一种机械臂末端运动位姿时间同步方法技术

本发明专利技术涉及一种机械臂末端运动位姿时间同步方法，其首先使用梯形轨迹规划方法处理得到位置轨迹参数，使用“角

【技术实现步骤摘要】
一种机械臂末端运动位姿时间同步方法


[0001]本专利技术涉及机械臂控制领域，具体涉及一种机械臂末端运动位姿时间同步方法。

技术介绍

[0002]如图1所示为机械臂的结构示意图，机械臂的一个主要工作是执行机械臂末端运动指令，即给定机械臂末端的工作空间的起点位姿信息(位置和姿态)和工作空间的终点位姿信息(位置和姿态)，让机械臂末端在工作空间中作直线路径或其它形状的路径运动，如下图2所示。机械臂末端的位置行程和姿态行程均可使用固定在机械臂末端的坐标系的变化来表示，如图3和图4所示，其中图3表示的位置行程为坐标系{1}到坐标系{2}的平行运动，绕虚线平移距离1；图4表示的姿态行程为坐标系{1}到坐标系{2}的旋转运动，绕r旋转角度
[0003]由于位置行程和姿态行程是分开作轨迹规划计算的，位置和姿态的计量单位是不同的，前者是距离，后者是角度(如下图3和图4所示)，经过轨迹规划计算后得到的轨迹参数也是不同的，所以经过轨迹规划算法得到的运动时间一般也是不一样的。
[0004]但是在实际应用中，机械臂在工作时，是需要让机械臂末端的位置和姿态同时开始启动，同时停止，如图2所示，机械臂从虚线状态运动到实线状态，机械臂末端沿直线运动，坐标系的位置和姿态均一直在变化。这样的一个必要性是为了机械臂调试方便和安全，可消除用户对机械臂工作中动作的误判。所以，机械臂的位姿时间同步成为机械臂控制系统的一个重要的功能。

技术实现思路

[0005]本专利技术的目的在于提供一种机械臂末端运动位姿时间同步方法，以试下机械臂末端的位置和姿态同时开始变化，同时停止的目的。
[0006]为实现上述目的，本专利技术采用的技术方案是：
[0007]一种机械臂末端运动位姿时间同步方法，所述方法基于梯形轨迹规划方法进行，设定位置和姿态的轨迹参数，包括位置的极限线速度Ψ
P
，极限线加速度Ω
P
，姿态的极限角速度Ψ
R
，极限角加速度Ω
R
；同时设定加速时间和减速时间相同；
[0008]具体包括以下步骤：
[0009]步骤1、给定机械臂末端的初始位姿T0和终点位姿T1，，其中P0表示初始位置向量，R0表示初始姿态矩阵，P1表示终点位置向量，R1表示终点姿态矩阵；
[0010]步骤2、进行位置轨迹规划：
[0011]根据初始位置P0、终点位置P1、极限线速度Ψ
P
和极限线加速度Ω
R
，利用梯形轨迹
规划方法求出位置轨迹参数：加速时间t1、匀速时间t2、减速时间t3、可达最大速度vm、可达最大加速度am、速度轨迹类型P
tj
，P
tj
为2或者3，分别表示速度轨迹是2段式轨迹或3段式轨迹；
[0012]步骤3、进行姿态轨迹规划：
[0013]根据初始姿态R0、终点姿态R1、极限角速度Ψ
P
和极限角加速度Ω
R
，利用“角
‑
轴”法求角度：
[0014]将初始姿态R0到终点姿态R1的行程，转化为绕姿态旋转轴r的起始姿态角度Θ0、终点姿态角度Θ1，两角度之差即为姿态的变化行程；
[0015]再通过经典梯形轨迹规划方法求出旋转角度的轨迹参数：加速时间T1、匀速时间T2、减速时间T3、可达最大角速度wm、可达最大角加速度αm、速度轨迹类型P
θtj
，P
θtj
只能为2或者3，分别表示速度轨迹是2段式轨迹或3段式轨迹；
[0016]步骤4、计算位置和姿态的总运行时间：
[0017]位置行程的总时间：t＝t1+t2+t3，姿态行程的总时间：T＝T1+T2+T3，取出t和T的较大值，记为T
max
；
[0018]步骤5、利用时间延长算法对位置和姿态的梯形轨迹参数进行时间同步处理：输入为位置和姿态的短时梯形轨迹参数：加速时间t1，T1、匀速时间t2，T2、减速时间t3，T3、可达最大速度vm，wm、可达最大加速度am，αm和速度轨迹类型P
tj
，P
θtj
；输出为所有位置和姿态的长时梯形轨迹参数，即修正后的参数值：修正加速时间t1
′
，T1
′
、修正匀速时间t2
′
，T2
′
、修正减速时间t3
′
，T3
′
、修正可达最大速度vm
′
，wm
′
、修正可达最大加速度am
′
，αm
′
和速度轨迹类型P
tj
′
，P
θtj
′
；
[0019]步骤6、对位置和姿态进行插补，并将修成后的位置和姿态轨迹参数下发到逆解模块中，即完成了位置和姿态的时间同步。
[0020]所述时间同步处理具体如下：
[0021]对于输入的位置轨迹参数；
[0022]如果是轨迹类型是2段式轨迹，那么，
[0023]修正后的可达最大速度
[0024]修正后的加速时间
[0025]修正后的可达最大加速度
[0026]修正后的匀速时间t2
′
＝0；
[0027]修正后的减速时间t3
′
＝t1
′
；
[0028]修正后的速度轨迹类型P
′
tj
＝P
tj
；
[0029]如果轨迹类型是3段式轨迹，那么，
[0030]修正后的可达最大速度
[0031]修正后的加速时间
[0032]修正后的匀速时间
[0033]修正后的减速时间t3
′
＝t1
′
；
[0034]修正后的可达最大加速度am
′
＝am；
[0035]修正后的速度轨迹类型P
′
tj
＝P
tj
；
[0036]对于输入的姿态轨迹参数，
[0037]如果轨迹类型是2段式轨迹，那么，
[0038]修正后的可达最大角速度
[0039]修正后的加速时间
[0040]修正后的可达最大角加速度
[0041]修正后的匀速时间T2
′
＝0；
[0042]修正后的减速时间T3
′
＝T1
′
；
[0043]修正后的速度轨迹类型P
θtj
′
＝P
θtj
；
[0044]如果轨迹类型是3段式轨迹，那么
[0045]修正后的可达最大角速度
[0046][0047]修正后的加速时间
[0048]修正后的匀速时间
[0049]修正后的减速时间T3
′
＝T1
′本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种机械臂末端运动位姿时间同步方法，其特征在于：所述方法基于梯形轨迹规划方法进行，设定位置和姿态的轨迹参数，包括位置的极限线速度Ψ
P
，极限线加速度Ω
P
，姿态的极限角速度Ψ
R
，极限角加速度Ω
R
；同时设定加速时间和减速时间相同；具体包括以下步骤：步骤1、给定机械臂末端的初始位姿T0和终点位姿T1，，其中P0表示初始位置向量，R0表示初始姿态矩阵，P1表示终点位置向量，R1表示终点姿态矩阵；步骤2、进行位置轨迹规划：根据初始位置P0、终点位置P1、极限线速度Ψ
P
和极限线加速度Ω
R
，利用梯形轨迹规划方法求出位置轨迹参数：加速时间t1、匀速时间t2、减速时间t3、可达最大速度vm、可达最大加速度am、速度轨迹类型P
tj
，P
tj
为2或者3，分别表示速度轨迹是2段式轨迹或3段式轨迹；步骤3、进行姿态轨迹规划：根据初始姿态R0、终点姿态R1、极限角速度Ψ
P
和极限角加速度Ω
R
，利用“角
‑
轴”法求角度：将初始姿态R0到终点姿态R1的行程，转化为绕姿态旋转轴r的起始姿态角度Θ0、终点姿态角度Θ1，两角度之差即为姿态的变化行程；再通过经典梯形轨迹规划方法求出旋转角度的轨迹参数：加速时间T1、匀速时间T2、减速时间T3、可达最大角速度wm、可达最大角加速度αm、速度轨迹类型P
θtj
，P
θtj
只能为2或者3，分别表示速度轨迹是2段式轨迹或3段式轨迹；步骤4、计算位置和姿态的总运行时间：位置行程的总时间：t＝t1+t2+t3，姿态行程的总时间：T＝T1+T2+T3，取出t和T的较大值，记为T
max
；步骤5、利用时间延长算法对位置和姿态的梯形轨迹参数进行时间同步处理：输入为位置和姿态的短时梯形轨迹参数：加速时间t1，T1、匀速时间t2，T2、减速时间t3，T3、可达最大速度vm，wm、可达最大加速度am，αm和速度轨迹类型P
tj
，P
θtj
；输出为所有位置和姿态的长时梯形轨迹参数，即修正后的参数值：修正加速时间t1
′
，T1
′
、修正匀速时...

【专利技术属性】
技术研发人员：郭鹏，夏雪琴，张健，吴勇毅，谢双胜，
申请(专利权)人：伯朗特机器人股份有限公司，
类型：发明
国别省市：