74 lines
2.4 KiB
C
74 lines
2.4 KiB
C
#ifndef _DISPLAY_H_
|
|
#define _DISPLAY_H_
|
|
|
|
#include <Wire.h>
|
|
#include <Adafruit_GFX.h>
|
|
#include <Adafruit_SSD1306.h>
|
|
#include <Fonts/FreeMonoBold18pt7b.h>
|
|
#include <Fonts/FreeSansBold9pt7b.h>
|
|
|
|
|
|
|
|
#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);
|
|
|
|
bool display_init();
|
|
void display_update();
|
|
|
|
|
|
bool display_init(){
|
|
if(!display.begin(SSD1306_SWITCHCAPVCC, SCREEN_ADDRESS)) {
|
|
Serial.println(F("SSD1306 allocation failed"));
|
|
return false;
|
|
}
|
|
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
|
|
display.display();
|
|
return true;
|
|
}
|
|
|
|
void display_update(ESCSerialComm& escFront, ESCSerialComm& escRear){
|
|
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
|
|
display.print(F("Speed : ")); display.println((escFront.getMeanSpeed()+escRear.getMeanSpeed())/2.0);
|
|
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());
|
|
*/
|
|
|
|
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); // Start at top-left corner
|
|
|
|
float _speeddisplay=(-escFront.getMeanSpeed()-escRear.getMeanSpeed())/2.0*3.6;
|
|
//_speeddisplay=(millis()/1000)%21; //debugging
|
|
char buf[8];
|
|
dtostrf(_speeddisplay,1,1,buf);
|
|
String strbuf=buf;
|
|
|
|
if (strbuf.length()<4) { //pad spaces on the left
|
|
strbuf=" "+strbuf;
|
|
}
|
|
display.print(strbuf);
|
|
|
|
display.setCursor(SCREEN_WIDTH-25,SCREEN_HEIGHT-1);
|
|
display.setFont();
|
|
display.print("km/h");
|
|
|
|
display.display();
|
|
}
|
|
|
|
|
|
#endif |