PX4 / PX4-ECL

Estimation & Control Library for Guidance, Navigation and Control Applications
http://dev.px4.io
BSD 3-Clause "New" or "Revised" License
477 stars 508 forks source link

ekf terrain process #1031

Open garlinplus opened 2 years ago

garlinplus commented 2 years ago

When quadrotor fly cross step surface, ranger measure a gap.When in ranger fusion mode,how to process this situation to make measured height no jump point?

bresch commented 2 years ago

That's exactly the reason why using range finder as primary height source is only recommended when the terrain is flat (e.g.: warehouse). With a good accelerometer you might be able to reject the step and assign it as a terrain change, but it's easier if you can use baro or GNSS height fusion.

garlinplus commented 2 years ago

That's exactly the reason why using range finder as primary height source is only recommended when the terrain is flat (e.g.: warehouse). With a good accelerometer you might be able to reject the step and assign it as a terrain change, but it's easier if you can use baro or GNSS height fusion.

In ranger fusion mode,we can use fault detector to detect ranger gap,and reset ranger offset to keep height no jump.

bresch commented 2 years ago

In ranger fusion mode,we can use fault detector to detect ranger gap,and reset ranger offset to keep height no jump.

Do you mean to use the innovation test ratio to detect a step? Yes, that's possible if you have a good accelerometer that you can trust and that the range finder is reliable too; otherwise it will be difficult to detect those steps.

garlinplus commented 2 years ago

In ranger fusion mode,we can use fault detector to detect ranger gap,and reset ranger offset to keep height no jump.

Do you mean to use the innovation test ratio to detect a step? Yes, that's possible if you have a good accelerometer that you can trust and that the range finder is reliable too; otherwise it will be difficult to detect those steps.

yes,when rng test ratio > 1,we can reset ranger offset to keep ranger mesure no jump. Accelerometer integrate bettween two ranger measure time,the drift is not too big.

garlinplus commented 2 years ago

@bresch Can we use baro as main height fusion sensor,and use ranger fusion to estimator baro drift.