91 lines
1.7 KiB
C
91 lines
1.7 KiB
C
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <stdarg.h>
|
|
#include "imports.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_SIZE_X (8)
|
|
#define CHAR_SIZE_Y (8)
|
|
|
|
u32* const framebuffer = (u32*)FRAMEBUFFER_ADDRESS;
|
|
|
|
void clearScreen(u32 color)
|
|
{
|
|
int i;
|
|
for(i = 0; i < ((FRAMEBUFFER_STRIDE * 504)/4); i++)
|
|
{
|
|
framebuffer[i] = color;
|
|
}
|
|
}
|
|
|
|
void clearLine(int y, u32 color)
|
|
{
|
|
u32* fb = &framebuffer[y * FRAMEBUFFER_STRIDE_WORDS];
|
|
u32* fb_end = &framebuffer[(y+CHAR_SIZE_Y) * FRAMEBUFFER_STRIDE_WORDS];
|
|
|
|
while(fb < fb_end)
|
|
{
|
|
*fb = color;
|
|
fb++;
|
|
}
|
|
}
|
|
|
|
void drawCharacter(char c, int x, int y)
|
|
{
|
|
if(c < 32)return;
|
|
c -= 32;
|
|
u8* charData = (u8*)&font_bin[(CHAR_SIZE_X * CHAR_SIZE_Y * c) / 8];
|
|
u32* fb = &framebuffer[x + y * FRAMEBUFFER_STRIDE_WORDS];
|
|
int i, j;
|
|
for(i = 0; i < CHAR_SIZE_Y; i++)
|
|
{
|
|
u8 v= *(charData++);
|
|
for(j = 0; j < CHAR_SIZE_X; j++)
|
|
{
|
|
if(v & 1) *fb = 0x00000000;
|
|
else *fb = 0xFFFFFFFF;
|
|
v >>= 1;
|
|
fb++;
|
|
}
|
|
fb += FRAMEBUFFER_STRIDE_WORDS - CHAR_SIZE_X;
|
|
}
|
|
}
|
|
|
|
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 += 8;
|
|
|
|
if(str[k] == '\n')
|
|
{
|
|
dx = 0;
|
|
dy -= 8;
|
|
}
|
|
}
|
|
}
|
|
|
|
void _printf(int x, int y, const char *format, ...)
|
|
{
|
|
va_list args;
|
|
va_start(args, format);
|
|
|
|
char buffer[0x100];
|
|
|
|
FS_VSNPRINTF(buffer, sizeof(buffer), format, args);
|
|
drawString(buffer, x, y);
|
|
|
|
va_end(args);
|
|
}
|