Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-21 16:18:29 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_TemperatureSensor: Extend analog sensor backend to 5th order polynomial

Browse Source
This commit is contained in:
rishabsingh3003 2024-07-23 11:39:18 -04:00 committed by Peter Barker
parent 941f16cd8e
commit 07b6c57173
2 changed files with 13 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

17
libraries/AP_TemperatureSensor/AP_TemperatureSensor_Analog.cpp
View File

@ -33,29 +33,34 @@ const AP_Param::GroupInfo AP_TemperatureSensor_Analog::var_info[] = {
// @Param: A0
// @DisplayName: Temperature sensor analog 0th polynomial coefficient
// @Description: a0 in polynomial of form temperature in deg = a0 + a1*voltage + a2*voltage^2 + a3*voltage^3 + a4*voltage^4
// @Description: a0 in polynomial of form temperature in deg = a0 + a1*voltage + a2*voltage^2 + a3*voltage^3 + a4*voltage^4 + a5*voltage^5
AP_GROUPINFO("A0", 2, AP_TemperatureSensor_Analog, _a[0], 0),
// @Param: A1
// @DisplayName: Temperature sensor analog 1st polynomial coefficient
// @Description: a1 in polynomial of form temperature in deg = a0 + a1*voltage + a2*voltage^2 + a3*voltage^3 + a4*voltage^4
// @Description: a1 in polynomial of form temperature in deg = a0 + a1*voltage + a2*voltage^2 + a3*voltage^3 + a4*voltage^4 + a5*voltage^5
AP_GROUPINFO("A1", 3, AP_TemperatureSensor_Analog, _a[1], 0),
// @Param: A2
// @DisplayName: Temperature sensor analog 2nd polynomial coefficient
// @Description: a2 in polynomial of form temperature in deg = a0 + a1*voltage + a2*voltage^2 + a3*voltage^3 + a4*voltage^4
// @Description: a2 in polynomial of form temperature in deg = a0 + a1*voltage + a2*voltage^2 + a3*voltage^3 + a4*voltage^4 + a5*voltage^5
AP_GROUPINFO("A2", 4, AP_TemperatureSensor_Analog, _a[2], 0),
// @Param: A3
// @DisplayName: Temperature sensor analog 3rd polynomial coefficient
// @Description: a3 in polynomial of form temperature in deg = a0 + a1*voltage + a2*voltage^2 + a3*voltage^3 + a4*voltage^4
// @Description: a3 in polynomial of form temperature in deg = a0 + a1*voltage + a2*voltage^2 + a3*voltage^3 + a4*voltage^4 + a5*voltage^5
AP_GROUPINFO("A3", 5, AP_TemperatureSensor_Analog, _a[3], 0),
// @Param: A4
// @DisplayName: Temperature sensor analog 4th polynomial coefficient
// @Description: a4 in polynomial of form temperature in deg = a0 + a1*voltage + a2*voltage^2 + a3*voltage^3 + a4*voltage^4
// @Description: a4 in polynomial of form temperature in deg = a0 + a1*voltage + a2*voltage^2 + a3*voltage^3 + a4*voltage^4 + a5*voltage^5
AP_GROUPINFO("A4", 6, AP_TemperatureSensor_Analog, _a[4], 0),
// @Param: A5
// @DisplayName: Temperature sensor analog 5th polynomial coefficient
// @Description: a5 in polynomial of form temperature in deg = a0 + a1*voltage + a2*voltage^2 + a3*voltage^3 + a4*voltage^4 + a5*voltage^5
AP_GROUPINFO("A5", 7, AP_TemperatureSensor_Analog, _a[5], 0),
AP_GROUPEND
};
@ -81,7 +86,7 @@ void AP_TemperatureSensor_Analog::update()
const float voltage = _analog_source->voltage_average_ratiometric();
// Evaluate polynomial
// temperature (deg) = a0 + a1*voltage + a2*voltage^2 + a3*voltage^3 + a4*voltage^4
// temperature (deg) = a0 + a1*voltage + a2*voltage^2 + a3*voltage^3 + a4*voltage^4 + a5*voltage^5
float temp = 0.0;
float poly = 1.0;
for (uint8_t i = 0; i < ARRAY_SIZE(_a); i++) {

4
libraries/AP_TemperatureSensor/AP_TemperatureSensor_Analog.h
View File

@ -35,10 +35,10 @@ private:
AP_HAL::AnalogSource *_analog_source;
// Pin used to measure voltage
AP_Int8 _pin;
AP_Int8 _pin;
// Polynomial coefficients to calculate temperature from voltage
AP_Float _a[5];
AP_Float _a[6];
};