Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-25 17:25:18 +03:00
Code Issues Wiki Activity

Thank you, Travis

Browse source
This commit is contained in:
Pawel Spychalski (DzikuVx) 2017-07-02 21:18:43 +02:00
parent ea822fbeff
commit cfc911bee4
2 changed files with 3 additions and 3 deletions
Download patch file Download diff file Expand all files Collapse all files

2
src/main/fc/fc_msp.c
View file

@ -658,7 +658,7 @@ static bool mspFcProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst, mspPostProcessFn
break;
case MSP_SONAR_ALTITUDE:
#ifdef(USE_RANGEFINDER)
#ifdef USE_RANGEFINDER
sbufWriteU32(dst, rangefinderGetLatestAltitude());
#else
sbufWriteU32(dst, 0);

4
src/main/navigation/navigation_pos_estimator.c
View file

@ -469,7 +469,7 @@ static void updatePitotTopic(timeUs_t currentTimeUs)
}
#endif
#ifdef(USE_RANGEFINDER)
#ifdef USE_RANGEFINDER
/**
* Read sonar and update alt/vel topic
* Function is called from TASK_RANGEFINDER at arbitrary rate - as soon as new measurements are available
@ -809,7 +809,7 @@ static void updateEstimatedTopic(timeUs_t currentTimeUs)
}
/* Surface offset */
#ifdef(USE_RANGEFINDER)
#ifdef USE_RANGEFINDER
posEstimator.est.surface = posEstimator.est.surface + posEstimator.est.surfaceVel * dt;
if (isSonarValid) {