bobbycar/controller_teensy/include/display.h

245 lines
7.4 KiB
C
Raw Normal View History

2023-03-02 21:05:48 +00:00
#ifndef _DISPLAY_H_
#define _DISPLAY_H_
#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
2023-05-23 21:57:22 +00:00
#include <Fonts/FreeMonoBold18pt7b.h>
#include <Fonts/FreeSansBold9pt7b.h>
2023-03-02 21:05:48 +00:00
#define SCREEN_WIDTH 128 // OLED display width, in pixels
#define SCREEN_HEIGHT 32 // OLED display height, in pixels
#define OLED_RESET -1 // Reset pin # (or -1 if sharing Arduino reset pin)
#define SCREEN_ADDRESS 0x3C ///< See datasheet for Address; 0x3D for 128x64, 0x3C for 128x32
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);
2023-05-23 19:46:34 +00:00
bool display_init();
void display_update(ESCSerialComm& escFront, ESCSerialComm& escRear);
void display_drivingDisplay(ESCSerialComm& escFront, ESCSerialComm& escRear);
void display_standingDisplay(ESCSerialComm& escFront, ESCSerialComm& escRear);
void display_standingDisarmedDisplay(ESCSerialComm& escFront, ESCSerialComm& escRear);
2023-03-02 21:05:48 +00:00
void display_debugDisplay(ESCSerialComm& escFront, ESCSerialComm& escRear);
2023-05-23 21:57:22 +00:00
2023-05-23 19:46:34 +00:00
bool display_init(){
2023-03-02 21:05:48 +00:00
if(!display.begin(SSD1306_SWITCHCAPVCC, SCREEN_ADDRESS)) {
Serial.println(F("SSD1306 allocation failed"));
2023-05-23 19:46:34 +00:00
return false;
2023-03-02 21:05:48 +00:00
}
display.clearDisplay();
display.setTextSize(1); // Normal 1:1 pixel scale
display.setTextColor(SSD1306_WHITE); // Draw white text
display.setCursor(0,0); // Start at top-left corner
2023-03-02 21:05:48 +00:00
display.display();
2023-05-23 19:46:34 +00:00
return true;
2023-03-02 21:05:48 +00:00
}
void display_update(ESCSerialComm& escFront, ESCSerialComm& escRear){
2023-03-02 21:05:48 +00:00
display.clearDisplay();
2023-05-23 21:57:22 +00:00
/*
2023-03-02 21:05:48 +00:00
display.setTextSize(1); // Normal 1:1 pixel scale
display.setTextColor(SSD1306_WHITE); // Draw white text
display.setCursor(0,0); // Start at top-left corner
display.print(F("Speed : ")); display.println((escFront.getMeanSpeed()+escRear.getMeanSpeed())/2.0);
2023-05-23 21:57:22 +00:00
display.print(F("Thr: ")); display.print(throttle_pos);
display.print(F(" Brk : ")); display.println(brake_pos);
display.print(F("Current : ")); display.println(filtered_currentAll);
display.print(F("Vbat : ")); display.print(escFront.getFeedback_batVoltage());
display.print(F(" / ")); display.println(escRear.getFeedback_batVoltage());
2023-05-23 21:57:22 +00:00
*/
if ( (error_brake_outofrange || error_throttle_outofrange || error_ads_max_read_interval ) && ((loopmillis/2000)%2==0)) {
//Error Messages
display.setFont();
display.setTextSize(1); // Normal 1:1 pixel scale
display.setTextColor(SSD1306_WHITE); // Draw white text
display.setCursor(0,0); // Start at top-left corner
display.print(F("Error!"));
display.println();
String errorstring="";
if (error_brake_outofrange) {
errorstring+="brake_outofrange\n";
}
if (error_throttle_outofrange) {
errorstring+="throttle_outofrange\n";
}
if (error_ads_max_read_interval) {
errorstring+="ads_max_read_interval\n";
}
display.print(errorstring);
}else{
//Normal Display Routinges here
if (armed) {
if (loopmillis-last_notidle>5000) {
display_standingDisplay(escFront,escRear);
}else{
display_drivingDisplay(escFront,escRear);
//display_debugDisplay(escFront,escRear);
}
}else{
display_standingDisarmedDisplay(escFront,escRear);
}
}
display.display();
}
void display_drivingDisplay(ESCSerialComm& escFront, ESCSerialComm& escRear) {
//## Km/h Display
2023-05-23 21:57:22 +00:00
display.setFont(&FreeMonoBold18pt7b);
display.setTextSize(1); // Normal 1:1 pixel scale
display.setTextColor(SSD1306_WHITE); // Draw white text
display.setCursor(0,SCREEN_HEIGHT-(SCREEN_HEIGHT-18)/2 - 3); // Start at top-left corner
2023-05-23 21:57:22 +00:00
float _speeddisplay=(escFront.getMeanSpeed()+escRear.getMeanSpeed())/2.0*3.6;
2023-05-23 21:57:22 +00:00
//_speeddisplay=(millis()/1000)%21; //debugging
char buf[8];
dtostrf(_speeddisplay,1,1,buf);
String strbuf=buf;
2023-05-23 21:57:22 +00:00
if (strbuf.length()<4) { //pad spaces on the left
strbuf=" "+strbuf;
}
display.print(strbuf);
2023-05-23 21:57:22 +00:00
display.setFont();
display.setCursor(SCREEN_WIDTH-25,SCREEN_HEIGHT-16);
2023-05-23 21:57:22 +00:00
display.print("km/h");
//A
display.setCursor(SCREEN_WIDTH-37,1);
static float averaged_filtered_currentAll;
2023-06-03 10:59:26 +00:00
#define CURRENT_FILTER 0.8
averaged_filtered_currentAll=averaged_filtered_currentAll*CURRENT_FILTER+(1-CURRENT_FILTER)*filtered_currentAll; //filter over time
dtostrf(averaged_filtered_currentAll,1,2,buf);
strbuf=buf;
if (strbuf.length()<5) { //pad spaces on the left
strbuf=" "+strbuf;
}
display.print(strbuf);
display.print("A");
//## Trip / Current Consumed Display
display.setCursor(1,SCREEN_HEIGHT-7);
if (((millis()/2500)%2)==0) {
//## Speed statistic
display.print("max: ");
dtostrf(max_meanSpeed*3.6,1,0,buf);
display.print((String)buf);
display.print("km/h");
}else{
//## Current Consumed
dtostrf(min_filtered_currentAll,1,1,buf);
display.print("min:");
display.print((String)buf);
display.print("A max:");
dtostrf(max_filtered_currentAll,1,1,buf);
display.print((String)buf);
display.print("A");
}
}
void display_debugDisplay(ESCSerialComm& escFront, ESCSerialComm& escRear) {
//Debug
display.setTextSize(1); // Normal 1:1 pixel scale
display.setFont();
display.setTextColor(SSD1306_WHITE); // Draw white text
char buf[8];
display.setCursor(1,0);
dtostrf(filtered_currentAll,1,3,buf);
display.print((String)buf);
display.print(" A > ");
}
void display_standingDisplay(ESCSerialComm& escFront, ESCSerialComm& escRear) {
char buf[8];
display.setFont();
display.setCursor(0,0);
display.print(F("Vbat:")); display.print(escFront.getFeedback_batVoltage());
display.print(F("/")); display.print(escRear.getFeedback_batVoltage());
display.print(" V");
display.println();
2023-06-13 21:45:17 +00:00
//display.print(F("Temp:")); display.print(escFront.getFeedback_boardTemp());
//display.print(F("/")); display.print(escRear.getFeedback_boardTemp());
display.print(F("T:")); display.print(temp_ESCFront,0);
display.print(F("/")); display.print(temp_ESCRear,0);
display.print(F("/")); display.print(temp_Air,0);
display.print(" C");
display.println();
display.print(F("Trip:"));
dtostrf(min(escFront.getTrip(),escRear.getTrip()),1,0,buf);
display.print((String)buf);
display.print(" m ");
dtostrf(escFront.getCurrentConsumed()+escRear.getCurrentConsumed(),1,2,buf);
display.print((String)buf);
display.print(" Ah");
display.println();
display.print(F("Eff: "));
dtostrf( min(escFront.getTrip(),escRear.getTrip())/1000/(escFront.getCurrentConsumed()+escRear.getCurrentConsumed()) ,1,2,buf);
display.print((String)buf);
display.print(" km/Ah");
display.println();
2023-03-02 21:05:48 +00:00
}
void display_standingDisarmedDisplay(ESCSerialComm& escFront, ESCSerialComm& escRear) {
//Displayed stuff here when escs are powered off / disconnected
char buf[8];
display.setFont();
display.setCursor(0,0);
display.print(getLogFilename());
display.print(F(" ")); display.print(loopmillis/1000);
display.print(F("s"));
display.println();
display.print(F("ESC F="));
display.print(escFront.getControllerConnected());
display.print(F(" R="));
display.print(escRear.getControllerConnected());
display.println();
display.print("throttle=");
dtostrf(ads_throttle_A_raw,1,0,buf);
display.print((String)buf);
display.print("/");
dtostrf(ads_throttle_B_raw,1,0,buf);
display.print((String)buf);
display.println();
display.print("brake=");
dtostrf(ads_brake_raw,1,0,buf);
display.print((String)buf);
}
2023-03-02 21:05:48 +00:00
#endif