mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-09 09:28:31 -04:00
AP_GPS: Remove unused blending function.
Thanks to ender-chen for noticing, closes #7510
This commit is contained in:
parent
c8e0ae6890
commit
9e37e9ee82
@ -1457,16 +1457,6 @@ void AP_GPS::calc_blended_state(void)
|
|||||||
corrected_location[i].alt += (int)(_hgt_offset_cm[i]);
|
corrected_location[i].alt += (int)(_hgt_offset_cm[i]);
|
||||||
}
|
}
|
||||||
|
|
||||||
// Calculate the weighted sum of horizontal and vertical position offsets relative to the blended location
|
|
||||||
blended_alt_offset_cm = 0.0f;
|
|
||||||
blended_NE_offset_m.zero();
|
|
||||||
for (uint8_t i=0; i<GPS_MAX_RECEIVERS; i++) {
|
|
||||||
if (_blend_weights[i] > 0.0f) {
|
|
||||||
blended_NE_offset_m += location_diff(state[GPS_BLENDED_INSTANCE].location, corrected_location[i]) * _blend_weights[i];
|
|
||||||
blended_alt_offset_cm += (float)(corrected_location[i].alt - state[GPS_BLENDED_INSTANCE].location.alt) * _blend_weights[i];
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
// If the GPS week is the same then use a blended time_week_ms
|
// If the GPS week is the same then use a blended time_week_ms
|
||||||
// If week is different, then use time stamp from GPS with largest weighting
|
// If week is different, then use time stamp from GPS with largest weighting
|
||||||
// detect inconsistent week data
|
// detect inconsistent week data
|
||||||
|
Loading…
Reference in New Issue
Block a user