diff --git a/controller_teensy/include/display.h b/controller_teensy/include/display.h index 89d668c..0cb869b 100644 --- a/controller_teensy/include/display.h +++ b/controller_teensy/include/display.h @@ -31,7 +31,6 @@ void display_debugDisplay(ESCSerialComm& escFront, ESCSerialComm& escRear); bool display_init(){ if(!display.begin(SSD1306_SWITCHCAPVCC, SCREEN_ADDRESS)) { Serial.println(F("SSD1306 allocation failed")); - writeLogComment((unsigned long)millis(), "SSD1306 allocation failed"); return false; } display.clearDisplay(); diff --git a/controller_teensy/src/main.cpp b/controller_teensy/src/main.cpp index 71ff69e..69e7a38 100644 --- a/controller_teensy/src/main.cpp +++ b/controller_teensy/src/main.cpp @@ -99,6 +99,9 @@ void setup() bool initResult=false; initResult=display_init(); + if (!initResult) { + writeLogComment((unsigned long)millis(), "SSD1306 allocation failed"); + } led_simpeProgress(1,initResult);