一种基于分段常曲率的连续体机械臂逆运动学建模方法

摘要

本发明公开了一种基于分段常曲率的连续体机械臂逆运动学建模方法，它解决了传统针对分段常曲率线驱连续体机械臂的逆运动学模型不能得到解析解，也没有考虑机械臂末端姿态的问题，其技术方案为：包括以下步骤：基于分段常曲率假设，建立机械臂关节的几何模型，得出机械臂弯曲方向和弯曲角度到驱动丝长度的映射关系；提取机械臂骨干曲线模型，建立机械臂末端位置到机械臂弯曲方向和弯曲角度的映射关系；基于四元数得出机械臂末端位姿的约束条件，建立包含机械臂末端位置和姿态的逆运动学模型，并得出解析解。