Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-26 17:55:28 +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; break;
case MSP_SONAR_ALTITUDE: case MSP_SONAR_ALTITUDE:
#ifdef(USE_RANGEFINDER) #ifdef USE_RANGEFINDER
sbufWriteU32(dst, rangefinderGetLatestAltitude()); sbufWriteU32(dst, rangefinderGetLatestAltitude());
#else #else
sbufWriteU32(dst, 0); sbufWriteU32(dst, 0);

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

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