97 lines
2.1 KiB
C
97 lines
2.1 KiB
C
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <stdarg.h>
|
|
|
|
#include "types.h"
|
|
#include "font_bin.h"
|
|
|
|
#define FRAMEBUFFER_ADDRESS (0x14000000+0x38C0000)
|
|
#define FRAMEBUFFER_STRIDE (0xE00)
|
|
#define FRAMEBUFFER_STRIDE_WORDS (FRAMEBUFFER_STRIDE >> 2)
|
|
|
|
#define CHAR_MULT 2
|
|
#define CHAR_SIZE_X 8
|
|
#define CHAR_SIZE_Y 8
|
|
|
|
|
|
u32* const framebuffer = (u32*)FRAMEBUFFER_ADDRESS;
|
|
|
|
void clearScreen(u32 color)
|
|
{
|
|
int i;
|
|
for(i = 0; i < 896 * 504; i++)
|
|
{
|
|
framebuffer[i] = color;
|
|
}
|
|
}
|
|
|
|
void drawCharacter(char c, int x, int y)
|
|
{
|
|
if(c < 32)return;
|
|
c -= 32;
|
|
u8* charData = (u8*)&font_bin[(int)c << 3];
|
|
u32* fb = &framebuffer[x + y * FRAMEBUFFER_STRIDE_WORDS];
|
|
int i, j, n, k;
|
|
for(i = 0; i < CHAR_SIZE_Y; i++)
|
|
{
|
|
for(k = 0; k < CHAR_MULT; k++)
|
|
{
|
|
u8 v = *charData;
|
|
|
|
for(j = 0; j < CHAR_SIZE_X; j++)
|
|
{
|
|
for(n = 0; n < CHAR_MULT; n++)
|
|
{
|
|
if(v & 1)
|
|
{
|
|
*fb = 0x00000000;
|
|
}
|
|
else
|
|
{
|
|
*fb = 0xFFFFFFFF;
|
|
}
|
|
fb++;
|
|
}
|
|
v >>= 1;
|
|
}
|
|
fb += FRAMEBUFFER_STRIDE_WORDS - CHAR_SIZE_X * CHAR_MULT;
|
|
}
|
|
charData++;
|
|
}
|
|
}
|
|
|
|
void drawString(char* str, int x, int y)
|
|
{
|
|
if(!str) return;
|
|
int k;
|
|
int dx = 0, dy = 0;
|
|
for(k = 0; str[k]; k++)
|
|
{
|
|
if(str[k] >= 32 && str[k] < 128)
|
|
drawCharacter(str[k], x + dx, y + dy);
|
|
|
|
dx += CHAR_SIZE_X * CHAR_MULT;
|
|
|
|
if(str[k] == '\n')
|
|
{
|
|
dx = 0;
|
|
dy -= CHAR_SIZE_Y * CHAR_MULT;
|
|
}
|
|
}
|
|
}
|
|
|
|
void _printf(int x, int y, const char *format, ...)
|
|
{
|
|
void (*kernel_vsnprintf)(char * s, size_t n, const char * format, va_list arg) = (void*)0x0813293C;
|
|
|
|
va_list args;
|
|
va_start(args, format);
|
|
static char buffer[0x100];
|
|
|
|
kernel_vsnprintf(buffer, 0xFF, format, args);
|
|
drawString(buffer, x, y);
|
|
|
|
va_end(args);
|
|
}
|