#include <Adafruit_GFX.h>
#include <Adafruit_ST7789.h>
#include "FreeSans9pt7b.h"
#include "fonts.h"

#define TFT_CS         D8
#define TFT_RST        D4                                            
#define TFT_DC         D3
#define TFT_BL         D0

Adafruit_ST7789 tft = Adafruit_ST7789(TFT_CS, TFT_DC, TFT_RST);

#define WHITE    0xFFFF
#define BLACK    0x0000
#define ORANGE   0xFBE0
#define SKYBLUE  0x8410
#define color4   0x15B3
#define color5   0x00A3

volatile int counter = 0;
float gauge;

double rad=0.01745;
float x[360];
float y[360];

float px[360];
float py[360];

float lx[360];
float ly[360];


int r  = 100;
int sx = 110 + 10;
int sy = 116 + 30;

char *cc[10]={" 0","10","20","30","40","50","60","70","80","90"};
int start[10];
int startP[60];

#define ENC_A D1
#define ENC_B D2

bool debounce=true;
uint8_t prev = 0;
int     angle = 270;
int     lastAngle = 0;

void drawGauge()
{
	char buf[16];

	gauge = ((angle-270)/3.60)*-1;
	if(gauge < 0) gauge = gauge + 100;
//	tft.fillCircle(sx,sy,124,color5);
	tft.fillCircle(sx,sy,112,color5);
//	tft.setTextColor(color5);
	tft.setFont(&FreeSans9pt7b);
	tft.setTextColor(WHITE);

	for(int i=0;i<10;i++) {
		if(start[i]+angle<360){
			drawString(cc[i],x[start[i]+angle]-10,y[start[i]+angle]+9);
			tft.drawLine(px[start[i]+angle],py[start[i]+angle],lx[start[i]+angle],ly[start[i]+angle],WHITE);
		} else {
			drawString(cc[i],x[(start[i]+angle)-360]-10,y[(start[i]+angle)-360]+9);
			tft.drawLine(px[(start[i]+angle)-360],py[(start[i]+angle)-360],lx[(start[i]+angle)-360],ly[(start[i]+angle)-360],WHITE);
		}
	}

	tft.setFont(&DSEG7_Modern_Bold_20);
	sprintf(buf, "%d", (uint8_t)gauge);
	if (gauge < 10) {
		drawString(buf,sx-4,sy-16);
	} else {
		drawString(buf,sx-20,sy-16);
	}

	for(int i=0;i<60;i++) {
		if(startP[i]+angle<360)
			tft.fillCircle(px[startP[i]+angle],py[startP[i]+angle],1,SKYBLUE);
		else
			tft.fillCircle(px[(startP[i]+angle)-360],py[(startP[i]+angle)-360],1,SKYBLUE);
	}
	tft.fillTriangle(sx-1,sy-70,sx-5,sy-56,sx+4,sy-56,ORANGE);

	tft.setTextColor(WHITE);
	tft.setFont();
	drawString("POWER",104,96);
	tft.setFont(&FreeSans9pt7b);
	drawString("%",sx+16,sy-16);
}

void updateEncoder()
{
	int value = 0;
	uint8_t ab, encoded;

	if (debounce) {
		for (uint8_t i=0; i < 20; ++i) {
			uint8_t a = digitalRead(ENC_A);
			uint8_t b = digitalRead(ENC_B);

			ab = (a << 1) | b;
			encoded  = (prev << 2) | ab;

			if(encoded == 0b1101 || encoded == 0b0100 || encoded == 0b0010 || encoded == 0b1011){
				value++;
			} else if(encoded == 0b1110 || encoded == 0b0111 || encoded == 0b0001 || encoded == 0b1000) {
				value--;
			}
			prev = ab;
			delay(10);
		}
		if (value > 0) {
			angle = angle + 6;
		} else if (value < 0) {
			angle = angle - 6;
		}

		if(angle>=360) angle=0;
		if(angle<   0) angle=354;
//		Serial.print("angle:");
//		Serial.println(angle);
	}
}

void drawOnOFF(bool onOff)
{
	tft.fillRect(192,11,50,16,BLACK);
	tft.drawCircle(202,18,7,WHITE);
	tft.drawCircle(222,18,7,WHITE);
	tft.drawLine(202,11,222,11,WHITE);
	tft.drawLine(202,25,222,25,WHITE);
	tft.fillRect(203,12,18,13,BLACK);
	if (onOff) {
		tft.fillCircle(202,18,4,ORANGE);
	} else {
		tft.fillCircle(222,18,4,ORANGE);
	}
}

void drawString(char *str, uint8_t x, uint8_t y)
{
	tft.setCursor(x, y);
	tft.print(str);
}

void setup()
{
	Serial.begin(9600);
	pinMode(ENC_A, INPUT_PULLUP);
	pinMode(ENC_B, INPUT_PULLUP);
/*
	ledcSetup(pwmLedChannelTFT, 5000, 8);
	ledcAttachPin(TFT_BL, 0);
	ledcWrite(0, 90);
*/
	pinMode(TFT_BL,OUTPUT);
	analogWrite(TFT_BL, 64); // 0 - 255

	tft.init(135, 240);
	tft.setRotation(3);
	tft.fillScreen(BLACK);

//	tft.setFont(&FreeSans9pt7b);
	drawString("ON/OFF",196,4);
	drawString("CONTROL",20,20);
	drawString("MOTOR",20,6);

	tft.setTextColor(color4);
	drawString("REVOLUTIONS PER MINUTE",60,4);

	drawOnOFF(true);

	int b=0;
	int b2=0;

	for(int i=0;i<360;i++) {
		x[i]=(r*cos(rad*i))+sx;
		y[i]=(r*sin(rad*i))+sy;
		px[i]=((r-16)*cos(rad*i))+sx;
		py[i]=((r-16)*sin(rad*i))+sy;

		lx[i]=((r-24)*cos(rad*i))+sx;
		ly[i]=((r-24)*sin(rad*i))+sy;

		if(i%36==0) {
			start[b]=i;
			b++;
		}

		if(i%6==0) {
			startP[b2]=i;
			b2++;
		}
	}
	tft.fillCircle(sx,sy,124,color5);

	tft.setTextColor(ORANGE);
	tft.setFont(&FreeSans9pt7b);
//	tft.setFont(&Slackey_Regular_16);
	drawString("32465",92,30);

	drawGauge();
}

void loop()
{
	static int lastCounter = 0;

	updateEncoder();

	debounce = false;
	if(angle != lastCounter) lastCounter = angle;

	if(angle!=lastAngle) {
		lastAngle = angle;
		drawGauge();
	}
	debounce=true;
}