120 lines
2.2 KiB
C
120 lines
2.2 KiB
C
|
#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
|
||
|
|
};
|
||
|
|
|
||
|
|
|