Do not trigger setSetpointUpdateRateFromSetpointTypes() after registration if the mode has already set a desired setpoint update rate (e.g. already called setSetpointUpdateRate() in the mode constructor)
Testing
Tested in SITL that the expected control frequency is set when specifying / not specifying an update rate in the mode's constructor / onActivate
Changes
setSetpointUpdateRateFromSetpointTypes()
after registration if the mode has already set a desired setpoint update rate (e.g. already calledsetSetpointUpdateRate()
in the mode constructor)Testing