mirror of
https://github.com/isometimes/rpi4-osdev
synced 2024-11-13 22:00:40 +00:00
260 lines
6.1 KiB
C
260 lines
6.1 KiB
C
#include "io.h"
|
|
#include "mb.h"
|
|
#include "terminal.h"
|
|
|
|
unsigned int width, height, pitch, isrgb;
|
|
unsigned char *fb;
|
|
|
|
int curx = 0;
|
|
int cury = 0;
|
|
|
|
void fb_init()
|
|
{
|
|
mbox[0] = 35*4; // Length of message in bytes
|
|
mbox[1] = MBOX_REQUEST;
|
|
|
|
mbox[2] = MBOX_TAG_SETPHYWH; // Tag identifier
|
|
mbox[3] = 8; // Value size in bytes
|
|
mbox[4] = 8; // Value size in bytes (again!)
|
|
mbox[5] = 1920; // Value(width)
|
|
mbox[6] = 1080; // Value(height)
|
|
|
|
mbox[7] = MBOX_TAG_SETVIRTWH;
|
|
mbox[8] = 8;
|
|
mbox[9] = 8;
|
|
mbox[10] = 1920;
|
|
mbox[11] = 1080;
|
|
|
|
mbox[12] = MBOX_TAG_SETVIRTOFF;
|
|
mbox[13] = 8;
|
|
mbox[14] = 8;
|
|
mbox[15] = 0; // Value(x)
|
|
mbox[16] = 0; // Value(y)
|
|
|
|
mbox[17] = MBOX_TAG_SETDEPTH;
|
|
mbox[18] = 4;
|
|
mbox[19] = 4;
|
|
mbox[20] = 32; // Bits per pixel
|
|
|
|
mbox[21] = MBOX_TAG_SETPXLORDR;
|
|
mbox[22] = 4;
|
|
mbox[23] = 4;
|
|
mbox[24] = 1; // RGB
|
|
|
|
mbox[25] = MBOX_TAG_GETFB;
|
|
mbox[26] = 8;
|
|
mbox[27] = 8;
|
|
mbox[28] = 4096; // FrameBufferInfo.pointer
|
|
mbox[29] = 0; // FrameBufferInfo.size
|
|
|
|
mbox[30] = MBOX_TAG_GETPITCH;
|
|
mbox[31] = 4;
|
|
mbox[32] = 4;
|
|
mbox[33] = 0; // Bytes per line
|
|
|
|
mbox[34] = MBOX_TAG_LAST;
|
|
|
|
// Check call is successful and we have a pointer with depth 32
|
|
if (mbox_call(MBOX_CH_PROP) && mbox[20] == 32 && mbox[28] != 0) {
|
|
mbox[28] &= 0x3FFFFFFF; // Convert GPU address to ARM address
|
|
width = mbox[10]; // Actual physical width
|
|
height = mbox[11]; // Actual physical height
|
|
pitch = mbox[33]; // Number of bytes per line
|
|
isrgb = mbox[24]; // Pixel order
|
|
fb = (unsigned char *)((long)mbox[28]);
|
|
}
|
|
}
|
|
|
|
void drawPixel(int x, int y, unsigned char attr)
|
|
{
|
|
int offs = (y * pitch) + (x * 4);
|
|
*((unsigned int*)(fb + offs)) = vgapal[attr & 0x0f];
|
|
}
|
|
|
|
void drawRect(int x1, int y1, int x2, int y2, unsigned char attr, int fill)
|
|
{
|
|
int y=y1;
|
|
|
|
while (y <= y2) {
|
|
int x=x1;
|
|
while (x <= x2) {
|
|
if ((x == x1 || x == x2) || (y == y1 || y == y2)) drawPixel(x, y, attr);
|
|
else if (fill) drawPixel(x, y, (attr & 0xf0) >> 4);
|
|
x++;
|
|
}
|
|
y++;
|
|
}
|
|
}
|
|
|
|
void drawLine(int x1, int y1, int x2, int y2, unsigned char attr)
|
|
{
|
|
int dx, dy, p, x, y;
|
|
|
|
dx = x2-x1;
|
|
dy = y2-y1;
|
|
x = x1;
|
|
y = y1;
|
|
p = 2*dy-dx;
|
|
|
|
while (x<x2) {
|
|
if (p >= 0) {
|
|
drawPixel(x,y,attr);
|
|
y++;
|
|
p = p+2*dy-2*dx;
|
|
} else {
|
|
drawPixel(x,y,attr);
|
|
p = p+2*dy;
|
|
}
|
|
x++;
|
|
}
|
|
}
|
|
|
|
void drawCircle(int x0, int y0, int radius, unsigned char attr, int fill)
|
|
{
|
|
int x = radius;
|
|
int y = 0;
|
|
int err = 0;
|
|
|
|
while (x >= y) {
|
|
if (fill) {
|
|
drawLine(x0 - y, y0 + x, x0 + y, y0 + x, (attr & 0xf0) >> 4);
|
|
drawLine(x0 - x, y0 + y, x0 + x, y0 + y, (attr & 0xf0) >> 4);
|
|
drawLine(x0 - x, y0 - y, x0 + x, y0 - y, (attr & 0xf0) >> 4);
|
|
drawLine(x0 - y, y0 - x, x0 + y, y0 - x, (attr & 0xf0) >> 4);
|
|
}
|
|
drawPixel(x0 - y, y0 + x, attr);
|
|
drawPixel(x0 + y, y0 + x, attr);
|
|
drawPixel(x0 - x, y0 + y, attr);
|
|
drawPixel(x0 + x, y0 + y, attr);
|
|
drawPixel(x0 - x, y0 - y, attr);
|
|
drawPixel(x0 + x, y0 - y, attr);
|
|
drawPixel(x0 - y, y0 - x, attr);
|
|
drawPixel(x0 + y, y0 - x, attr);
|
|
|
|
if (err <= 0) {
|
|
y += 1;
|
|
err += 2*y + 1;
|
|
}
|
|
|
|
if (err > 0) {
|
|
x -= 1;
|
|
err -= 2*x + 1;
|
|
}
|
|
}
|
|
}
|
|
|
|
void drawChar(unsigned char ch, int x, int y, unsigned char attr, int zoom)
|
|
{
|
|
unsigned char *glyph = (unsigned char *)&font + (ch < FONT_NUMGLYPHS ? ch : 0) * FONT_BPG;
|
|
|
|
for (int i=1;i<=(FONT_HEIGHT*zoom);i++) {
|
|
for (int j=0;j<(FONT_WIDTH*zoom);j++) {
|
|
unsigned char mask = 1 << (j/zoom);
|
|
unsigned char col = (*glyph & mask) ? attr & 0x0f : (attr & 0xf0) >> 4;
|
|
|
|
drawPixel(x+j, y+i, col);
|
|
}
|
|
glyph += (i%zoom) ? 0 : FONT_BPL;
|
|
}
|
|
}
|
|
|
|
void drawString(int x, int y, char *s, unsigned char attr, int zoom)
|
|
{
|
|
while (*s) {
|
|
if (*s == '\r') {
|
|
x = 0;
|
|
} else if(*s == '\n') {
|
|
x = 0; y += (FONT_HEIGHT*zoom);
|
|
} else {
|
|
drawChar(*s, x, y, attr, zoom);
|
|
x += (FONT_WIDTH*zoom);
|
|
}
|
|
s++;
|
|
}
|
|
}
|
|
|
|
void moveRect(int oldx, int oldy, int width, int height, int shiftx, int shifty, unsigned char attr)
|
|
{
|
|
unsigned int newx = oldx + shiftx, newy = oldy + shifty;
|
|
unsigned int xcount = 0, ycount = 0;
|
|
unsigned int bitmap[width][height]; // This is very unsafe if it's too big for the stack...
|
|
unsigned int offs;
|
|
|
|
// Save the bitmap
|
|
while (xcount < width) {
|
|
while (ycount < height) {
|
|
offs = ((oldy + ycount) * pitch) + ((oldx + xcount) * 4);
|
|
|
|
bitmap[xcount][ycount] = *((unsigned int*)(fb + offs));
|
|
ycount++;
|
|
}
|
|
ycount=0;
|
|
xcount++;
|
|
}
|
|
// Wipe it out with background colour
|
|
drawRect(oldx, oldy, oldx + width, oldy + width, attr, 1);
|
|
// Draw it again
|
|
for (int i=newx;i<newx + width;i++) {
|
|
for (int j=newy;j<newy + height;j++) {
|
|
offs = (j * pitch) + (i * 4);
|
|
*((unsigned int*)(fb + offs)) = bitmap[i-newx][j-newy];
|
|
}
|
|
}
|
|
}
|
|
|
|
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);
|
|
}
|
|
|
|
int strlen(const char *str) {
|
|
const char *s;
|
|
|
|
for (s = str; *s; ++s);
|
|
return (s - str);
|
|
}
|
|
|
|
void debugstr(char *str) {
|
|
if (curx + (strlen(str) * 8) >= 1920) {
|
|
curx = 0; cury += 8;
|
|
}
|
|
if (cury + 8 >= 1080) {
|
|
cury = 0;
|
|
}
|
|
drawString(curx, cury, str, 0x0f, 1);
|
|
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(" ");
|
|
}
|