mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-11-22 14:19:57 +08:00
* feat(mc_rate_control): add rate loop gain compression Extend the gain compression already available on fixed-wing to the multicopter rate controller, so that an oscillation (limit cycle) on the torque setpoint dynamically reduces the loop gain instead of requiring a manual retune. The gain recovers to 1.0 once the oscillation stops. GainCompression3d is templated on the enable and minimum gain parameter IDs so both airframe types share one implementation while keeping their own MC_GC_* / FW_GC_* parameters. Behaviour is opt-in: MC_GC_EN defaults to disabled. The dt clamp in the spectral damper is widened from 1 ms to 0.125 ms because multicopter rate loops run well above the 1 kHz that the previous floor assumed, which would otherwise mis-scale the filter coefficients. Compression is reset while landed so that ground contact vibration does not compress the gains before takeoff. Assisted-by: Claude:claude-opus-5 Signed-off-by: Andrea Bernasconi <andrea.bernasconi@auterion.com> * fix(rate_control): fully restart gain compression on reset reset() only restored the scalar compression gains, leaving the spectral damper history and the cached gain vector untouched. A reset therefore did not really restart at gain 1: the next cycle still multiplied the torque setpoint by the previously compressed vector, and the stale HPF/LPF state could immediately recreate compression. Clear the detector history and the cached gains so that disarming, a non-rotary-wing transition or ground contact genuinely restart from an uncompressed loop. Seed the high-pass filter from the first sample after a reset instead of zeroing the input history. Since the multicopter controller resets on every cycle while landed, a zeroed history would make the first airborne sample look like a step edge and inject a spurious spike into the spectral damper right at takeoff. Assisted-by: Claude:claude-opus-5 Signed-off-by: Andrea Bernasconi <andrea.bernasconi@auterion.com> * docs(mc_rate_control): document multicopter gain compression Add a feature page for gain compression on multicopters, mirroring the fixed-wing one but covering the multicopter specifics: it is opt-in (MC_GC_EN defaults to disabled), and compression is reset while disarmed or landed so ground contact cannot compress the gains before takeoff. The fixed-wing block diagram is linked rather than duplicated, since it contains an airspeed scaling stage that does not exist in the multicopter rate loop. Also note in the multicopter PID tuning guide that compression should be off during manual tuning, as it damps out the very oscillation the tuning process looks for. Assisted-by: Claude:claude-opus-5 Signed-off-by: Andrea Bernasconi <andrea.bernasconi@auterion.com> --------- Signed-off-by: Andrea Bernasconi <andrea.bernasconi@auterion.com>