TEDü Getac Changes

There are only 7 RX mailboxes available, so one of the filters won't
work.

.editorconfig

@@ -0,0 +1,8 @@
+[*]
+charset = utf-8
+end_of_line = lf
+insert_final_newline = true
+
+[*.{cpp,c,h,hpp}]
+indent_style = space
+indent_size = 4

.git-blame-ignore-revs

@@ -0,0 +1,2 @@
+# Format everything
+41d3bd907e65b484876859b767328e5d81181911

.vscode/extensions.json

@@ -2,7 +2,9 @@
     // See http://go.microsoft.com/fwlink/?LinkId=827846
     // for the documentation about the extensions.json format
     "recommendations": [
-        "platformio.platformio-ide",
+        "platformio.platformio-ide"
-        "ms-vscode.cpptools-extension-pack"
     ],
+    "unwantedRecommendations": [
+        "ms-vscode.cpptools-extension-pack"
+    ]
 }

include/debug.h

@@ -13,9 +13,7 @@ struct FaultStatusRegisters {
   uint32_t SHCSR;
 };
 
-enum class FaultType {
+enum class FaultType { HardFault, MemManage, BusFault, UsageFault };
-  HardFault, MemManage, BusFault, UsageFault
-};
 
 struct FlashDump {
   FaultType type;
@@ -43,22 +41,23 @@ const FlashDump *flash_dump_get_fault(uint32_t n);
 
 void uart_wait_for_txrdy();
 size_t uart_write(uint8_t c);
-size_t uart_print(const char* str);
+size_t uart_print(const char *str);
 size_t uart_print_hex(uint32_t x);
 
-void print_dumped_faults(bool in_irq=false);
+void print_dumped_faults(bool in_irq = false);
-void print_stacked_registers(const uint32_t *stack, bool in_irq=false);
+void print_stacked_registers(const uint32_t *stack, bool in_irq = false);
-void print_fault_registers(const FaultStatusRegisters *fsr, bool in_irq=false);
+void print_fault_registers(const FaultStatusRegisters *fsr,
+                           bool in_irq = false);
 
 FaultStatusRegisters get_current_fsr();
 
-const char* get_fault_type_name(FaultType type);
+const char *get_fault_type_name(FaultType type);
-void fault_handler(uint32_t *stack_addr, FaultType fault_type,
+void fault_handler(uint32_t *stack_addr, FaultType fault_type, const int *leds,
-                   const int *leds, unsigned n_leds);
+                   unsigned n_leds);
 
 void inline busy_wait(size_t iterations) {
   for (size_t i = 0; i < iterations; i++) {
     // Does nothing, but ensures the compiler doesn't optimize the loop away.
-    __ASM ("" ::: "memory");
+    __ASM("" ::: "memory");
   }
 }

lib/FT18_STW_DISPLAY/FT18_STW_DISPLAY.cpp

@@ -1,39 +1,39 @@
+#include "FT18_STW_DISPLAY.h"
 #include "Arduino.h"
 #include "EDIPTFT.h"
-#include "FT_2018_STW_CAN.h"
 #include "FT18_STW_INIT.h"
-#include "FT18_STW_DISPLAY.h"
+#include "FT_2018_STW_CAN.h"
 
-EDIPTFT tft(true,false);
+String pad_left(String orig, int len, char pad_char) {
-String bezeichnungen[]={"T_mot","T_oil","P_oil","% fa","U_batt","P_wat","T_air",
+  String result = {orig};
-						"P_b_front","P_b_rear","Error Type","Speed_fl","Speed_fr","Speed"};
+  for (int i = orig.length(); i < len; i++) {
+    result = pad_char + result;
+  }
+
+  return result;
+}
+
+EDIPTFT tft(true, false);
+String bezeichnungen[] = {"T_mot",    "T_oil",      "P_oil",    "% fa",
+                          "U_batt",   "P_wat",      "T_air",    "P_b_front",
+                          "P_b_rear", "Error Type", "Speed_fl", "Speed_fr",
+                          "Speed"};
 //"Drehzahl","P_fuel","Index"
-int vergleichsindex;
+int led_s[] = {led1, led2,  led3,  led4,  led5,  led6,  led7,  led8,
-int sizeaalt;
+               led9, led10, led11, led12, led13, led14, led15, led16};
-int sizeaneu;
-int sizebalt;
-int sizebneu;
-int sizecalt;
-int sizecneu;
-int sizedalt;
-int sizedneu;
-int sizeealt;
-int sizeeneu;
-uint8_t clearcounter = 56;
-uint8_t trcalt = Stw_data.trc; 
-uint8_t modealt = Stw_data.mode;
-uint8_t trccounter;// = Stw_data.trc;
-uint8_t modecounter;// = Stw_data.mode;
-bool trctimer;
-bool modetimer;
-int led_s[] = {led1,led2,led3,led4,led5,led6,led7,led8,led9,led10,led11,led12,led13,led14,led15,led16};
-unsigned long poiltimer;
-unsigned long tmottimer;
-unsigned long toiltimer;
-bool poilbool = true;
-bool tmotbool = true;
-bool toilbool = true;
 
+DataBox gear_box(121, 0, 199, 94, 160, 0, EA_SWISS30B, 4, 4, 'C', true);
+DataBox left_box(0, 25, 119, 94, 110, 25, EA_FONT6X8, 3, 8, 'R', false);
+DataBox right_box(201, 25, 320, 94, 310, 25, EA_FONT6X8, 3, 8, 'R', false);
+DataBox autoshift_box(164+50, 184, 240+50, 230, 202+50, 178, EA_FONT7X12, 3, 5, 'C', false);
+
+TireTempBox fl_box(80, 130, 156, 176, 118, 124, EA_FONT7X12, 3, 5, 'C');
+TireTempBox fr_box(164, 130, 240, 176, 202, 124, EA_FONT7X12, 3, 5, 'C');
+TireTempBox rl_box(80, 184, 156, 230, 118, 178, EA_FONT7X12, 3, 5, 'C');
+TireTempBox rr_box(164, 184, 240, 230, 202, 178, EA_FONT7X12, 3, 5, 'C');
+
+int testing_page = 0;
+uint16_t clearcounter = 1;
 void init_display() {
   pinMode(writeprotect, OUTPUT);
   digitalWrite(writeprotect, HIGH);
@@ -41,366 +41,544 @@ void init_display() {
   pinMode(disp_cs, OUTPUT);
   pinMode(MOSI, OUTPUT);
   pinMode(MISO, OUTPUT);
-	//pinMode(CLK, INPUT);
   digitalWrite(disp_cs, HIGH);
   digitalWrite(MOSI, HIGH);
   digitalWrite(MISO, HIGH);
   digitalWrite(reset, LOW);
-		//edip.smallProtoSelect(7);
+  digitalWrite(reset, HIGH);
-		//edip.setNewColor(EA_GREY, 0xe3, 0xe3,0xe3);	 // redefine r-g-b-values of EA_GREY 
-		//edip.drawImage(0,50,FASTTUBE_LOGO_PNG);
-	digitalWrite(reset,HIGH);
   tft.begin(115200); // start display communication
-	/*int h = 20;
-	char charh[2];
-	String strh = String(h);
-	strh.toCharArray(charh,2);
-	tft.DisplayLight(charh);*/
   tft.cursorOn(false);
   tft.terminalOn(false);
-	tft.setDisplayColor(EA_WHITE,EA_BLACK);
+  tft.setDisplayColor(EA_WHITE, EA_BLACK);
-	tft.setTextColor(EA_WHITE,EA_BLACK);
+  tft.setTextColor(EA_WHITE, EA_TRANSPARENT);
-	//tft.setTextFont('4');
+  tft.setTextSize(5, 8);
-	tft.setTextSize(5,8);
   tft.clear();
-	//tft.displayLight('30');
+
-	tft.drawText(0, 14, 'C', "FaSTTUBe");  //draw some text
+  gear_box.update_label(get_label(VAL_GEAR));
-	//tft.loadImage(0,0,1);
+  left_box.update_label(get_label(VAL_FIRST_LEFT_BOX));
-	//delay(2000);
+  right_box.update_label(get_label(VAL_RPM));
+  autoshift_box.update_label("");
 }
 
-double get_value(int a){
+String get_value(Value val) {
-	double value;
+  switch (val) {
-	if (a == 0){ 
+  case VAL_GEAR:
-		value = Vehicle_data.gear;
+    if (Vehicle_data.gear == 0) {
-	//}else if (a == 11){
+      return "N";
-	//	value = Stw_data.i;
+    }
-	//}else if (a == 1){
+    return String(Vehicle_data.gear);
-	//	value = Vehicle_data.revol/2; 
+  case VAL_RPM:
-	}else if (a == 1){		
+    return String(Vehicle_data.revol / 2);
-		value = Vehicle_data.t_mot-40;
+  case VAL_TT_FL:
-	}else if (a == 5){
+    return String(Vehicle_data.t_tfl * 0.423529 + 8, 0);
-		value = 0.0706949*Vehicle_data.u_batt;
+  case VAL_TT_FR:
-	}else if (a == 7){
+    return String(Vehicle_data.t_tfr * 0.423529 + 0, 0);
-		value = Vehicle_data.t_air-40;
+  case VAL_TT_RL:
-	}else if(a == 10){
+    return String(Vehicle_data.t_trl * 0.423529 + 11, 0);
-		value = Stw_data.error_type;
+  case VAL_TT_RR:
-	}else if (a == 2){		
+    return String(Vehicle_data.t_trr * 0.423529 + 4, 0);
-		value = Vehicle_data.t_oil-40;
+  case VAL_LAPTIME: {
-	}else if (a == 6){
+    double time =
-		value = 0.0514*Vehicle_data.p_wat;
+        Vehicle_data.lap_time_sec + Vehicle_data.lap_time_msec / 1000.0;
-	//}else if (a == 7){		
+    if (time < 100) {
-	//	value = 0.0514*Vehicle_data.p_fuel;
+      return String(time, 2);
-	}else if (a == 3){		
+    } else if (time < 1000) {
-		value = 0.0514*Vehicle_data.p_oil;
+      return String(time, 1);
-	}else if (a == 8){		
+    } else if (time < 10000) {
-		value = Vehicle_data.p_brake_front;
+      return String(time, 0);
-	}else if (a == 9){		
+    } else {
-		value = Vehicle_data.p_brake_rear;
+      return "2SLOW";
-	}else if(a == 4){
+    }
-		value = 200*Vehicle_data.p_brake_front/(Vehicle_data.p_brake_rear+(2*Vehicle_data.p_brake_front));
+  }
-	}else if (a == 11){		
+  case VAL_UBATT:
-		value = Vehicle_data.speed_fl;
+    return String(0.0706949 * Vehicle_data.u_batt, 2);
-	}else if (a == 12){		
+  case VAL_TMOT:
-		value = Vehicle_data.speed_fr;
+    return String(Vehicle_data.t_mot - 40);
-	}else if(a == 13){
+  case VAL_TAIR:
-		value = Vehicle_data.speed;
+    return String(Vehicle_data.t_air - 40);
+  case VAL_TOIL:
+    return String(Vehicle_data.t_oil - 40);
+  case VAL_ERR_TYPE:
+    return String(Stw_data.error_type);
+  case VAL_PFUEL:
+    return String(0.0514 * Vehicle_data.p_fuel, 2);
+  case VAL_PWAT:
+    return String(0.0514 * Vehicle_data.p_wat, 2);
+  case VAL_POIL:
+    return String(0.0514 * Vehicle_data.p_oil, 2);
+  case VAL_PBF:
+    return String(Vehicle_data.p_brake_front);
+  case VAL_PBR:
+    return String(Vehicle_data.p_brake_rear);
+  case VAL_SPEED_FL:
+    return String(Vehicle_data.speed_fl);
+  case VAL_SPEED_FR:
+    return String(Vehicle_data.speed_fr);
+  case VAL_SPEED:
+    return String(Vehicle_data.speed);
+  case VAL_BBAL: {
+    double p_total =
+        Vehicle_data.p_brake_front + Vehicle_data.p_brake_rear / 2.398;
+    double bbal = p_total == 0 ? 0 : 100 * Vehicle_data.p_brake_front / p_total;
+    if (bbal >= 100) {
+      return "100";
+    }
+    return String(bbal, 2);
+  }
+  default:
+    return "???";
   }
-	return value;
 }
 
-void update_display(){
+String get_label(Value val) {
-	if(((millis()-poiltimer)>=20000) and poilbool){
+  switch (val) {
-		poilbool = false;
+  case VAL_GEAR:
-		alarm("P_oil");
+    return "GEAR";
+  case VAL_RPM:
+    return "RPM";
+  case VAL_TT_FL:
+    return "TEMP FL";
+  case VAL_TT_FR:
+    return "TEMP FR";
+  case VAL_TT_RL:
+    return "TEMP RL";
+  case VAL_TT_RR:
+    return "TEMP RR";
+  case VAL_LAPTIME:
+    return "LAPTIME";
+  case VAL_UBATT:
+    return "BATT VOLTAGE";
+  case VAL_TMOT:
+    return "TEMP ENG";
+  case VAL_TAIR:
+    return "TEMP AIR";
+  case VAL_TOIL:
+    return "TEMP OIL";
+  case VAL_ERR_TYPE:
+    return "ERROR TYPE";
+  case VAL_PFUEL:
+    return "PRESS FUEL";
+  case VAL_PWAT:
+    return "PRESS WAT";
+  case VAL_POIL:
+    return "PRESS OIL";
+  case VAL_PBF:
+    return "PRESS BRAKE F";
+  case VAL_PBR:
+    return "PRESS BRAKE R";
+  case VAL_SPEED_FL:
+    return "SPEED FL";
+  case VAL_SPEED_FR:
+    return "SPEED FR";
+  case VAL_SPEED:
+    return "SPEED";
+  case VAL_BBAL:
+    return "BBAL";
+  default:
+    return "???";
   }
-	if(((millis()-tmottimer)>=20000) and tmotbool){
+}
-		tmotbool = false;
+
-		alarm("T_mot");
+bool check_alarms() {
+  static uint32_t poil_last_valid, tmot_last_valid, toil_last_valid;
+  uint32_t now = millis();
+  if (Vehicle_data.p_oil >= POIL_ALARM_THRESH || Vehicle_data.speed == 0) {
+    poil_last_valid = now;
   }
-	if(((millis()-toiltimer)>=10000) and toilbool){
+  if (Vehicle_data.t_mot <= TMOT_ALARM_THRESH ||
-		toilbool = false;
+      Vehicle_data.t_mot == TMOT_SAFE_VALUE) {
-		alarm("T_oil");
+    tmot_last_valid = now;
   }
-	if((0.0514*Vehicle_data.p_oil)>=0,1 or Vehicle_data.speed == 0){
+  if (Vehicle_data.t_oil <= TOIL_ALARM_THRESH) {
-		poiltimer = millis();
+    toil_last_valid = now;
   }
-	if(((Vehicle_data.t_mot - 40) <= 0x69) or ((Vehicle_data.t_mot - 40)==0xC8)){
+  // bool poil_alarm = now - poil_last_valid >= POIL_ALARM_TIME;
-		tmottimer = millis();
+  bool poil_alarm = false;
+  bool tmot_alarm = now - tmot_last_valid >= TMOT_ALARM_TIME;
+  bool toil_alarm = now - toil_last_valid >= TOIL_ALARM_TIME;
+  bool alarm_active = poil_alarm || tmot_alarm || toil_alarm;
+
+  if (alarm_active) {
+    String alarm_text = "";
+    if (poil_alarm)
+      alarm_text += "PO";
+    if (tmot_alarm)
+      alarm_text += "TM";
+    if (toil_alarm)
+      alarm_text += "TO";
+    alarm(alarm_text);
   }
-	if((Vehicle_data.t_oil - 40) <= 0x96){
+
-		toiltimer = millis();
+  return alarm_active;
-	}
+}
-	if(Stw_data.buttonState1 & Stw_data.buttonState4){
+
-		alarm("");
+bool check_enc_displays() {
-	}
+  static uint8_t trc_old, mode_old;
-	if(!tft.disconnected){
+  static bool display_trc, display_mode;
-		tft.cursorOn(false);
+  static uint32_t display_trc_begin, display_mode_begin;
-		if(trcalt!=Stw_data.trc or trctimer == true or Stw_data.buttonStateEnc1 == HIGH){
+
-			display_trc();
+  return check_display(trc_old, Stw_data.trc, display_trc, display_trc_begin,
-		}else if(modealt!=Stw_data.mode or modetimer == true or Stw_data.buttonStateEnc2 == HIGH){
+                       "ARB") ||
-			display_mode();
+         check_display(mode_old, Stw_data.mode, display_mode,
-		}else{
+                       display_mode_begin, "MODE");
-			if(clearcounter>=56){
+}
+
+bool check_display(uint8_t& val_old, uint8_t val_new, bool& active,
+                   uint32_t& begin, const String& title) {
+  if (val_old != val_new) {
+    active = true;
+    begin = millis();
+    val_old = val_new;
     tft.clear();
-				clearcounter = 0;
+    tft.fillDisplayColor(EA_RED);
+    tft.setTextColor(EA_WHITE, EA_RED);
+    tft.setTextSize(7, 8);
+    String text = title + ":" + val_new;
+    char text_arr[16];
+    text.toCharArray(text_arr, 16);
+    tft.drawText(15, 68, 'C', text_arr);
+  } else if (active && millis() - begin > ENC_DISPLAY_TIME) {
+    tft.setTextColor(EA_WHITE, EA_TRANSPARENT);
+    tft.clear();
+    active = false;
+  }
+
+  return active;
+}
+
+void update_display() {
+  static DisplayView view = VIEW_DRIVER;
+  static uint32_t last_cleared;
+  static bool cleared = true;
+
+  if (check_alarms()) {
+    cleared = true;
+    return;
+  }
+  if (tft.disconnected) {
+    uint32_t now = millis();
+    if (now - last_cleared < 1000) {
+      return;
+    }
+    digitalWrite(reset, LOW);
+    delay(100);
+    digitalWrite(reset, HIGH);
+    tft.disconnected = false;
+    tft.clear();
+    cleared = true;
+    last_cleared = now;
+  }
+
+  if (check_enc_displays()) {
+    cleared = true;
+    return;
+  }
+
+  uint32_t now = millis();
+  // Both buttons have to be pressed at the same time, but we also use the
+  // debounced rises to ensure we don't keep toggling between the views
+  if (Stw_data.buttonState1 && Stw_data.buttonState4 &&
+      (Stw_data.button1_rises > 0 || Stw_data.button4_rises > 0)) {
+    Stw_data.button1_rises = 0;
+    Stw_data.button4_rises = 0;
+    view = (DisplayView)((view + 1) % (VIEW_LAST + 1));
+    tft.clear();
+    cleared = true;
+  }
+
+  if (view == VIEW_DRIVER) {
+    if (cleared) {
+      redraw_view_driver();
+      cleared = false;
+    } else {
+      update_view_driver();
+    }
+  } else {
+    if (cleared) {
+      redraw_view_testing();
+      cleared = false;
+    } else {
+      update_view_testing();
+    }
+  }
+  if (clearcounter>= 10000){
+  pinMode(writeprotect, OUTPUT);
+  digitalWrite(writeprotect, HIGH);
+  pinMode(reset, OUTPUT);
+  pinMode(disp_cs, OUTPUT);
+  pinMode(MOSI, OUTPUT);
+  pinMode(MISO, OUTPUT);
+  digitalWrite(disp_cs, HIGH);
+  digitalWrite(MOSI, HIGH);
+  digitalWrite(MISO, HIGH);
+  digitalWrite(reset, LOW);
+  digitalWrite(reset, HIGH);
+  //tft.begin(115200); // start display communication
+  //tft.cursorOn(false);
+  //tft.terminalOn(false);
+  //tft.setDisplayColor(EA_WHITE, EA_BLACK);
+  //tft.setTextColor(EA_WHITE, EA_TRANSPARENT);
+  //tft.setTextSize(5, 8);
+  //tft.clear();
+
+ // gear_box.update_label(get_label(VAL_GEAR));
+ // left_box.update_label(get_label(VAL_FIRST_LEFT_BOX));
+ // right_box.update_label(get_label(VAL_RPM));
+ 
+   clearcounter = 0; //clearen des display nach definierter Zeit
+ cleared =true;
+//
   }
  clearcounter+=1;
-			if(Stw_data.buttonState4){
-				if(Stw_data.displayindex>=sizeof(bezeichnungen)/sizeof(String)-3){
-					Stw_data.displayindex = 0;
-					delay(250);
-				}else{
-					Stw_data.displayindex+=1;
-					delay(250);
-				}
-			}
-			if(Stw_data.buttonState1){
-				if(Stw_data.displayindex<=0){
-					Stw_data.displayindex = sizeof(bezeichnungen)/sizeof(String)-3;
-					delay(250);
-				}else{
-					Stw_data.displayindex-=1;
-					delay(250);
-				}
-			}
-			if(vergleichsindex!=Stw_data.displayindex){
-				tft.clear();
-				vergleichsindex=Stw_data.displayindex;
-			}	
-			int a = sizeof(bezeichnungen[Stw_data.displayindex]);
-			int g = sizeof(bezeichnungen[Stw_data.displayindex+1]);
-			int h = sizeof(bezeichnungen[Stw_data.displayindex+2]);
-			char d[a];
-			char e[g];
-			char f[h];
-			bezeichnungen[Stw_data.displayindex].toCharArray(d,a);
-			bezeichnungen[Stw_data.displayindex+1].toCharArray(e,g);
-			bezeichnungen[Stw_data.displayindex+2].toCharArray(f,h);
-			char b[2];
-			char c[5];
-			char i[5];
-			char j[5];
-			char k[5];
-			char m[5];
-			String str=String(int(get_value(0)));
-			if(str.equals(String(0))){
-				str = "N";
-			}
-			String str1;
-			String str2;
-			String str3;
-			if(Stw_data.displayindex+1==0 or Stw_data.displayindex+1==2 or Stw_data.displayindex+1==1 or Stw_data.displayindex+1==10 or Stw_data.displayindex+1==7 or Stw_data.displayindex+1==11 or Stw_data.displayindex+1==12 or Stw_data.displayindex+1==13){
-				str1=String(int(get_value(Stw_data.displayindex+1)));	
-			}else{
-				str1=String(get_value(Stw_data.displayindex+1));
-			}
-			if(Stw_data.displayindex+1 == 10){
-				if(str1.equals(String(1))){
-					str1 = "PC";
-				}else if(str1.equals(String(2))){
-					str1 = "BSE";
-				}else if(str1.equals(String(3))){
-					str1 = "APS";
-				}else if(str1.equals(String(4))){
-					str1 = "ETB";
-				}else if(str1.equals(String(0))){
-					str1 = "None";
-				}
-			}
-			if(Stw_data.displayindex+2==0 or Stw_data.displayindex+2==2 or Stw_data.displayindex+2==1 or Stw_data.displayindex+2==10 or Stw_data.displayindex+2==7 or Stw_data.displayindex+2==11 or Stw_data.displayindex+2==12 or Stw_data.displayindex+2==13){
-				str2=String(int(get_value(Stw_data.displayindex+2)));
-			}else{
-				str2=String(get_value(Stw_data.displayindex+2));
-			}
-			if(Stw_data.displayindex+2 == 10){
-				if(str2.equals(String(1))){
-					str2 = "PC";
-				}else if(str2.equals(String(2))){
-					str2 = "BSE";
-				}else if(str2.equals(String(3))){
-					str2 = "APS";
-				}else if(str2.equals(String(4))){
-					str2 = "ETB";
-				}else if(str2.equals(String(0))){
-					str2 = "None";
-				}
-			}
-			if(Stw_data.displayindex+3==0 or Stw_data.displayindex+3==2 or Stw_data.displayindex+3==1 or Stw_data.displayindex+3==10 or Stw_data.displayindex+3==7 or Stw_data.displayindex+3==11 or Stw_data.displayindex+3==12 or Stw_data.displayindex+3==13){
-				str3=String(int(get_value(Stw_data.displayindex+3)));
-			}else{
-				str3=String(get_value(Stw_data.displayindex+3));
-			}
-			if(Stw_data.displayindex+3 == 10){
-				if(str3.equals(String(1))){
-					str3 = "PC";
-				}else if(str3.equals(String(2))){
-					str3 = "BSE";
-				}else if(str3.equals(String(3))){
-					str3 = "APS";
-				}else if(str3.equals(String(4))){
-					str3 = "ETB";
-				}else if(str3.equals(String(0))){
-					str3 = "None";
-				}
-			}
-			String str5=String(Vehicle_data.revol/2);
-			String str4=String(0.0514*Vehicle_data.p_fuel);
-			str.toCharArray(b,2);
-			str1.toCharArray(c,5);
-			str2.toCharArray(i,5);
-			str3.toCharArray(j,5);
-			str4.toCharArray(k,5);
-			str5.toCharArray(m,5);
-			sizeaneu = strlen(c);
-			sizebneu = strlen(i);
-			sizecneu = strlen(j);
-			sizedneu = strlen(k);
-			sizeeneu = strlen(m);
-			if(sizeaalt!=sizeaneu){
-				tft.clear();
-				sizeaalt=sizeaneu;
-			}
-			if(sizebalt!=sizebneu){
-				tft.clear();
-				sizebalt=sizebneu;
-			}
-			if(sizecalt!=sizecneu){
-				tft.clear();
-				sizecalt=sizecneu;
-			}
-			if(sizedalt!=sizedneu){
-				tft.clear();
-				sizedalt=sizedneu;
-			}
-			if(sizeealt!=sizeeneu){
-				tft.clear();
-				sizeealt=sizeeneu;
-			}
-			tft.setTextSize(6,8);
-			tft.drawText(132, 0, 'L', b);
-			tft.setTextSize(2,7);
-			tft.drawText(10, 20, 'L', k);
-			tft.drawText(240, 20, 'L', m);
-			tft.drawText(10,130, 'L', c);
-			tft.drawText(120, 130, 'L', i);
-			tft.drawText(240,130, 'L', j);
-			tft.setTextSize(1,1);	
-			tft.drawText(136,116, 'L', "Gang");
-			tft.drawText(10,116, 'L', "P_fuel");
-			tft.drawText(240,116, 'L', "Drehzahl");
-			tft.drawText(10,226, 'L', d);
-			tft.drawText(120,226, 'L', e);
-			tft.drawText(240,226, 'L', f);
-			/*if (cleaner){
-				tft.setTextSize(5,8);
-				tft.drawText(0, 14, 'C', "FaSTTUBe");  // draw some text
-				tft.setTextSize(4,4);
-				tft.drawText(24, 120, 'C', "insert coin");  // draw some text
-				tft.drawText(0, 180, 'C', "to continue");
-				cleaner = false;
-			}else{
-				tft.setTextSize(5,8);
-				tft.drawText(0, 14, 'C', "FaSTTUBe");  // draw some text
-				tft.setTextSize(4,4);
-				tft.drawText(24, 120, 'C', "              ");  // draw some text
-				tft.drawText(0, 180, 'C', "              ");
-				cleaner = true;
-			}
-			delay(80);*/
-		}
-	}
 }
 
-void display_trc(){
+void alarm(String textstr) {
-	if(trcalt!=Stw_data.trc or Stw_data.buttonStateEnc1 == HIGH){
+  uint8_t x = 1;
-		tft.clear();
+  ;
-		tft.setTextSize(7,8);
-		tft.setDisplayColor(EA_WHITE,EA_RED);
-		tft.setTextColor(EA_WHITE,EA_RED);
-		char trcanzeige[7];
-		String str = String("ARB:");
-		if(Stw_data.trc==11){
-			str+="ED";
-		}else{
-			str+=String(Stw_data.trc);
-		}
-		str.toCharArray(trcanzeige,7);
-		tft.drawText(0,0,'L',"            ");
-		tft.drawText(0,60,'L',"            ");
-		tft.drawText(0,120,'L',"            ");
-		tft.drawText(0,180,'L',"            ");
-		tft.drawText(15,68,'L',trcanzeige);
-		trccounter = 0;
-		trcalt = Stw_data.trc;
-		trctimer = true;
-	}else if(trccounter >= 255){
-		tft.setDisplayColor(EA_WHITE,EA_BLACK);
-		tft.setTextColor(EA_WHITE,EA_BLACK);
-		tft.clear();
-		trctimer = false;
-	}else{
-		trccounter+=1;
-		delay(5);
-	}
-}
-
-void display_mode(){
-	if(modealt!=Stw_data.mode or Stw_data.buttonStateEnc2 == HIGH){
-		tft.clear();
-		tft.setTextSize(6,8);
-		tft.setDisplayColor(EA_WHITE,EA_RED);
-		tft.setTextColor(EA_WHITE,EA_RED);
-		char modeanzeige[7];
-		String str = String("MODE:");
-		str+=String(Stw_data.mode);
-		str.toCharArray(modeanzeige,7);
-		tft.drawText(0,0,'L',"            ");
-		tft.drawText(0,60,'L',"            ");
-		tft.drawText(0,120,'L',"            ");
-		tft.drawText(0,180,'L',"            ");
-		tft.drawText(15,68,'L',modeanzeige);
-		modecounter = 0;
-		modealt = Stw_data.mode;
-		modetimer = true;
-	}else if(modecounter >= 255){
-		tft.setDisplayColor(EA_WHITE,EA_BLACK);
-		tft.setTextColor(EA_WHITE,EA_BLACK);
-		tft.clear();
-		modetimer = false;
-	}else{
-		modecounter+=1;
-		delay(5);
-	}
-}
-
-void alarm(String textstr){
-	uint8_t x = 1;;
   char text[7];
-	textstr.toCharArray(text,7);
+  textstr.toCharArray(text, 7);
-	tft.setTextSize(8,8);
+  tft.setTextSize(8, 8);
-	while(x==1){
+  while (x == 1) {
-		if(!tft.disconnected){
+    if (!tft.disconnected) {
-			tft.setTextColor(EA_BLACK,EA_RED);
+      tft.setTextColor(EA_BLACK, EA_RED);
       tft.fillDisplayColor(EA_RED);
-			tft.drawText(5,68,'L',text);
+      tft.drawText(5, 68, 'L', text);
     }
-		for (int j = 0; j < 16; j++){
+    for (int j = 0; j < 16; j++) {
       digitalWrite(led_s[j], HIGH);
     }
     delay(100);
-		if(!tft.disconnected){
+    if (!tft.disconnected) {
-			tft.setTextColor(EA_BLACK,EA_WHITE);
+      tft.setTextColor(EA_BLACK, EA_WHITE);
       tft.fillDisplayColor(EA_WHITE);
-			tft.drawText(5,68,'L',text);
+      tft.drawText(5, 68, 'L', text);
     }
-		for (int j = 0; j < 16; j++){
+    for (int j = 0; j < 16; j++) {
       digitalWrite(led_s[j], LOW);
     }
     delay(100);
-		if(Stw_data.buttonState1 & Stw_data.buttonState4){
+    if (Stw_data.buttonState1 & Stw_data.buttonState4) {
-			x=0;
+      x = 0;
-			tft.setTextColor(EA_WHITE,EA_BLACK);
+      tft.setTextColor(EA_WHITE, EA_TRANSPARENT);
     }
   }
 }
+
+void redraw_view_driver() {
+  tft.setTextColor(EA_WHITE, EA_TRANSPARENT);
+
+  // Boxes
+  tft.drawLine(0, 110, 320, 110);
+  tft.drawLine(120, 0, 120, 110);
+  tft.drawLine(200, 0, 200, 110);
+
+  // Tire temperature cross
+  tft.drawLine(80, 180, 240, 180);
+  tft.drawLine(160, 130, 160, 230);
+
+  // Boxes
+  gear_box.redraw();
+  left_box.redraw();
+  right_box.redraw();
+  autoshift_box.redraw();
+  fl_box.redraw();
+  fr_box.redraw();
+  rl_box.redraw();
+  rr_box.redraw();
+}
+
+void update_view_driver() {
+  uint8_t prev_autoshift = Vehicle_data.autoshift;
+  static Value left_box_value = VAL_FIRST_LEFT_BOX;
+  if (Stw_data.button4_rises > 0) {
+    Stw_data.button4_rises--;
+    if (left_box_value == VAL_LAST) {
+      left_box_value = VAL_FIRST_LEFT_BOX;
+    } else {
+      left_box_value = (Value)(left_box_value + 1);
+    }
+    left_box.update_label(get_label(left_box_value));
+  }
+  if (Stw_data.button1_rises > 0) {
+    Stw_data.button1_rises--;
+    if (left_box_value == VAL_FIRST_LEFT_BOX) {
+      left_box_value = VAL_LAST;
+    } else {
+      left_box_value = (Value)(left_box_value - 1);
+    }
+    left_box.update_label(get_label(left_box_value));
+  }
+
+  // These can change rapidly, which would lead to a lot of flickering if
+  // rendered in the clear-redraw method. So instead, they're simply overwritten
+  // with a black background.
+  tft.setTextColor(EA_WHITE, EA_BLACK);
+  left_box.update_value(pad_left(get_value(left_box_value), 5));
+  right_box.update_value(pad_left(get_value(VAL_RPM), 5));
+  // Vehicle_data.autoshift = true;
+  if(Vehicle_data.autoshift == true){
+    tft.drawRectf(164+100, 184, 240+100, 230, TT_COL3);
+  }
+  else{
+    tft.drawRectf(164+100, 184, 240+100, 230, EA_BLACK);
+  }
+  autoshift_box.update_value(pad_left(String(Vehicle_data.autoshift), 5));
+  
+  // These don't change as rapidly, and would overwrite adjacent elements
+  // (lines/labels) if rendered with a background because of the empty pixels
+  // above/below the characters. So they're rendered using the clear-redraw
+  // method.0
+  tft.setTextColor(EA_WHITE, EA_TRANSPARENT);
+  //gear_box.update_value(get_value(VAL_GEAR));
+  fl_box.update_value(get_value(VAL_TT_FL).toInt());
+  fr_box.update_value(get_value(VAL_TT_FR).toInt());
+  rl_box.update_value(get_value(VAL_TT_RL).toInt());
+  rr_box.update_value(get_value(VAL_TT_RR).toInt());
+  //Vehicle_data.autoshift = true; //For testing only!!
+  if(Vehicle_data.autoshift == true){
+    tft.setTextColor(EA_ORANGE, EA_TRANSPARENT);
+  }
+  gear_box.update_value(get_value(VAL_GEAR));
+}
+
+void redraw_view_testing() {
+  tft.clear();
+  tft.setTextFont(EA_FONT7X12);
+  tft.setTextSize(2, 2);
+  int start = 10 * testing_page;
+
+  tft.setTextColor(EA_WHITE, EA_BLACK);
+  for (int i = start; i <= min(VAL_LAST, start + 9); i += 2) {
+    redraw_label_testing(i, EA_BLACK);
+  }
+  tft.setTextColor(EA_WHITE, EA_DARKGREY);
+  for (int i = start + 1; i <= min(VAL_LAST, start + 9); i += 2) {
+    redraw_label_testing(i, EA_DARKGREY);
+  }
+
+  update_view_testing();
+}
+
+void update_view_testing() {
+  if (Stw_data.button4_rises > 0) {
+    Stw_data.button4_rises--;
+    testing_page++;
+    if (testing_page * 10 > VAL_LAST) {
+      testing_page = 0;
+    }
+    redraw_view_testing();
+  }
+  if (Stw_data.button1_rises > 0) {
+    Stw_data.button1_rises--;
+    testing_page--;
+    if (testing_page < 0) {
+      testing_page = VAL_LAST / 10;
+    }
+    redraw_view_testing();
+  }
+
+  tft.setTextFont(EA_FONT7X12);
+  tft.setTextSize(2, 2);
+
+  int start = 10 * testing_page;
+
+  tft.setTextColor(EA_WHITE, EA_BLACK);
+  for (int i = start; i <= min(VAL_LAST, start + 9); i += 2) {
+    update_value_testing(i);
+  }
+  tft.setTextColor(EA_WHITE, EA_DARKGREY);
+  for (int i = start + 1; i <= min(VAL_LAST, start + 9); i += 2) {
+    update_value_testing(i);
+  }
+}
+
+void redraw_label_testing(int i, uint8_t color) {
+  String text = get_label((Value)i) + ":";
+  int y = (i % 10) * 24;
+  tft.drawRectf(0, y, 320, y + 23, color);
+  tft.drawText(10, y, 'L', text.c_str());
+}
+
+void update_value_testing(int i) {
+  String text = pad_left(get_value((Value)i), 5);
+  int y = (i % 10) * 24;
+  tft.drawText(310, y, 'R', text.c_str());
+}
+
+DataBox::DataBox(int x1, int y1, int x2, int y2, int text_x, int text_y,
+                 int font, int size_x, int size_y, uint8_t justification,
+                 bool do_clear)
+    : x1{x1}, y1{y1}, x2{x2}, y2{y2}, text_x{text_x}, text_y{text_y},
+      font{font}, size_x{size_x}, size_y{size_y},
+      justification{justification}, do_clear{do_clear}, value{""}, label{""} {}
+
+void DataBox::update_value(String val_new) {
+  if (!val_new.equals(value)) {
+    value = val_new;
+    redraw_value();
+  }
+}
+
+void DataBox::update_label(String label_new) {
+  if (!label_new.equals(label)) {
+    label = label_new;
+    redraw_label();
+  }
+}
+
+void DataBox::redraw() {
+  redraw_value();
+  redraw_label();
+}
+
+void DataBox::redraw_value() {
+  tft.setTextFont(font);
+  tft.setTextSize(size_x, size_y);
+  Serial.println("Redrawing value:");
+  if (do_clear) {
+    tft.clearRect(x1, y1, x2, y2);
+  }
+  tft.drawText(text_x, text_y, justification, value.c_str());
+}
+
+void DataBox::redraw_label() {
+  tft.setTextFont(EA_FONT7X12);
+  tft.setTextSize(1, 1);
+  Serial.println("Redrawing label:");
+  tft.clearRect(x1, y2 + 1, x2, y2 + 13);
+  tft.drawText((x1 + x2) / 2, y2 + 1, 'C', label.c_str());
+}
+
+TireTempBox::TireTempBox(int x1, int y1, int x2, int y2, int text_x, int text_y,
+                         int font, int size_x, int size_y,
+                         uint8_t justification)
+    : DataBox{x1,     y1,   x2,     y2,     text_x,
+              text_y, font, size_x, size_y, justification,
+              false},
+      num_value{-1} {}
+
+void TireTempBox::update_value(int val_new) {
+  if (val_new != num_value) {
+    num_value = val_new;
+    if (val_new < TT_THRESH1) {
+      color = TT_COL0;
+    } else if (val_new < TT_THRESH2) {
+      color = TT_COL1;
+    } else if (val_new < TT_THRESH3) {
+      color = TT_COL2;
+    } else {
+      color = TT_COL3;
+    }
+    String val_str = pad_left(String(val_new), 3);
+    DataBox::update_value(val_str);
+  }
+}
+
+void TireTempBox::redraw_value() {
+  tft.setTextFont(font);
+  tft.setTextSize(size_x, size_y);
+  tft.drawRectf(x1, y1, x2, y2, color);
+  tft.drawText(text_x, text_y, justification, value.c_str());
+}
+
+void TireTempBox::redraw_label() {}

lib/FT18_STW_DISPLAY/FT18_STW_DISPLAY.h

@@ -1,28 +1,117 @@
 #include "Arduino.h"
 #include "EDIPTFT.h"
-#include "FT_2018_STW_CAN.h"
 #include "FT18_STW_INIT.h"
+#include "FT_2018_STW_CAN.h"
 #ifndef FT18_STW_DISPLAY_h
-	#define FT18_STW_DISPLAY_h
+#define FT18_STW_DISPLAY_h
 
-	#define EA_BLACK	1
+#define MOSI 75
-	#define EA_RED		3
+#define MISO 74
-	#define EA_GREY    10
+#define CLK 76
-	#define EA_WHITE	8
+#define disp_cs 42
+#define reset 43
+#define writeprotect 52
 
-	#define MOSI			75
+#define POIL_ALARM_THRESH ((uint32_t)(0.1 / 0.0514))
-	#define MISO			74
+#define POIL_ALARM_TIME 20000 // ms
-	#define CLK				76
+#define TMOT_ALARM_THRESH (40 + 105)
-	#define disp_cs			42
+#define TMOT_SAFE_VALUE (40 + 200)
-	#define reset 			43
+#define TMOT_ALARM_TIME 20000 // ms
-	#define writeprotect 	52
+#define TOIL_ALARM_THRESH (40 + 150)
+#define TOIL_ALARM_TIME 10000 // ms
+#define ENC_DISPLAY_TIME 1000 // ms
 
+String pad_left(String orig, int len, char pad_char = ' ');
 
-	void init_display(void);
+enum DisplayView { VIEW_DRIVER, VIEW_TESTING, VIEW_LAST = VIEW_TESTING };
-	void update_display(void);
+
-	double get_value(int a);
+enum Value {
-	void display_trc(void);
+  VAL_GEAR,
-	void display_mode(void);
+  VAL_RPM,
-	void alarm(String text);
+  VAL_TT_FL,
+  VAL_TT_FR,
+  VAL_TT_RL,
+  VAL_TT_RR,
+  VAL_LAPTIME,
+  VAL_UBATT,
+  VAL_TMOT,
+  VAL_TAIR,
+  VAL_TOIL,
+  VAL_ERR_TYPE,
+  VAL_PFUEL,
+  VAL_PWAT,
+  VAL_POIL,
+  VAL_PBF,
+  VAL_PBR,
+  VAL_SPEED_FL,
+  VAL_SPEED_FR,
+  VAL_SPEED,
+  VAL_BBAL,
+  VAL_FIRST_LEFT_BOX = VAL_LAPTIME,
+  VAL_LAST = VAL_BBAL
+};
+String get_value(Value val);
+String get_label(Value val);
+
+void init_display(void);
+void update_display(void);
+void display_trc(void);
+void display_mode(void);
+void alarm(String text);
+
+bool check_alarms();
+bool check_enc_displays();
+bool check_display(uint8_t& val_old, uint8_t val_new, bool& active,
+                   uint32_t& begin, const String& title);
+
+void redraw_view_driver();
+void update_view_driver();
+void redraw_view_testing();
+void update_view_testing();
+void redraw_label_testing(int i, uint8_t bg_color);
+void update_value_testing(int i);
+
+class DataBox {
+public:
+  DataBox(int x1, int y1, int x2, int y2, int text_x, int text_y, int font,
+          int size_x, int size_y, uint8_t justification, bool do_clear);
+
+  void update_value(String val_new);
+  void update_label(String label_new);
+
+  void redraw();
+  virtual void redraw_value();
+  virtual void redraw_label();
+
+protected:
+  int x1, y1, x2, y2, text_x, text_y, font, size_x, size_y;
+  uint8_t justification;
+  bool do_clear;
+  String value;
+  String label;
+};
+
+#define TT_COL0 EA_LIGHTBLUE
+#define TT_COL1 EA_GREEN
+#define TT_COL2 EA_ORANGE
+#define TT_COL3 EA_RED
+#define TT_THRESH1 40
+#define TT_THRESH2 60
+#define TT_THRESH3 70
+
+class TireTempBox : public DataBox {
+public:
+  TireTempBox(int x1, int y1, int x2, int y2, int text_x, int text_y, int font,
+              int size_x, int size_y, uint8_t justification);
+
+  void update_value(int val_new);
+
+  void redraw_value() override;
+  void redraw_label() override;
+
+private:
+  int color;
+  int num_value;
+};
 
 #endif

lib/FT18_STW_INIT/FT18_STW_INIT.cpp

@@ -4,73 +4,87 @@
 #include <Bounce2.h>
 #include <RotaryEncoder.h>
 
-volatile stw_data_type Stw_data = {0}; //alles mit 0 initialisieren
+volatile stw_data_type Stw_data = {0};         // alles mit 0 initialisieren
-volatile vehicle_data_type Vehicle_data = {0}; //alles mit 0 initialisieren
+volatile vehicle_data_type Vehicle_data = {0}; // alles mit 0 initialisieren
-bool enc1PinALast,enc1PinANow,enc2PinALast,enc2PinANow;
+bool enc1PinALast, enc1PinANow, enc2PinALast, enc2PinANow;
-int led[] = {led1,led2,led3,led4,led5,led6,led7,led8,led9,led10,led11,led12,led13,led14,led15,led16};
+int led[] = {led1, led2,  led3,  led4,  led5,  led6,  led7,  led8,
+             led9, led10, led11, led12, led13, led14, led15, led16};
 bool entprell;
-int buttons[] = {button1,button2,button3,button4,button5,button6,enc1PinS,enc2PinS};
+int buttons[] = {button1, button2, button3,  button4,
-constexpr size_t N_BUTTONS = sizeof(buttons)/sizeof(buttons[0]);
+                 button5, button6, enc1PinS, enc2PinS};
+constexpr size_t N_BUTTONS = sizeof(buttons) / sizeof(buttons[0]);
 Bounce2::Button debouncer[N_BUTTONS];
 double val = 0;
 double val2 = 0;
-RotaryEncoder encoder(enc1PinA,enc1PinB,1,1,50);
+RotaryEncoder encoder(enc1PinA, enc1PinB, 1, 1, 50);
-RotaryEncoder encoder2(enc2PinA,enc2PinB,1,1,50);
+RotaryEncoder encoder2(enc2PinA, enc2PinB, 1, 1, 50);
 ///////////////////////////////////////////////////
 // functions
 ///////////////////////////////////////////////////
 
-void set_pins(){
+void set_pins() {
-	pinMode (l,OUTPUT);
+  pinMode(l, OUTPUT);
-	for (int thisLed = 0; thisLed < sizeof(led)/sizeof(int); thisLed++) {
+  for (int thisLed = 0; thisLed < sizeof(led) / sizeof(int); thisLed++) {
     pinMode(led[thisLed], OUTPUT);
   }
   pinMode(enc1PinA, INPUT);
   pinMode(enc1PinB, INPUT);
   pinMode(enc2PinA, INPUT);
   pinMode(enc2PinB, INPUT);
-	enc1PinALast=LOW;
+  enc1PinALast = LOW;
-	enc1PinANow=LOW;
+  enc1PinANow = LOW;
-	enc2PinALast=LOW;
+  enc2PinALast = LOW;
-	enc2PinANow=LOW;
+  enc2PinANow = LOW;
-	for(int i = 0; i < N_BUTTONS; i++){
+  for (int i = 0; i < N_BUTTONS; i++) {
     debouncer[i].attach(buttons[i], INPUT);
     debouncer[i].interval(10);
   }
 }
 
-void read_buttons(){
+void read_buttons() {
   for (int i = 0; i < N_BUTTONS; i++) {
     debouncer[i].update();
   }
 
   // These are only used to send them out via CAN, so they only need to be
   // high once.
-	Stw_data.Stw_neutral = debouncer[1].rose();
+  //Stw_data.Stw_neutral = debouncer[1].rose();
-	Stw_data.Stw_auto_shift = debouncer[2].rose();
+  //Stw_data.Stw_auto_shift = debouncer[2].isPressed(); //Hold to open DRS
+  // 05.09.: swapped neutral and auto_shift (DRS)
+  Stw_data.Stw_neutral = debouncer[2].rose();
+  Stw_data.Stw_auto_shift = debouncer[1].isPressed(); //Hold to open DRS
   Stw_data.Stw_shift_down = debouncer[4].rose();
   Stw_data.Stw_shift_up = debouncer[5].rose();
 
-	// These are also used for GUI, so if we set them only at rising edge, they
+  Stw_data.buttonState1 = debouncer[0].isPressed();
-	// might never be high when checked in the GUI.
+  Stw_data.buttonState4 = debouncer[3].isPressed();
-	// TODO: Rewrite so we can use debounced values here as well
+  Stw_data.buttonStateEnc1 = debouncer[6].isPressed();
-	Stw_data.buttonState1 = digitalRead(button1);
+  Stw_data.buttonStateEnc2 = debouncer[7].isPressed();
-	Stw_data.buttonState4 = digitalRead(button4);
+  if (debouncer[0].rose()) {
-	Stw_data.buttonStateEnc1 = digitalRead(enc1PinS);
+    Stw_data.button1_rises++;
-	Stw_data.buttonStateEnc2 = digitalRead(enc2PinS);
+  }
+  if (debouncer[3].rose()) {
+    Stw_data.button4_rises++;
+  }
+  if (debouncer[6].rose()) {
+    Stw_data.enc1_rises++;
+  }
+  if (debouncer[7].rose()) {
+    Stw_data.enc2_rises++;
+  }
 }
 
-void read_rotary(){
+void read_rotary() {
   int enc = encoder.readEncoder();
   int enc2 = encoder2.readEncoder();
-	if(enc != 0){
+  if (enc != 0) {
-		val = val +0.5*enc;
+    val = val + 0.5 * enc;
-		if (val==1 or val ==-1){
+    if (val == 1 or val == -1) {
-			if(Stw_data.trc==0 and enc<0){
+      if (Stw_data.trc == 0 and enc < 0) {
         Stw_data.trc = 11;
-			}else if(Stw_data.trc==11 and enc>0){
+      } else if (Stw_data.trc == 11 and enc > 0) {
-				Stw_data.trc=0;
+        Stw_data.trc = 0;
-			}else{
+      } else {
         Stw_data.trc = Stw_data.trc + enc;
       }
       val = 0;
@@ -97,17 +111,17 @@ void read_rotary(){
   /*if (Stw_data.buttonStateEnc1 == HIGH){
           digitalWrite(led[Stw_data.i], HIGH);
   }*/
-	if(enc2 != 0){
+  if (enc2 != 0) {
-		val2 = val2 +0.5*enc2;
+    val2 = val2 + 0.5 * enc2;
-		if(val2==1 or val2==-1){
+    if (val2 == 1 or val2 == -1) {
-			if((Stw_data.mode==1 or Stw_data.mode==0) and enc2<0){
+      if ((Stw_data.mode == 1 or Stw_data.mode == 0) and enc2 < 0) {
         Stw_data.mode = 5;
-			}else if(Stw_data.mode==5 and enc2>0){
+      } else if (Stw_data.mode == 5 and enc2 > 0) {
-				Stw_data.mode=1;
+        Stw_data.mode = 1;
-			}else{
+      } else {
         Stw_data.mode = Stw_data.mode + enc2;
       }
-			val2=0;
+      val2 = 0;
     }
   }
   /*if ((enc2PinALast == LOW) && (enc2PinANow == HIGH)) {

lib/FT18_STW_INIT/FT18_STW_INIT.h

@@ -2,29 +2,29 @@
 #ifndef FT18_STW_Init
 #define FT18_STW_Init
 
-#define l  				78	//test_led
+#define l 78       // test_led
-#define led1 			12//PD8
+#define led1 12    // PD8
-#define led2			11//PD7
+#define led2 11    // PD7
-#define led3			9//PC21
+#define led3 9     // PC21
-#define led4			8//PC22
+#define led4 8     // PC22
-#define led5			7//PC23
+#define led5 7     // PC23
-#define led6			6//PC24
+#define led6 6     // PC24
-#define led7			5//PC25
+#define led7 5     // PC25
-#define led8			4//PC26 und PA29
+#define led8 4     // PC26 und PA29
-#define led9			3//PC28
+#define led9 3     // PC28
-#define led10			2//PB25
+#define led10 2    // PB25
-#define led11			10//PC29 und PA28
+#define led11 10   // PC29 und PA28
-#define led12			22//PB26
+#define led12 22   // PB26
-#define led13			19//PA10
+#define led13 19   // PA10
-#define led14			13//PB27
+#define led14 13   // PB27
-#define led15			17//PA12
+#define led15 17   // PA12
-#define led16			18//PA11
+#define led16 18   // PA11
-#define button1			48//bl
+#define button1 48 // bl
-#define button2			47//gl
+#define button2 47 // gl
-#define button3			44//gr
+#define button3 44 // gr
-#define button4			46//br
+#define button4 46 // br
-#define button5			45//sl
+#define button5 45 // sl
-#define button6			49//sr
+#define button6 49 // sr
 #define enc1PinA 37
 #define enc1PinB 38
 #define enc1PinS 35
@@ -32,47 +32,49 @@
 #define enc2PinB 41
 #define enc2PinS 39
 
-
 // define Drehzahlgrenzen TODOOOO
-	#define RPM_THRES_1		 1000
+#define RPM_THRES_1 6000
-	#define RPM_THRES_2		 6000
+#define RPM_THRES_2 12000
-	#define RPM_THRES_3		 7000
+#define RPM_THRES_3 12800
-	#define RPM_THRES_4		 8000
+#define RPM_THRES_4 13600
-	#define RPM_THRES_5		 10000
+#define RPM_THRES_5 14400
-	#define RPM_THRES_6		 14000
+#define RPM_THRES_6 15200
-	#define RPM_THRES_7		 17000
+#define RPM_THRES_7 16000
-	#define RPM_THRES_8		 18000
+#define RPM_THRES_8 16800
-	#define RPM_THRES_9		 20000
+#define RPM_THRES_9 18000
-	#define RPM_THRES_10	20000
+#define RPM_THRES_10 18000
-
 
 void set_pins(void);
 void read_buttons(void);
 void read_rotary(void); // read rotary switches
 
-typedef struct
+typedef struct {
-	{
   uint8_t Stw_shift_up;   // 1 Bit	0
   uint8_t Stw_shift_down; // 1 Bit	1
   uint8_t Stw_neutral;    // 1 Bit	2
   uint8_t Stw_auto_shift; // 1 Bit	3
   uint8_t buttonState1;   // 1 Bit	4
   uint8_t buttonState4;   // 1 Bit	5
-		//bool		CAN_toggle;
+  // bool		CAN_toggle;
-		//bool		CAN_check;
+  // bool		CAN_check;
-		//uint8_t		i;						//Index linker Drehschalter
+  // uint8_t		i;						//Index
+  // linker Drehschalter
   uint8_t buttonStateEnc1; // button
-		//uint8_t		br;						//test mode : mittlere Drehschalter	position
+  // uint8_t		br;						//test
-		uint8_t		buttonStateEnc2;		//button
+  // mode : mittlere Drehschalter position
-		uint8_t 	displayindex; 			//index für Displayanzeige
+  uint8_t buttonStateEnc2; // button
-		uint8_t		error_type;				//Extrainfos über Error-LED
+  uint8_t displayindex;    // index für Displayanzeige
+  uint8_t error_type;      // Extrainfos über Error-LED
   uint8_t trc;
   uint8_t mode;
 
-	} stw_data_type;
+  uint8_t button1_rises;
+  uint8_t button4_rises;
+  uint8_t enc1_rises;
+  uint8_t enc2_rises;
+} stw_data_type;
 
-	typedef struct
+typedef struct {
-	{
   uint8_t e_thro;  // E-Drossel
   uint8_t g_auto;  // Auto-Shift
   uint8_t gear;    // Gang
@@ -80,8 +82,14 @@ typedef struct
   uint8_t t_oil;   // Öl-Motor-Temperatur
   uint8_t t_mot;   // Wasser-Motor-Temperatur
   uint8_t t_air;   // LLK-Temperatur
+  uint8_t t_tfl;   // Tire temp front left
+  uint8_t t_tfr;   // Tire temp front right
+  uint8_t t_trl;   // Tire temp rear left
+  uint8_t t_trr;   // Tire temp rear right
   uint8_t u_batt;  // Batteriespannung
   uint8_t rev_lim; // Drehzahllimit Bit
+  bool drs_active; // DRS status from BCU
+  bool autoshift;  // Autoshift status from BCU
   uint8_t p_wat;
   uint8_t p_fuel;
   uint8_t p_oil;
@@ -90,12 +98,11 @@ typedef struct
   uint8_t speed_fl;
   uint8_t speed_fr;
   uint8_t speed;
+  uint8_t lap_time_sec;
+  uint16_t lap_time_msec;
+} vehicle_data_type;
 
-	} vehicle_data_type;
+extern volatile stw_data_type Stw_data;
-
+extern volatile vehicle_data_type Vehicle_data;
-	
-	extern volatile stw_data_type Stw_data;
-	extern volatile vehicle_data_type Vehicle_data;
-
 
 #endif

lib/FT18e_STW_DISPLAY/FT18e_STW_DISPLAY.cpp

@@ -1,8 +1,8 @@
+#include "FT18e_STW_DISPLAY.h"
 #include "Arduino.h"
 #include "EDIPTFT.h"
-#include "FT_2018e_STW_CAN.h"
 #include "FT18e_STW_INIT.h"
-#include "FT18e_STW_DISPLAY.h"
+#include "FT_2018e_STW_CAN.h"
 
 EDIPTFT tft(true, false);
 String bezeichnungen[] = {"Batterieleistung", "Moment", "Batterietemp"};
@@ -26,7 +26,8 @@ uint8_t trccounter;	 // = Stw_data.trc;
 uint8_t modecounter; // = Stw_data.mode;
 bool trctimer;
 bool modetimer;
-int led_s[] = {led1, led2, led3, led4, led5, led6, led7, led8, led9, led10, led11, led12, led13, led14, led15, led16};
+int led_s[] = {led1, led2,  led3,  led4,  led5,  led6,  led7,  led8,
+               led9, led10, led11, led12, led13, led14, led15, led16};
 unsigned long poiltimer;
 unsigned long tmottimer;
 unsigned long toiltimer;
@@ -34,22 +35,21 @@ bool poilbool = true;
 bool tmotbool = true;
 bool toilbool = true;
 
-void init_display()
+void init_display() {
-{
   pinMode(writeprotect, OUTPUT);
   digitalWrite(writeprotect, HIGH);
   pinMode(reset, OUTPUT);
   pinMode(disp_cs, OUTPUT);
   pinMode(MOSI, OUTPUT);
   pinMode(MISO, OUTPUT);
-	//pinMode(CLK, INPUT);
+  // pinMode(CLK, INPUT);
   digitalWrite(disp_cs, HIGH);
   digitalWrite(MOSI, HIGH);
   digitalWrite(MISO, HIGH);
   digitalWrite(reset, LOW);
-	//edip.smallProtoSelect(7);
+  // edip.smallProtoSelect(7);
-	//edip.setNewColor(EA_GREY, 0xe3, 0xe3,0xe3);	 // redefine r-g-b-values of EA_GREY
+  // edip.setNewColor(EA_GREY, 0xe3, 0xe3,0xe3);	 // redefine r-g-b-values
-	//edip.drawImage(0,50,FASTTUBE_LOGO_PNG);
+  // of EA_GREY edip.drawImage(0,50,FASTTUBE_LOGO_PNG);
   digitalWrite(reset, HIGH);
   tft.begin(115200); // start display communication
   /*int h = 20;
@@ -61,45 +61,35 @@ void init_display()
   tft.terminalOn(false);
   tft.setDisplayColor(EA_WHITE, EA_BLACK);
   tft.setTextColor(EA_WHITE, EA_BLACK);
-	//tft.setTextFont('4');
+  // tft.setTextFont('4');
   tft.setTextSize(5, 8);
   tft.clear();
-	//tft.displayLight('30');
+  // tft.displayLight('30');
-	tft.drawText(0, 14, 'C', "FaSTTUBe"); //draw some text
+  tft.drawText(0, 14, 'C', "FaSTTUBe"); // draw some text
-										  //tft.loadImage(0,0,1);
+                                        // tft.loadImage(0,0,1);
-										  //delay(2000);
+                                        // delay(2000);
 }
 
-double get_value(int a)
+double get_value(int a) { return 0; }
-{
-	return 0;
-}
 
-void update_display()
+void update_display() {
-{
+  if (!tft.disconnected) {
-	if (!tft.disconnected)
-	{
     tft.cursorOn(false);
-		if (modealt != Stw_data.mode || modetimer == true)
+    if (modealt != Stw_data.mode || modetimer == true) {
-		{
       display_mode();
-		}
+    } else {
-		else
+      if (clearcounter >= 56) {
-		{
-			if (clearcounter >= 56)
-			{
         tft.clear();
         clearcounter = 0;
       }
       clearcounter += 1;
     }
   }
+  // else für neue init?
 }
 
-void display_mode()
+void display_mode() {
-{
+  if (modealt != Stw_data.mode) {
-	if (modealt != Stw_data.mode)
-	{
     tft.clear();
     tft.setTextSize(6, 8);
     tft.setDisplayColor(EA_WHITE, EA_RED);
@@ -116,54 +106,43 @@ void display_mode()
     modecounter = 0;
     modealt = Stw_data.mode;
     modetimer = true;
-	}
+  } else if (modecounter >= 255) {
-	else if (modecounter >= 255)
-	{
     tft.setDisplayColor(EA_WHITE, EA_BLACK);
     tft.setTextColor(EA_WHITE, EA_BLACK);
     tft.clear();
     modetimer = false;
-	}
+  } else {
-	else
-	{
     modecounter += 1;
     delay(5);
   }
 }
 
-void alarm(String textstr)
+void alarm(String textstr) {
-{
   uint8_t x = 1;
   ;
   char text[7];
   textstr.toCharArray(text, 7);
   tft.setTextSize(8, 8);
-	while (x == 1)
+  while (x == 1) {
-	{
+    if (!tft.disconnected) {
-		if (!tft.disconnected)
-		{
       tft.setTextColor(EA_BLACK, EA_RED);
       tft.fillDisplayColor(EA_RED);
       tft.drawText(5, 68, 'L', text);
     }
-		for (int j = 0; j < 16; j++)
+    for (int j = 0; j < 16; j++) {
-		{
       digitalWrite(led_s[j], HIGH);
     }
     delay(100);
-		if (!tft.disconnected)
+    if (!tft.disconnected) {
-		{
       tft.setTextColor(EA_BLACK, EA_WHITE);
       tft.fillDisplayColor(EA_WHITE);
       tft.drawText(5, 68, 'L', text);
     }
-		for (int j = 0; j < 16; j++)
+    for (int j = 0; j < 16; j++) {
-		{
       digitalWrite(led_s[j], LOW);
     }
     delay(100);
-		if (Stw_data.button_ll & Stw_data.button_rr)
+    if (Stw_data.button_ll & Stw_data.button_rr) {
-		{
       x = 0;
       tft.setTextColor(EA_WHITE, EA_BLACK);
     }

lib/FT18e_STW_DISPLAY/FT18e_STW_DISPLAY.h

@@ -1,7 +1,7 @@
 #include "Arduino.h"
 #include "EDIPTFT.h"
-#include "FT_2018e_STW_CAN.h"
 #include "FT18e_STW_INIT.h"
+#include "FT_2018e_STW_CAN.h"
 #ifndef FT18e_STW_DISPLAY_h
 #define FT18e_STW_DISPLAY_h
 

lib/FT18e_STW_INIT/FT18e_STW_INIT.cpp

@@ -1,14 +1,16 @@
-#include "Arduino.h"
 #include "FT18e_STW_INIT.h"
+#include "Arduino.h"
 #include "Bounce2.h"
 #include "RotaryEncoder.h"
 
-volatile stw_data_type Stw_data = {0};		   //alles mit 0 initialisieren
+volatile stw_data_type Stw_data = {0};         // alles mit 0 initialisieren
-volatile vehicle_data_type Vehicle_data = {0}; //alles mit 0 initialisieren
+volatile vehicle_data_type Vehicle_data = {0}; // alles mit 0 initialisieren
 bool enc1PinALast, enc1PinANow, enc2PinALast, enc2PinANow;
-int led[] = {led1, led2, led3, led4, led5, led6, led7, led8, led9, led10, led11, led12, led13, led14, led15, led16};
+int led[] = {led1, led2,  led3,  led4,  led5,  led6,  led7,  led8,
+             led9, led10, led11, led12, led13, led14, led15, led16};
 bool entprell;
-int buttons[] = {PIN_BUTTON_LL, PIN_BUTTON_LR, PIN_BUTTON_RL, PIN_BUTTON_RR, enc1PinS, enc2PinS};
+int buttons[] = {PIN_BUTTON_LL, PIN_BUTTON_LR, PIN_BUTTON_RL,
+                 PIN_BUTTON_RR, enc1PinS,      enc2PinS};
 Bounce debouncer[8];
 double val = 0;
 double val2 = 0;
@@ -18,10 +20,8 @@ RotaryEncoder encoder2(enc2PinA, enc2PinB, 1, 1, 50);
 // functions
 ///////////////////////////////////////////////////
 
-void set_pins()
+void set_pins() {
-{
+  for (int thisLed = 0; thisLed < sizeof(led) / sizeof(int); thisLed++) {
-	for (int thisLed = 0; thisLed < sizeof(led) / sizeof(int); thisLed++)
-	{
     pinMode(led[thisLed], OUTPUT);
   }
   pinMode(l, OUTPUT);
@@ -33,49 +33,39 @@ void set_pins()
   pinMode(button6, INPUT);*/
   pinMode(enc1PinA, INPUT);
   pinMode(enc1PinB, INPUT);
-	//pinMode(enc1PinS, INPUT);
+  // pinMode(enc1PinS, INPUT);
   pinMode(enc2PinA, INPUT);
   pinMode(enc2PinB, INPUT);
-	//pinMode(enc2PinS, INPUT);
+  // pinMode(enc2PinS, INPUT);
-	//Stw_data.i=0;
+  // Stw_data.i=0;
   enc1PinALast = LOW;
   enc1PinANow = LOW;
   enc2PinALast = LOW;
   enc2PinANow = LOW;
-	for (int i = 0; i < sizeof(buttons) / sizeof(*buttons); i++)
+  for (int i = 0; i < sizeof(buttons) / sizeof(*buttons); i++) {
-	{
     pinMode(buttons[i], INPUT);
     debouncer[i].attach(buttons[i]);
     debouncer[i].interval(10);
   }
 }
 
-void read_buttons()
+void read_buttons() {
-{
   Stw_data.button_ll = digitalRead(PIN_BUTTON_LL);
   Stw_data.button_lr = digitalRead(PIN_BUTTON_LR);
   Stw_data.button_rl = digitalRead(PIN_BUTTON_RL);
   Stw_data.button_rr = digitalRead(PIN_BUTTON_RR);
 }
 
-void read_rotary()
+void read_rotary() {
-{
   int enc2 = encoder2.readEncoder();
-	if (enc2 != 0)
+  if (enc2 != 0) {
-	{
     val2 = val2 + 0.5 * enc2;
-		if (val2 == 1 or val2 == -1)
+    if (val2 == 1 or val2 == -1) {
-		{
+      if ((Stw_data.mode == 1 or Stw_data.mode == 0) and enc2 < 0) {
-			if ((Stw_data.mode == 1 or Stw_data.mode == 0) and enc2 < 0)
-			{
         Stw_data.mode = 5;
-			}
+      } else if (Stw_data.mode == 5 and enc2 > 0) {
-			else if (Stw_data.mode == 5 and enc2 > 0)
-			{
         Stw_data.mode = 1;
-			}
+      } else {
-			else
-			{
         Stw_data.mode = Stw_data.mode + enc2;
       }
       val2 = 0;

lib/FT18e_STW_INIT/FT18e_STW_INIT.h

@@ -2,23 +2,23 @@
 #ifndef FT18e_STW_Init
 #define FT18e_STW_Init
 
-#define l 78	 //test_led
+#define l 78     // test_led
-#define led1 12	 //PD8
+#define led1 12  // PD8
-#define led2 11	 //PD7
+#define led2 11  // PD7
-#define led3 9	 //PC21
+#define led3 9   // PC21
-#define led4 8	 //PC22
+#define led4 8   // PC22
-#define led5 7	 //PC23
+#define led5 7   // PC23
-#define led6 6	 //PC24
+#define led6 6   // PC24
-#define led7 5	 //PC25
+#define led7 5   // PC25
-#define led8 4	 //PC26 und PA29
+#define led8 4   // PC26 und PA29
-#define led9 3	 //PC28
+#define led9 3   // PC28
-#define led10 2	 //PB25
+#define led10 2  // PB25
-#define led11 10 //PC29 und PA28
+#define led11 10 // PC29 und PA28
-#define led12 22 //PB26
+#define led12 22 // PB26
-#define led13 19 //PA10
+#define led13 19 // PA10
-#define led14 13 //PB27
+#define led14 13 // PB27
-#define led15 17 //PA12
+#define led15 17 // PA12
-#define led16 18 //PA11
+#define led16 18 // PA11
 #define enc1PinA 37
 #define enc1PinB 38
 #define enc1PinS 35
@@ -51,20 +51,18 @@ void set_pins(void);
 void read_buttons(void);
 void read_rotary(void); // read rotary switches
 
-typedef struct
+typedef struct {
-{
   bool button_ll; // Left side, left button
   bool button_lr; // Left side, right button
   bool button_rl; // Right side, left button
   bool button_rr; // Right side, right button
   uint8_t mode;
-	uint8_t displayindex; //index für Displayanzeige
+  uint8_t displayindex; // index für Displayanzeige
-	uint8_t error_type;	  //Extrainfos über Error-LED
+  uint8_t error_type;   // Extrainfos über Error-LED
 
 } stw_data_type;
 
-struct InverterData
+struct InverterData {
-{
   bool ready;
   bool derating;
   bool warning;
@@ -75,8 +73,7 @@ struct InverterData
   bool ts_active;
 };
 
-typedef struct
+typedef struct {
-{
   uint16_t u_cell_min; // Minimale Zellspannung
   uint16_t u_batt;     // Batteriespannung (pre-AIR-voltage)
   int16_t t_mot_l;     // Motor-Wasser-Temperatur Links

lib/FT_2018_STW_CAN/FT_2018_STW_CAN.cpp

@@ -2,35 +2,47 @@
 FT_2018_STW_CAN.cpp
 */
 
+#include "FT_2018_STW_CAN.h"
 #include "Arduino.h"
 #include "DueTimer.h"
-#include "due_can.h"
-#include "FT_2018_STW_CAN.h"
 #include "FT18_STW_INIT.h"
+#include "due_can.h"
 
 CAN_FRAME can_0_msg;
-//can_1_msg.id = 0x110;
+// can_1_msg.id = 0x110;
 int can_0_temp_data = 0;
-int leds[] = {led1,led2,led3,led4,led5,led6,led7,led8,led9,led10,led11,led12,led13,led14,led15,led16};
 
+int leds[] = {led1, led2,  led3,  led4,  led5,  led6,  led7,  led8,
+              led9, led10, led11, led12, led13, led14, led15, led16};
+
+void Init_Can_0() {
         
-void Init_Can_0(){
   Can0.begin(1000000);   // set CAN0 baud to 1kbit/s and don`t use enable pin!
-	Can0.setNumTXBoxes(1);					// reserves mailbox 0 for tx only 8 mailboxes are available (the other 7 mailboxes are for rx)
+  Can0.setNumTXBoxes(1); // reserves mailbox 0 for tx only 8 mailboxes are
-	Can0.watchFor(0x502);					// set CAN RX filter for ID 0x502 and reserves mailbox 1 for rx
+                         // available (the other 7 mailboxes are for rx)
-	Can0.watchFor(0x504);
+
-	Can0.watchFor(0x500);
+  // We only have 7 mailboxes, but want to receive 9 messages. This trick should
-	Can0.watchFor(0x773);					// set CAN RX filter for ID 0x773 and reserves mailbox 3 for rx
+  // allow us to receive BCU_APS_BRAKE, BCU_ETC and BCU_SHIFT_CTRL in the same
-	Can0.watchFor(0x775);
+  // mailbox. It will also let through 0x506, but that shouldn't be much of an
-//	Can0.watchFor(0x777);					// set CAN RX filter for ID 0x777 and reserves mailbox 5 for rx
+  // issue.
-	Can0.watchFor(0x779);					// set CAN RX filter for ID 0x779 and reserves mailbox 6 for rx
+  /*
-	Can0.watchFor(0x77A);
+  Can0.watchFor(CAN_ID_BCU_APS_BRAKE & CAN_ID_BCU_ETC & CAN_ID_BCU_SHIFT_CTRL,
+                0x7F9);
+  Can0.watchFor(CAN_ID_BCU_TIRES);
+  Can0.watchFor(CAN_ID_BCU_LAP_TIME);
+  Can0.watchFor(CAN_ID_MS4_IGN_REV_ATH);
+  Can0.watchFor(CAN_ID_MS4_SPEED);
+  Can0.watchFor(CAN_ID_MS4_ETC);
+  Can0.watchFor(CAN_ID_MS4_STATES_TEMP_PRESS);
+
   Can0.setGeneralCallback(Receive_Can_0);
+  */
+
   Timer3.attachInterrupt(Send_0x110); // set send interrupt
   Timer3.start(10000);                // Calls every 10ms
 }
 
-void Send_0x110(){
+void Send_0x110() {
   read_buttons();
   read_rotary();
   can_0_msg.id = 0x110;
@@ -44,147 +56,157 @@ void Send_0x110(){
   can_0_temp_data |= Stw_data.Stw_shift_down << 1 & 0b00000010;
   can_0_temp_data |= Stw_data.Stw_neutral << 2 & 0b00000100;
   can_0_temp_data |= Stw_data.Stw_auto_shift << 3 & 0b00001000;
-	can_0_temp_data |= Stw_data.buttonStateEnc1 << 5 & 0b00100000; //pitlane
+  can_0_temp_data |= Stw_data.buttonStateEnc1 << 5 & 0b00100000; // pitlane
   can_0_msg.data.byte[0] = can_0_temp_data;
   can_0_msg.data.byte[1] = Stw_data.trc & 0b00001111;
   can_0_msg.data.byte[2] = Stw_data.mode & 0b00000111;
-	if ((Stw_data.Stw_auto_shift << 3 & 0b00001000)){
+  if ((Stw_data.Stw_auto_shift << 3 & 0b00001000)) {
-		if(Vehicle_data.g_auto){
+    if (Vehicle_data.g_auto) {
       Vehicle_data.g_auto = false;
-		}else{
+    } else {
       Vehicle_data.g_auto = true;
     }
   }
   Can0.sendFrame(can_0_msg);
 }
 
-void Receive_Can_0(CAN_FRAME *temp_message){
+void Receive_Can_0(CAN_FRAME *temp_message) {
   switch (temp_message->id) {
-		//g_auto
+  case CAN_ID_BCU_APS_BRAKE: {
-		case 0x502:{ // eDrossel error bit
+    Vehicle_data.p_brake_front = temp_message->data.byte[1];
-			Vehicle_data.e_thro			= (temp_message->data.byte[0] & 0x80) | (temp_message->data.byte[0] & 0x40) | (temp_message->data.byte[0] & 0x20) | (temp_message->data.byte[0] & 0x10); // bit 4-7
+    Vehicle_data.p_brake_rear = temp_message->data.byte[2];
-			
+    Vehicle_data.drs_active = ((temp_message->data.byte[0] >> 7) & 0b00000001);
-			if(temp_message->data.byte[0] & 0x80){
+    Vehicle_data.autoshift = ((temp_message->data.byte[7] >> 0) & 0b00000001);
-				Stw_data.error_type = 1;//"pc_error";
-			} 
-			if(temp_message->data.byte[0] & 0x40){
-				Stw_data.error_type = 2;//"bse_error";
-			} 
-			if(temp_message->data.byte[0] & 0x20){
-				Stw_data.error_type = 3;//"aps_error";
-			} 
-			if(temp_message->data.byte[0] & 0x10){
-				Stw_data.error_type = 4;//"etb_error";
-			}
-			//can_1_temp_data |= g_etb_e << 4;
-			//can_1_temp_data |= g_aps_e << 5;
-			//can_1_temp_data |= g_bse_e << 6;
-			//can_1_temp_data |= g_pc_e << 7;
     break;
   }
-		case 0x504:{ //autoshift+gear
+  case CAN_ID_BCU_ETC: { // eDrossel error bit
-			//Vehicle_data.g_auto					= (temp_message->data.byte[1]) >> 4;
+    Vehicle_data.e_thro = (temp_message->data.byte[0] & 0xF0); // bit 4-7
+
+    if (temp_message->data.byte[0] & 0x80) {
+      Stw_data.error_type = 1; //"pc_error";
+    }
+    if (temp_message->data.byte[0] & 0x40) {
+      Stw_data.error_type = 2; //"bse_error";
+    }
+    if (temp_message->data.byte[0] & 0x20) {
+      Stw_data.error_type = 3; //"aps_error";
+    }
+    if (temp_message->data.byte[0] & 0x10) {
+      Stw_data.error_type = 4; //"etb_error";
+    }
+    break;
+  }
+  case CAN_ID_BCU_SHIFT_CTRL: { // autoshift+gear
     Vehicle_data.gear = (temp_message->data.byte[1]) >> 5;
     break;
   }
-		case 0x773:{ // rpm
+  case CAN_ID_BCU_TIRES: { // Tire temps
-			Vehicle_data.revol					= (temp_message->data.byte[4] | temp_message->data.byte[3] << 8);
+    Vehicle_data.t_trl = temp_message->data.byte[1];
+    Vehicle_data.t_trr = temp_message->data.byte[4];
+    Vehicle_data.t_tfl = temp_message->data.byte[5];
+    Vehicle_data.t_tfr = temp_message->data.byte[6];
     break;
   }
-		case 0x779:{ // battery voltage
+  case CAN_ID_BCU_LAP_TIME: { // lap time
+    Vehicle_data.lap_time_sec = temp_message->data.byte[1];
+    Vehicle_data.lap_time_msec =
+        temp_message->data.byte[2] | ((temp_message->data.byte[3] & 0b11) << 8);
+    break;
+  }
+  case CAN_ID_MS4_IGN_REV_ATH: { // rpm
+    Vehicle_data.revol =
+        (temp_message->data.byte[4] | temp_message->data.byte[3] << 8);
+    break;
+  }
+  case CAN_ID_MS4_SPEED: { // speed
+    Vehicle_data.speed_fl = 2 * (temp_message->data.byte[2]);
+    Vehicle_data.speed_fr = 2 * (temp_message->data.byte[3]);
+    Vehicle_data.speed = (Vehicle_data.speed_fl + Vehicle_data.speed_fr) / 2;
+    break;
+  }
+  case CAN_ID_MS4_ETC: { // battery voltage
     Vehicle_data.u_batt = temp_message->data.byte[6];
     break;
   }
-		/*case 0x77A: // revolution limit bit
+  case CAN_ID_MS4_STATES_TEMP_PRESS: { // temp und p
-			Vehicle_data.rev_lim				= (temp_message->data.byte[3] & 0x20) >> 4;
+    if (temp_message->data.byte[0] == 1) {
-			switch(temp_message->data.byte[0]) {
-				case 0x02: // temp. intercooler
-					Vehicle_data.t_air			= temp_message->data.byte[7];
-					break;
-				case 0x05: // temp. water
-					Vehicle_data.t_mot			= temp_message->data.byte[4];
-					break;
-				case 0x04: // temp. oil
-					Vehicle_data.t_oil			= temp_message->data.byte[5];
-				case 0x01: {
-					Vehicle_data.p_wat 			= temp_message->data.byte[6];
-					Vehicle_data.p_fuel			= temp_message->data.byte[7];
-					Vehicle_data.p_oil 			= temp_message->data.byte[5];
-					break;
-				}
-			}
-			break;*/
-		case 0x77A:{//temp und p
-			//g_ms4_idle_b			= (temp_message->data.byte[2] & 0b10000000) >> 7;
-			//g_ms4_engine_status		= (temp_message->data.byte[3] & 0b01000000) >> 6;
-			//g_ms4_ignoff_b			= (temp_message->data.byte[3] & 0b10000000) >> 7;			
-			// Serial.println("CAN 77A");
-			// for (int i = 0; i < 8; i++) {
-			// 	Serial.print('[');
-			// 	Serial.print(i);
-			// 	Serial.print("] ");
-			// 	Serial.println(temp_message->data.byte[i], HEX);
-			// }
-			
-			if ( temp_message->data.byte[0] == 1){
       Vehicle_data.p_oil = temp_message->data.byte[5];
       Vehicle_data.p_fuel = temp_message->data.byte[7];
-			}
+    } else if (temp_message->data.byte[0] == 2) {
-			else if ( temp_message->data.byte[0] == 2){
       Vehicle_data.t_air = temp_message->data.byte[7];
-			}
+    } else if (temp_message->data.byte[0] == 4) {
-			else if ( temp_message->data.byte[0] == 4){
       Vehicle_data.t_oil = temp_message->data.byte[5];
-			}
+    } else if (temp_message->data.byte[0] == 5) {
-			else if ( temp_message->data.byte[0] == 5){
       Vehicle_data.t_mot = temp_message->data.byte[4];
     }
     break;
   }
-		case 0x775:{//speed
-			Vehicle_data.speed_fl			= 2*(temp_message->data.byte[2]);
-			Vehicle_data.speed_fr			= 2*(temp_message->data.byte[3]);
-			Vehicle_data.speed 				= (Vehicle_data.speed_fl+Vehicle_data.speed_fr)/2;
-			break;
-		}
-		/*case 0x777:{//m4_gear
-			Vehicle_data.gear				= temp_message->data.byte[0];
-			break;
-		}*/
-		case 0x500:{
-				Vehicle_data.p_brake_front	= temp_message->data.byte[1];
-				Vehicle_data.p_brake_rear 	= temp_message->data.byte[2];
-			break;
-		}
   }
 }
 
-void update_LED(){
-//Copyright Michael Dietzel
-//m.dietzel@fasttube.de
-//Edit Michael Witt 05-2015
-//m.witt@fasttube.de
 
-//EDIT BAHA ZARROUKI 05-2107
+void update_LED() {
-//z.baha@fasttube.de
+  // Copyright Michael Dietzel
+  // m.dietzel@fasttube.de
+  // Edit Michael Witt 05-2015
+  // m.witt@fasttube.de
 
-// alle Werte als Hex-Werte angegeben
+  // EDIT BAHA ZARROUKI 05-2107
+  // z.baha@fasttube.de
+
+  // alle Werte als Hex-Werte angegeben
   bool t_oil = (Vehicle_data.t_oil - 40) >= 0x96; // 150°C temp.oil
   bool t_air = (Vehicle_data.t_air - 40) >= 0x3C; // 60°C temp.llk
-	bool t_mot = ((Vehicle_data.t_mot - 40) >= 0x69) and ((Vehicle_data.t_mot - 40)!=0xC8);	// 105°C temp.water und !=200
+  bool t_mot =
+      ((Vehicle_data.t_mot - 40) >= 0x69) and
+      ((Vehicle_data.t_mot - 40) != 0xC8); // 105°C temp.water und !=200
 
-	bool g_auto = Vehicle_data.g_auto;
+  bool g_auto = Vehicle_data.drs_active;
-	bool u_batt = Vehicle_data.u_batt <= 0xB1;	// 12.5V batt.spann.
+  bool u_batt = Vehicle_data.u_batt <= 0xA9; // 11.95V batt.spann.
   bool e_dros = Vehicle_data.e_thro;         // error-bit
 
   bool rev_lim = Vehicle_data.rev_lim;
 
   uint16_t rev = Vehicle_data.revol;
+  //uint16_t clearcounter = 1;
+
+
+ // if (clearcounter>= 5000){
+//Can0.begin(1000000);   // set CAN0 baud to 1kbit/s and don`t use enable pin!
+//Can0.setNumTXBoxes(1); // reserves mailbox 0 for tx only 8 mailboxes are
+                         // available (the other 7 mailboxes are for rx)
+
+  // We only have 7 mailboxes, but want to receive 9 messages. This trick should
+  // allow us to receive BCU_APS_BRAKE, BCU_ETC and BCU_SHIFT_CTRL in the same
+  // mailbox. It will also let through 0x506, but that shouldn't be much of an
+  // issue.
+  /* 10.09.2024 - auskommentiert, weil wieso hier nochmal watchfor? */
+  Can0.watchFor(CAN_ID_BCU_APS_BRAKE & CAN_ID_BCU_ETC & CAN_ID_BCU_SHIFT_CTRL,  0x7F9);
+  Can0.watchFor(CAN_ID_BCU_TIRES);
+  Can0.watchFor(CAN_ID_BCU_LAP_TIME);
+  Can0.watchFor(CAN_ID_MS4_IGN_REV_ATH);
+  Can0.watchFor(CAN_ID_MS4_SPEED);
+  Can0.watchFor(CAN_ID_MS4_ETC);
+  Can0.watchFor(CAN_ID_MS4_STATES_TEMP_PRESS);
+
+  //Can0.setGeneralCallback(Receive_Can_0);
+
+  //Timer3.attachInterrupt(Send_0x110); // set send interrupt
+ // Timer3.start(10000);                // Calls every 10ms
+ 
+  //  clearcounter = 0; //clearen des display nach definierter Zeit
+    
+
+ // }
+
+ // clearcounter+=1;
+
 
   /*if(Vehicle_data.rev_lim){
           for (int j = 0; j < 10; j++){
                   digitalWrite(leds[j], HIGH);
-			//analogWrite(leds[j], STW_data.br);	//nur eine der zwei zeilen
+                  //analogWrite(leds[j], STW_data.br);	//nur eine der zwei
+  zeilen
           }
           delay(100);
           for (int j = 0; j < 10; j++){

lib/FT_2018_STW_CAN/FT_2018_STW_CAN.h

@@ -2,10 +2,22 @@
 FT_2018_STW_CAN.h
 */
 
+#pragma once
+
 #include "Arduino.h"
 #include "DueTimer.h"
 #include "due_can.h"
 
+#define CAN_ID_BCU_APS_BRAKE 0x500
+#define CAN_ID_BCU_ETC 0x502
+#define CAN_ID_BCU_SHIFT_CTRL 0x504
+#define CAN_ID_BCU_TIRES 0x562
+#define CAN_ID_BCU_LAP_TIME 0x570
+#define CAN_ID_MS4_IGN_REV_ATH 0x773
+#define CAN_ID_MS4_SPEED 0x775
+#define CAN_ID_MS4_ETC 0x779
+#define CAN_ID_MS4_STATES_TEMP_PRESS 0x77A
+
 void Init_Can_0();
 void Send_0x110();
 void Receive_Can_0(CAN_FRAME *frame);

lib/FT_2018e_STW_CAN/FT_2018e_STW_CAN.cpp

@@ -2,22 +2,23 @@
 FT_2018_STW_CAN.cpp
 */
 
+#include "FT_2018e_STW_CAN.h"
 #include "Arduino.h"
 #include "DueTimer.h"
-#include "due_can.h"
-#include "FT_2018e_STW_CAN.h"
 #include "FT18e_STW_INIT.h"
+#include "due_can.h"
 
 CAN_FRAME can_0_msg;
-//can_1_msg.id = 0x110;
+// can_1_msg.id = 0x110;
 int can_0_temp_data = 0;
-int leds[] = {led1, led2, led3, led4, led5, led6, led7, led8, led9, led10, led11, led12, led13, led14, led15, led16};
+int leds[] = {led1, led2,  led3,  led4,  led5,  led6,  led7,  led8,
+              led9, led10, led11, led12, led13, led14, led15, led16};
 
-void Init_Can_0()
+void Init_Can_0() {
-{
   Serial.begin(9600);
   Can0.begin(1000000);   // set CAN0 baud to 1kbit/s and don`t use enable pin!
-	Can0.setNumTXBoxes(1); // reserves mailbox 0 for tx only 8 mailboxes are available (the other 7 mailboxes are for rx)
+  Can0.setNumTXBoxes(1); // reserves mailbox 0 for tx only 8 mailboxes are
+                         // available (the other 7 mailboxes are for rx)
   Can0.watchFor(CAN_CELL_STATS_ID);
   Can0.watchFor(CAN_BATTERY_STATS_ID);
   Can0.watchFor(CAN_COOLING_STATS_ID);
@@ -27,8 +28,7 @@ void Init_Can_0()
   Timer3.start(10000);                // Calls every 10ms
 }
 
-void Send_0x110()
+void Send_0x110() {
-{
   read_buttons();
   read_rotary();
   can_0_msg.id = 0x110;
@@ -47,10 +47,8 @@ void Send_0x110()
   Can0.sendFrame(can_0_msg);
 }
 
-void Receive_Can_0(CAN_FRAME *temp_message)
+void Receive_Can_0(CAN_FRAME *temp_message) {
-{
+  switch (temp_message->id) {
-	switch (temp_message->id)
-	{
   case CAN_CELL_STATS_ID:
     process_cell_stats(temp_message);
     break;
@@ -70,21 +68,18 @@ void Receive_Can_0(CAN_FRAME *temp_message)
   }
 }
 
-void process_cell_stats(CAN_FRAME *frame)
+void process_cell_stats(CAN_FRAME *frame) {
-{
   CellStats *data = (CellStats *)&frame->data;
   Vehicle_data.t_cell_max = data->max_cell_temp;
   Vehicle_data.u_cell_min = data->min_cell_voltage;
 }
 
-void process_battery_stats(CAN_FRAME *frame)
+void process_battery_stats(CAN_FRAME *frame) {
-{
   BatteryStats *data = (BatteryStats *)&frame->data;
   Vehicle_data.u_batt = data->pre_air_voltage;
 }
 
-void process_cooling_stats(CAN_FRAME *frame)
+void process_cooling_stats(CAN_FRAME *frame) {
-{
   CoolingStats *data = (CoolingStats *)&frame->data;
   Vehicle_data.p_wat = data->water_pressure;
   Vehicle_data.t_wat = data->water_temp;
@@ -92,8 +87,7 @@ void process_cooling_stats(CAN_FRAME *frame)
   Vehicle_data.t_mot_r = data->motor_r_temp;
 }
 
-void process_inverter_stats(CAN_FRAME *frame)
+void process_inverter_stats(CAN_FRAME *frame) {
-{
   InverterStats *data = (InverterStats *)&frame->data;
   uint8_t status = data->status;
   Vehicle_data.inverter.ready = status & CAN_INVERTER_STATS_READY;
@@ -109,9 +103,9 @@ void process_inverter_stats(CAN_FRAME *frame)
   Vehicle_data.wheel_speed = data->wheel_speed;
 }
 
-void update_LED()
+void update_LED() {
-{
+  bool t_mot = (Vehicle_data.t_mot_l > LED_THRESH_T_MOT) ||
-	bool t_mot = (Vehicle_data.t_mot_l > LED_THRESH_T_MOT) || (Vehicle_data.t_mot_r > LED_THRESH_T_MOT);
+               (Vehicle_data.t_mot_r > LED_THRESH_T_MOT);
   bool t_inv = Vehicle_data.t_inv > LED_THRESH_T_INV;
   bool t_bat = Vehicle_data.t_cell_max > LED_THRESH_T_BAT;
 

lib/FT_2018e_STW_CAN/FT_2018e_STW_CAN.h

@@ -31,32 +31,28 @@ void process_cooling_stats(CAN_FRAME *frame);
 void process_inverter_stats(CAN_FRAME *frame);
 void update_LED(void);
 
-struct CellStats
+struct CellStats {
-{
   uint16_t sum_cell_voltage;
   int16_t max_cell_temp;
   uint16_t max_cell_voltage;
   uint16_t min_cell_voltage;
 };
 
-struct BatteryStats
+struct BatteryStats {
-{
   uint16_t battery_current;
   uint16_t pre_air_voltage;
   uint16_t post_air_voltage;
   uint16_t battery_power;
 };
 
-struct CoolingStats
+struct CoolingStats {
-{
   int16_t water_pressure;
   int16_t water_temp;
   int16_t motor_l_temp;
   int16_t motor_r_temp;
 };
 
-struct InverterStats
+struct InverterStats {
-{
   uint8_t status;
   uint8_t _reserved;
   uint16_t temp;

lib/arduino-ediptft-master/EDIPTFT.cpp

@@ -1,4 +1,4 @@
- //
+//
 // Library for controlling Electronic Assembly eDIPTFT displays
 //
 //      Copyright (c) 2013 Stefan Gofferje. All rights reserved.
@@ -25,56 +25,40 @@
 #include "Arduino.h"
 #define DEBUG false
 
-
 EDIPTFT::EDIPTFT(boolean smallprotocol, boolean disconnected)
     : _smallprotocol{smallprotocol}, disconnected{disconnected} {}
 
+void EDIPTFT::begin(long baud) { SERIAL_DEV.begin(baud); }
 
-void EDIPTFT::begin(long baud) {
+void EDIPTFT::sendByte(char data) { SERIAL_DEV.write(data); }
-    SERIAL_DEV.begin(baud);
-}
-
-
-void EDIPTFT::sendByte(char data) {
-  SERIAL_DEV.write(data);
-}
-
-
-char EDIPTFT::readByte() {
-  return SERIAL_DEV.read();
-}
 
+char EDIPTFT::readByte() { return SERIAL_DEV.read(); }
 
 void EDIPTFT::waitBytesAvailable() {
   const uint32_t t_start = millis();
   char loop = 0;
-  while (loop == 0)
+  while (loop == 0) {
-  {
+    if (bytesAvailable() != 0) {
-	if (bytesAvailable() != 0){
       loop = 1;
     }
-	if(t_start + 100 < millis())
+    if (t_start + 100 < millis()) {
-	{
+      // Serial.println("Error: waited to long!");
-		//Serial.println("Error: waited to long!");
+      loop = 1;
-		loop =1;
     }
   }
 }
 
-
 char EDIPTFT::waitandreadByte() {
   waitBytesAvailable();
   char result = readByte();
-  return(result);
+  return (result);
 }
 
-
 unsigned char EDIPTFT::bytesAvailable() {
   return SERIAL_DEV.available();
   //ÄNDERN
 }
 
-
 void EDIPTFT::sendData(char* data, char len) {
 
   /*for(int i=0; i < len; i++) {
@@ -86,7 +70,7 @@ void EDIPTFT::sendData(char* data, char len) {
   if (DEBUG) {
     unsigned char i;
     for (i = 0; i < len; i++) {
-	  //Serial.print(byte(data[i]), HEX);
+      // Serial.print(byte(data[i]), HEX);
       SERIAL_DEV.print(byte(data[i]), HEX);
       SERIAL_DEV.print(" ");
     }
@@ -95,16 +79,14 @@ void EDIPTFT::sendData(char* data, char len) {
 
   if (_smallprotocol) {
     sendSmall(data, len);
-  }
+  } else {
-  else {
     unsigned char i;
-    for(i=0; i < len; i++) {
+    for (i = 0; i < len; i++) {
       sendByte(data[i]);
     }
   }
 }
 
-
 void EDIPTFT::sendSmall(char* data, char len) {
   if (disconnected) {
     return;
@@ -121,7 +103,7 @@ void EDIPTFT::sendSmall(char* data, char len) {
     sendByte(len);
     bcc = bcc + len;
 
-    for(i=0; i < len; i++) {
+    for (i = 0; i < len; i++) {
       sendByte(data[i]);
       bcc = bcc + data[i];
     }
@@ -129,13 +111,13 @@ void EDIPTFT::sendSmall(char* data, char len) {
     waitBytesAvailable();
     if (bytesAvailable() > 0) {
       char x = readByte();
-	   //Serial.print(uint16_t(x));
+      // Serial.print(uint16_t(x));
-      if (x == ACK) ok = 1;
+      if (x == ACK)
+        ok = 1;
       else {
         ok = 0;
       }
-    }
+    } else {
-    else {
       delay(200);
       ok = 0;
     }
@@ -146,7 +128,6 @@ void EDIPTFT::sendSmall(char* data, char len) {
   }
 }
 
-
 void EDIPTFT::sendSmallDC2(char* data, char len) {
   unsigned char i, bcc;
   char ok = 0;
@@ -156,307 +137,268 @@ void EDIPTFT::sendSmallDC2(char* data, char len) {
     sendByte(0x12);
     bcc = 0x12;
 
-    for(i=0; i < len; i++) {
+    for (i = 0; i < len; i++) {
       sendByte(data[i]);
       bcc = bcc + data[i];
     }
     sendByte(bcc);
-    waitBytesAvailable(); //delay(6); im 17er
+    waitBytesAvailable(); // delay(6); im 17er
     if (bytesAvailable() > 0) {
-      if (readByte() == ACK) ok = 1;
+      if (readByte() == ACK)
-      else ok = 0;
+        ok = 1;
-    }
+      else
-    else {
+        ok = 0;
+    } else {
       delay(200);
       ok = 0;
     }
   }
 }
 
-
 void EDIPTFT::smallProtoSelect(char address) {
-  char command [] = {
+  char command[] = {0x03, 'A', 'S', address};
-    0x03, 'A', 'S', address
-  };
   sendSmallDC2(command, sizeof(command));
 }
 
-
 void EDIPTFT::smallProtoDeselect(char address) {
-  char command [] = {
+  char command[] = {0x03, 'A', 'D', address};
-    0x03, 'A', 'D', address
-  };
   sendSmallDC2(command, sizeof(command));
 }
 
-
 unsigned char EDIPTFT::datainBuffer() {
   unsigned char result;
-  char command [] = {
+  char command[] = {0x01, 'I'};
-    0x01, 'I'
-  };
   sendSmallDC2(command, sizeof(command));
   waitandreadByte();
   waitandreadByte();
-  result=waitandreadByte();
+  result = waitandreadByte();
   waitandreadByte();
   waitandreadByte();
   return result;
 }
 
-
+int EDIPTFT::readBuffer(char* data) { // return void
-int EDIPTFT::readBuffer(char* data) { //return void
   unsigned char len, i;               // char in 17er
-    char command [] = {
+  char command[] = {0x01, 'S'};
-        0x01, 'S'
-    };
   sendSmallDC2(command, sizeof(command));
   waitandreadByte();
-    len=waitandreadByte();
+  len = waitandreadByte();
   char result[len];
   for (i = 0; i < len; i++) {
     result[i] = waitandreadByte();
   }
   memcpy(data, result, len);
   waitandreadByte();
-    return len; //zeile nicht vorhanden 
+  return len; // zeile nicht vorhanden
 }
 
-
+void EDIPTFT::clear() { // vgl 17er
-void EDIPTFT::clear() { //vgl 17er
   this->deleteDisplay();
   this->removeTouchArea(0, 1);
 }
 
-
 void EDIPTFT::deleteDisplay() {
-    char command [] = {
+  char command[] = {27, 'D', 'L'};
-      27, 'D', 'L'
-    };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::invert() {
-  char command [] = {
+  char command[] = {27, 'D', 'I'};
-    27, 'D', 'I'
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::setDisplayColor(char fg, char bg) {
-  char command [] = {
+  char command[] = {27, 'F', 'D', fg, bg};
-    27, 'F', 'D', fg, bg
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::fillDisplayColor(char bg) {
-  char command [] = {
+  char command[] = {27, 'D', 'F', bg};
-    27, 'D', 'F', bg
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::terminalOn(boolean on) {
   if (on) {
-    char command [] = {27, 'T', 'E'};
+    char command[] = {27, 'T', 'E'};
     sendData(command, sizeof(command));
-  }
+  } else {
-  else {
+    char command[] = {27, 'T', 'A'};
-    char command [] = {27, 'T', 'A'};
     sendData(command, sizeof(command));
   }
 }
 
-
 void EDIPTFT::loadImage(int x1, int y1, int nr) {
-    char command [] = {27, 'U', 'I',
+  char command[] = {
-    #if COORD_SIZE == 1
+    27,
-        (char)x1, (char)y1,
+    'U',
-    #else
+    'I',
-        lowByte(x1), highByte(x1), lowByte(y1), highByte(y1),
+#if COORD_SIZE == 1
-    #endif
+    (char)x1,
-        nr};
+    (char)y1,
+#else
+    lowByte(x1),
+    highByte(x1),
+    lowByte(y1),
+    highByte(y1),
+#endif
+    nr
+  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::cursorOn(boolean on) {
   if (on) {
-    char command [] = {27, 'T', 'C', 1};
+    char command[] = {27, 'T', 'C', 1};
     sendData(command, sizeof(command));
-  }
+  } else {
-  else {
+    char command[] = {27, 'T', 'C', 0};
-    char command [] = {27, 'T', 'C', 0};
     sendData(command, sizeof(command));
   }
 }
 
-
 void EDIPTFT::setCursor(char col, char row) {
-  char command [] = {27, 'T', 'P', col, row};
+  char command[] = {27, 'T', 'P', col, row};
   sendData(command, sizeof(command));
 }
 
 void EDIPTFT::displayLight(char no) {
-  char command [] = {
+  char command[] = {27, 'Y', 'H', no};
-    27, 'Y', 'H', no
-  };
   sendData(command, sizeof(command));
 }
 
-void EDIPTFT::defineBargraph(char dir, char no, int x1, int y1, int x2, int y2, byte sv, byte ev, char type, char mst) {
+void EDIPTFT::defineBargraph(char dir, char no, int x1, int y1, int x2, int y2,
-  char command [] = {
+                             byte sv, byte ev, char type, char mst) {
-    27, 'B', dir, no,
+  char command[] = {
-    #if COORD_SIZE == 1
+    27,
-        x1, y1, x2, y2,
+    'B',
-    #else
+    dir,
-        lowByte(x1), highByte(x1), lowByte(y1), highByte(y1),
+    no,
-        lowByte(x2), highByte(x2), lowByte(y2), highByte(y2),
+#if COORD_SIZE == 1
-    #endif
+    x1,
+    y1,
+    x2,
+    y2,
+#else
+    lowByte(x1),
+    highByte(x1),
+    lowByte(y1),
+    highByte(y1),
+    lowByte(x2),
+    highByte(x2),
+    lowByte(y2),
+    highByte(y2),
+#endif
     char(sv),
     char(ev),
     type,
     mst
   };
   sendData(command, sizeof(command));
-  //mst fehlt 17
+  // mst fehlt 17
 }
 
-
 void EDIPTFT::updateBargraph(char no, char val) {
-  char command [] = {
+  char command[] = {27, 'B', 'A', no, val};
-    27, 'B', 'A', no, val
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::setBargraphColor(char no, char fg, char bg, char fr) {
-  char command [] = {
+  char command[] = {27, 'F', 'B', no, fg, bg, fr};
-    27, 'F', 'B', no, fg, bg, fr
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::linkBargraphLight(char no) {
-  char command [] = {
+  char command[] = {27, 'Y', 'B', no};
-    27, 'Y', 'B', no
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::makeBargraphTouch(char no) {
-  char command [] = {
+  char command[] = {27, 'A', 'B', no};
-    27, 'A', 'B', no
-  };
   sendData(command, sizeof(command));
 }
 
-
+void EDIPTFT::deleteBargraph(char no, char n1) {
-void EDIPTFT::deleteBargraph(char no,char n1) {
+  char command[] = {27, 'B', 'D', no, n1};
-  char command [] = {
-    27, 'B', 'D', no, n1
-  };
   sendData(command, sizeof(command));
 }
 
-
+void EDIPTFT::defineInstrument(char no, int x1, int y1, char image, char angle,
-void EDIPTFT::defineInstrument(char no, int x1, int y1, char image, char angle, char sv, char ev) {
+                               char sv, char ev) {
-  char command [] = {
+  char command[] = {
-    27, 'I', 'P', no,
+    27,
-    #if COORD_SIZE == 1
+    'I',
-        x1, y1,
+    'P',
-    #else
+    no,
-        lowByte(x1), highByte(x1), lowByte(y1), highByte(y1),
+#if COORD_SIZE == 1
-    #endif
+    x1,
-    image, angle, sv, ev
+    y1,
+#else
+    lowByte(x1),
+    highByte(x1),
+    lowByte(y1),
+    highByte(y1),
+#endif
+    image,
+    angle,
+    sv,
+    ev
   };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::updateInstrument(char no, char val) {
-  char command [] = {
+  char command[] = {27, 'I', 'A', no, val};
-    27, 'I', 'A', no, val
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::redrawInstrument(char no) {
-  char command [] = {
+  char command[] = {27, 'I', 'N', no};
-    27, 'I', 'N', no
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::deleteInstrument(char no, char n1, char n2) {
-  char command [] = {
+  char command[] = {27, 'B', 'D', no, n1, n2};
-    27, 'B', 'D', no, n1, n2
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::setLineColor(char fg, char bg) {
-  char command [] = {
+  char command[] = {27, 'F', 'G', fg, bg};
-    27, 'F', 'G', fg, bg
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::setLineThick(char x, char y) {
-  char command [] = {
+  char command[] = {27, 'G', 'Z', x, y};
-    27, 'G', 'Z', x, y
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::setTextColor(char fg, char bg) {
-  char command [] = {
+  char command[] = {27, 'F', 'Z', fg, bg};
-    27, 'F', 'Z', fg, bg
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::setTextFont(char font) {
-  char command [] = {
+  char command[] = {27, 'Z', 'F', font};
-    27, 'Z', 'F', font
-  };
   sendData(command, sizeof(command));
 }
 
-void EDIPTFT::setTextSize(int xsize, int ysize){
+void EDIPTFT::setTextSize(int xsize, int ysize) {
   char command[] = {27, 'Z', 'Z', xsize, ysize};
-	sendData(command,sizeof(command));
+  sendData(command, sizeof(command));
 }
 
 void EDIPTFT::setTextAngle(char angle) {
   // 0 = 0°, 1 = 90°, 2 = 180°, 3 = 270°
-  char command [] = {
+  char command[] = {27, 'Z', 'W', angle};
-    27, 'Z', 'W', angle
-  };
   sendData(command, sizeof(command));
 }
 
-
+void EDIPTFT::drawText(uint16_t x1, uint16_t y1, char justification,
-void EDIPTFT::drawText(uint16_t x1, uint16_t y1, char justification, const char* text) {
+                       const char* text) {
-	//nicht const 17//
+  // nicht const 17//
   byte len = strlen(text);
   byte i;
-  char helper [3 + 4 + len + 1];
+  char helper[3 + 4 + len + 1];
-  helper[0] = 27; //esc
+  helper[0] = 27; // esc
   helper[1] = 'Z';
   helper[2] = justification;
   helper[3] = x1 & 0xFF;
@@ -470,228 +412,318 @@ void EDIPTFT::drawText(uint16_t x1, uint16_t y1, char justification, const char*
   sendData(helper, sizeof(helper));
 }
 
+void EDIPTFT::drawTextInRect(int x1, int y1, int x2, int y2, uint8_t align,
+                             const char* text) {
+  int len_text = strlen(text);
+  int len = 3 + 8 + 1 + len_text + 1;
+  char data[len] = {27,           'Z',         'B',          lowByte(x1),
+                    highByte(x1), lowByte(y1), highByte(y1), lowByte(x2),
+                    highByte(x2), lowByte(y2), highByte(y2), align};
+  for (int i = 0; i < len_text; i++) {
+    data[3 + 8 + 1 + i] = text[i];
+  }
+  data[len - 1] = 0;
+
+  sendData(data, len);
+}
 
 void EDIPTFT::drawLine(int x1, int y1, int x2, int y2) {
-  char command [] = {
+  char command[] = {
-    27,'G','D',
+    27,
-    #if COORD_SIZE == 1
+    'G',
-        x1, y1, x2, y2
+    'D',
-    #else
+#if COORD_SIZE == 1
-        lowByte(x1),highByte(x1),lowByte(y1),highByte(y1),
+    x1,
-        lowByte(x2),highByte(x2),lowByte(y2),highByte(y2)
+    y1,
-    #endif
+    x2,
+    y2
+#else
+    lowByte(x1),
+    highByte(x1),
+    lowByte(y1),
+    highByte(y1),
+    lowByte(x2),
+    highByte(x2),
+    lowByte(y2),
+    highByte(y2)
+#endif
   };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::drawRect(int x1, int y1, int x2, int y2) {
-  char command [] = {
+  char command[] = {
-    27,'G','R',
+    27,
-    #if COORD_SIZE == 1
+    'G',
-        x1, y1, x2, y2
+    'R',
-    #else
+#if COORD_SIZE == 1
-        lowByte(x1),highByte(x1),lowByte(y1),highByte(y1),
+    x1,
-        lowByte(x2),highByte(x2),lowByte(y2),highByte(y2)
+    y1,
-    #endif
+    x2,
+    y2
+#else
+    lowByte(x1),
+    highByte(x1),
+    lowByte(y1),
+    highByte(y1),
+    lowByte(x2),
+    highByte(x2),
+    lowByte(y2),
+    highByte(y2)
+#endif
   };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::drawRectf(int x1, int y1, int x2, int y2, char color) {
-  char command [] = {
+  char command[] = {
-    27,'R','F',
+    27,
-    #if COORD_SIZE == 1
+    'R',
-        x1, y1, x2, y2,
+    'F',
-    #else
+#if COORD_SIZE == 1
-        lowByte(x1),highByte(x1),lowByte(y1),highByte(y1),
+    x1,
-        lowByte(x2),highByte(x2),lowByte(y2),highByte(y2),
+    y1,
-    #endif
+    x2,
+    y2,
+#else
+    lowByte(x1),
+    highByte(x1),
+    lowByte(y1),
+    highByte(y1),
+    lowByte(x2),
+    highByte(x2),
+    lowByte(y2),
+    highByte(y2),
+#endif
     color
   };
   sendData(command, sizeof(command));
 }
 
+void EDIPTFT::clearRect(int x1, int y1, int x2, int y2) {
+  Serial.print("Clearing ");
+  Serial.print(x1);
+  Serial.print(", ");
+  Serial.print(y1);
+  Serial.print(", ");
+  Serial.print(x2);
+  Serial.print(", ");
+  Serial.println(y2);
+  char command[] = {
+    27,
+    'R',
+    'L',
+#if COORD_SIZE == 1
+    x1,
+    y1,
+    x2,
+    y2
+#else
+    lowByte(x1),
+    highByte(x1),
+    lowByte(y1),
+    highByte(y1),
+    lowByte(x2),
+    highByte(x2),
+    lowByte(y2),
+    highByte(y2),
+#endif
+  };
+  sendData(command, sizeof(command));
+}
 
 void EDIPTFT::defineTouchKey(int x1, int y1, int x2, int y2, char down, char up,
-                             const char* text) { //text nicht const 17
+                             const char* text) { // text nicht const 17
   byte len = strlen(text);
   byte i;
-  char helper [len + 6 + 4 * COORD_SIZE];//len+13 17
+  char helper[len + 6 + 4 * COORD_SIZE]; // len+13 17
-  char command [] = {
+  char command[] = {
-    27, 'A', 'T',
+    27,
-    #if COORD_SIZE == 1
+    'A',
-        x1, y1, x2, y2,
+    'T',
-    #else
+#if COORD_SIZE == 1
-        lowByte(x1), highByte(x1), lowByte(y1), highByte(y1),
+    x1,
-        lowByte(x2), highByte(x2), lowByte(y2), highByte(y2),
+    y1,
-    #endif
+    x2,
-    down, up
+    y2,
+#else
+    lowByte(x1),
+    highByte(x1),
+    lowByte(y1),
+    highByte(y1),
+    lowByte(x2),
+    highByte(x2),
+    lowByte(y2),
+    highByte(y2),
+#endif
+    down,
+    up
   };
-  for (i = 0; i < (5 + 4 * COORD_SIZE); i++) helper[i] = command[i];//i<=12 17
+  for (i = 0; i < (5 + 4 * COORD_SIZE); i++)
-  for (i = 0; i <= len+1; i++) helper[i + 5 + 4 * COORD_SIZE] = text[i];//i<=len 17
+    helper[i] = command[i]; // i<=12 17
-  sendData(helper, sizeof(helper));//size len+14 17
+  for (i = 0; i <= len + 1; i++)
+    helper[i + 5 + 4 * COORD_SIZE] = text[i]; // i<=len 17
+  sendData(helper, sizeof(helper));           // size len+14 17
 }
 
-
+void EDIPTFT::defineTouchSwitch(int x1, int y1, int x2, int y2, char down,
-void EDIPTFT::defineTouchSwitch(int x1, int y1, int x2, int y2,
+                                char up, const char* text) { // const nicht 17
-                                char down, char up, const char* text) {//const nicht 17
   byte len = strlen(text);
   byte i;
-  char helper [len + 6 + 4 * COORD_SIZE];//len+13 17
+  char helper[len + 6 + 4 * COORD_SIZE]; // len+13 17
-  char command [] = {
+  char command[] = {
-    27, 'A', 'K',
+    27,
-    #if COORD_SIZE == 1
+    'A',
-        x1, y1, x2, y2,
+    'K',
-    #else
+#if COORD_SIZE == 1
-        lowByte(x1),highByte(x1),lowByte(y1),highByte(y1),
+    x1,
-        lowByte(x2),highByte(x2),lowByte(y2),highByte(y2),
+    y1,
-    #endif
+    x2,
-    down, up
+    y2,
+#else
+    lowByte(x1),
+    highByte(x1),
+    lowByte(y1),
+    highByte(y1),
+    lowByte(x2),
+    highByte(x2),
+    lowByte(y2),
+    highByte(y2),
+#endif
+    down,
+    up
   };
-  for (i = 0; i < 5 + 4 * COORD_SIZE; i++) helper[i] = command[i];
+  for (i = 0; i < 5 + 4 * COORD_SIZE; i++)
-  for (i = 0; i <= len; i++) helper[i + 5 + 4 * COORD_SIZE] = text[i];
+    helper[i] = command[i];
-  sendData(helper, sizeof(helper));//size len+14
+  for (i = 0; i <= len; i++)
+    helper[i + 5 + 4 * COORD_SIZE] = text[i];
+  sendData(helper, sizeof(helper)); // size len+14
 }
 
-
 void EDIPTFT::defineTouchSwitch(int x, int y, int img, char downcode,
                                 char upcode, const char* text) {
   byte len = strlen(text);
   byte i;
   byte n = 6 + 2 * COORD_SIZE;
-  char helper [len + n + 1];
+  char helper[len + n + 1];
-  char command [] = {
+  char command[] = {
-    27, 'A', 'J',
+    27,
-    #if COORD_SIZE == 1
+    'A',
-        x, y,
+    'J',
-    #else
+#if COORD_SIZE == 1
-        lowByte(x), highByte(x), lowByte(y), highByte(y),
+    x,
-    #endif
+    y,
-    img, downcode, upcode
+#else
+    lowByte(x),
+    highByte(x),
+    lowByte(y),
+    highByte(y),
+#endif
+    img,
+    downcode,
+    upcode
   };
-  for (i = 0; i < n; i++) helper[i] = command[i];
+  for (i = 0; i < n; i++)
-  for (i = 0; i <= len; i++) helper[i + n] = text[i];
+    helper[i] = command[i];
+  for (i = 0; i <= len; i++)
+    helper[i + n] = text[i];
   sendData(helper, sizeof(helper));
 }
 
-
+void EDIPTFT::setTouchSwitch(char code, char value) {
-void EDIPTFT::setTouchSwitch(char code,char value) {
+  char command[] = {27, 'A', 'P', code, value};
-  char command [] = {
-    27, 'A', 'P', code, value
-  };
   sendData(command, sizeof(command));
 }
 
-
+void EDIPTFT::setTouchkeyColors(char n1, char n2, char n3, char s1, char s2,
-void EDIPTFT::setTouchkeyColors(
+                                char s3) {
-  char n1, char n2, char n3, char s1, char s2, char s3) {
+  char command[] = {27, 'F', 'E', n1, n2, n3, s1, s2, s3};
-  char command [] = {
-    27, 'F', 'E', n1, n2, n3, s1, s2, s3
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::setTouchkeyFont(char font) {
-  char command [] = {
+  char command[] = {27, 'A', 'F', font};
-    27, 'A', 'F', font
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::setTouchkeyLabelColors(char nf, char sf) {
-  char command [] = {
+  char command[] = {27, 'F', 'A', nf, sf};
-    27, 'F', 'A', nf, sf
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::setTouchGroup(char group) {
-  char command [] = {
+  char command[] = {27, 'A', 'R', group};
-    27, 'A', 'R', group
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::removeTouchArea(char code, char n1) {
-  char command [] = {
+  char command[] = {27, 'A', 'L', code, n1};
-    27, 'A', 'L', code, n1
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::callMacro(uint nr) {
-  char command[] = {
+  char command[] = {27, 'M', 'N', nr};
-    27, 'M', 'N', nr
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::callTouchMacro(uint nr) {
-  char command[] = {
+  char command[] = {27, 'M', 'T', nr};
-    27, 'M', 'T', nr
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::callMenuMacro(uint nr) {
-  char command[] = {
+  char command[] = {27, 'M', 'M', nr};
-    27, 'M', 'M', nr
-  };
   sendData(command, sizeof(command));
 }
 
-
+void EDIPTFT::defineTouchMenu(int x1, int y1, int x2, int y2, char downcode,
-void EDIPTFT::defineTouchMenu(int x1, int y1, int x2, int y2,
+                              char upcode, char mnucode, const char* text) {
-    char downcode, char upcode, char mnucode, const char *text) {
   byte len = strlen(text);
   byte n = 6 + 4 * COORD_SIZE;
-  char helper [len + n + 1];
+  char helper[len + n + 1];
 
-  char command [] = {
+  char command[] = {
-    27, 'A', 'M',
+    27,
-    #if COORD_SIZE == 1
+    'A',
-        x1, y1, x2, y2,
+    'M',
-    #else
+#if COORD_SIZE == 1
-        lowByte(x1),highByte(x1),lowByte(y1),highByte(y1),
+    x1,
-        lowByte(x2),highByte(x2),lowByte(y2),highByte(y2),
+    y1,
-    #endif
+    x2,
-    downcode, upcode, mnucode
+    y2,
+#else
+    lowByte(x1),
+    highByte(x1),
+    lowByte(y1),
+    highByte(y1),
+    lowByte(x2),
+    highByte(x2),
+    lowByte(y2),
+    highByte(y2),
+#endif
+    downcode,
+    upcode,
+    mnucode
   };
-  for (int i = 0; i < n; i++) helper[i] = command[i];
+  for (int i = 0; i < n; i++)
-  for (int i = 0; i <= len; i++) helper[i + n] = text[i];
+    helper[i] = command[i];
+  for (int i = 0; i <= len; i++)
+    helper[i + n] = text[i];
   sendData(helper, sizeof(helper));
 }
 
-
 void EDIPTFT::openTouchMenu() {
-  char command [] = {
+  char command[] = {27, 'N', 'T', 2};
-    27, 'N', 'T', 2
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::setMenuFont(char font) {
-  char command [] = {
+  char command[] = {27, 'N', 'F', font};
-    27, 'N', 'F', font
-  };
   sendData(command, sizeof(command));
 }
 
-
 void EDIPTFT::setTouchMenuAutomation(bool val) {
   char n1 = val ? 1 : 0;
-  char command [] = {
+  char command[] = {27, 'N', 'T', n1};
-    27, 'N', 'T', n1
-  };
   sendData(command, sizeof(command));
 }

lib/arduino-ediptft-master/EDIPTFT.h

@@ -26,17 +26,18 @@
 
 #include "Arduino.h"
 
-//Devices
+// Devices
 #define EDIP128 1
 #define EDIP160 1
 #define EDIP240 1
 #define EDIP320 2
 
-//Set your device
+// Set your device
 #define DEVICE EDIP320
-#define COORD_SIZE DEVICE  //Byte count for coordinates
+#define COORD_SIZE DEVICE // Byte count for coordinates
 #define SERIAL_DEV Serial3
 
+#define EA_TRANSPARENT 0
 #define EA_BLACK 1
 #define EA_BLUE 2
 #define EA_RED 3
@@ -71,11 +72,11 @@
 #define uint unsigned int
 
 class EDIPTFT {
-  public:
+public:
-    EDIPTFT(boolean smallprotocol=true, boolean disconnected=false);
+  EDIPTFT(boolean smallprotocol = true, boolean disconnected = false);
   boolean disconnected;
 
-    void begin(long baud=115200);
+  void begin(long baud = 115200);
 
   // helper functions
   char readByte();
@@ -207,8 +208,8 @@ class EDIPTFT {
   void deleteBargraph(char no, char n1);
 
   // Instrument
-    void defineInstrument(char no, int x1, int y1, char image,
+  void defineInstrument(char no, int x1, int y1, char image, char angle,
-                          char angle, char sv, char ev);
+                        char sv, char ev);
   void updateInstrument(char no, char val);
   void redrawInstrument(char no);
   void deleteInstrument(char no, char n1, char n2);
@@ -252,6 +253,22 @@ class EDIPTFT {
    */
   void drawText(uint16_t x1, uint16_t y1, char justification, const char* text);
 
+  /*! \brief Draw text on display in an area
+   *
+   * Draw a *text* on screen. Several lines are separated by the character `|`
+   * ($7C).
+   * * place text between `~`: characters flash on/off
+   * * place text between `@`: characters flash inversely
+   * * use `\\` as to escape special characters
+   *
+   * \param align set alignment in the rectangle. 1 = top left, 2 = top
+   * center, 3 = top right, 4 = center left, 5 = center, 6 = center right, 7 =
+   * bottom left, 8 = bottom center, 9 = bottom right.
+   * \param text text to draw on display
+   */
+  void drawTextInRect(int x1, int y1, int x2, int y2, uint8_t align,
+                      const char* text);
+
   // Rectangle and Line
   void setLineColor(char fg, char bg);
 
@@ -276,6 +293,9 @@ class EDIPTFT {
 
   void drawRectf(int x1, int y1, int x2, int y2, char color);
 
+  /*! \brief Clear rectangular area */
+  void clearRect(int x1, int y1, int x2, int y2);
+
   // Touch keys
 
   /*! \brief Define touch key
@@ -290,8 +310,8 @@ class EDIPTFT {
    * \param up return/touchmacro (1-255) if released
    * \param text label of the touch key
    */
-    void defineTouchKey(int x1, int y1, int x2, int y2,
+  void defineTouchKey(int x1, int y1, int x2, int y2, char down, char up,
-                        char down, char up, const char* text);
+                      const char* text);
 
   /*! \brief Define touch switch
    *
@@ -305,8 +325,8 @@ class EDIPTFT {
    * \param up return/touchmacro (1-255) if released
    * \param text label of the touch key
    */
-    void defineTouchSwitch(int x1, int y1, int x2, int y2,
+  void defineTouchSwitch(int x1, int y1, int x2, int y2, char down, char up,
-                           char down, char up, const char* text);
+                         const char* text);
 
   /*! \brief Define touch switch with image
    *
@@ -320,8 +340,8 @@ class EDIPTFT {
    * \param up return/touchmacro (1-255) if released
    * \param text label of the touch switch
    */
-    void defineTouchSwitch(int x, int y, int img, char downcode,
+  void defineTouchSwitch(int x, int y, int img, char downcode, char upcode,
-                           char upcode, const char* text);
+                         const char* text);
 
   /*! \brief Set touch switch
    *
@@ -331,10 +351,9 @@ class EDIPTFT {
    * \param code Return code of the switch
    * \param value `value=0`: OFF, `value=1`: ON
    */
-    void setTouchSwitch(char code,char value);
+  void setTouchSwitch(char code, char value);
 
-    void setTouchkeyColors(char n1, char n2, char n3,
+  void setTouchkeyColors(char n1, char n2, char n3, char s1, char s2, char s3);
-                           char s1, char s2, char s3);
 
   /*! \brief Label font
    *
@@ -342,7 +361,7 @@ class EDIPTFT {
    */
   void setTouchkeyFont(char font);
 
-    void setTouchkeyLabelColors(char nf,char sf);
+  void setTouchkeyLabelColors(char nf, char sf);
 
   /*! \brief Radio group for switches
    *
@@ -363,7 +382,7 @@ class EDIPTFT {
    *  \param n1 n1==0: the area remains visible on the display,
    *            n1==1: the area is deleted
    */
-    void removeTouchArea(char code,char n1);
+  void removeTouchArea(char code, char n1);
 
   // Macro Calls
   /*! \brief Run macro
@@ -387,21 +406,23 @@ class EDIPTFT {
   /*! \brief Define touch key with menu function
    *
    * Define the area from *x1*, *y1* to *x2*, *y2*  as a menu key.
-     * The first character determines the direction in which the menu opens (R=right,L=left,O=up,U=down)
+   * The first character determines the direction in which the menu opens
-     * The second character determines the alignment of the touch text (C=center,L=left-,R=right justified)
+   * (R=right,L=left,O=up,U=down) The second character determines the alignment
-     * The menu items are separated by the character '|' ($7C,dec:124) (e.g. "UCkey|item1|item2|item3".
+   * of the touch text (C=center,L=left-,R=right justified) The menu items are
-     * The key text is written with the current touch font and the menu items are written with the current menu font. The background of the menu is saved automatically.
+   * separated by the character '|' ($7C,dec:124) (e.g.
-     * \param downcode `1-255` return/touchmacro if pressed
+   * "UCkey|item1|item2|item3". The key text is written with the current touch
-     * \param upcode `1-255` return/touchmacro if released
+   * font and the menu items are written with the current menu font. The
-     * \param mnucode return/menumacro+(item nr - 1) after selection of a
+   * background of the menu is saved automatically. \param downcode `1-255`
+   * return/touchmacro if pressed \param upcode `1-255` return/touchmacro if
+   * released \param mnucode return/menumacro+(item nr - 1) after selection of a
    *                menu item
    * \param text string with the key text and menu items
    */
-    void defineTouchMenu(int x1, int y1, int x2, int y2,
+  void defineTouchMenu(int x1, int y1, int x2, int y2, char downcode,
-                         char downcode, char upcode, char mnucode,
+                       char upcode, char mnucode, const char* text);
-                         const char *text);
 
-    /*! \brief Send *open* signal after a Menu open request has been sent from TFT.
+  /*! \brief Send *open* signal after a Menu open request has been sent from
+   * TFT.
    *
    *  If a touch menu is not set to open automatically the TFT sends a
    *  request 'ESC T 0'. This function sends 'ESC N T 2' to open the menu.
@@ -422,7 +443,7 @@ class EDIPTFT {
    */
   void setTouchMenuAutomation(bool val);
 
-  private:
+private:
   boolean _smallprotocol;
   int _counter;
   unsigned char bytesAvailable();