void lcd_writechar(unsigned char b) { unsigned char i,j,c; if (lcd_xpos+5>=160) { lcd_xpos=0; if (lcd_ypos+7>=80) lcd_ypos=0; } for (i=0; i<8; i++) { c=pgm_read_byte(&font[b][i]); for (j=0; j<6; j++) { if (c&(32>>j)) lcd_setpixel(lcd_xpos+j,lcd_ypos+i); else lcd_clrpixel(lcd_xpos+j,lcd_ypos+i); } } lcd_xpos+=6; }