[发明专利]软体机械臂的运动学模型的校正方法

摘要

本发明公开了一种软体机械臂的运动学模型的校正方法，包括以下步骤：确定本体坐标系与观测坐标系的变换关系；使软体机械臂形成多种运动状态，并且采用观测仪测量出每种运动状态下的软体机械臂上各个特征点在观测坐标系中位置坐标；将特征点在观测坐标系中位置坐标变换到本体坐标系中，获得每种运动状态下的软体机械臂上各个特征点在本体坐标系中实际位置坐标；获得每种运动状态下的软体机械臂上各个特征点在本体坐标系中理论位置坐标；根据各种运动状态下软体机械臂上各个特征点的实际位置坐标与理论位置坐标之间的关系对软体机械臂的运动学模型进行校正，确定软体机械臂的校正后的运动学模型。

主权项

1.一种软体机械臂的运动学模型的校正方法，用于对描述软体机械臂的运动状态的运动学模型进行校正，软体机械臂包括M个软体驱动器(1)，软体驱动器(1)通过连接结构(2)沿轴向首尾密封连接，软体驱动器包括沿周向等距排布的Z个波纹管状的气囊体(11)，每个气囊体(11)包括多个波纹小节，波纹小节分布的中心为特征点，M个软体驱动器(1)从软体机械臂固定端起依次排列为第一个软体驱动器，第二个软体驱动器，……，第M个软体驱动器；每个软体驱动器(1)的Z个气囊体(11)从同一方位沿周向依次排列为第一个气囊体，第二个气囊体，……，第Z个气囊体；M个软体驱动器(1)上波纹小节的个数依次为N₁，N₂，……，N_M；M个软体驱动器(1)上特征点的个数依次为N₁，N₂，……，N_M；其特征在于，包括以下步骤：软体机械臂的本体坐标系为设于软体机械臂的固定底端的xyz坐标系，采用观测仪观测软体机械臂的位置，观测仪的观测坐标系为XYZ坐标系，确定本体坐标系与观测坐标系的变换关系；分别向M个软体驱动器的(M*Z)个气囊体中输入相同和/或不同的压力，使软体机械臂形成多种运动状态，并且采用观测仪测量出每种运动状态下的软体机械臂上各个特征点在观测坐标系中位置坐标；根据本体坐标系与观测坐标系的变换关系，将特征点在观测坐标系中位置坐标变换到本体坐标系中，获得每种运动状态下的软体机械臂上各个特征点在本体坐标系中实际位置坐标；将每种运动状态下分别输入至M个软体驱动器的(M*Z)个气囊体中的压力值代入软体机械臂的运动学模型中，获得每种运动状态下的软体机械臂上各个特征点在本体坐标系中理论位置坐标；根据各种运动状态下软体机械臂上各个特征点的实际位置坐标与理论位置坐标之间的关系对软体机械臂的运动学模型进行校正，确定软体机械臂的校正后的运动学模型。