1
0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2025-01-18 03:52:11 +01:00

2251 rev changes reverted. Let someone change UAVObjects to provide calibrated altitude and/or offset to HomeLocation and/or take off location (which can be quite different including elevation). But please do not forget that many of users do not have the GCS with Internet at field and/or do not have sufficient weather/baro/altitude condition info for their country. So the solution should provide also a way to 'drive-power-launch'.

git-svn-id: svn://svn.openpilot.org/OpenPilot/trunk@2259 ebee16cc-31ac-478f-84a7-5cbb03baadba
This commit is contained in:
osnwt 2010-12-20 05:20:06 +00:00 committed by osnwt
parent 39d0b2e4a7
commit 801568269c

View File

@ -69,10 +69,6 @@ int32_t AltitudeInitialize()
*/
static void altitudeTask(void *parameters)
{
// For power-up zero height pressure calibration
static float p0 = BMP085_P0 / 1000.0;
static uint32_t i = 15;
BaroAltitudeData data;
portTickType lastSysTime;
@ -97,13 +93,8 @@ static void altitudeTask(void *parameters)
// Convert from Pa to kPa
data.Pressure = PIOS_BMP085_GetPressure() / 1000.0;
// Save zero height pressure as p0
if (i && (--i == 0)) {
p0 = data.Pressure;
}
// Compute the current altitude (all pressures in kPa)
data.Altitude = 44330.0 * (1.0 - powf((data.Pressure / p0), (1.0 / 5.255)));
data.Altitude = 44330.0 * (1.0 - powf((data.Pressure / (BMP085_P0 / 1000.0)), (1.0 / 5.255)));
// Update the AltitudeActual UAVObject
BaroAltitudeSet(&data);