mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-21 00:43:34 +08:00
px4io: improve multi-rotor motor saturation status reporting
This commit is contained in:
committed by
Lorenz Meier
parent
57a6faf8a2
commit
efb7131186
@@ -2046,9 +2046,7 @@ PX4IO::io_publish_pwm_outputs()
|
||||
/* get mixer status flags from IO */
|
||||
uint16_t mixer_status;
|
||||
ret = io_reg_get(PX4IO_PAGE_STATUS, PX4IO_P_STATUS_MIXER, &mixer_status, sizeof(mixer_status) / sizeof(uint16_t));
|
||||
motor_limits.lower_limit = mixer_status & PX4IO_P_STATUS_MIXER_LOWER_LIMIT;
|
||||
motor_limits.upper_limit = mixer_status & PX4IO_P_STATUS_MIXER_UPPER_LIMIT;
|
||||
motor_limits.yaw = mixer_status & PX4IO_P_STATUS_MIXER_YAW_LIMIT;
|
||||
motor_limits.saturation_status = mixer_status;
|
||||
|
||||
if (ret != OK) {
|
||||
return ret;
|
||||
|
||||
Reference in New Issue
Block a user