text.c

#include "text.h"
#include "font.h"
#include "graphics.h"
#include "myLib.h"

/**
 * Draws a character at a given row and column
 */
void drawChar(int row, int col, char ch, unsigned short color, unsigned short background) {
    for (int r = 0; r < 8; r++) {
        for (int c = 0; c < 6; c++) {
            if (fontdata_6x8[OFFSET(r, c, 6) + ch * 48]) {
                setPixel(row + r, col + c, color);
            } else {
                setPixel(row + r, col + c, background);
            }
        }
    }
}

/**
 * Draws a string at a given row and column
 */
void drawString(int row, int col, char str[], unsigned short color, unsigned short background) {
	for (int i = 0; str[i] != 0; i++) {
		drawChar(row, col + i * 6, str[i], color, background);
	}
}