该代码主要解释了APM 3.4.6版本中四轴飞行器的混控逻辑。首先，针对每个电机计算roll和pitch的控制量，并根据油门值确定yaw的最大可用控制量。然后，计算roll、pitch和yaw的综合控制量，同时记录最小和最大值。最后，根据油门最佳值和控制量范围调整各电机的最终控制信号，确保所有电机控制量保持在0.0到1.0之间。
AP_MotorsMatrix::output_armed_stabilizing：
1、针对每个舵机，计算roll和pitch占用的控制量，并按油门量最大不超过0.5计算yaw最大可使用的控制量
// calculate roll and pitch for each motor
// calculate the amount of yaw input that each motor can accept
for (i=0; i<AP_MOTORS_MAX_NUM_MOTORS; i++) {
if (motor_enabled[i] && (_test_order[i] != 0xff)) {
_thrust_rpyt_out[i] = roll_thrust * _roll_factor[i] + pitch_thrust * _pitch_factor[i];
if (!is_zero(_yaw_factor[i])){
if (yaw_thrust * _yaw_factor[i] > 0.0f) {
unused_range = fabsf((1.0f - (throttle_thrust_best_rpy + _thrust_rpyt_out[i]))/_yaw_factor[i]);
if (yaw_allowed > unused_range) {
yaw_allowed = unused_ran
最低0.47元/天 解锁文章
扫一扫
1万+
被折叠的 条评论
为什么被折叠?
到【灌水乐园】发言
