From 7337b964d60ef22138a47eab8a89e06b3e399941 Mon Sep 17 00:00:00 2001
From: mikeller <github@ike.ch>
Date: Mon, 24 Dec 2018 20:53:52 +1300
Subject: [PATCH] Added sensor for core temperature to SmartPort.

---
 src/main/sensors/adcinternal.c |  2 +-
 src/main/telemetry/smartport.c | 48 ++++++++++++++++++++++------------
 src/main/telemetry/telemetry.h |  3 ++-
 3 files changed, 35 insertions(+), 18 deletions(-)

diff --git a/src/main/sensors/adcinternal.c b/src/main/sensors/adcinternal.c
index 969b6d9c2..1ed2f345b 100644
--- a/src/main/sensors/adcinternal.c
+++ b/src/main/sensors/adcinternal.c
@@ -23,7 +23,7 @@
 
 #include "platform.h"
 
-#if defined(USE_ADC) && defined(USE_ADC_INTERNAL)
+#if defined(USE_ADC_INTERNAL)
 
 #include "build/debug.h"
 
diff --git a/src/main/telemetry/smartport.c b/src/main/telemetry/smartport.c
index c7b85c2f2..3a90ba2c2 100644
--- a/src/main/telemetry/smartport.c
+++ b/src/main/telemetry/smartport.c
@@ -38,9 +38,6 @@
 #include "common/utils.h"
 
 #include "config/feature.h"
-#include "pg/pg.h"
-#include "pg/pg_ids.h"
-#include "pg/rx.h"
 
 #include "drivers/accgyro/accgyro.h"
 #include "drivers/compass/compass.h"
@@ -52,33 +49,38 @@
 #include "fc/rc_controls.h"
 #include "fc/runtime_config.h"
 
-#include "flight/position.h"
 #include "flight/failsafe.h"
 #include "flight/imu.h"
 #include "flight/mixer.h"
 #include "flight/pid.h"
+#include "flight/position.h"
 
 #include "interface/msp.h"
 
 #include "io/beeper.h"
-#include "io/motors.h"
 #include "io/gps.h"
+#include "io/motors.h"
 #include "io/serial.h"
 
-#include "sensors/boardalignment.h"
-#include "sensors/sensors.h"
-#include "sensors/battery.h"
-#include "sensors/acceleration.h"
-#include "sensors/barometer.h"
-#include "sensors/compass.h"
-#include "sensors/esc_sensor.h"
-#include "sensors/gyro.h"
-
 #include "rx/rx.h"
 
-#include "telemetry/telemetry.h"
-#include "telemetry/smartport.h"
+#include "pg/pg.h"
+#include "pg/pg_ids.h"
+#include "pg/rx.h"
+
+#include "sensors/acceleration.h"
+#include "sensors/adcinternal.h"
+#include "sensors/barometer.h"
+#include "sensors/battery.h"
+#include "sensors/boardalignment.h"
+#include "sensors/compass.h"
+#include "sensors/esc_sensor.h"
+#include "sensors/gyro.h"
+#include "sensors/sensors.h"
+
 #include "telemetry/msp_shared.h"
+#include "telemetry/smartport.h"
+#include "telemetry/telemetry.h"
 
 #define SMARTPORT_MIN_TELEMETRY_RESPONSE_DELAY_US 500
 
@@ -127,6 +129,7 @@ enum
     FSSP_DATAID_ACCY       = 0x0710 ,
     FSSP_DATAID_ACCZ       = 0x0720 ,
     FSSP_DATAID_T1         = 0x0400 ,
+    FSSP_DATAID_T11        = 0x0401 ,
     FSSP_DATAID_T2         = 0x0410 ,
     FSSP_DATAID_HOME_DIST  = 0x0420 ,
     FSSP_DATAID_GPS_ALT    = 0x0820 ,
@@ -324,6 +327,12 @@ static void initSmartPortSensors(void)
         ADD_SENSOR(FSSP_DATAID_T2);
     }
 
+#if defined(USE_ADC_INTERNAL)
+    if (telemetryIsSensorEnabled(SENSOR_TEMPERATURE)) {
+        ADD_SENSOR(FSSP_DATAID_T11);
+    }
+#endif
+
     if (isBatteryVoltageConfigured() && telemetryIsSensorEnabled(SENSOR_VOLTAGE)) {
 #ifdef USE_ESC_SENSOR_TELEMETRY
         if (!telemetryIsSensorEnabled(ESC_SENSOR_VOLTAGE))
@@ -785,7 +794,14 @@ void processSmartPortTelemetry(smartPortPayload_t *payload, volatile bool *clear
                     smartPortSendPackage(id, tmp2);
                     *clearToSend = false;
                 }
+
                 break;
+#if defined(USE_ADC_INTERNAL)
+            case FSSP_DATAID_T11        :
+                smartPortSendPackage(id, getCoreTemperatureCelsius());
+
+                break;
+#endif
 #ifdef USE_GPS
             case FSSP_DATAID_SPEED      :
                 if (STATE(GPS_FIX)) {
diff --git a/src/main/telemetry/telemetry.h b/src/main/telemetry/telemetry.h
index 6bfb1d16f..2d84aff70 100644
--- a/src/main/telemetry/telemetry.h
+++ b/src/main/telemetry/telemetry.h
@@ -65,7 +65,8 @@ typedef enum {
                             | ESC_SENSOR_VOLTAGE \
                             | ESC_SENSOR_RPM \
                             | ESC_SENSOR_TEMPERATURE,
-    SENSOR_ALL             = (1 << 19) - 1,
+    SENSOR_TEMPERATURE     = 1 << 19,
+    SENSOR_ALL             = (1 << 20) - 1,
 } sensor_e;
 
 typedef struct telemetryConfig_s {