crashtest-r0ket/lcd/render.c

120 lines
2.2 KiB
C
Raw Normal View History

#include <sysdefs.h>
#include <render.h>
#include <fonts.h>
/* Global Variables */
const struct FONT_DEF * font = NULL;
char font_direction = FONT_DIR_LTR;
/* Exported Functions */
int DoChar(int sx, int sy, char c){
int rx=RESX-sx-1;
int ry=RESY-sy-font->u8Height;
if(c<font->u8FirstChar || c>font->u8LastChar)
c=font->u8FirstChar+1; // error
int off;
int x;
int byte;
int dmul=0;
if(font_direction==FONT_DIR_RTL)
dmul=1;
else if (font_direction==FONT_DIR_LTR)
dmul=-1;
off=(c-font->u8FirstChar)*font->u8Width;
char yidx=ry/8;
if(0 && sy%8==0){
for(x=0;x<font->u8Width;x++){
buffer[(sx+x)+yidx*96]=font->au8FontTable[off+x];
};
}else{
char yoff=ry%8;
unsigned char mask;
if(font->u8Height == 6)
mask=255-3;
else
mask=255;
if(font_direction==FONT_DIR_LTR)
flip(mask);
for(x=0;x<font->u8Width;x++){
byte=font->au8FontTable[off+x];
if(font_direction==FONT_DIR_LTR)
flip(byte);
#ifdef SANITY
if(rx+x <0 || rx+x > RESX)
gpioSetValue (CFG_LED_PORT, CFG_LED_PIN, CFG_LED_ON);
if(yidx<0 || yidx> RESY/8) // Gah. non-integer height. XXX fixme
gpioSetValue (CFG_LED_PORT, CFG_LED_PIN, CFG_LED_ON);
#endif
buffer[(rx+dmul*x)+yidx*96]&=~((mask)<<yoff);
buffer[(rx+dmul*x)+yidx*96]|=byte<<yoff;
buffer[(rx+dmul*x)+(yidx+1)*96]&=~((mask)>>(8-yoff));
buffer[(rx+dmul*x)+(yidx+1)*96]|=byte>>(8-yoff);
};
};
return sx-dmul*x;
};
int DoString(int sx, int sy, char *s){
char *c;
for(c=s;*c!=0;c++){
sx=DoChar(sx,sy,*c);
};
return sx;
};
int DoInt(int sx, int sy, int num){
#define mxlen 5
char s[(mxlen+1)];
char * o=s;
int len;
s[mxlen]=0;
char neg=0;
if(num<0){
num=-num;
neg=1;
};
for (len=(mxlen-1);len>=0;len--){
s[len]=(num%10)+'0';
if(num==0){
s[len]=' '; // configurable?
o=s+len;
break;
};
num/=10;
};
if(neg)
*o='-';
return DoString(sx,sy,o);
#undef mxlen
};
int DoIntX(int sx, int sy, unsigned int num){
#define mxlen 8
char s[(mxlen+1)];
char * o=s;
int len;
s[mxlen]=0;
for (len=(mxlen-1);len>=0;len--){
s[len]=(num%16)+'0';
if(s[len]>'9')
s[len]+='A'-'9'-1;
if(num==0){
// s[len]=' '; // configurable?
// o=s+len; break;
};
num/=16;
};
return DoString(sx,sy,o);
#undef mxlen
};