【机器人学】平面2R机器人(二)——逆运动学

前情回顾

【机器人学】平面2R机器人(一)——正运动学

解答

逆运动学求解

尽管在题目要求上并没有计算逆运动学的步骤,但是在后续的MATLAB仿真中,需要从末端执行器的笛卡尔坐标得到各关节的角度,同时保证思路的连续性,在此插入完成逆运动学的求解。因为平面2R机器人结构比较简单,可以直接通过几何法进行逆运动学求解,如下图 1 所示。

图 1  逆运动学求解示意图

在图中 x,y 是已知的末端坐标,而 \theta_1,\theta_2 是要求解的关节坐标,其余变量 \beta=\theta_1 + \gamma

根据余弦定理可得,

x^2+y^2=l^2+l^2-2l^2\cos(180^{\circ}-\theta_2)

所以,

\cos \theta_2 =\frac{x^2+y^2-2l^2}{2l^2}

\theta_2=\pm\arccos (\cos \theta_2)

即求出了 \theta_2,然后有,

\beta=\arctan(\frac{x}{-y})

l^2=x^2+y^2+l^2-2l\sqrt{x^2+y^2} \cos \gamma

\cos \gamma= \frac{x^2+y^2+l^2-l^2}{2l\sqrt{x^2+y^2} }=\frac{\sqrt{x^2+y^2}}{2l }

假设,

\gamma=\arccos(\cos \gamma)

则有,

\theta_1=\beta \pm \gamma

至此,使用几何法简单地对机器人进行了逆运动学求解。关于在多解情况下如何取舍,将在后续实际仿真时进行详细的说明。

未完待续...

【机器人学】平面2R机器人(三)——速度雅可比矩阵

评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

打赏作者

Guo_Zhanyu

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

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

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

打赏作者

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

抵扣说明:

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

余额充值