含UP副支链的并联机构的运动学正解求解方法

摘要

本发明公开一种含UP副支链的并联机构的运动学正解求解方法，其包括以下步骤：S1：在UP支链的U副的两个转轴上安装角度传感器；S2：建立分支坐标系；S3：建立定坐标系和动坐标系；S4：在初始状态各坐标系位姿关系已知的条件下，建立它们之间的位姿坐标关系；S5：构建并联机构各个分支杆长约束方程；S6：结合U副上的角度传感器测得的数据，分析UP支链，确定动平台上的分支坐标系原点在空间的位置矢量；S7：根据闭环矢量方程，构造分支杆长表达式；S8：结合S5构造并联机构的求解位置正解方程组；S9：求出位置正解求解式；S10：得到位置正解唯一解。本发明所提方法通过测量U副的转角值，可将高次方程简化，整个求解过程简单高效、具有普遍适用性。