Attempt to show temperature reading

8 files changed, 54 insertions, 9 deletions

diff --git a/src/displayapp/DisplayApp.cpp b/src/displayapp/DisplayApp.cpp
index 574f964..155d69a 100644
--- a/src/displayapp/DisplayApp.cpp
+++ b/src/displayapp/DisplayApp.cpp
@@ -296,7 +296,8 @@ void DisplayApp::LoadApp(Apps app, DisplayApp::FullRefreshDirections direction)
                                                        bleController,
                                                        notificationManager,
                                                        settingsController,
-                                                       motionController);
+                                                       motionController,
+                                                       *systemTask);
       break;
 
     case Apps::Error:
diff --git a/src/displayapp/screens/Clock.cpp b/src/displayapp/screens/Clock.cpp
index f390eed..ab4cafd 100644
--- a/src/displayapp/screens/Clock.cpp
+++ b/src/displayapp/screens/Clock.cpp
@@ -9,6 +9,7 @@
 #include "components/settings/Settings.h"
 #include "displayapp/DisplayApp.h"
 #include "displayapp/screens/WatchFaceDigital.h"
+#include "systemtask/SystemTask.h"
 
 using namespace Pinetime::Applications::Screens;
 
@@ -18,8 +19,10 @@ Clock::Clock(DisplayApp* app,
              Controllers::Ble& bleController,
              Controllers::NotificationManager& notificatioManager,
              Controllers::Settings& settingsController,
-             Controllers::MotionController& motionController)
+             Controllers::MotionController& motionController,
+             System::SystemTask& systemTask)
   : Screen(app),
+    systemTask {systemTask},
     dateTimeController {dateTimeController},
     batteryController {batteryController},
     bleController {bleController},
@@ -56,6 +59,7 @@ std::unique_ptr<Screen> Clock::WatchFaceDigitalScreen() {
                                                      bleController,
                                                      notificatioManager,
                                                      settingsController,
-                                                     motionController);
+                                                     motionController,
+                                                     systemTask);
 }
 
diff --git a/src/displayapp/screens/Clock.h b/src/displayapp/screens/Clock.h
index 8d1a5b2..5001dce 100644
--- a/src/displayapp/screens/Clock.h
+++ b/src/displayapp/screens/Clock.h
@@ -6,6 +6,7 @@
 #include <memory>
 #include "displayapp/screens/Screen.h"
 #include "components/datetime/DateTimeController.h"
+#include "systemtask/SystemTask.h"
 
 namespace Pinetime {
   namespace Controllers {
@@ -26,12 +27,14 @@ namespace Pinetime {
               Controllers::Ble& bleController,
               Controllers::NotificationManager& notificatioManager,
               Controllers::Settings& settingsController,
-              Controllers::MotionController& motionController);
+              Controllers::MotionController& motionController,
+              System::SystemTask& systemTask);
         ~Clock() override;
 
         bool OnTouchEvent(TouchEvents event) override;
         bool OnButtonPushed() override;
 
+        System::SystemTask& systemTask;
       private:
         Controllers::DateTime& dateTimeController;
         Controllers::Battery& batteryController;
diff --git a/src/displayapp/screens/WatchFaceDigital.cpp b/src/displayapp/screens/WatchFaceDigital.cpp
index e33a403..56409d0 100644
--- a/src/displayapp/screens/WatchFaceDigital.cpp
+++ b/src/displayapp/screens/WatchFaceDigital.cpp
@@ -21,8 +21,10 @@ WatchFaceDigital::WatchFaceDigital(DisplayApp* app,
                                    Controllers::Ble& bleController,
                                    Controllers::NotificationManager& notificatioManager,
                                    Controllers::Settings& settingsController,
-                                   Controllers::MotionController& motionController)
+                                   Controllers::MotionController& motionController,
+                                   System::SystemTask& systemTask)
   : Screen(app),
+    systemTask {systemTask},
     currentDateTime {{}},
     dateTimeController {dateTimeController},
     batteryController {batteryController},
@@ -56,6 +58,12 @@ WatchFaceDigital::WatchFaceDigital(DisplayApp* app,
   lv_obj_set_style_local_text_color(label_date, LV_LABEL_PART_MAIN, LV_STATE_DEFAULT, lv_color_hex(0x999999));
   lv_obj_set_style_local_text_font(label_date, LV_LABEL_PART_MAIN, LV_STATE_DEFAULT, &neofont2);
 
+  label_temp = lv_label_create(lv_scr_act(), nullptr);
+  lv_obj_align(label_temp, lv_scr_act(), LV_ALIGN_CENTER, 0, -60);
+  lv_obj_set_style_local_text_color(  label_temp, LV_LABEL_PART_MAIN, LV_STATE_DEFAULT, lv_color_hex(0x999999));
+  lv_obj_set_style_local_text_font(   label_temp, LV_LABEL_PART_MAIN, LV_STATE_DEFAULT, &neofont1);
+  lv_label_set_text_fmt(batteryIcon, "T? [?,?]");
+
   label_time = lv_label_create(lv_scr_act(), nullptr);
   lv_obj_set_style_local_text_font(label_time, LV_LABEL_PART_MAIN, LV_STATE_DEFAULT, &neofont3);
 
@@ -111,6 +119,13 @@ void WatchFaceDigital::Refresh() {
     lv_label_set_text_static(notificationIcon, NotificationIcon::GetIcon(notificationState.Get()));
   }
 
+  systemTask.motionSensor.RefreshTemperature();
+  lv_label_set_text_fmt(batteryIcon, "T%d [%d,%d]",
+    ((int)(systemTask.motionSensor.temperature_last_read_value+23)),
+    ((int)(systemTask.motionSensor.temperature_last_result)),
+    ((int)(systemTask.motionSensor.temperature_read_counter))
+  );
+
   currentDateTime = dateTimeController.CurrentDateTime();
 
   if (currentDateTime.IsUpdated()) {
diff --git a/src/displayapp/screens/WatchFaceDigital.h b/src/displayapp/screens/WatchFaceDigital.h
index 572a783..770645d 100644
--- a/src/displayapp/screens/WatchFaceDigital.h
+++ b/src/displayapp/screens/WatchFaceDigital.h
@@ -7,6 +7,7 @@
 #include "displayapp/screens/Screen.h"
 #include "components/datetime/DateTimeController.h"
 #include "components/ble/BleController.h"
+#include "systemtask/SystemTask.h"
 
 namespace Pinetime {
   namespace Controllers {
@@ -28,12 +29,14 @@ namespace Pinetime {
                          Controllers::Ble& bleController,
                          Controllers::NotificationManager& notificatioManager,
                          Controllers::Settings& settingsController,
-                         Controllers::MotionController& motionController);
+                         Controllers::MotionController& motionController,
+                         System::SystemTask& systemTask);
         ~WatchFaceDigital() override;
 
         void Refresh() override;
 
       private:
+        System::SystemTask& systemTask;
         uint8_t displayedHour = -1;
         uint8_t displayedMinute = -1;
 
@@ -50,6 +53,7 @@ namespace Pinetime {
         DirtyValue<uint32_t> stepCount {};
         DirtyValue<bool> notificationState {};
 
+        lv_obj_t* label_temp;
         lv_obj_t* label_time;
         lv_obj_t* label_time_ampm;
         lv_obj_t* label_date;
diff --git a/src/drivers/Bma421.cpp b/src/drivers/Bma421.cpp
index 2f60f42..c5d55cc 100644
--- a/src/drivers/Bma421.cpp
+++ b/src/drivers/Bma421.cpp
@@ -102,9 +102,7 @@ Bma421::Values Bma421::Process() {
   uint32_t steps = 0;
   bma423_step_counter_output(&steps, &bma);
 
-  int32_t temperature;
-  bma4_get_temperature(&temperature, BMA4_DEG, &bma);
-  temperature = temperature / 1000;
+  RefreshTemperature();
 
   uint8_t activity = 0;
   bma423_activity_output(&activity, &bma);
@@ -112,6 +110,19 @@ Bma421::Values Bma421::Process() {
   // X and Y axis are swapped because of the way the sensor is mounted in the PineTime
   return {steps, data.y, data.x, data.z};
 }
+
+void Bma421::RefreshTemperature() {
+  // uint8_t temperature_last_read_value;
+  // uint8_t temperature_last_result;
+  // uint8_t temperature_read_counter;
+  uint8_t data[BMA4_TEMP_DATA_SIZE] = { 0 };
+  temperature_last_result = bma4_read_regs(BMA4_TEMPERATURE_ADDR, data, BMA4_TEMP_DATA_SIZE, &bma);
+  if (temperature_last_result == BMA4_OK) {
+    temperature_last_read_value = data[BMA4_TEMP_BYTE];
+    temperature_read_counter++;
+  }
+}
+
 bool Bma421::IsOk() const {
   return isOk;
 }
diff --git a/src/drivers/Bma421.h b/src/drivers/Bma421.h
index ace644b..1503acd 100644
--- a/src/drivers/Bma421.h
+++ b/src/drivers/Bma421.h
@@ -30,6 +30,11 @@ namespace Pinetime {
       Values Process();
       void ResetStepCounter();
 
+      void RefreshTemperature();
+      uint8_t temperature_last_read_value;
+      uint8_t temperature_last_result;
+      uint8_t temperature_read_counter;
+
       void Read(uint8_t registerAddress, uint8_t* buffer, size_t size);
       void Write(uint8_t registerAddress, const uint8_t* data, size_t size);
 
diff --git a/src/systemtask/SystemTask.h b/src/systemtask/SystemTask.h
index 600d13e..7104115 100644
--- a/src/systemtask/SystemTask.h
+++ b/src/systemtask/SystemTask.h
@@ -104,7 +104,9 @@ namespace Pinetime {
       Pinetime::Drivers::Watchdog& watchdog;
       Pinetime::Controllers::NotificationManager& notificationManager;
       Pinetime::Controllers::MotorController& motorController;
+    public:
       Pinetime::Drivers::Bma421& motionSensor;
+    private:
       Pinetime::Controllers::Settings& settingsController;
       Pinetime::Controllers::MotionController& motionController;