float OilPressure;
float Temp;
//double dispValues[3];
#include <max6675.h>
#include <Adafruit_Sensor.h>
#include <SPI.h>
#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>

#define LARGHEZZA_SCHERMO 128 // Larghezza display OLED, in pixel
#define ALTEZZA_SCHERMO 64 // Altezza display OLED, in pixel

Adafruit_SSD1306 display(LARGHEZZA_SCHERMO, ALTEZZA_SCHERMO, &Wire, -1);
const unsigned char LOGO [] PROGMEM = {
  // Mazda logo, 128x64px
  0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1f, 0xff, 0xff, 0xf8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x00, 0xff, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x03, 0xf8, 0x00, 0x00, 0x7f, 0x80, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x07, 0xf0, 0x00, 0x00, 0x0f, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x07, 0x80, 0x00, 0x00, 0x03, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x13, 0x00, 0x00, 0x00, 0x01, 0xb0, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x31, 0x00, 0x00, 0x00, 0x02, 0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x70, 0x80, 0x00, 0x00, 0x00, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0x70, 0x00, 0x00, 0x18, 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x5e, 0x1c, 0x00, 0x00, 0xc1, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x1f, 0xc7, 0x00, 0x03, 0x07, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x90, 0x71, 0xc0, 0x06, 0x3f, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0xb0, 0x7e, 0x60, 0x19, 0xfc, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x03, 0xf0, 0x37, 0xe0, 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x01, 0xb0, 0x2f, 0x80, 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x00, 0xf8, 0x7e, 0x00, 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0xb0, 0x00, 0x3d, 0x78, 0x00, 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0xb8, 0x00, 0x3c, 0xf0, 0x00, 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0xf8, 0x00, 0x16, 0xe0, 0x00, 0xd0, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0xfc, 0x00, 0x0b, 0xc0, 0x00, 0xd0, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0x00, 0x05, 0xc0, 0x00, 0x90, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0x00, 0x07, 0xc0, 0x01, 0xa0, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x3e, 0x00, 0x03, 0x80, 0x01, 0xa0, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x37, 0x00, 0x03, 0x80, 0x01, 0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x1b, 0x80, 0x00, 0x00, 0x03, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x1c, 0x80, 0x00, 0x00, 0x06, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x0c, 0xc0, 0x00, 0x00, 0x0c, 0x80, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x07, 0x70, 0x00, 0x00, 0x1d, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x03, 0xbc, 0x00, 0x00, 0xfb, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xcf, 0x80, 0x0d, 0xbc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7f, 0x9f, 0xe8, 0x78, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1f, 0xc0, 0x07, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x07, 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3f, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0e, 0x00, 0x00, 0x00, 0x7f, 0xc0, 0x00, 0xdf, 0x8c, 0x20, 
0x00, 0x00, 0x00, 0x3f, 0xe0, 0x7f, 0xff, 0xe0, 0x00, 0x3f, 0xff, 0xe0, 0x3f, 0xff, 0xff, 0xf0, 
0x00, 0x00, 0x00, 0xe0, 0x3b, 0xe0, 0x3f, 0x1c, 0x01, 0xf8, 0x1e, 0x00, 0xe0, 0x00, 0x00, 0x60, 
0x00, 0x00, 0x03, 0x80, 0x7f, 0x80, 0x31, 0x87, 0x0f, 0x81, 0xf8, 0x09, 0xc0, 0x0f, 0xff, 0xc0, 
0x00, 0x00, 0x06, 0x00, 0x7e, 0x00, 0x60, 0x41, 0xfe, 0x07, 0xc0, 0x0f, 0x81, 0xff, 0xfc, 0x00, 
0x00, 0x00, 0x0c, 0x30, 0xfc, 0x10, 0x60, 0x60, 0xf0, 0x1f, 0x80, 0x0f, 0x03, 0xff, 0xf8, 0x00, 
0x00, 0x00, 0x38, 0x61, 0xf8, 0x70, 0xc0, 0x38, 0x00, 0x7f, 0xff, 0xfe, 0x03, 0xff, 0xf8, 0x00, 
0x00, 0x00, 0x61, 0xe1, 0xe0, 0xe0, 0x80, 0x3c, 0x03, 0xdf, 0xf8, 0x6c, 0x00, 0x00, 0x0c, 0x00, 
0x00, 0x01, 0xc3, 0xc3, 0xc3, 0xc1, 0x80, 0x78, 0x07, 0xfe, 0x00, 0xf8, 0x00, 0x00, 0x00, 0x00, 
0x00, 0x03, 0x87, 0x87, 0x87, 0xc1, 0x01, 0xe0, 0x03, 0xff, 0xff, 0xff, 0xf0, 0x3e, 0x01, 0x00, 
0x00, 0x06, 0x1f, 0x87, 0x1f, 0x83, 0x07, 0x80, 0x01, 0xff, 0xff, 0xff, 0x00, 0x0e, 0x00, 0x00, 
0x00, 0x0c, 0x3f, 0x0c, 0x3f, 0x02, 0x1e, 0x01, 0xc0, 0xe0, 0x00, 0x00, 0x00, 0x0e, 0x01, 0x00, 
0x00, 0x38, 0x7f, 0x08, 0xff, 0x06, 0x78, 0x07, 0xe0, 0x20, 0x00, 0x00, 0x00, 0x3c, 0x03, 0x00, 
0x00, 0x7f, 0xfe, 0x01, 0xde, 0x07, 0xe0, 0x1c, 0x30, 0x18, 0x00, 0x00, 0x01, 0xf0, 0x06, 0x00, 
0x00, 0xff, 0xfd, 0xe7, 0x8e, 0x0f, 0x80, 0xf0, 0x18, 0x0c, 0x00, 0x43, 0xff, 0xc0, 0x1c, 0x00, 
0x03, 0xff, 0xff, 0xee, 0x0d, 0xfe, 0x03, 0xc0, 0x0c, 0x06, 0x03, 0xff, 0xf8, 0x01, 0xf0, 0x00, 
0x07, 0xff, 0xff, 0xfc, 0x0c, 0x00, 0x3e, 0x00, 0x07, 0x03, 0xff, 0x00, 0x00, 0x3f, 0xc0, 0x00, 
0x0e, 0xff, 0xff, 0xf0, 0x0f, 0xff, 0xf8, 0x00, 0x03, 0xff, 0xff, 0xff, 0xff, 0xfc, 0x00, 0x00
};

const unsigned char snowflake [] PROGMEM {
  // Icona fiocco di neve, 9x9px
  0x08, 0x00, 0x2a, 0x00, 0x6b, 0x00, 0x14, 0x00, 0xeb, 0x80, 0x14, 0x00, 0x6b, 0x00, 0x2a, 0x00,
  0x08, 0x00
};

int analogIn = 1;  // Cambiato da 0 a 1 per leggere da A1
int val = 0;
int x1 = 0;
int x2 = 0;
int x3 = 0;
int needle = 0;

int thermoD0 = 4; // so
int thermoCS = 5;
int thermoCLK = 6; // sck



void setup() {
  Serial.begin(9600); // Inizia la comunicazione seriale
 if (!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) { // Indirizzo 0x3C per 128x64
    Serial.println(F("Errore nell'allocazione SSD1306"));
    for (;;);
  }
  display.clearDisplay();
  display.drawBitmap(0, 0, LOGO, 128, 64, WHITE); // Logo Mazda
  display.display();
  delay(500); // tempo di visualizzazione Logo Mazda orig 2000
 pinMode(A0, INPUT);

}

void loop() {
  delay(1);
  display.clearDisplay();
  /*********** BORDI ***********/
 display.drawRect(0, 0, 128, 64, WHITE); // rettangolo riquadro
 display.drawLine(63, 0, 63, 63, WHITE); // Bordo divisorio verticale
 display.drawLine(0, 32, 128, 32, WHITE); // Bordo divisorio inferiore

/*********** VALORE TEMPERATURA ***********/
  display.setTextSize(2); // valore originale 2 cambia la dim. del carattere
  display.setCursor(10, 10); // valore originale 13, 28 cambia la posizione del carattere
  if (Temp < 65) {  // sotto i 65 °C compare l'icona del fiocco di neve
    display.setTextColor(BLACK);
    display.fillRect(2, 2, 60, 29, WHITE);//valore originale 2, 27, 60, 16, WHITE cambia la dim. del rettangolo
    display.print(Temp  , 0);

    display.drawBitmap(1, 21, snowflake, 9, 9, BLACK); // Icona fiocco di neve orig. 3, 33, snowflake, 9, 9, BLACK

    display.setTextColor(BLACK);
    display.setTextSize(1);
    display.setCursor(52, 21); // val orig (50, 35);
    display.print((char)247); //"°" carattere
    display.print("C");
  }
  else {
    display.setTextColor(WHITE);
    display.print(Temp , 0);
    display.setTextColor(WHITE);
    display.setTextSize(1);
    display.setCursor(50, 20);
    display.print((char)247); //"°" carattere
    display.print("C");
  }
   
   //********  calcolo PRESSIONE *********

   int RawADC = analogRead(A2); // Legge un valore analogico dal pin A2
  float Pressure = (RawADC / 1024.00) * 5; // Calcola la tensione effettiva attraverso il sensore
  Pressure = (-0.177 + sqrt(0.03133 - (4 * -0.0065 * (0.052 - Pressure)))) / -0.013; // Formula quadratica per una lettura più accurata
  Serial.println(Pressure); // Stampa la pressione
  
   //******** FINE calcolo PRESSIONE *********
  display.setTextColor(WHITE);
  display.setTextSize(3);// dimensione carattere ori 2
  display.setCursor(65, 9);// posizione cursore pressione
  display.print(Pressure, 1);
//********** Scritta Bar**********
  display.setTextSize(1);
  display.setCursor(120, 2);
  display.print("B");
  display.setCursor(120, 12);
  display.print("a");
  display.setCursor(120, 22);
  display.print("r");

  /*********** VOLTAGGIO BATTERIA ***********/
 int rawValue = analogRead(A0); // Legge il valore analogico dal pin A0
  float Vin = rawValue * 0.0293255;
  if (Vin < 11.8) {
    display.setTextColor(BLACK);
    display.fillRect(2, 34, 60, 27, WHITE);
    display.setTextSize(2);// dimensione carattere
    display.setCursor(3,40);//posizione carattere
    display.print (Vin, 1);
    display.setCursor(55,52);//posizione carattere
    display.setTextSize(1);// dimensione carattere
    display.print ("V");
  }
  else{
    display.setTextSize(2);// dimensione carattere
    display.setCursor(3, 40);//posizione carattere
    display.print(Vin, 1);
    display.setTextSize(1);// dimensione carattere
    display.setCursor(55,52);//posizione carattere
    display.print("V");
  }
  //************* scritta AFR **********
  display.setTextSize(1);
  display.setTextColor(WHITE);
  display.setCursor(120, 34);
  display.print("A");
  display.setCursor(120, 44);
  display.print("F");
  display.setCursor(120, 54);
  display.print("R");
  
 //********* calcolo AFR***********
   val = analogRead(analogIn);
  needle = map(val, 0, 1023, 1, 127);
  display.setTextSize(2);
  display.setTextColor(WHITE);
  display.setCursor(68, 40);
  display.print(x1);
  display.print(x2);
  display.print(".");
  display.print(x3);
  display.display();
  devide();
}

void devide() {
  x1 = 0;
  x2 = 0;
  x3 = 0;
  int value = val;
  
  while (value >= 100) {
    value -= 100;
    x1++;
  }

  while (value >= 10) {
    value -= 10;
    x2++;
  }

  x3 = value;
//******** fine calcolo AFR *********

}