我的狗子-业余四足机器人笔记(3)-自稳

引入

本篇与上篇单腿逆解内容相互联系,单腿逆解和自稳都属于静态解算

理论

在这里插入图片描述
以左前腿作为讨论对象,其他腿只需要类似步骤并更换符号即可

  1. 向量关系
    在这里插入图片描述
  2. 向量描述
    在这里插入图片描述
    3.代入计算
    在这里插入图片描述
    这里,x,y,z就是前篇单腿的x,y,z代入坐标

结语

其余三条腿只需要更换90,82前面的符号即可(90,82分别为站立姿态支撑四边形的长和宽的一半)
整体思路就是把整体的解算向每条腿的解算靠拢。这样已知整体的RPY角和体心的坐标(px,py,pz)就可以得到足端的坐标,进而通过单腿逆解得到整体12个角度值。用IMU的数据作为RPY角的值,即可实现自稳

  • 1
    点赞
  • 7
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值