mirror of
https://github.com/isometimes/rpi4-osdev
synced 2024-11-08 19:30:39 +00:00
Added wticker.c and wgt03.c which exercises it - SMP required
This commit is contained in:
parent
e49504d577
commit
065f413ea7
5 changed files with 221 additions and 2 deletions
147
part12-wgt/examples/wgt03.c
Normal file
147
part12-wgt/examples/wgt03.c
Normal file
|
@ -0,0 +1,147 @@
|
|||
#include "wgt.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;
|
||||
}
|
||||
|
||||
void wait_msec(unsigned int n)
|
||||
{
|
||||
register unsigned long f, t, r;
|
||||
|
||||
// Get the current counter frequency
|
||||
asm volatile ("mrs %0, cntfrq_el0" : "=r"(f));
|
||||
// Read the current counter
|
||||
asm volatile ("mrs %0, cntpct_el0" : "=r"(t));
|
||||
// Calculate expire value for counter
|
||||
t+=((f/1000)*n)/1000;
|
||||
do{asm volatile ("mrs %0, cntpct_el0" : "=r"(r));}while(r<t);
|
||||
}
|
||||
|
||||
// ######## STUB FUNCTIONS ########
|
||||
|
||||
unsigned int kb = 0;
|
||||
|
||||
unsigned int kbhit(void) {
|
||||
kb++;
|
||||
return kb / 500;
|
||||
}
|
||||
|
||||
void getch(void) {
|
||||
wait_msec(0x500000);
|
||||
kb = 0;
|
||||
}
|
||||
|
||||
// ######## WGT EXAMPLES ########
|
||||
|
||||
#define TIMERSPEED 60 /* timer_routine is called 60 times per second */
|
||||
|
||||
int timer; /* Counts how many times it has been called */
|
||||
int clearcount; /* Counts the number of screen clears. */
|
||||
|
||||
int curx = 0;
|
||||
int cury = 0;
|
||||
|
||||
void debugstr(char *str) {
|
||||
if (curx + (strlen(str) * 8) >= 1920) {
|
||||
curx = 0; cury += 8;
|
||||
}
|
||||
if (cury + 8 >= 1080) {
|
||||
cury = 0;
|
||||
}
|
||||
wtextcolor(vgapal[15]);
|
||||
wouttextxy (curx, cury, NULL, str);
|
||||
|
||||
curx += (strlen(str) * 8);
|
||||
}
|
||||
|
||||
void debugcrlf(void) {
|
||||
curx = 0; cury += 8;
|
||||
}
|
||||
|
||||
void debugch(unsigned char b) {
|
||||
unsigned int n;
|
||||
int c;
|
||||
for(c=4;c>=0;c-=4) {
|
||||
n=(b>>c)&0xF;
|
||||
n+=n>9?0x37:0x30;
|
||||
debugstr((char *)&n);
|
||||
}
|
||||
debugstr(" ");
|
||||
}
|
||||
|
||||
void debughex(unsigned int d) {
|
||||
unsigned int n;
|
||||
int c;
|
||||
for(c=28;c>=0;c-=4) {
|
||||
n=(d>>c)&0xF;
|
||||
n+=n>9?0x37:0x30;
|
||||
debugstr((char *)&n);
|
||||
}
|
||||
debugstr(" ");
|
||||
}
|
||||
|
||||
void timer_routine (void)
|
||||
{
|
||||
timer++;
|
||||
}
|
||||
|
||||
void wgt03()
|
||||
{
|
||||
vga256 (); /* Initialize WGT system */
|
||||
|
||||
debugstr ("WGT Example #3"); debugcrlf(); debugcrlf();
|
||||
debugstr ("This program will use the wcls routine to clear the screen"); debugcrlf();
|
||||
debugstr ("using random colors as fast as it can until you press a key."); debugcrlf();
|
||||
debugstr ("It will then report the highest frame rate possible on your computer."); debugcrlf(); debugcrlf(); debugcrlf();
|
||||
debugstr ("Press any key to continue."); debugcrlf();
|
||||
getch ();
|
||||
|
||||
clearcount = 0;
|
||||
timer = 0;
|
||||
|
||||
winittimer ();
|
||||
wstarttimer (timer_routine, TIMERSPEED);
|
||||
|
||||
curx = 0;
|
||||
cury = 0;
|
||||
|
||||
while (!kbhit ())
|
||||
{
|
||||
wcls(vgapal[rand() % 256]); /* Clear with random color out of 256 */
|
||||
clearcount++;
|
||||
}
|
||||
|
||||
wstoptimer ();
|
||||
wdonetimer ();
|
||||
|
||||
getch ();
|
||||
|
||||
wcls(vgapal[0]);
|
||||
|
||||
unsigned int fps = clearcount / (timer / TIMERSPEED);
|
||||
debughex(fps); debugstr("frames per second"); debugcrlf();
|
||||
debugstr ("This is the highest frame rate your computer can produce for full screen\n"); debugcrlf();
|
||||
debugstr ("animation."); debugcrlf();
|
||||
}
|
||||
|
||||
void main()
|
||||
{
|
||||
wgt03();
|
||||
while (1);
|
||||
}
|
|
@ -69,7 +69,7 @@ void wgt08()
|
|||
|
||||
getch ();
|
||||
|
||||
wcls (0);
|
||||
wcls (vgapal[0]);
|
||||
for (x = 1; x < 10000; x++) /* try filling 10,000 random pixels */
|
||||
{
|
||||
wsetcolor (vgapal[rand() % 255]);
|
||||
|
|
|
@ -3,7 +3,7 @@ extern unsigned char _end[];
|
|||
// Define the heap
|
||||
|
||||
unsigned char *HEAP_START = &_end[0];
|
||||
unsigned int HEAP_SIZE = 0x40000000; // Max heap size is 1Gb
|
||||
unsigned int HEAP_SIZE = 0x30000000; // Max heap size is 768Mb
|
||||
unsigned char *HEAP_END;
|
||||
|
||||
// Set up some globals
|
||||
|
|
|
@ -86,3 +86,8 @@ short wgetblockwidth (block ptr);
|
|||
short wgetblockheight (block ptr);
|
||||
block wnewblock (short x, short y, short x2, short y2);
|
||||
block wallocblock (short width, short height);
|
||||
void wdonetimer (void);
|
||||
void winittimer (void);
|
||||
void wsettimerspeed (int speed);
|
||||
void wstarttimer (void (*rout)(), int speed);
|
||||
void wstoptimer (void);
|
||||
|
|
67
part12-wgt/wticker.c
Normal file
67
part12-wgt/wticker.c
Normal file
|
@ -0,0 +1,67 @@
|
|||
#include "wgt.h"
|
||||
#include "include/multicore.h"
|
||||
|
||||
short ticker_speed, ticker_running;
|
||||
unsigned int ticker_interval;
|
||||
void (*ticker_routine)();
|
||||
|
||||
void twait(unsigned int n)
|
||||
{
|
||||
register unsigned long f, t, r;
|
||||
|
||||
// Get the current counter frequency
|
||||
asm volatile ("mrs %0, cntfrq_el0" : "=r"(f));
|
||||
// Read the current counter
|
||||
asm volatile ("mrs %0, cntpct_el0" : "=r"(t));
|
||||
// Calculate expire value for counter
|
||||
t+=((f/1000)*n)/1000;
|
||||
do{asm volatile ("mrs %0, cntpct_el0" : "=r"(r));}while(r<t);
|
||||
}
|
||||
|
||||
void widletimer (void)
|
||||
{
|
||||
/* do nothing */
|
||||
}
|
||||
|
||||
void winittimer (void)
|
||||
{
|
||||
ticker_running = 0;
|
||||
wsettimerspeed (60);
|
||||
}
|
||||
|
||||
void wdonetimer (void)
|
||||
{
|
||||
wsettimerspeed (60);
|
||||
ticker_running = 0;
|
||||
}
|
||||
|
||||
void wsettimerspeed (int speed)
|
||||
{
|
||||
ticker_speed = speed;
|
||||
ticker_interval = 1000000 / speed;
|
||||
}
|
||||
|
||||
void wtick(void)
|
||||
{
|
||||
clear_core1();
|
||||
|
||||
while (ticker_running) {
|
||||
twait(ticker_interval);
|
||||
ticker_routine();
|
||||
}
|
||||
}
|
||||
|
||||
void wstarttimer (void (*Rout)(), int speed)
|
||||
{
|
||||
ticker_routine = Rout;
|
||||
wsettimerspeed (speed);
|
||||
ticker_running = 1;
|
||||
|
||||
start_core1(wtick);
|
||||
}
|
||||
|
||||
void wstoptimer (void)
|
||||
{
|
||||
ticker_routine = widletimer;
|
||||
wsettimerspeed (19);
|
||||
}
|
Loading…
Reference in a new issue