display.cpp

#include "display.h"
#include "config.h"

#include <ssd1306.h>
#include <nano_gfx.h>
#include <font6x8.h>

#define CHAR_WIDTH 6.0
#define CHAR_HEIGHT 8.0


static const PROGMEM uint8_t bitmapTemp[] = {
	0b00000000,
	0b00000000,
	0b01100000,
	0b10011111,
	0b10011111,
	0b01100000,
	0b00000000,
};
static const PROGMEM uint8_t bitmapFan[3][7] = {
	{
		0b00110000,
		0b00110011,
		0b00011111,
		0b00011100,
		0b01111100,
		0b01100110,
		0b00000110,
	}, {
		0b00011100,
		0b00011000,
		0b01001011,
		0b01111111,
		0b01101001,
		0b00001100,
		0b00011100,
	}, {
		0b00000110,
		0b01100110,
		0b01111100,
		0b00011100,
		0b00011111,
		0b00110011,
		0b00110000,
	}
};
static const PROGMEM uint8_t bitmapDegree[] = {
	0b00000000,
	0b00000110,
	0b00001001,
	0b00001001,
	0b00000110,
};
static const PROGMEM uint8_t deltaIcon[] = {
	0b11000000,
	0b10110000,
	0b10001100,
	0b10000011,
	0b10001100,
	0b10110000,
	0b11000000,
};


Display::Display(Sensor* sensors, size_t sensorsLength, Fan* fans, size_t fansLength){
	this->sensors = sensors;
	this->sensorsLength = sensorsLength;
	this->fans = fans;
	this->fansLength = fansLength;

	ssd1306_128x64_i2c_init();
	ssd1306_clearScreen();
	ssd1306_setContrast(0);
	ssd1306_setFixedFont(ssd1306xled_font6x8);
	ssd1306_printFixed(ssd1306_displayWidth() / 2 - 5 * CHAR_WIDTH,  ssd1306_displayHeight() / 2 - CHAR_HEIGHT / 2,
		"Booting...", STYLE_NORMAL);

	lastState.rpm = new uint16_t[fansLength];
}

void Display::update(Mode mode){
	//Notes
	// Characters are 5 * 7
	// They are spaced 6 * 8

	if(init){
		ssd1306_clearScreen();
	}

	uint8_t x = 0;
	uint8_t y = 0;

	if(mode != lastState.mode || init){

		if(mode == Mode::Low)
			ssd1306_negativeMode();

		ssd1306_clearBlock(0, 0, ssd1306_displayWidth(), CHAR_HEIGHT);

		x = ssd1306_displayWidth() / 2.0 - (5 + strlen(modeToStr(mode))) * CHAR_WIDTH / 2.0;
		ssd1306_printFixed(x, y, "Mode:", STYLE_NORMAL);
		ssd1306_printFixed(x + 5 * CHAR_WIDTH, y, modeToStr(mode), STYLE_NORMAL);

		if(mode == Mode::Low)
			ssd1306_positiveMode();

		lastState.mode = mode;
	}

	y += CHAR_HEIGHT;

	char buffer[24];

	for(uint8_t i = 0 ; i < sensorsLength ; i++){
		auto& sensor = sensors[i];

		if(init){
			ssd1306_clearBlock(0, y / 8, ssd1306_displayWidth(), y / 8 + 1);
			// Icon
			ssd1306_drawBitmap(0, y / 8, 7, 8, bitmapTemp);
			// Name
			ssd1306_printFixed(9, y, sensor.def->name, STYLE_NORMAL);
			// °
			ssd1306_drawBitmap(ssd1306_displayWidth() - 2 * CHAR_WIDTH + 1, y / 8, 5, 8, bitmapDegree);
			// C
			ssd1306_printFixed(ssd1306_displayWidth() - 1 * CHAR_WIDTH, y, "C", STYLE_NORMAL);
		}

		// Temp value
		dtostrf(sensor.smoothedTemp(), 6, 1, buffer);
		ssd1306_printFixed(
			ssd1306_displayWidth() - (2 + 6) * CHAR_WIDTH, y,
			buffer, STYLE_NORMAL);

		y += CHAR_HEIGHT;

		for(uint8_t j = 0 ; j < fansLength ; j++){
			auto& fan = fans[j];
			if(fan.def->sensorIndex == i){
				if(init){
					ssd1306_clearBlock(0, y / 8, ssd1306_displayWidth(), y / 8 + 1);

					// Name
					ssd1306_printFixed(15, y, fan.def->name, STYLE_NORMAL);

					// %
					ssd1306_printFixed(ssd1306_displayWidth() - CHAR_WIDTH, y, "%", STYLE_NORMAL);
				}

				// Icon
				if(fan.currentSpeed() > 0)
					ssd1306_drawBitmap(6, y / 8, 7, 8, bitmapFan[cnt % 3]);
				else
					ssd1306_drawBitmap(6, y / 8, 7, 8, bitmapFan[0]);

				//Speed
				sprintf(buffer, "%3d", fan.currentSpeed());
				ssd1306_printFixed(ssd1306_displayWidth() - (3 + 1) * CHAR_WIDTH, y,
					buffer, STYLE_NORMAL);

				//RPM
				if(fan.hasTacho()){
					auto rpm = fan.getRPM();
					auto rpmSave = rpm;
					if(init == false){
						rpm = (rpm + lastState.rpm[j]) / 2;
					}
					lastState.rpm[j] = rpmSave;

					int digits = rpm == 0 ? 1 : (log10(rpm) + 1);

					if(digits <= 4)
						sprintf(buffer, "%4u", rpm);
					else
						sprintf(buffer, "%3uk", rpm / 1000ul);

					ssd1306_printFixed(ssd1306_displayWidth() - (5 + 3 + 1) * CHAR_WIDTH, y,
						buffer, STYLE_NORMAL);
				}

				y += CHAR_HEIGHT;
			}
		}
	}

	for(uint8_t i = 0 ; i < customLength ; i++){
		auto& custom = customDefs[i];
		if(init){
			ssd1306_clearBlock(0, y / 8, ssd1306_displayWidth(), y / 8 + 1);
			// Icon
			ssd1306_drawBitmap(0, y / 8, 7, 8, custom.icon);
			// Name
			ssd1306_printFixed(9, y, custom.name, STYLE_NORMAL);
		}

		custom.value(buffer, sensors, fans);
		ssd1306_printFixed(ssd1306_displayWidth() - (strlen(buffer)) * CHAR_WIDTH, y,
			buffer, STYLE_NORMAL);

		y += CHAR_HEIGHT;
	}

	cnt++;
	init = false;
}