//#include <WiFi.h>
//#include <ArduinoJson.h>

// Color definitions
#define BLACK    0x0000
#define BLUE     0x0C3A
#define RED      0xF800
#define GREEN    0x07E0
#define CYAN     0x07FF
#define MAGENTA  0xF81F
#define YELLOW   0xF640 
#define WHITE    0xFFFF
#define GREY     0xD6BA


//#define cs   15  // CS & DC can use pins 2, 6, 9, 10, 15, 20, 21, 22, 23
//#define dc   2   //  but certain pairs must NOT be used: 2+10, 6+9, 20+23, 21+22
//#define rst  4   // RST can use any pin

/*
  Simple "Hello World" for ILI9341 LCD

  https://wokwi.com/arduino/projects/308024602434470466
*/

#include "SPI.h"
#include "Adafruit_GFX.h"
#include "Adafruit_ILI9341.h"


#define TFT_DC 21
#define TFT_CS 22
//#define TFT_DC 2
//#define TFT_CS 15
#define rst  4   // RST can use any pin
Adafruit_ILI9341 tft = Adafruit_ILI9341(TFT_CS, TFT_DC);

//#define TFT_DC 9
//#define TFT_CS 10
//Adafruit_ILI9341 tft = Adafruit_ILI9341(TFT_CS, TFT_DC);

String prijato;
int prijatoInt;

int Hline = 100;
int HlineStart = 10;
int HlineX = Hline * 10;
int pres = 1006;
int Hpres1 = 1005;
int Hpres2 = 995;
int Hpres3 = 950;
int Hpres4 = 995;
int Hpres5 = 1010;
int Hpres6 = 1014;

int Hpres1y;
int Hpres2y;
int Hpres3y;
int Hpres4y;
int Hpres5y;
int Hpres6y;



int Hline2 = 200;
int HlineStart2 = 10;
int HlineX2 = Hline2 * 10;

int Hpres21y;
int Hpres22y;
int Hpres23y;
int Hpres24y;
int Hpres25y;
int Hpres26y;


int Hline3 = 200;
int HlineStart3 = 10;
int HlineX3 = Hline3 * 10;

int Hpres31y;
int Hpres32y;
int Hpres33y;
int Hpres34y;
int Hpres35y;
int Hpres36y;

int Hpres31;
int Hpres32;
int Hpres33;
int Hpres34;
int Hpres35;
int Hpres36;




int xmax=240;             // max length x-axis
int ymax=320;             // max length y-axis
int xcenter=xmax/2;      // center of x-axis
int ycenter=ymax/2;      // center of y-axis
int arc=ymax/4;                                                              
int p, w, m,a=10;        // a= Needle Speed
int xx=0;    




void DrawAngledLine();


void setup() {
  Serial.begin(115200);
  Serial.println("Komunikace zahajena");


  tft.begin();

  tft.setCursor(26, 120);
  tft.setTextColor(ILI9341_RED);
  tft.setTextSize(3);
  tft.println("Hello, TFT!");

  tft.setCursor(20, 160);
  tft.setTextColor(ILI9341_GREEN);
  tft.setTextSize(2);
  tft.println("I can has colors?");

delay(1000);
  // Meme reference: https://english.stackexchange.com/questions/20356/origin-of-i-can-haz
}

void loop() {

  Serial.print("V bufferu je nyni: ");
  Serial.print(Serial.available());
  Serial.println(" bytu.");
  delay(500);


if (Serial.available() > 0) {
    prijato = Serial.readString();           
    Serial.print("Prijato: ");
    Serial.println(prijato);
    prijatoInt = prijato.toInt();
}

//prijatoInt = prijato.toInt();

long PresRND = random(950,1030);
pres = PresRND;

int PfromLow = 950;
int PfromHigh = 1030;
int PtoLow = 1;
int PtoHigh = 40;
int presX;


//tft.fillScreen(ILI9341_BLACK);

///*



tft.setTextSize(1);
/*
delay(3000);
   
    tft.setTextColor(ILI9341_RED);
    tft.setCursor(5,65);
    tft.print("Lokalita: ");
    tft.setCursor(5,75);
    tft.print("Lang: ");
    tft.setCursor(60,75);
    tft.print("Units: ");
    tft.setCursor(5,85);
    tft.print("Reload Pocasi (s): ");
    tft.setCursor(5,95);
    tft.print("Reload Predpoved (s): ");
    tft.setCursor(5,105);
    tft.print("Reload Tlak (s): ");

delay(3000);

*/

tft.fillScreen(ILI9341_BLACK);
//tft.drawFastHLine(0, 11, tft.width(), ILI9341_WHITE);
   // tft.drawFastHLine(1, 127, tft.width(), ILI9341_WHITE);
   // tft.drawFastVLine(0, 11, tft.height(), ILI9341_WHITE);
    //tft.drawFastVLine(159, 11, tft.height(), ILI9341_WHITE);
    //tft.drawFastVLine(80, 60, 35, ILI9341_WHITE);
   // tft.drawFastHLine(1, 60, tft.width(), ILI9341_WHITE);
    //tft.drawFastHLine(1, 95, tft.width(), ILI9341_WHITE);

//delay(3000);


Hpres1y = Hline - (Hpres1 - 1000);
Hpres2y = Hline - (Hpres2 - 1000);
Hpres3y = Hline - (Hpres3 - 1000);
Hpres4y = Hline - (Hpres4 - 1000);
Hpres5y = Hline - (Hpres5 - 1000);
Hpres6y = Hline - (Hpres6 - 1000);





//******Tlak 2**********
Hpres21y = Hline2 - (Hpres1 - 1000);
Hpres22y = Hline2 - (Hpres2 - 1000);
Hpres23y = Hline2 - (Hpres3 - 1000);
Hpres24y = Hline2 - (Hpres4 - 1000);
Hpres25y = Hline2 - (Hpres5 - 1000);
Hpres26y = Hline2 - (Hpres6 - 1000);
//***********************


//******Tlak historie******
Hpres6 = Hpres5;
Hpres5 = Hpres4;
Hpres4 = Hpres3;
Hpres3 = Hpres2;
Hpres2 = Hpres1;
Hpres1 = pres;






//map(value, fromLow, fromHigh, toLow, toHigh);
presX = map(pres, PfromLow, PfromHigh, PtoLow, PtoHigh);

//******Tlak historie3******
Hpres36 = Hpres35;
Hpres35 = Hpres34;
Hpres34 = Hpres33;
Hpres33 = Hpres32;
Hpres32 = Hpres31;
Hpres31 = presX;

//int PfromLow = 950;
//int PfromHigh = 1030;
//int PtoLow = 1;
//int PtoHigh = 80;

//******Tlak 3**********
Hpres31y = Hline3 - (Hpres31);
Hpres32y = Hline3 - (Hpres32);
Hpres33y = Hline3 - (Hpres33);
Hpres34y = Hline3 - (Hpres34);
Hpres35y = Hline3 - (Hpres35);
Hpres36y = Hline3 - (Hpres36);
//***********************



      Serial.println("*****tlak z fce*****");
      Serial.print("Tlak: ");
      Serial.println(pres);
      Serial.print("Tlak H1: ");
      Serial.println(Hpres1);
      Serial.print("Tlak H2: ");
      Serial.println(Hpres2);
      Serial.print("Tlak H3: ");
      Serial.println(Hpres3);
      Serial.print("Tlak H4: ");
      Serial.println(Hpres4);
      Serial.print("Tlak H5: ");
      Serial.println(Hpres5);
      Serial.print("Tlak H6: ");
      Serial.println(Hpres6);
      Serial.println("*****tlak z fce*****konec");

    tft.fillScreen(ILI9341_BLACK);
    tft.setCursor(5,1);
    tft.print(pres);
    tft.setCursor(5,20);
    tft.print(Hpres1);
    tft.setCursor(5,30);
    tft.print(Hpres2);
    tft.setCursor(5,40);
    tft.print(Hpres3);
    tft.setCursor(5,50);
    tft.print(Hpres4);
    tft.setCursor(5,60);
    tft.print(Hpres5);
   tft.setCursor(5,70);
    tft.print(Hpres6);

delay(3000);

     
    tft.fillScreen(ILI9341_BLACK);
    tft.drawFastHLine(1, 100, tft.width(), ILI9341_WHITE);

    //drawLine(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1, uint16_t color);
    tft.drawLine(HlineStart + 0, Hline, HlineStart + 5, Hpres1y, ILI9341_YELLOW);
    tft.drawLine(HlineStart + 5, Hpres1y, HlineStart + 10, Hpres2y, ILI9341_YELLOW);
    tft.drawLine(HlineStart + 10, Hpres2y, HlineStart + 15, Hpres3y, ILI9341_YELLOW);
    tft.drawLine(HlineStart + 15, Hpres3y, HlineStart + 20, Hpres4y, ILI9341_YELLOW);
    tft.drawLine(HlineStart + 20, Hpres4y, HlineStart + 25, Hpres5y, ILI9341_YELLOW);
    tft.drawLine(HlineStart + 25, Hpres5y, HlineStart + 30, Hpres6y, ILI9341_YELLOW);
    
    
    
    
   /* 
    delay(3000);

 

     
    tft.fillScreen(ILI9341_BLACK);
    tft.drawFastHLine(1, 100, tft.width(), ILI9341_WHITE);

    //drawLine(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1, uint16_t color);
    tft.drawLine(HlineStart + 0, Hline, HlineStart + 0, Hpres1y, ILI9341_YELLOW);
    tft.drawLine(HlineStart + 5, Hline, HlineStart + 5, Hpres2y, ILI9341_YELLOW);
    tft.drawLine(HlineStart + 10, Hline, HlineStart + 10, Hpres3y, ILI9341_YELLOW);
    tft.drawLine(HlineStart + 15, Hline, HlineStart + 15, Hpres4y, ILI9341_YELLOW);
    tft.drawLine(HlineStart + 20, Hline, HlineStart + 20, Hpres5y, ILI9341_YELLOW);
    tft.drawLine(HlineStart + 25, Hline, HlineStart + 25, Hpres6y, ILI9341_YELLOW);
    //dupliLine
    tft.drawLine(HlineStart+1 + 0, Hline, HlineStart+1 + 0, Hpres1y, ILI9341_RED);
    tft.drawLine(HlineStart+1 + 5, Hline, HlineStart+1 + 5, Hpres2y, ILI9341_RED);
    tft.drawLine(HlineStart+1 + 10, Hline, HlineStart+1 + 10, Hpres3y, ILI9341_RED);
    tft.drawLine(HlineStart+1 + 15, Hline, HlineStart+1 + 15, Hpres4y, ILI9341_RED);
    tft.drawLine(HlineStart+1 + 20, Hline, HlineStart+1 + 20, Hpres5y, ILI9341_RED);
    tft.drawLine(HlineStart+1 + 25, Hline, HlineStart+1 + 25, Hpres6y, ILI9341_RED);

    */




     //   tft.fillScreen(ILI9341_BLACK);
   // tft.drawFastHLine(1, 100, tft.width(), ILI9341_WHITE);
///*
    //drawLine(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1, uint16_t color);
    tft.drawLine(HlineStart +100 + 0, Hline, HlineStart +100 + 0, Hpres1y, ILI9341_RED);
    tft.drawLine(HlineStart +100 + 5, Hline, HlineStart +100 + 5, Hpres2y, ILI9341_RED);
    tft.drawLine(HlineStart +100 + 10, Hline, HlineStart +100 + 10, Hpres3y, ILI9341_RED);
    tft.drawLine(HlineStart +100 + 15, Hline, HlineStart +100 + 15, Hpres4y, ILI9341_RED);
    tft.drawLine(HlineStart +100 + 20, Hline, HlineStart +100 + 20, Hpres5y, ILI9341_RED);
    tft.drawLine(HlineStart +100 + 25, Hline, HlineStart +100 + 25, Hpres6y, ILI9341_RED);
    //dupli
    tft.drawLine(HlineStart+1 +100 + 0, Hline, HlineStart+1 +100 + 0, Hpres1y, ILI9341_RED);
    tft.drawLine(HlineStart+1 +100 + 5, Hline, HlineStart+1 +100 + 5, Hpres2y, ILI9341_RED);
    tft.drawLine(HlineStart+1 +100 + 10, Hline, HlineStart+1 +100 + 10, Hpres3y, ILI9341_RED);
    tft.drawLine(HlineStart+1 +100 + 15, Hline, HlineStart+1 +100 + 15, Hpres4y, ILI9341_RED);
    tft.drawLine(HlineStart+1 +100 + 20, Hline, HlineStart+1 +100 + 20, Hpres5y, ILI9341_RED);
    tft.drawLine(HlineStart+1 +100 + 25, Hline, HlineStart+1 +100 + 25, Hpres6y, ILI9341_RED);
//*/

int ovY1 = 0;
//if (prijatoInt >=1015) {
if ((Hpres1 >=1015) || (Hpres2 >=1015) || (Hpres3 >=1015) || (Hpres4 >=1015) || (Hpres5 >=1015) || (Hpres6 >=1015) || (prijatoInt >=1015)) {
   //drawLine(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1, uint16_t color);
ovY1 = 5;
}

if ((Hpres1 >=1025) || (Hpres2 >=1025) || (Hpres3 >=1025) || (Hpres4 >=1025) || (Hpres5 >=1025) || (Hpres6 >=1025) || (prijatoInt >=1025)) {
   //drawLine(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1, uint16_t color);
ovY1 = 15;
}

    tft.drawLine(HlineStart +151 + 0, Hline, HlineStart +151 + 0, Hpres1y+ovY1, ILI9341_GREEN);
    tft.drawLine(HlineStart +151 + 5, Hline, HlineStart +151 + 5, Hpres2y+ovY1, ILI9341_GREEN);
    tft.drawLine(HlineStart +151 + 10, Hline, HlineStart +151 + 10, Hpres3y+ovY1, ILI9341_GREEN);
    tft.drawLine(HlineStart +151 + 15, Hline, HlineStart +151 + 15, Hpres4y+ovY1, ILI9341_GREEN);
    tft.drawLine(HlineStart +151 + 20, Hline, HlineStart +151 + 20, Hpres5y+ovY1, ILI9341_GREEN);
    tft.drawLine(HlineStart +151 + 25, Hline, HlineStart +151 + 25, Hpres6y+ovY1, ILI9341_GREEN);
    //dupli
    tft.drawLine(HlineStart+1 +151 + 0, Hline, HlineStart+1 +151 + 0, Hpres1y+ovY1, ILI9341_GREEN);
    tft.drawLine(HlineStart+1 +151 + 5, Hline, HlineStart+1 +151 + 5, Hpres2y+ovY1, ILI9341_GREEN);
    tft.drawLine(HlineStart+1 +151 + 10, Hline, HlineStart+1 +151 + 10, Hpres3y+ovY1, ILI9341_GREEN);
    tft.drawLine(HlineStart+1 +151 + 15, Hline, HlineStart+1 +151 + 15, Hpres4y+ovY1, ILI9341_GREEN);
    tft.drawLine(HlineStart+1 +151 + 20, Hline, HlineStart+1 +151 + 20, Hpres5y+ovY1, ILI9341_GREEN);
    tft.drawLine(HlineStart+1 +151 + 25, Hline, HlineStart+1 +151 + 25, Hpres6y+ovY1, ILI9341_GREEN);



if ((Hpres1 >=1015) || (Hpres2 >=1015) || (Hpres3 >=1015) || (Hpres4 >=1015) || (Hpres5 >=1015) || (Hpres6 >=1015) || (prijatoInt >=1015)) {
     Serial.print("hodnonta je vetsi nez 1015: ");
      //Serial.println(uhel); ;
      }



///******tlak*******graf2*****

    //čtereček
    //tft.drawRect(uint16_t x0, uint16_t y0, uint16_t w, uint16_t h, uint16_t color);
    tft.drawRect(80, 160, 160, 80, GREEN);
    
    //linka
    tft.drawFastHLine(1, Hline2, tft.width(), ILI9341_WHITE);

    //drawLine(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1, uint16_t color);
    tft.drawLine(HlineStart2 +100 + 0, Hline2, HlineStart2 +100 + 0, Hpres21y, ILI9341_RED);
    tft.drawLine(HlineStart2 +100 + 5, Hline2, HlineStart2 +100 + 5, Hpres22y, ILI9341_RED);
    tft.drawLine(HlineStart2 +100 + 10, Hline2, HlineStart2 +100 + 10, Hpres23y, ILI9341_RED);
    tft.drawLine(HlineStart2 +100 + 15, Hline2, HlineStart2 +100 + 15, Hpres24y, ILI9341_RED);
    tft.drawLine(HlineStart2 +100 + 20, Hline2, HlineStart2 +100 + 20, Hpres25y, ILI9341_RED);
    tft.drawLine(HlineStart2 +100 + 25, Hline2, HlineStart2 +100 + 25, Hpres26y, ILI9341_RED);
    //dupli
    tft.drawLine(HlineStart2+1 +100 + 0, Hline2, HlineStart2+1 +100 + 0, Hpres21y, ILI9341_RED);
    tft.drawLine(HlineStart2+1 +100 + 5, Hline2, HlineStart2+1 +100 + 5, Hpres22y, ILI9341_RED);
    tft.drawLine(HlineStart2+1 +100 + 10, Hline2, HlineStart2+1 +100 + 10, Hpres23y, ILI9341_RED);
    tft.drawLine(HlineStart2+1 +100 + 15, Hline2, HlineStart2+1 +100 + 15, Hpres24y, ILI9341_RED);
    tft.drawLine(HlineStart2+1 +100 + 20, Hline2, HlineStart2+1 +100 + 20, Hpres25y, ILI9341_RED);
    tft.drawLine(HlineStart2+1 +100 + 25, Hline2, HlineStart2+1 +100 + 25, Hpres26y, ILI9341_RED);
//*/



///******tlak*******graf3*****

    //čtereček
    //tft.drawRect(uint16_t x0, uint16_t y0, uint16_t w, uint16_t h, uint16_t color);
    //tft.drawRect(80, 160, 160, 80, GREEN);
    
    //linka
    //tft.drawFastHLine(1, Hline2, tft.width(), ILI9341_WHITE);

    //drawLine(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1, uint16_t color);
    tft.drawLine(HlineStart3 +151 + 0, Hline3, HlineStart3 +151 + 0, Hpres31y, ILI9341_RED);
    tft.drawLine(HlineStart3 +151 + 5, Hline3, HlineStart3 +151 + 5, Hpres32y, ILI9341_RED);
    tft.drawLine(HlineStart3 +151 + 10, Hline3, HlineStart3 +151 + 10, Hpres33y, ILI9341_RED);
    tft.drawLine(HlineStart3 +151 + 15, Hline3, HlineStart3 +151 + 15, Hpres34y, ILI9341_RED);
    tft.drawLine(HlineStart3 +151 + 20, Hline3, HlineStart3 +151 + 20, Hpres35y, ILI9341_RED);
    tft.drawLine(HlineStart3 +151 + 25, Hline3, HlineStart3 +151 + 25, Hpres36y, ILI9341_RED);
    //dupli
    tft.drawLine(HlineStart3+1 +151 + 0, Hline3, HlineStart3+1 +151 + 0, Hpres31y, ILI9341_RED);
    tft.drawLine(HlineStart3+1 +151 + 5, Hline3, HlineStart3+1 +151 + 5, Hpres32y, ILI9341_RED);
    tft.drawLine(HlineStart3+1 +151 + 10, Hline3, HlineStart3+1 +151 + 10, Hpres33y, ILI9341_RED);
    tft.drawLine(HlineStart3+1 +151 + 15, Hline3, HlineStart3+1 +151 + 15, Hpres34y, ILI9341_RED);
    tft.drawLine(HlineStart3+1 +151 + 20, Hline3, HlineStart3+1 +151 + 20, Hpres35y, ILI9341_RED);
    tft.drawLine(HlineStart3+1 +151 + 25, Hline3, HlineStart3+1 +151 + 25, Hpres36y, ILI9341_RED);
//*/

  // tft.fillScreen(ILI9341_BLACK);
    //tft.drawFastHLine(1, Hline2, tft.width(), ILI9341_WHITE);

    //drawLine(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1, uint16_t color);
    tft.drawLine(HlineStart3 + 0, Hline3, HlineStart3 + 5, Hpres31y, ILI9341_YELLOW);
    tft.drawLine(HlineStart3 + 5, Hpres31y, HlineStart3 + 10, Hpres32y, ILI9341_YELLOW);
    tft.drawLine(HlineStart3 + 10, Hpres32y, HlineStart3 + 15, Hpres33y, ILI9341_YELLOW);
    tft.drawLine(HlineStart3 + 15, Hpres33y, HlineStart3 + 20, Hpres34y, ILI9341_YELLOW);
    tft.drawLine(HlineStart3 + 20, Hpres34y, HlineStart3 + 25, Hpres35y, ILI9341_YELLOW);
    tft.drawLine(HlineStart3 + 25, Hpres35y, HlineStart3 + 30, Hpres36y, ILI9341_YELLOW);
    
    
    

//int Hline = 100;
//int HlineStart = 10;
//int HlineX = Hline * 10;
//int pres = 1000;
//int Hpres1 = 1005;
//int Hpres2 = 1010;
//int Hpres3 = 995;
//int Hpres4 = 1005;
//int Hpres5 = 1010;
//int Hpres6 = 1006;

//Hpres1y = Hline - (Hpres1 - 1000);

//int Hpres1y = (Hpres1 - 1000) + Hline;
//int Hpres2y = (Hpres2 - 1000) + Hline;
//int Hpres3y = (Hpres3 - 1000) + Hline;
//int Hpres4y = (Hpres4 - 1000) + Hline;
//int Hpres5y = (Hpres5 - 1000) + Hline;
//int Hpres6y = (Hpres6 - 1000) + Hline;


//pres = prijatoInt;




   delay(5000);

/*
    tft.fillScreen(ILI9341_BLACK);
   tft.drawTriangle(85, 100, 100, 60, 120, 150, ILI9341_GREEN);
   delay(5000);





tft.fillScreen(ILI9341_BLACK);
DrawAngledLine(85, 100, 100, 60, 20, ILI9341_GREEN);
 delay(5000);
*/


/*
testtriangles();
delay(2000);

rotateline();
delay(5000);


   // p+=a;     
    //m = map(p,0,1023,0,100);      // map needle movement

// Show Needle
    //xx = m;                       // 135 = zero position, 180 = just before middle, 0 = middle, 45 = max

// Picture Loop

    //display.display();     
    gauge(prijatoInt); 


 }


/*


 void DrawAngledLine(int x, int y, int x1, int y1, int size, int color) {
//DrawAngledLine(85, 100, 100, 60, 10, ILI9341_GREEN) {
  //tft.DrawAngledLine(85, 100, 100, 60, 10, ILI9341_GREEN) {
  float dx = (size / 2.0) * (y - y1) / sqrt(sq(x - x1) + sq(y - y1));
  float dy = (size / 2.0) * (x - x1) / sqrt(sq(x - x1) + sq(y - y1));
  tft.fillTriangle(x + dx, y - dy, x - dx,  y + dy,  x1 + dx, y1 - dy, color);
  //tft.fillTriangle(x - dx, y + dy, x1 - dx, y1 + dy, x1 + dx, y1 - dy, color);
}



void testtriangles() {
  tft.fillScreen(ILI9341_BLACK);
  uint16_t color = 0xF800;
  int t;
  int w = tft.width()/2;
  int x = tft.height()-1;
  int y = 0;
  int z = tft.width();
  for(t = 0 ; t <= 15; t++) {
    tft.drawTriangle(w, y, y, x, z, x, color);
    x-=4;
    y+=4;
    z-=4;
    color+=100;
  }
}


void rotateline() {
  tft.fillScreen(ILI9341_BLACK);
  uint16_t color = 0xF800;
  
  int t;
  int x1 = 60;
  int y1 = 150;
  int x2 = 100;
  int y2 = 150;
  int x1x;
  int y1y;
  int x2x;
  int y2y;
  int uhel;
  uhel = prijatoInt;

  tft.drawLine(x1, y1, x2, y2, ILI9341_YELLOW);
  //tft.drawLine(HlineStart + 0, Hline, HlineStart + 0, Hpres1y, ILI9341_YELLOW);

delay(3000);
//rotate fce

x1x = (x1 * cos(uhel)) - (y1 * sin(uhel));
y1y = (y1 * cos(uhel)) + (x1 * sin(uhel));
x2x = (x2 * sin(uhel)) - (y2 * sin(uhel));
y2y = (y2 * cos(uhel)) + (x2 * sin(uhel));

Serial.print("uhel: ");
Serial.println(uhel);
Serial.print("x1x: ");
Serial.println(x1x);
Serial.print("y1y: ");
Serial.println(y1y);
Serial.print("x2x: ");
Serial.println(x2x);
Serial.print("y2y: ");
Serial.println(y2y);

tft.drawLine(x1, y1, x2x, y2y, ILI9341_GREEN);

delay(3000);
tft.drawLine(x1x, y1y, x2, y2, ILI9341_RED);

delay(3000);

tft.drawLine(x1x, y1y, x2x, y2y, ILI9341_BLUE);

delay(3000);





  }





  void gauge(uint16_t angle) {
  
  //tft.fillScreen(ILI9341_BLACK);
  // Draw the Needle
 /*
    float x1=sin(2*angle*2*3.14/100);              // needle position
    float y1=cos(2*angle*2*3.14/100);
    tft.drawLine(xcenter, ycenter, xcenter+arc*x1, ycenter-arc*y1, ILI9341_WHITE);
    //display.display();
Serial.print("uhel: ");
Serial.println(angle);

/////////////
delay(100);
 tft.fillScreen(ILI9341_BLACK);

  float x1=arc*sin(angle*M_PI/180.);              // needle TIP position, arc=needle length
 float y1=arc*cos(angle*M_PI/180.);
  tft.drawLine(xcenter, ycenter, xcenter+x1, ycenter-y1,ILI9341_YELLOW);


Serial.print("uhel2: ");
Serial.println(angle);
 
 
 */
  }