jrl-umi3218 / mc_rtc

mc_rtc is an interface for simulated and real robotic systems suitable for real-time control
BSD 2-Clause "Simplified" License
122 stars 36 forks source link

[StabilizerTask] Fix disabling when the robot is in the air #411

Closed arntanguy closed 12 months ago

arntanguy commented 12 months ago

This PR properly disables the stabilizer when the robot is in the air by ensuring that all feedback gains are set to zero when lifting occurs and resets them to their pre-lifting values when the robot is back on the ground.

Please note however that in case of erroneous lift-off detection, this might have some side effects as the derivators and integrators are reset (current existing behaviour). However I don't think we ever had erroneous detection of whether the robot is in the air, so it's not a big concern.