摘要
针对球面手腕康复机器人的末端执行机构——共轴3RRR球面并联机构(CSPM)存在逆运动学解不完整性或无解析解的问题,提出基于欧拉角的逆运动学分步求解方法.根据共轴球面并联机构的特性,可以将CSPM姿态欧拉角分解为绕Z轴和绕X、Y轴旋转的2个子姿态,求解绕X、Y轴旋转子姿态逆运动学解的集合.选取每个关节逆运动学解集合中的较小值,与绕Z轴旋转的角度相加作为CSPM逆运动学解,利用CSPM正运动学验证了所提方法的正确性.在真实手腕运动范围的基础上,以无连杆碰撞点和无奇异位形为约束条件,使用所提方法求解手腕康复装置的实际姿态空间.在实际的姿态空间内,将提出的逆运动学求解方法与单位四元数相互转换,将单位四元数插补应用于CSPM运动规划中,理论计算结果与试验结果均为光滑的轨迹曲线,两者误差的最大值不超过2.5°.
- 单位