86 lines
2.3 KiB
C
86 lines
2.3 KiB
C
#include "st7735_font.h"
|
|
|
|
#include <string.h>
|
|
#include <avr/pgmspace.h>
|
|
|
|
#include "st7735.h"
|
|
|
|
|
|
|
|
void st7735_draw_char(int16_t x, int16_t y, const GFXglyph *glyph, const GFXfont *font,
|
|
uint8_t size, uint16_t color) {
|
|
if(size < 1) {
|
|
return;
|
|
}
|
|
|
|
// Clipping will be done by fill rect if necessary
|
|
|
|
uint8_t *bitmap = font->bitmap;
|
|
uint16_t bo = glyph->bitmapOffset;
|
|
uint8_t bits = 0, bit = 0;
|
|
uint16_t set_pixels = 0;
|
|
|
|
uint8_t cur_x, cur_y;
|
|
for(cur_y = 0; cur_y < glyph->height; cur_y++) {
|
|
for(cur_x = 0; cur_x < glyph->width; cur_x++) {
|
|
if(bit == 0) {
|
|
bits = pgm_read_byte(&bitmap[bo++]);
|
|
bit = 0x80;
|
|
}
|
|
|
|
if(bits & bit) {
|
|
set_pixels++;
|
|
} else if (set_pixels > 0) {
|
|
st7735_fill_rect(x + (glyph->xOffset + cur_x-set_pixels) * size,
|
|
y + (glyph->yOffset+cur_y) * size,
|
|
size * set_pixels,
|
|
size,
|
|
color);
|
|
set_pixels=0;
|
|
}
|
|
|
|
bit >>= 1;
|
|
}
|
|
|
|
// Draw rest of line
|
|
if (set_pixels > 0) {
|
|
st7735_fill_rect(x + (glyph->xOffset + cur_x-set_pixels) * size,
|
|
y + (glyph->yOffset + cur_y) * size,
|
|
size * set_pixels,
|
|
size,
|
|
color);
|
|
set_pixels=0;
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
void st7735_draw_text(int8_t x, int8_t y, char *text, const GFXfont *p_font,
|
|
uint8_t size, uint16_t color) {
|
|
|
|
int16_t cursor_x = x;
|
|
int16_t cursor_y = y;
|
|
|
|
GFXfont font;
|
|
memcpy_P(&font, p_font, sizeof(GFXfont));
|
|
|
|
|
|
for(uint16_t text_pos = 0; text_pos < strlen(text); text_pos++) {
|
|
char c = text[text_pos];
|
|
|
|
if(c == '\n') {
|
|
cursor_x = x;
|
|
cursor_y += font.yAdvance * size;
|
|
}
|
|
else if(c >= font.first && c <= font.last && c != '\r') {
|
|
GFXglyph glyph;
|
|
memcpy_P(&glyph, &font.glyph[c - font.first], sizeof(GFXglyph));
|
|
|
|
st7735_draw_char(cursor_x, cursor_y, &glyph, &font, size, color);
|
|
cursor_x += glyph.xAdvance * size;
|
|
}
|
|
|
|
}
|
|
|
|
}
|