【技术实现步骤摘要】
一种基于梯形规划的机械臂多关节轨迹时间同步方法
[0001]本专利技术涉及机械臂控制领域,具体涉及一种基于梯形规划的机械臂多关节轨迹时间同步方法。
技术介绍
[0002]关节插补功能是机械臂的控制系统的一个重要功能,它的效果是使机械臂从初始位姿运行到终点位姿,运行过程中需满足多个关节从特定的初始角度运行到特定的终点角度。如下图1所示,以3关节为例。
[0003]机械臂的多关节运动中,各个关节的初始角度和终点角度的差值,即角度行程,一般是不一样的,机械臂的关节插补功能要求各个关节在初始角度同时启动,在终点角度同时停止,即时间同步。
[0004]使用经典的梯形轨迹规划算法,在规划不同的角度行程时,算出的时间是不一样的,即各个关节的时间不同步。如果各个关节的运动不同步,那么机械臂在执行一条关节插补运动指令的时候,多个关节是在不同的时间停止运动的,当调试人员在对机械臂编程时,调试人员无法正确判定运动指令是否已经停止或即将停止,这会造成误判,严重情况下会造成机械臂碰撞到其它外围设备的情况,所以对关节的时间同步已成为机械臂控制系统开发中的一个基础功能。
技术实现思路
[0005]针对现有技术存在的问题,本专利技术的目的在于提供一种基于梯形规划的机械臂多关节轨迹时间同步方法。
[0006]为实现上述目的,本专利技术采用的技术方案是:
[0007]一种基于梯形规划的机械臂多关节轨迹时间同步方法,其包括以下步骤:
[0008]步骤1、对于包含n个关节的机械臂,其的初始位姿T0和终
【技术保护点】
【技术特征摘要】 【专利技术属性】
1.一种基于梯形规划的机械臂多关节轨迹时间同步方法,其特征在于:包括以下步骤:步骤1、对于包含n个关节的机械臂,其的初始位姿T0和终点位姿T1,使用逆解算法计算各个关节的初始角度序列α1,
…
,α
n
和终点角度序列β1,
…
,β
n
,其中,n>1;步骤2、根据上述计算得到的每个关节的参数:初始角度、终点角度、极限速度和极限加速度,经过经典的梯形轨迹规划方法后,求出每个关节的梯形轨迹参数:加速时间t11,
…
,t1
n
、匀速时间t21,
…
,t2
n
、减速时间t31,
…
,t3
n
、可达最大速度wm1,
…
,wm
n
、可达最大加速度αm1,
…
,αm
n
和速度轨迹类型P1,
…
,P
n
;P1,
…
,P
n
为2或者3,表示速度轨迹是2段式轨迹或3段式轨迹;使用梯形轨迹规划方法时设定的加速时间和减速时间相同;步骤3、计算每个关节的总运行时间,求得n个关节的运行时间T1,
…
,T
n
;取出n个关节的总运行时间T1,
…
,T
n
的最大值,记为T
max
,设这个总运行时间最长的关节的编号为k;步骤4、对所有关节梯形轨迹参数进行时间同步处理:输入为所有关节的短时梯形轨迹参数:加速时间t11,
…
,t1
技术研发人员:郭鹏,刘珍亮,谢双胜,黄朋生,潘桐,
申请(专利权)人:伯朗特机器人股份有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。