【技术实现步骤摘要】
一种多自由度机械臂的逆运动学通用求解方法及装置
[0001]本专利技术涉及一种机器人逆运动学通用求解方法，具体来说是一种多自由度机械臂的逆运动学通用求解方法及装置。
技术介绍
[0002]随着机器人行业的发展，机械臂作为机器人行业至关重要的一部分，在未来将占据越来越重要的作用；机械臂的运动逆解，是当机械臂末端处于某一点及某一姿态，求出机械臂每个自由度旋转角度的一种方法；机械臂的运动学逆解是机器人学中最基础也是最重要的一部分，它直接关系到机器人的运动控制、路径规划等一系列问题。目前传统机器人行业中广泛应用的机械臂逆解方法是以D
‑
H参数法为基础的解析法，该方法实时性较高，但是其计算过程相当复杂；解析法与机械臂的自由度数量和构型关系较大，如研发过程中改变结构构型或增减自由度数量，则需重新进行计算。
技术实现思路
[0003]为了克服目前已有的逆解方法复杂性、通用性等不足，本专利技术提供了一种适用于多自由度机械臂的通用逆运动学通用求解方法。
[0004]本专利技术所采用的技术方案是：提供一...
【技术保护点】
【技术特征摘要】
1.一种多自由度机械臂的逆运动学通用求解方法，其特征在于：包括以下步骤： 1）将所述机械臂各关节自由度当前角度作为初始迭代角度，计算所述机械臂当前状态下的末端齐次变换矩阵及运动至目标位置的运动旋量；2）判断所述运动旋量是否小于等于误差，如果是，此时的关节自由度角度即为所述机械臂的逆运动学解，计算终止；如果否，则进入步骤3）;3）计算所述机械臂各关节的下一迭代自由度角度，将新各自由度角度带入步骤1）和2），进行迭代计算，直到其满足计算终止条件。2.根据权利要求1所述的一种多自由度机械臂的逆运动学通用求解方法，其特征在于：所述步骤1）还包括以下步骤：1.1）利用指数积方法表示空间构型，在三维空间笛卡尔坐标系下构建各自由度的旋转轴矩阵，构建末端正解的表达公式。3.根据权利要求2所述的多自由度机械臂的逆运动学通用求解方法，其特征在于：所述步骤1.1）还包括以下步骤：1.1.1） 利用指数积方法表示空间构型，在三维空间笛卡尔坐标系下构建各自由度的旋转轴矩阵；自由度机械臂的单位旋转轴矩阵为：其中为自由度机械臂各自由度旋转轴单位角速度在三维空间下的表示，为自由度机械臂各自由度旋转轴单位线速度在三维空间下的表示；1.1.2） 通过指数积法表示空间构型，机械臂末端正解公式为：其中为机械臂初始状态下末端的齐次变换矩阵，其中为机械臂第个自由度的单位旋转矩阵, 为第个自由度的旋转角度。4.根据权利要求3所述的多自由度机械臂的逆运动学通用求解方法，其特征在于：所述步骤1）还包括以下步骤：1.2） 令为机械臂各关节自由度当前角度，通过上述步骤1.1.2）得到机械臂末端当前状态下的齐次变换矩阵。5.根据权利要求4所述的多自由度机械臂的逆运动学通用求解方法，其特征在于：所述步骤1）还包括以下步骤：1.3）输入机械臂末端目标状态下的齐次变换矩阵，计算机械臂从至的运动旋量
；将...
【专利技术属性】
技术研发人员：何川甫，陈万楷，吴易谦，江微杰，刘彦禹，童伟宇，郑淳馨，
申请(专利权)人：杭州锐沃机器人科技有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。