#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/module.h>
#include <sys/syslog.h>
#include <sys/consio.h>
#include <sys/fbio.h>
#include <dev/fb/fbreg.h>
#include <dev/fb/splashreg.h>
#include <dev/syscons/syscons.h>
#define SAVER_NAME "warp_saver"
#define SPP 15
#define STARS (SPP * (1 + 2 + 4 + 8))
#define SET_ORIGIN(adp, o) do { \
int oo = o; \
if (oo != last_origin) \
vidd_set_win_org(adp, last_origin = oo); \
} while (0)
static u_char *vid;
static int banksize, scrmode, bpsl, scrw, scrh;
static int blanked;
static int star[STARS];
static u_char warp_pal[768] = {
0x00, 0x00, 0x00,
0x66, 0x66, 0x66,
0x99, 0x99, 0x99,
0xcc, 0xcc, 0xcc,
0xff, 0xff, 0xff
};
static void
warp_update(video_adapter_t *adp)
{
int i, j, k, n, o, p;
int last_origin = -1;
for (i = 1, k = 0, n = SPP*8; i < 5; i++, n /= 2) {
for (j = 0; j < n; j++, k++) {
p = (star[k] / scrw) * bpsl + (star[k] % scrw);
o = 0;
while (p > banksize) {
p -= banksize;
o += banksize;
}
SET_ORIGIN(adp, o);
vid[p] = 0;
star[k] += i;
if (star[k] > scrw*scrh)
star[k] -= scrw*scrh;
p = (star[k] / scrw) * bpsl + (star[k] % scrw);
o = 0;
while (p > banksize) {
p -= banksize;
o += banksize;
}
SET_ORIGIN(adp, o);
vid[p] = i;
}
}
}
static int
warp_saver(video_adapter_t *adp, int blank)
{
int pl;
if (blank) {
if (blanked <= 0) {
pl = splhigh();
vidd_set_mode(adp, scrmode);
vidd_load_palette(adp, warp_pal);
vidd_set_border(adp, 0);
blanked++;
vid = (u_char *)adp->va_window;
banksize = adp->va_window_size;
bpsl = adp->va_line_width;
splx(pl);
vidd_clear(adp);
}
warp_update(adp);
} else {
blanked = 0;
}
return (0);
}
static int
warp_init(video_adapter_t *adp)
{
video_info_t info;
int i;
if (!vidd_get_info(adp, M_VGA_CG320, &info)) {
scrmode = M_VGA_CG320;
} else {
log(LOG_NOTICE,
"%s: the console does not support M_VGA_CG320\n",
SAVER_NAME);
return (ENODEV);
}
scrw = info.vi_width;
scrh = info.vi_height;
for (i = 0; i < STARS; i++)
star[i] = random() % (scrw * scrh);
return (0);
}
static int
warp_term(video_adapter_t *adp)
{
return (0);
}
static scrn_saver_t warp_module = {
SAVER_NAME,
warp_init,
warp_term,
warp_saver,
NULL
};
SAVER_MODULE(warp_saver, warp_module);