rpi4-osdev/part12-wgt/samples/wgt39.c
2021-04-17 21:40:09 +01:00

101 lines
1.8 KiB
C

#include "include/wgt.h"
#include "include/mem.h"
#include "include/multicore.h"
// ######## REQUIRED FUNCTIONS ########
unsigned long state0 = 1000;
unsigned long state1 = 2000;
unsigned long rand(void)
{
unsigned long s1 = state0;
unsigned long s0 = state1;
state0 = s0;
s1 ^= s1 << 23;
s1 ^= s1 >> 17;
s1 ^= s0;
s1 ^= s0 >> 26;
state1 = s1;
return state0 + state1;
}
// ######## STUB FUNCTIONS ########
unsigned int kb = 0;
unsigned int kbhit(void) {
kb++;
return kb / 500;
}
void getch(void) {
wait_msec(0x500000);
kb = 0;
}
// ######## WGT EXAMPLES ########
void wgt39()
{
int i;
int px[256], py[256];
color p[256];
int numpix;
set_clock_rate(get_max_clock());
mem_init();
vga256 (); /* Initialize graphics mode */
start_core2(minit); // Start the comms engine (core 2)
while (!comms_up); // Wait for comms up
numpix = 255;
extern unsigned char _binary_bin_wgt1_pal_start[];
wloadpalette (&_binary_bin_wgt1_pal_start[0], p);
wsetpalette (0, 255, p);
for (i = 0; i < 256; i++)
{
px[i] = 0;
py[i] = 0;
}
do {
wsetcolor (vgapal[0]);
wait_msec(0x3E9F); // wait for retrace (ish)
for (i = numpix; i >= 1; i--)
{
wfastputpixel (px[i], py[i]);
wfastputpixel (319 - px[i], 199 - py[i]);
px[i] = px[i-1];
py[i] = py[i-1];
}
wsetcolor (vgapal[0]);
wfastputpixel (px[0], py[0]);
wfastputpixel (319 - px[0], 199 - py[0]);
px[0] = mx;
py[0] = my;
for (i = 0; i < numpix; i++)
{
wsetcolor (vgapal[i]);
wfastputpixel (px[i], py[i]);
wfastputpixel (319 - px[i], 199 - py[i]);
}
} while (!but);
mdeinit (); /* Deinitialize the mouse handler */
}
void main()
{
wgt39();
while (1);
}