|
|
|
@ -41,7 +41,7 @@ void NavEKF3_core::readRangeFinder(void)
@@ -41,7 +41,7 @@ void NavEKF3_core::readRangeFinder(void)
|
|
|
|
|
if (sensor == nullptr) { |
|
|
|
|
continue; |
|
|
|
|
} |
|
|
|
|
if ((sensor->orientation() == ROTATION_PITCH_270) && (sensor->status() == RangeFinder::RangeFinder_Good)) { |
|
|
|
|
if ((sensor->orientation() == ROTATION_PITCH_270) && (sensor->status() == RangeFinder::Status::Good)) { |
|
|
|
|
rngMeasIndex[sensorIndex] ++; |
|
|
|
|
if (rngMeasIndex[sensorIndex] > 2) { |
|
|
|
|
rngMeasIndex[sensorIndex] = 0; |
|
|
|
|