前情回顾
解答
逆运动学求解
尽管在题目要求上并没有计算逆运动学的步骤,但是在后续的MATLAB仿真中,需要从末端执行器的笛卡尔坐标得到各关节的角度,同时保证思路的连续性,在此插入完成逆运动学的求解。因为平面2R机器人结构比较简单,可以直接通过几何法进行逆运动学求解,如下图 1 所示。
在图中 是已知的末端坐标,而 是要求解的关节坐标,其余变量 。
根据余弦定理可得,
所以,
即求出了 ,然后有,
假设,
则有,
至此,使用几何法简单地对机器人进行了逆运动学求解。关于在多解情况下如何取舍,将在后续实际仿真时进行详细的说明。
未完待续...