Looking into SSD1306 not writing properly

Author: brentru

src/Wippersnapper.cpp

@@ -2834,7 +2834,7 @@ void Wippersnapper::connect() {
 #endif
 
   // Configure hardware
-  WS.pinCfgCompleted = false;
+  WS.pinCfgCompleted = true;
   while (!WS.pinCfgCompleted) {
     WS_DEBUG_PRINTLN(
         "Polling for message containing hardware configuration...");
@@ -2901,26 +2901,26 @@ ws_status_t Wippersnapper::run() {
   WS._mqtt->processPackets(10);
   WS.feedWDT();
 
-  // Process digital inputs, digitalGPIO module
+/*   // Process digital inputs, digitalGPIO module
   WS._digitalGPIO->processDigitalInputs();
   WS.feedWDT();
 
   // Process analog inputs
   WS._analogIO->update();
-  WS.feedWDT();
+  WS.feedWDT(); */
 
   // Process I2C sensor events
   if (WS._isI2CPort0Init)
     WS._i2cPort0->update();
   WS.feedWDT();
 
-  // Process DS18x20 sensor events
+/*   // Process DS18x20 sensor events
   WS._ds18x20Component->update();
   WS.feedWDT();
 
   // Process UART sensor events
   WS._uartComponent->update();
-  WS.feedWDT();
+  WS.feedWDT(); */
 
   return WS_NET_CONNECTED; // TODO: Make this funcn void!
 }

src/components/i2c/WipperSnapper_I2C.cpp

@@ -879,7 +879,9 @@ bool WipperSnapper_Component_I2C::initI2CDevice(
     _drivers_out.push_back(_sevenSeg);
     WS_DEBUG_PRINTLN("7-Segement LED Matrix Initialized Successfully!");
   } else if (strcmp("ssd1306", msgDeviceInitReq->i2c_device_name) == 0) {
+    WS_DEBUG_PRINTLN("SSD1306 display detected!");
     _ssd1306 = new WipperSnapper_I2C_Driver_Out_Ssd1306(this->_i2c, i2cAddress);
+    WS_DEBUG_PRINTLN("Configuring SSD1306 display...");
     _ssd1306->ConfigureSSD1306(
         (uint8_t)msgDeviceInitReq->i2c_output_add.config.ssd1306_config.width,
         (uint8_t)msgDeviceInitReq->i2c_output_add.config.ssd1306_config.height,
@@ -891,6 +893,7 @@ bool WipperSnapper_Component_I2C::initI2CDevice(
           wippersnapper_i2c_v1_BusResponse_BUS_RESPONSE_DEVICE_INIT_FAIL;
       return false;
     }
+    WS_DEBUG_PRINTLN("SSD1306 display configured successfully!");
     _drivers_out.push_back(_ssd1306);
     WS_DEBUG_PRINTLN("SSD1306 display initialized Successfully!");
   } else {
@@ -1190,6 +1193,7 @@ bool WipperSnapper_Component_I2C::Handle_I2cDeviceOutputWrite(
     driver_out->WriteMessageCharLCD(&msgDeviceWrite->output_msg.write_char_lcd);
   } else if (msgDeviceWrite->which_output_msg ==
              wippersnapper_i2c_v1_I2CDeviceOutputWrite_write_ssd1306_tag) {
+    WS_DEBUG_PRINTLN("Calling WriteMessageSSD1306..");
     driver_out->WriteMessageSSD1306(
         msgDeviceWrite->output_msg.write_ssd1306.message);
   } else {

src/components/i2c/drivers/WipperSnapper_I2C_Driver_Out_Ssd1306.h

@@ -64,21 +64,24 @@ class WipperSnapper_I2C_Driver_Out_Ssd1306
   */
   bool begin() {
     _display = new Adafruit_SSD1306(_width, _height, _i2c);
-    bool did_begin = _display->begin(SSD1306_SWITCHCAPVCC, _sensorAddress);
+    bool did_begin = _display->begin(
+        SSD1306_SWITCHCAPVCC,
+        0x3C); // TODO: Note that this is hardcoded, not sure why not init'd yet
     if (!did_begin)
       return false;
 
     // Show initial display buffer contents on the screen --
     // the library initializes this with an Adafruit splash screen.
     _display->display();
-    delay(2000);
+    delay(1000);
     // Clear the buffer
     _display->clearDisplay();
     // Configure the text size and color
     _display->setTextSize(_text_sz);
     _display->setTextColor(SSD1306_WHITE);
     // Reset the cursor position
     _display->setCursor(0, 0);
+    _display->display();
     return true;
   }
 
@@ -107,18 +110,25 @@ class WipperSnapper_I2C_Driver_Out_Ssd1306
     if (_display == nullptr)
       return;
     _display->clearDisplay();
-    _display->setCursor(0, 0);
 
     // Calculate the line height based on the text size (NOTE: base height is
     // 8px)
     int16_t line_height = 8 * _text_sz;
+    WS_DEBUG_PRINT("Line height: ");
+    WS_DEBUG_PRINTLN(line_height);
 
     int16_t y_idx = 0;
+    _display->setCursor(0, y_idx);
     for (int i = 0; message[i] != '\0'; i++) {
       if (message[i] == '\n') {
+        WS_DEBUG_PRINTLN("New line detected!");
         y_idx += line_height;
         _display->setCursor(0, y_idx);
       } else {
+        WS_DEBUG_PRINT("Printing char: ");
+        WS_DEBUG_PRINT(message[i]);
+        WS_DEBUG_PRINT(" at y: ");
+        WS_DEBUG_PRINTLN(y_idx);
         _display->print(message[i]);
       }
     }

src/components/register/Wippersnapper_Register.cpp

@@ -77,6 +77,7 @@ bool Wippersnapper::encodePubRegistrationReq() {
 /****************************************************************************/
 void Wippersnapper::pollRegistrationResp() {
   // Blocking loop, WDT reset upon failure.
+  WS._boardStatus = WS_BOARD_DEF_OK;
   while (WS._boardStatus != WS_BOARD_DEF_OK) {
     WS_DEBUG_PRINT("Polling for registration message response...");
     WS_DEBUG_PRINTLN(WS._boardStatus);