diff --git a/main/ugv_display.cc b/main/ugv_display.cc index 9743253..025a55f 100644 --- a/main/ugv_display.cc +++ b/main/ugv_display.cc @@ -40,6 +40,7 @@ void DisplayClass::Run() { int8_t last_packet_snr; #endif TickType_t last_packet_tick; + messages::UGV_State state; ESP_LOGD(TAG, "Started display thread"); while (true) { @@ -51,6 +52,7 @@ void DisplayClass::Run() { comms_->Lock(); last_packet_tick = comms_->last_packet_tick; + state = comms_->status.state(); #ifdef COMMS_SX127X last_packet_rssi = comms_->last_packet_rssi; last_packet_snr = comms_->last_packet_snr; @@ -68,10 +70,8 @@ void DisplayClass::Run() { oled->printf("heap allc/free %d/%d", heap_info.total_allocated_bytes, heap_info.total_free_bytes); -#ifdef COMMS_SX127X oled->setCursor(4, 3 * 8); - oled->printf("rssi: %d lna gain: %d", lora_rssi, lora_lna_gain); -#endif + oled->printf("state: %d", (int) state); if (last_packet_tick > 0) { double time_since_last_packet =