一种机械臂运动规划的方法、机械臂及机器人技术

本发明专利技术实施例涉及机械臂控制技术领域，尤其公开了一种机械臂运动规划的方法、机械臂及机器人，其中，方法包括：计算机械臂末端在运动轨迹中各位姿的臂角范围和起始臂角值，并且根据臂角范围生成上边界曲线和下边界曲线并识别各位姿的臂角范围中存在的突变臂角范围，根据起始臂角值以及起始位姿的臂角范围，计算臂角比例，根据预设修正模型，计算突变臂角范围对应的位姿的臂角，根据臂角比例，计算其它位姿对应的臂角，最终根据机械臂末端在运动轨迹中的位姿，以及各位姿的臂角，计算各位姿对应的机械臂关节的角度。通过上述方式，本发明专利技术实施例能使机械臂在运动中关节转动角度连续，可保证机械臂连续平稳运动。

A Method of Motion Planning for Robot Arm, Robot and Robot

The embodiment of the present invention relates to the field of manipulator control technology, and in particular discloses a method of manipulator motion planning, a manipulator and a robot. The method includes: calculating the range of arm angle and the angle value of the starting arm of each pose at the end of the manipulator in the motion trajectory, and generating the upper and lower boundary curves according to the range of arm angle, and identifying the existing range of arm angle of each pose. The angle range of the abrupt arm is calculated according to the angle value of the initial arm and the angle range of the initial position and posture. According to the preset revised model, the arm angle corresponding to the angle range of the abrupt arm is calculated. According to the angle ratio of the arm, the arm angles corresponding to other positions and postures are calculated. Finally, the corresponding machinery of each position is calculated according to the position and posture of the end of the manipulator in the trajectory and the arm angle of each position. The angle of the arm joint. By the above way, the embodiment of the present invention can make the joint rotation angle of the manipulator continuous in motion, and can ensure the continuous and stable movement of the manipulator.

【技术实现步骤摘要】
一种机械臂运动规划的方法、机械臂及机器人
本专利技术实施例涉及机械臂控制技术
，特别是涉及一种机械臂运动规划的方法、机械臂及机器人。
技术介绍
机器人是指模拟人类行为或思想与模拟其他生物的机械。而随着人工智能技术、机械设计技术的发展，机器人的灵活越来越高，智化能程度也越来越高，从而使得机器人应用范围越来越广泛。本专利技术的专利技术人在实现本专利技术的过程中，发现：机械臂运动规划一直是机器人学中研究的焦点问题，该类问题一般已知起点与终点的位姿，如何选择一条完备且最优的路径是该问题的目标。对于一般的六自由度串联机器人来说，路径规划过程已经较为成熟，因为六自由度机器人的逆运动学解的数量仅为有限个，当前时刻只要选取与上一时刻角度相差最小的一组关节角度值即可，而对于更高维度的机器人，例如七自由度机器人，每一个末端位姿均对应无数组关节值，因此难以选择一组最优的一组解保证运动过程中角度、角速度连续，而不连续的关节角度变化会对机器人运动造成抖动，严重影响机器人运动效果且容易造成机器人损坏。
技术实现思路
鉴于上述问题，提出了本专利技术以便提供一种克服上述问题或者至少部分地解决上述问题的一种机械臂运本文档来自技高网...

【技术保护点】
1.一种机械臂运动规划的方法，其特征在于，包括：获取所述机械臂末端的运动轨迹；计算所述机械臂末端在所述运动轨迹中各位姿的臂角范围，并且根据所述臂角范围生成上边界曲线和下边界曲线；计算所述机械臂末端在所述运动轨迹中起始位姿的起始臂角值；根据所述起始臂角值以及所述起始位姿的臂角范围，计算臂角比例；根据所述上边界曲线和下边界曲线，识别在各位姿的臂角范围中存在的突变臂角范围；根据预设修正模型，计算所述突变臂角范围对应的位姿的臂角，以及，根据所述臂角比例，计算其它位姿对应的臂角，其中，所述其它位姿为除突变臂角范围对应的位姿之外的位姿；根据机械臂末端在运动轨迹中的位姿，以及各位姿的臂角，计算所述各位姿对应...

【技术特征摘要】
1.一种机械臂运动规划的方法，其特征在于，包括：获取所述机械臂末端的运动轨迹；计算所述机械臂末端在所述运动轨迹中各位姿的臂角范围，并且根据所述臂角范围生成上边界曲线和下边界曲线；计算所述机械臂末端在所述运动轨迹中起始位姿的起始臂角值；根据所述起始臂角值以及所述起始位姿的臂角范围，计算臂角比例；根据所述上边界曲线和下边界曲线，识别在各位姿的臂角范围中存在的突变臂角范围；根据预设修正模型，计算所述突变臂角范围对应的位姿的臂角，以及，根据所述臂角比例，计算其它位姿对应的臂角，其中，所述其它位姿为除突变臂角范围对应的位姿之外的位姿；根据机械臂末端在运动轨迹中的位姿，以及各位姿的臂角，计算所述各位姿对应的机械臂的关节的角度。2.根据权利要求1所述的方法，其特征在于，所述突变臂角范围包括变大臂角范围和变小臂角范围；所述根据所述上边界曲线和下边界曲线，识别在各位姿的臂角范围中存在的突变臂角范围包括：计算所述各位姿在上边界曲线的上边界导数，以及各位姿在下边界曲线的下边界导数；当一所述位姿的上边界导数小于负阈值，以及，所述一所述位姿的下边界导数大于正阈值时，确定所述位姿的臂角范围为变小臂角范围；当一所述位姿的上边界导数大于正阈值，以及，所述一所述位姿的下边界导数小于负阈值时，确定所述位姿的臂角范围为变大臂角范围。3.根据权利要求2所述的方法，其特征在于，所述根据预设修正模型，计算所述突变臂角范围对应的位姿的臂角包括：当所述突变臂角范围为变大臂角范围时，根据预设大臂角比例，计算所述变大臂角范围对应的位姿的臂角；当所述突变臂角范围为变小臂角范围时，根据预设小臂角比例，计算所述变小臂角范围对应的位姿的臂角。4.根据权利要求2所述的方法，其特征在于，所述根据所述臂角比例，计算其它位姿对应的臂角的计算公式为：其中Prop为臂角值在范围中的比例值，α为臂角值，LLimit为臂角范围下边界的值，ULimit为臂角范围上边界的值。5.根据权利要求1所述的方法，其特征在于，所述根据所述臂角范围生成上边界曲线和下边界曲线，进一步包括；当一所述位姿对应的臂角范围的数量为一个，并且前一位姿的对应的臂角范围的数量也为一个时，则选取所述位姿对应的臂角范围；当一所述位姿对应的臂角范围的数量为两个，则向后计算其它位姿对应的臂角范围,直到出现单个臂角范围的位姿为止，并且当出现单个臂角范围的位姿不是运动轨迹的终点位姿时，从两个臂角范围中选取上边界和下边界之和最小的一个，当出现单个臂角范围的位姿不是运动轨迹的终点位姿时，则从两个臂角范围中选择上边界和下边界之差最小的一个；当一所述位姿对应的臂角范围的数量为一个，并且前一位姿的对应的臂角范围的数量为两个时，则选取所述位姿对应的臂角范围；当一所述位姿对应的臂角范围的数量为两个，并且前一位姿的对应的臂角范围的数量也为两个时，则从两个臂角范围中选取上边界和下边界之和最小的一个；根据所选取的臂角范围，生成上边界曲线和下边界曲线。6.一种机械臂运动规划的的装置，其特征在于，包括：获取模块，用于获取所述机械臂末端的运动轨迹；生成模块，用于计算所述机械臂末端在所述运动轨迹中各位姿的臂角范围，并且根据所述臂角范围生成上边界曲线和下边界曲线；第一计算模块，用于计算所述机械臂末端在所述运动轨迹中起始位姿的起始臂角值；第二计算模块，用于根据所述起始臂角值以及所述起始位姿的臂角...

【专利技术属性】
技术研发人员：王天昊，徐慎华，
申请(专利权)人：深圳前海达闼云端智能科技有限公司，
类型：发明
国别省市：广东,44