diagram.json

#include "system.h"
#include "hd44780.h"
#include "spi.h"
#include "ili9341.h"
#include "gfx.h"
#include "fonts.h"

char * buf[10];
uint32_t stamp = 0;
uint16_t framecount = 0;
uint16_t fps = 0;

font_t * font = &LiberationSansRegular15;
const uint8_t * holiday = "ABC";

void setup() {
	spi_enable();
	ili9341_enable(PinB2, PinB1);
	ili9341_set_pixel(0, 0, 0xffff);

	hd44780_enable(PinC2, PinC1, PinC0, PortD);

	
}

void loop() {
	uint32_t now = system_ms();
	if (now % 1000 < stamp % 1000) {
		fps = framecount;
		framecount = 0;
	}
	stamp = now;
	framecount++;
	sprintf(&buf, "TIME:%05lu", system_ms());
	hd44780_print(0, 0, buf);
	draw_text(0, 0, buf, font, White, Black, false);

	sprintf(&buf, "FPS:%u", fps);
	hd44780_print(0, 1, buf);
	draw_text(0, 20, buf, font, White, Black, false);
}


main.c

#include <avr/io.h>
#include <stdbool.h>
#include "gpio.h"

void pin_mode(pin_t pin, pin_mode_t mode) {
	volatile uint8_t * portx = 0x20 + (2 + 3 * (pin >> 8));
	volatile uint8_t * ddrx = 0x20 + (1 + 3 * (pin >> 8));
  uint8_t pin_mask = pin & 0xff;
	switch (mode) {
		case Input:
      *ddrx &= ~pin_mask;
			*portx &= ~pin_mask;
			break;
		case InputPullup:
      *ddrx &= ~pin_mask;
      *portx |= pin_mask;
			break;
		case Output:
			*ddrx |= pin_mask;
      *portx &= ~pin_mask;
			break;
	}
}

void port_mode(port_t port, pin_mode_t mode) {
	volatile uint8_t * portx = 0x20 + (2 + 3 * (port));
	volatile uint8_t * ddrx = 0x20 + (1 + 3 * port);
	switch (mode) {
		case Input:
			*ddrx = 0;
			*portx = 0;
			break;
		case InputPullup:
      *ddrx = 0;
      *portx = 0xff;
			break;
		case Output:
			*ddrx = 0xff;
			*portx = 0;
			break;
	}
}

void pin_set(pin_t pin) {
	volatile uint8_t * portx = 0x20 + (2 + 3 * (pin >> 8));
  uint8_t pin_mask = pin & 0xff;
  *portx |= pin_mask;
}

void pin_reset(pin_t pin) {
	volatile uint8_t * portx = 0x20 + (2 + 3 * (pin >> 8));
  uint8_t pin_mask = pin & 0xff;
  *portx &= ~pin_mask;
}

void pin_write(pin_t pin, bool value) {
	if (value)
		pin_set(pin);
	else
		pin_reset(pin);
}

bool pin_read(pin_t pin) {
	volatile uint8_t * portx = 0x20 + (2 + 3 * (pin >> 8));
	return *portx & (pin & 0xff);
}
void port_write_byte(port_t port, uint8_t value) {
	volatile uint8_t * portx = 0x20 + (2 + 3 * (port));
	*portx = value;
}

uint8_t port_read_byte(port_t port) {
	volatile uint8_t * portx = 0x20 + (2 + 3 * (port));
	return *portx;
}


gpio.c

#ifndef _gpio_h
#define _gpio_h
#include <stdint.h>
#include <stdbool.h>

typedef enum {
  Input,
  InputPullup,
  Output,
} pin_mode_t;

typedef enum {
  PortA = 0,
  PortB = 1,
  PortC = 2,
  PortD = 3,
} port_t;

typedef enum {
  PinA0 = 0x0001,
  PinA1 = 0x0002,
  PinA2 = 0x0004,
  PinA3 = 0x0008,
  PinA4 = 0x0010,
  PinA5 = 0x0020,
  PinA6 = 0x0040,
  PinA7 = 0x0080,
  PinB0 = 0x0101,
  PinB1 = 0x0102,
  PinB2 = 0x0104,
  PinB3 = 0x0108,
  PinB4 = 0x0110,
  PinB5 = 0x0120,
  PinB6 = 0x0140,
  PinB7 = 0x0180,
  PinC0 = 0x0201,
  PinC1 = 0x0202,
  PinC2 = 0x0204,
  PinC3 = 0x0208,
  PinC4 = 0x0210,
  PinC5 = 0x0220,
  PinC6 = 0x0240,
  PinC7 = 0x0280,
  PinD0 = 0x0301,
  PinD1 = 0x0302,
  PinD2 = 0x0304,
  PinD3 = 0x0308,
  PinD4 = 0x0310,
  PinD5 = 0x0320,
  PinD6 = 0x0340,
  PinD7 = 0x0380,
} pin_t;

#ifdef __cplusplus
extern "C" {
#endif
void pin_mode(pin_t pin, pin_mode_t mode);
void pin_set(pin_t pin);
void pin_reset(pin_t pin);
void pin_write(pin_t pin, bool value);
bool pin_read(pin_t pin);
void port_mode(port_t port, pin_mode_t mode);
void port_write_byte(port_t port, uint8_t value);
uint8_t port_read_byte(port_t port);
#ifdef __cplusplus
}
#endif
#endif


gpio.h

#include "hd44780.h"
#include "gpio.h"

typedef enum {
  CLEAR_DISPLAY = 0x01,
  RETURN_HOME = 0x02,
  ENTRY_MODE_SET = 0x04,
  DISPLAY_ON_OFF_CONTROL = 0x08,
  CURSOR_OR_DISPLAY_SHIFT = 0x10,
  FUNCTION_SET = 0x20,
  SET_CGRAM_ADDRESS = 0x40,
  SET_DDRAM_ADDRESS = 0x80,
} hd44780_command_t;

static pin_t _rs_pin;
static pin_t _rw_pin;
static pin_t _e_pin;
static port_t _data_port;

static void hd44780_write(uint8_t data, bool rs) {
  // TODO: delay
  pin_reset(_e_pin);
  pin_write(_rs_pin, rs);
  pin_reset(_rw_pin);
  port_mode(_data_port, Output);
  port_write_byte(_data_port, data);
  pin_set(_e_pin);
  pin_reset(_e_pin);
  pin_set(_rw_pin);
  port_mode(_data_port, Input);
  while (port_read_byte(_data_port) & 0x80);
}

static void hd44780_write_command(uint8_t command) {
  hd44780_write(command, false);
}

static void hd44780_write_data(uint8_t data) {
  hd44780_write(data, true);
}

void hd44780_enable(pin_t rs_pin, pin_t rw_pin, pin_t e_pin, port_t data_port) {
  _rs_pin = rs_pin;
  _rw_pin = rw_pin;
  _e_pin = e_pin;
  _data_port = data_port;
  pin_mode(_rs_pin, Output);
  pin_mode(_rw_pin, Output);
  pin_mode(_e_pin, Output);
  port_mode(_data_port, Output);
  hd44780_write_command(DISPLAY_ON_OFF_CONTROL + 4);
  hd44780_write_command(CLEAR_DISPLAY);
}

void hd44780_disable() {
  hd44780_write_command(DISPLAY_ON_OFF_CONTROL);
}

void hd44780_print(uint8_t x, uint8_t y, uint8_t * data) {
  uint8_t addr = (uint8_t[]){0, 64, 20, 84}[y] + x;
  hd44780_write_command(SET_DDRAM_ADDRESS + addr);
  uint8_t i = 0;
  while (data[i] != 0)
    hd44780_write_data(data[i++]);
}

hd44780.c

#ifndef _hd44780_h
#define _hd44780_h
#include "gpio.h"
#include <stdint.h>
#include <stdbool.h>

#ifdef __cplusplus
extern "C" {
#endif

void hd44780_enable(pin_t rs_pin, pin_t rw_pin, pin_t e_pin, port_t data_port);
void hd44780_disable();
void hd44780_print(uint8_t x, uint8_t y, uint8_t * data);

#ifdef __cplusplus
}
#endif
#endif


hd44780.h

#include <avr/io.h>
#include <avr/interrupt.h>
#include "system.h"
#include <stdint.h>

static volatile uint64_t _microseconds;

ISR(TIMER0_OVF_vect) {
	_microseconds += 1024;
}

uint64_t system_us() {
	return _microseconds;
}

uint32_t system_ms() {
	return system_us() / 1000;
}


void delay_ms(uint32_t ms) {
	return;
	until = system_ms() + ms;
	while (system_ms() < until);
	return;
	for (long int i = 0; i < 1000000; i++)
		asm("nop");
	asm("nop");
}

void system_init(void) {
	sei();
	TCCR0A |= _BV(WGM00) | _BV(WGM01);
	TCCR0B |= _BV(CS00) | _BV(CS01); //clk/64
	TIMSK0 |= _BV(TOIE0);
}

int main() {
	system_init();
	setup();
	while (1)
		loop();
}


system.c

#ifndef _system_h
#define _system_h
#include <stdint.h>
uint32_t until;
#ifdef __cplusplus
extern "C" {
#endif
uint64_t system_us();
uint32_t system_ms();
void delay_ms(uint32_t ms);
void setup();
void loop();
#ifdef __cplusplus
}
#endif
#endif


system.h

#include "ili9341.h"
#include "gpio.h"
#include "spi.h"
#include <stdint.h>
#include <stdbool.h>

#define BIT(x) (1<<x)

pin_t _cspin;
pin_t _dcpin;

typedef enum {
	NOP = 0x00,
	SOFTWARE_RESET = 0x01,
	READ_INDENTIFICATION = 0x04,
	READ_DISPLAY_STATUS = 0x09,
	READ_DISPLAY_POWER_MODE = 0xa,
	READ_MEMORY_ACCESS_CONTROL = 0x0b,
	READ_DISPLAY_PIXEL_FORMAT = 0xc,
	READ_DISPLAY_IMAGE_FORMAT = 0xc,
	READ_SELF_DIAGNOSTIC = 0xF,
	//
	ENTER_SLEEP_MODE = 0x10,
	SLEEP_OUT = 0x11,
	PARTIAL_DISPLAY_MODE_ON = 0x12,
	NORMAL_DISPLAY_MODE_ON = 0x13,
	//
	DISPLAY_INVERSION_OFF = 0x20,
	DISPLAY_INVERSION_ON = 0x21,
	GAMMA_SET = 0x26,
	DISPLAY_OFF = 0x28,
	DISPLAY_ON = 0x29,
	COLUMN_ADDRESS_SET = 0x2a,
	PAGE_ADDRESS_SET = 0x2b,
	MEMORY_WRITE = 0x2c,
	COLOR_SET = 0x2d,
	MEMORY_READ = 0x2e,
	//
	PARTIAL_AREA = 0x30,
	VERTICAL_SCROLLING_DEFINITION = 0x33,
	TEARING_EFFECT_LINE_OFF = 0x34,
	TEARING_EFFECT_LINE_ON = 0x35 ,
	MEMORY_ACCESS_CONTROL = 0x36,
	VERTICAL_SCROLLING_START_ADDRESS = 0x37,
	IDLE_MODE_OFF = 0x38,
	IDLE_MODE_ON = 0x39,
	PIXEL_FORMAT_SET = 0x3A,
	WRITE_MEMORY_CONTINUE = 0x3C,
	READ_MEMORY_CONTINUE = 0x3D,
	//
	RGB_INTERFACE_SIGNAL_CONTROL = 0xB0,
	FRAME_RATE_CONTROL = 0xB1,
	FRAME_RATE_CONTROL2 = 0xB2,
	FRAME_RATE_CONTROL3 = 0xB3,
	DISPLAY_INVERSION_CONTROL = 0xB4,
	BLANKING_PORCH_CONTROL = 0xB5,
	DISPLAY_FUNCTION_CONTROL = 0xB6,
	ENTRY_MODE_SET = 0xB7,
	BACKLIGHT_CONTROL1 = 0xB8,
	BACKLIGHT_CONTROL2 = 0xB9,
	BACKLIGHT_CONTROL3 = 0xBA,
	BACKLIGHT_CONTROL4 = 0xBB,
	BACKLIGHT_CONTROL5 = 0xBC,
	BACKLIGHT_CONTROL6 = 0xBD,
	BACKLIGHT_CONTROL7 = 0xBE,
	BACKLIGHT_CONTROL8 = 0xBF,
	//
	POWER_CONTROL1 = 0xC0,
	POWER_CONTROL2 = 0xC1,
	VCOM_CONTROL1 = 0xC5,
	VCOM_CONTROL2 = 0xC7,
	//
	READ_ID1 = 0xDA,
	READ_ID2 = 0xDB,
	READ_ID3 = 0xDC,
	//
	POSITIVE_GAMMA_CORRECTION = 0xE0,
	NEGATIVE_GAMMA_CORRECTION = 0xE1,
	INTERFACE_CONTROL = 0xF6,
	// extended
	POWER_CONTROL_A = 0xCB,
	POWER_CONTROL_B = 0xCF,
	DRIVER_TIMING_CONTROL_A = 0xE8,
	DRIVER_TIMING_CONTROL_b = 0xEA,
	POWER_ON_SEQUENCE_CONTROL = 0xED,
	PUMP_RATIO_CONTROL = 0xF7
} ili9341_command_t;

// MEMORY_ACCESS_CONTROL 0x0b
#define MY 7 // row address order 0=top to bottom, 1=bottom to top
#define MX 6 // column addres order 0=left to right, 1=right to left
#define MV 5 // row/column exchange
#define ML 4 // vertical refresh order
#define BGR 3 // rgb/grb order
#define MH 2 // horizontal refresh order
// DISPLAY_FUNCTION_CONTROL 0xB6
#define PT0 0
#define PT1 1
#define PTG0 2
#define PTG1 3
//
#define ISC0 0
#define ISC1 1
#define ISC2 2
#define ISC3 3
#define ISC 0b00001111
#define SM 4
#define SS 5
#define GS 6
#define REV 7
//
#define NL 0b00111111


static void chip_select() {
	pin_reset(_cspin);
}

static void chip_deselect() {
	pin_set(_cspin);
}

/*static void transmit_command(ili9341_command_t cmd) {
  pin_reset(_dcpin);
//  pin_reset(_cspin);
	spi_transfer8(cmd);
//  pin_set(_cspin);
}

static void transmit_data(uint8_t data) {
  pin_set(_dcpin);
//  pin_reset(_cspin);
	spi_transfer8(data);
//  pin_set(_cspin);
}

static void transmit_data16(uint16_t data) {
  pin_set(_dcpin);
//  pin_reset(_cspin);
	spi_transfer8((uint8_t)(data >> 8));
	spi_transfer8(data );
//  pin_set(_cspin);
}*/

static void command(uint8_t cmd) {
	pin_reset(_dcpin);
	spi_transfer8(cmd);
}

static void write_data(uint8_t data) {
	pin_set(_dcpin);
	spi_transfer8(data);
}

static void command1(uint8_t cmd, uint8_t p1) {
	pin_reset(_dcpin);
	spi_transfer8(cmd);
	pin_set(_dcpin);
	spi_transfer8(p1);
}

static void command2(uint8_t cmd, uint8_t p1, uint8_t p2) {
	pin_reset(_dcpin);
	spi_transfer8(cmd);
	pin_set(_dcpin);
	spi_transfer8(p1);
	spi_transfer8(p2);
}

static void command3(uint8_t cmd, uint8_t p1, uint8_t p2, uint8_t p3) {
	pin_reset(_dcpin);
	spi_transfer8(cmd);
	pin_set(_dcpin);
	spi_transfer8(p1);
	spi_transfer8(p2);
	spi_transfer8(p3);
}

static void command4(uint8_t cmd, uint8_t p1, uint8_t p2, uint8_t p3, uint8_t p4) {
	pin_reset(_dcpin);
	spi_transfer8(cmd);
	pin_set(_dcpin);
	spi_transfer8(p1);
	spi_transfer8(p2);
	spi_transfer8(p3);
	spi_transfer8(p4);
}

void ili9341_set_rotation(int rotation) {
	chip_select();
	switch (rotation) {
		case 0:
				command1(MEMORY_ACCESS_CONTROL, BIT(MX) | BIT(BGR));
				break;
		case 1:
				command1(MEMORY_ACCESS_CONTROL, BIT(MX) | BIT(MY) | BIT(MV) | BIT(BGR));
				break;
		case 2:
				command1(MEMORY_ACCESS_CONTROL, BIT(MY) | BIT(BGR));
				break;
		case 3:
				command1(MEMORY_ACCESS_CONTROL, BIT(MV) | BIT(BGR));
				break;
	}
	chip_deselect();
}

void ili9341_enable(pin_t cspin, pin_t dcpin) {
	_cspin = cspin;
	_dcpin = dcpin;
  pin_mode(_cspin, Output);
  pin_mode(_dcpin, Output);
	chip_select();
	command(SOFTWARE_RESET);
	//_delay_ms(50);
	command(DISPLAY_OFF);
	command1(POWER_CONTROL1, 0x23); // 4.60v
	command1(POWER_CONTROL2, 0x10); // ???
	command2(VCOM_CONTROL1, 0x2B, 0x2B); // 3.775V
	command1(VCOM_CONTROL2, 0xC0); // no offset voltage
	//command1(MEMORY_ACCESS_CONTROL, BIT(MX) | BIT(BGR));
	command2(VERTICAL_SCROLLING_START_ADDRESS, 0, 0);
	command1(PIXEL_FORMAT_SET, 0x55); // 16bit/px
	command2(FRAME_RATE_CONTROL, 0, 0x1B);
	command3(DISPLAY_FUNCTION_CONTROL, BIT(PTG1), BIT(REV) + 2, 0x27);
	// TODO: set gamma
	command(SLEEP_OUT);
	//_delay_ms(150);
	command(DISPLAY_ON);
	//_delay_ms(200);
	ili9341_set_rotation(0);
	chip_deselect();
}

void ili9341_disable() {
	chip_select();
	command(DISPLAY_OFF);
	command(ENTER_SLEEP_MODE);
	chip_deselect();
}

void ili9341_set_window(uint16_t x, uint16_t y, uint16_t w, uint16_t h) {
	uint8_t xh = x >> 8, xl = x & 0xff;
	uint8_t yh = y >> 8, yl = y & 0xff;
	chip_select();
	command4(COLUMN_ADDRESS_SET, xh, xl, xh, xl);
	command4(PAGE_ADDRESS_SET, yh, yl, yh, yl);
	chip_deselect();
}


void ili9341_set_pixel(uint16_t x, uint16_t y, uint16_t color) {
	uint8_t xh = x >> 8, xl = x & 0xff;
	uint8_t yh = y >> 8, yl = y & 0xff;
	uint8_t ch = (uint16_t)color >> 8, cl = (uint16_t)(color & 0xff);
	chip_select();
	command4(COLUMN_ADDRESS_SET, xh, xl, xh, xl);
	command4(PAGE_ADDRESS_SET, yh, yl, yh, yl);
	command(MEMORY_WRITE);
	write_data(ch);
	write_data(cl);
	chip_deselect();
}

void ili9341_write_block(uint16_t x, uint16_t y, uint16_t w, uint16_t h, uint8_t * data) {
	uint16_t x2 = x + w - 1;
	uint16_t y2 = y + h - 1;
	chip_select();
	command4(COLUMN_ADDRESS_SET, x >> 8, x & 0xFF, x2 >> 8, x2 & 0xFF);
	command4(PAGE_ADDRESS_SET, y >> 8, y & 0xFF, y2 >> 8, y2 & 0xFF);
	command(MEMORY_WRITE);
	for (int i = 0; i < w * h * 2; i++)
		write_data(data[i]);
	chip_deselect();
}

void ili9341_set_block(uint16_t x, uint16_t y, uint16_t w, uint16_t h, uint16_t color) {
	uint16_t x2 = x + w - 1;
	uint16_t y2 = y + h - 1;
	chip_select();
	command4(COLUMN_ADDRESS_SET, x >> 8, x & 0xFF, x2 >> 8, x2 & 0xFF);
	command4(PAGE_ADDRESS_SET, y >> 8, y & 0xFF, y2 >> 8, y2 & 0xFF);
	command(MEMORY_WRITE);
	for (int i = 0; i < w * h; i++) {
		write_data(color >> 8);
		write_data(color &0xFF);
	}
	chip_deselect();
}


ili9341.c

#ifndef _ili9341_h
#define _ili9341_h
#include "gpio.h"
#include <stdint.h>

#ifdef __cplusplus
extern "C" {
#endif
void ili9341_enable(pin_t cspin, pin_t dcpin);
void ili9341_disable();
void ili9341_set_rotation(int rotation);
void ili9341_set_pixel(uint16_t x, uint16_t y, uint16_t color);
void ili9341_set_block(uint16_t x, uint16_t y, uint16_t w, uint16_t h, uint16_t color);
void ili9341_write_block(uint16_t x, uint16_t y, uint16_t w, uint16_t h, uint8_t * data);
#ifdef __cplusplus
}
#endif
#endif


ili9341.h

#include <avr/io.h>
#include "spi.h"
#include "gpio.h"

#define SCK PinB5
#define MISO PinB4
#define MOSI PinB3

void spi_enable() {
	pin_mode(SCK, Output);
	pin_mode(MOSI, Output);
	SPCR = _BV(SPE) | _BV(MSTR) | _BV(SPR0); // clock/4
}

void spi_disable() {
	SPCR = 0;
	pin_mode(SCK, Input);
	pin_mode(MOSI, Input);
}

uint8_t spi_transfer8(uint8_t data) {
	SPDR = data;
	while (!(SPSR & _BV(SPIF)));
	return SPDR;
}

void spi_transfer(uint8_t * data, uint8_t len) {
	uint8_t *p = data;
	SPDR = *p;
	while (--len > 0) {
		uint8_t out = *(p + 1);
		while (!(SPSR & _BV(SPIF)));
		uint8_t in = SPDR;
		SPDR = out;
		*p++ = in;
	}
}


spi.c

#ifndef _spi_h_
#define _spi_h_
#include <stdint.h>
#include <stdbool.h>

#ifdef __cplusplus
extern "C" {
#endif
void spi_enable();
void spi_disable();
uint8_t spi_transfer8(uint8_t data);
void spi_transfer(uint8_t * data, uint8_t len);
#ifdef __cplusplus
}
#endif
#endif


spi.h

#include <avr/pgmspace.h>
#include "gfx.h"
#include "string.h"
#include "ili9341.h"

long map(long x, long in_min, long in_max, long out_min, long out_max) {
  return (x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min;
}

void draw_text(uint16_t x, uint16_t y, const uint8_t * text, font_t * font, rgb888_t color, rgb888_t bgcolor, bool rtl) {
	if (strlen(text) > 40)
		return;
	uint8_t bh = ((font->height * (font->smooth * 2) - 1) / 8 + 1);
	int16_t offset = 0;

	for (int chx = 0; chx < strlen((const char *)text); chx++) {
		uint8_t chr = text[chx] - font->offset;
		uint16_t char_offset = 0;
		for (int i = 0; i < chr; i++)
			char_offset += font->widths[i] * bh;
		for (int cl = 0; cl < font->widths[chr]; cl++) {
			uint8_t rcl = (rtl ? font->widths[chr] - cl - 1 : cl);

			uint8_t pixels[2 * bh * 4];
			for (int b = 0; b < bh; b++) {
				uint8_t val = pgm_read_byte_near(font->data + (char_offset + bh * rcl + b));
				//uint8_t val = font->data[char_offset + bh * rcl + b];
				if (font->smooth) {
					for (int p = 0; p < 4; p++) {
						uint8_t v = (val >> (2 * p)) & 0b11;
						int ratio = ((uint8_t[]){0, 50, 70, 100})[v];
						rgb888_t rgb;
						rgb.red = map(ratio, 0, 100, bgcolor.red, color.red);
						rgb.green = map(ratio, 0, 100, bgcolor.green, color.green);
						rgb.blue = map(ratio, 0, 100, bgcolor.blue, color.blue);
						uint16_t col = RGB565(rgb);
						pixels[2 * (bh * b + p)] = col >> 8;
						pixels[2 * (bh * b + p) + 1] = col & 0xff;
						//ili9341_set_pixel(100 + x + offset, y + 4 * b + p, col);
					}
				} else {
					for (int p = 0; p < 8; p++) {
						uint8_t v = (val >> p) & 1;
						uint16_t col;
						if (v)
							col = RGB565(color);
						else
							col = RGB565(bgcolor);
						ili9341_set_pixel(x + offset, y + 8 * b + p, col);
					}
				}
			}
			ili9341_write_block(x + offset, y, 1, 4 * 4, &pixels);
			if (rtl)
				offset--;
			else
				offset++;
		}
	}
}

uint16_t text_width(uint8_t * text, font_t * font) {
	uint16_t width = 0;
	for (int c = 0; c < strlen((const char *)text); c++)
		width += font->widths[text[c] - font->offset];
	return width;
}

void draw_rectangle(uint16_t x, uint16_t y, uint16_t w, uint16_t h, rgb888_t color) {
	ili9341_set_block(x, y, w, h, RGB565(color));
}

void draw_text_box(uint16_t x, uint16_t y, uint16_t width, uint16_t h, uint8_t * text, font_t * font, rgb888_t color, rgb888_t bgcolor, align_t align, bool rtl) {
	//draw_rectangle((rtl ? x: width - 1 - x), y, width, h, bgcolor);	
	uint16_t pad = 0;
	uint16_t tw = text_width(text, font);
	if (align == AlignRight)
		pad = width - tw;
	else if (align == AlignCenter)
		pad = (width - tw) / 2;
	if (rtl)
		draw_text(x + pad + tw, y, text, font, color, bgcolor, rtl);
	else
		draw_text(x + pad, y, text, font, color, bgcolor, rtl);
}



gfx.c

#ifndef _gfx_h_
#define _gfx_h_
#include <stdint.h>
#include <stdbool.h>
#include <avr/pgmspace.h>

typedef struct __attribute__ ((__packed__)) {
	const bool smooth;
	const uint8_t height;
	const uint8_t offset;
	const uint8_t num_chars;
	uint8_t * widths;
	uint8_t * data;
} font_t;

typedef enum {
	AlignRight,
	AlignLeft,
	AlignCenter
} align_t;

typedef union {
	uint8_t value[3];
	struct {
		uint8_t red;
		uint8_t green;
		uint8_t blue;
	};
} rgb888_t;

#define Red (rgb888_t){255, 0, 0}
#define Orange (rgb888_t){255, 125, 0}
#define Yellow (rgb888_t){255, 255, 0}
#define Green (rgb888_t){0, 255, 0}
#define SpringGreen (rgb888_t){125, 255, 0}
#define Turquoise (rgb888_t){0, 255, 125}
#define Cyan (rgb888_t){0, 255, 255}
#define Ocean (rgb888_t){0, 125, 255}
#define Blue (rgb888_t){0, 0, 255}
#define Violet (rgb888_t){125, 0, 255}
#define Magenta (rgb888_t){255, 0, 255}
#define Raspberry (rgb888_t){255, 0, 125}

#define White (rgb888_t){255, 255, 255}
#define LightGray (rgb888_t){0xD3, 0xD3, 0xD3}
#define Silver (rgb888_t){0xC0, 0xC0, 0xC0}
#define Gray (rgb888_t){0x80, 0x80, 0x80}
#define DarkGray (rgb888_t){0xA9, 0xA9, 0xA9}
#define Black (rgb888_t){0, 0, 0}

#define RGB565(c) (((c.red >> 3) << 11) | ((c.green >> 2) << 5) | c.blue >> 3)

#ifdef __cplusplus
extern "C" {
#endif
uint16_t text_width(uint8_t * text, font_t * font);
void draw_text(uint16_t x, uint16_t y, const uint8_t * text, font_t * font, rgb888_t color, rgb888_t bgcolor, bool rtl);
void draw_text_box(uint16_t x, uint16_t y, uint16_t width, uint16_t h, uint8_t * text, font_t * font, rgb888_t color, rgb888_t bgcolor, align_t align, bool rtl);
void draw_rectangle(uint16_t x_, uint16_t y_, uint16_t w, uint16_t h, rgb888_t color);
#ifdef __cplusplus
}
#endif
#endif
