ALPAKA/driver-ms56xx
1
0
Fork 0
mirror of https://git.intern.spaceteamaachen.de/ALPAKA/driver-ms56xx.git synced 2025-06-10 01:55:59 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity

small bugfix

Browse Source
This commit is contained in:
dario 2024-05-17 01:23:17 +02:00
parent 142db575a7
commit 6403df9561
1 changed files with 8 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

14
src/MS56xx.cpp
View File

@ -87,7 +87,7 @@ namespace sta
float sens = C_[1] + dT_ * C_[3];
// The pressure in Pa.
float pressure = (D1 * sens * 4.76837158205E-7 - offset) * 3.051757813E-5;
float pressure = (D1 * sens * 4.76837158203125E-7 - offset) * 3.0517578125E-5;
// Convert to desired unit.
pressure = convertPressure(pressure, unit);
@ -97,13 +97,15 @@ namespace sta
float MS56xx::getTemperature()
{
requestData(TEMPERATURE);
uint8_t buffer[3] = { 0x00, 0x00, 0x00 };
busRead(MS56xx::Operations::ADC_RESULT, buffer, 3);
uint32_t D2 = buffer[0] << 16 | buffer[1] << 8 | buffer[2];
float dT_ = D2 - C_[5];
return (2000 + dT_ * C_[6]) * 0.01;
float temperature = (2000 + dT_ * C_[6]) * 0.01;
return temperature;
}
void MS56xx::setPressureReference(float pressRef, float altRef, Unit unit /* = Unit::hPa */)
@ -142,19 +144,19 @@ namespace sta
case _MS5607:
C_[1] = 65536L;
C_[2] = 131072;
C_[3] = 7.8125E-3;
C_[3] = 0.0078125;
C_[4] = 0.015625;
C_[5] = 256;
C_[6] = 1.1920928955E-7;
C_[6] = 1.1920928955078125E-7;
break;
case _MS5611:
C_[1] = 32768L;
C_[2] = 65536L;
C_[3] = 3.90625E-3;
C_[4] = 7.8125E-3;
C_[4] = 0.0078125;
C_[5] = 256;
C_[6] = 1.1920928955E-7;
C_[6] = 1.1920928955078125E-7;
default:
break;
}