ardupilot的两个困惑点

第一个: Sub::get_pilot_desired_lean_angles函数里

 // do lateral tilt to euler roll conversion

roll_in = (18000/M_PI) * atanf(cosf(pitch_in*(M_PI/18000))*tanf(roll_in*(M_PI/18000)));

这里注释为将横向倾斜转换为欧拉滚转,可不可以理解为对横滚进行了限制,还是在欧拉转换公式里有一个数学关系?

第二个:attitude_controller_run_quat()函数里

 _rate_target_ang_vel = update_ang_vel_target_from_att_error(attitude_error_vector);//roll、pitch、yaw

    // Add feedforward term that attempts to ensure that roll and pitch errors rotate with the body frame rather than the reference frame.
    // todo: this should probably be a matrix that couples yaw as well.
    _rate_target_ang_vel.x += constrain_float(attitude_error_vector.y, -M_PI / 4, M_PI / 4) * _ahrs.get_gyro().z;//angle_delta_v_x+angle_delta_y*wbz
	
    _rate_target_ang_vel.y += -constrain_float(attitude_error_vector.x, -M_PI / 4, M_PI / 4) * _ahrs.get_gyro().z;

    ang_vel_limit(_rate_target_ang_vel, radians(_ang_vel_roll_max), radians(_ang_vel_pitch_max), radians(_ang_vel_yaw_max));

新版的源码里是没这一部分代码,这里的数学意义又是什么?注释为添加前馈项,试图确保滚转和俯仰误差与机身框架而非参考框架一起旋转,这可能是一个耦合yaw的矩阵。

   x轴角速率误差'= x轴角速率误差 + y轴的姿态误差 * 陀螺仪获取的z轴角速度
   y轴的速率误差'= y轴的速率误差 - x轴的姿态误差 * 陀螺仪获取的z轴角速度

这是怎么和Z轴角速度扯上关系的?难道这里应用了欧拉微分方程或者小角度转换关系?

记录一下,有时间再从数学上找到依据,欢迎大家讨论。

  • 3
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

meadl

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值