CN113942016B - 一种机械臂末端运动位姿时间同步方法 - Google Patents
一种机械臂末端运动位姿时间同步方法 Download PDFInfo
- Publication number
- CN113942016B CN113942016B CN202111410006.2A CN202111410006A CN113942016B CN 113942016 B CN113942016 B CN 113942016B CN 202111410006 A CN202111410006 A CN 202111410006A CN 113942016 B CN113942016 B CN 113942016B
- Authority
- CN
- China
- Prior art keywords
- corrected
- time
- track
- acceleration
- trajectory
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Abstract
本发明涉及一种机械臂末端运动位姿时间同步方法,其首先使用梯形轨迹规划方法处理得到位置轨迹参数,使用“角‑轴”法和梯形轨迹规划方法结合得到姿态轨迹参数,然后基于位置轨迹参数和位置轨迹参数确定最大运行时间,最后依据该最大运行时间调整位置轨迹参数和姿态轨迹参数,实现位置和姿态的同步处理。
Description
技术领域
本发明涉及机械臂控制领域,具体涉及一种机械臂末端运动位姿时间同步方法。
背景技术
如图1所示为机械臂的结构示意图,机械臂的一个主要工作是执行机械臂末端运动指令,即给定机械臂末端的工作空间的起点位姿信息(位置和姿态)和工作空间的终点位姿信息(位置和姿态),让机械臂末端在工作空间中作直线路径或其它形状的路径运动,如下图2所示。机械臂末端的位置行程和姿态行程均可使用固定在机械臂末端的坐标系的变化来表示,如图3和图4所示,其中图3表示的位置行程为坐标系{1}到坐标系{2}的平行运动,绕虚线平移距离1;图4表示的姿态行程为坐标系{1}到坐标系{2}的旋转运动,绕r旋转角度
由于位置行程和姿态行程是分开作轨迹规划计算的,位置和姿态的计量单位是不同的,前者是距离,后者是角度(如下图3和图4所示),经过轨迹规划计算后得到的轨迹参数也是不同的,所以经过轨迹规划算法得到的运动时间一般也是不一样的。
但是在实际应用中,机械臂在工作时,是需要让机械臂末端的位置和姿态同时开始启动,同时停止,如图2所示,机械臂从虚线状态运动到实线状态,机械臂末端沿直线运动,坐标系的位置和姿态均一直在变化。这样的一个必要性是为了机械臂调试方便和安全,可消除用户对机械臂工作中动作的误判。所以,机械臂的位姿时间同步成为机械臂控制系统的一个重要的功能。
发明内容
本发明的目的在于提供一种机械臂末端运动位姿时间同步方法,以试下机械臂末端的位置和姿态同时开始变化,同时停止的目的。
为实现上述目的,本发明采用的技术方案是:
一种机械臂末端运动位姿时间同步方法,所述方法基于梯形轨迹规划方法进行,设定位置和姿态的轨迹参数,包括位置的极限线速度ΨP,极限线加速度ΩP,姿态的极限角速度ΨR,极限角加速度ΩR;同时设定加速时间和减速时间相同;
具体包括以下步骤:
步骤2、进行位置轨迹规划:
根据初始位置P0、终点位置P1、极限线速度ΨP和极限线加速度ΩR,利用梯形轨迹规划方法求出位置轨迹参数:加速时间t1、匀速时间t2、减速时间t3、可达最大速度vm、可达最大加速度am、速度轨迹类型Ptj,Ptj为2或者3,分别表示速度轨迹是2段式轨迹或3段式轨迹;
步骤3、进行姿态轨迹规划:
根据初始姿态R0、终点姿态R1、极限角速度ΨP和极限角加速度ΩR,利用“角-轴”法求角度:
再通过经典梯形轨迹规划方法求出旋转角度的轨迹参数:加速时间T1、匀速时间T2、减速时间T3、可达最大角速度wm、可达最大角加速度αm、速度轨迹类型Pθtj,Pθtj只能为2或者3,分别表示速度轨迹是2段式轨迹或3段式轨迹;
步骤4、计算位置和姿态的总运行时间:
位置行程的总时间:t=t1+t2+t3,姿态行程的总时间:T=T1+T2+T3,取出t和T的较大值,记为Tmax;
步骤5、利用时间延长算法对位置和姿态的梯形轨迹参数进行时间同步处理:输入为位置和姿态的短时梯形轨迹参数:加速时间t1,T1、匀速时间t2,T2、减速时间t3,T3、可达最大速度vm,wm、可达最大加速度am,αm和速度轨迹类型Ptj,Pθtj;输出为所有位置和姿态的长时梯形轨迹参数,即修正后的参数值:修正加速时间t1′,T1′、修正匀速时间t2′,T2′、修正减速时间t3′,T3′、修正可达最大速度vm′,wm′、修正可达最大加速度am′,αm′和速度轨迹类型Ptj′,Pθtj′;
步骤6、对位置和姿态进行插补,并将修成后的位置和姿态轨迹参数下发到逆解模块中,即完成了位置和姿态的时间同步。
所述时间同步处理具体如下:
对于输入的位置轨迹参数;
如果是轨迹类型是2段式轨迹,那么,
修正后的匀速时间t2′=0;
修正后的减速时间t3′=t1′;
修正后的速度轨迹类型P′tj=Ptj;
如果轨迹类型是3段式轨迹,那么,
修正后的减速时间t3′=t1′;
修正后的可达最大加速度am′=am;
修正后的速度轨迹类型P′tj=Ptj;
对于输入的姿态轨迹参数,
如果轨迹类型是2段式轨迹,那么,
修正后的匀速时间T2′=0;
修正后的减速时间T3′=T1′;
修正后的速度轨迹类型Pθtj′=Pθtj;
如果轨迹类型是3段式轨迹,那么
修正后的可达最大角速度
修正后的减速时间T3′=T1′;
修正后的可达最大角加速度αm′=αm;
修正后的速度轨迹类型Pθtj′=Pθtj。
采用上述方案后,本发明首先使用梯形轨迹规划方法处理得到位置轨迹参数,使用“角-轴”法和梯形轨迹规划方法结合得到姿态轨迹参数,然后基于位置轨迹参数和位置轨迹参数确定最大运行时间,最后依据该最大运行时间调整位置轨迹参数和姿态轨迹参数,实现位置和姿态的同步处理。
附图说明
图1为机械臂的结构示意图;
图2为机械臂末端位置和姿态变的同步变化效果图;
图3为机械臂末端的位置行程示意图;
图4为机械臂末端的姿态行程示意图;
图5为本发明的同步方法流程图;
图6为梯形轨迹规划时间延长算法流程图。
具体实施方式
如图5所示,本发明揭示了一种机械臂末端运动位姿时间同步方法,其基于梯形轨迹规划方法进行,提前设定位置和姿态的轨迹参数,包括位置的极限线速度ΨP,极限线加速度ΩP,姿态的极限角速度ΨR,极限角加速度ΩR;同时设定加速时间和减速时间相同。基于这些前提,本发明的位姿时间同步方法具体包括以下步骤:
步骤2、进行位置轨迹规划。根据初始位置P0、终点位置P1、极限线速度ΨP和极限线加速度ΩR,利用梯形轨迹规划方法求出位置轨迹参数:加速时间t1、匀速时间t2、减速时间t3、可达最大速度vm、可达最大加速度am、速度轨迹类型Ptj,Ptj只能为2或者3,分别表示速度轨迹是2段式轨迹或3段式轨迹。对于空间位置,上述的参数确定了以后,即决定了一个位置的梯形曲线轨迹。
步骤3、进行姿态轨迹规划。根据初始姿态R0、终点姿态R1、极限角速度ΨP和极限角加速度ΩR,利用“角-轴”法求角度:
得到角-轴:
若R=I,则Θ=0,轴r不确定;
若tr(R)=-1,则Θ=π
一般情况下:
将初始姿态R0到终点姿态R1的行程,转化为绕姿态旋转轴r的起始姿态角度Θ0、终点姿态角度Θ1,两角度之差即为姿态的变化行程,原理如图4所示。再通过经典梯形轨迹规划方法可以求出旋转角度的轨迹参数:加速时间T1、匀速时间T2、减速时间T3、可达最大角速度wm、可达最大角加速度αm、速度轨迹类型Pθtj,Pθtj只能为2或者3,分别表示速度轨迹是2段式轨迹或3段式轨迹。对于空间姿态,上述的参数确定了以后,即决定了一个姿态的梯形曲线轨迹。
步骤4、计算位置和姿态的总运行时间。位置行程的总时间:t=t1+t2+t3,姿态行程的总时间:T=T1+T2+T3,取出t和T的较大值,记为Tmax。
步骤5、对位置和姿态的梯形轨迹参数进行时间同步处理,输入为位置和姿态的短时梯形轨迹参数:加速时间t1,T1、匀速时间t2,T2、减速时间t3,T3、可达最大速度vm,wm、可达最大加速度am,αm和速度轨迹类型Ptj,Pθtj;输出为所有位置和姿态的长时梯形轨迹参数,即修正后的参数值:修正加速时间t1′,T1′、修正匀速时间t2′,T2′、修正减速时间t3′,T3′、修正可达最大速度vm′,wm′、修正可达最大加速度am′,αm′和速度轨迹类型Ptj′,Pθtj′。
时间同步处理具体如下:
对于输入的位置轨迹参数;
如果是轨迹类型是2段式轨迹,那么,
修正后的匀速时间t2′=0;
修正后的减速时间t3′=t1′;
修正后的速度轨迹类型P′tj=Ptj。
如果轨迹类型是3段式轨迹,那么,
修正后的减速时间t3′=t1′;
修正后的可达最大加速度am′=am;
修正后的速度轨迹类型P′tj=Ptj。
对于输入的姿态轨迹参数,
如果轨迹类型是2段式轨迹,那么,
修正后的匀速时间T2′=0;
修正后的减速时间T3′=T1′;
修正后的速度轨迹类型Pθtj′=Pθtj。
如果轨迹类型是3段式轨迹,那么
修正后的减速时间T3′=T1′;
修正后的可达最大角加速度αm′=αm;
修正后的速度轨迹类型Pθtj′=Pθtj°
上述同步处理过程中,对于调整的位置轨迹参数或者姿态轨迹而言,相当于使用了时间延长算法进行了处理,其原理如图6所示。
步骤6、对位置和姿态进行插补,并将修成后的位置和姿态轨迹参数下发到逆解模块中,即完成了位置和姿态的时间同步。
本发明的方法可用于任意的多关节机械臂中,主要针对机械臂作单一的直线路径运动的情况,本发明首先使用梯形轨迹规划方法处理得到位置轨迹参数,使用“角-轴”法和梯形轨迹规划方法结合得到姿态轨迹参数,然后基于位置轨迹参数和位置轨迹参数确定最大运行时间,最后依据该最大运行时间调整位置轨迹参数和姿态轨迹参数,实现位置和姿态的同步处理。
以上所述,仅是本发明实施例而已,并非对本发明的技术范围作任何限制,故凡是依据本发明的技术实质对以上实施例所作的任何细微修改、等同变化与修饰,均仍属于本发明技术方案的范围内。
Claims (2)
1.一种机械臂末端运动位姿时间同步方法,其特征在于:所述方法基于梯形轨迹规划方法进行,设定位置和姿态的轨迹参数,包括位置的极限线速度ΨP,极限线加速度ΩP,姿态的极限角速度ΨR,极限角加速度ΩR;同时设定加速时间和减速时间相同;
具体包括以下步骤:
步骤2、进行位置轨迹规划:
根据初始位置P0、终点位置P1、极限线速度ΨP和极限线加速度Ωp,利用梯形轨迹规划方法求出位置轨迹参数:加速时间t1、匀速时间t2、减速时间t3、可达最大速度vm、可达最大加速度am、速度轨迹类型Ptj,Ptj为2或者3,分别表示速度轨迹是2段式轨迹或3段式轨迹;
步骤3、进行姿态轨迹规划:
根据初始姿态R0、终点姿态R1、极限角速度ΨR和极限角加速度ΩR,利用“角-轴”法求角度:
再通过经典梯形轨迹规划方法求出旋转角度的轨迹参数:加速时间T1、匀速时间T2、减速时间T3、可达最大角速度wm、可达最大角加速度αm、速度轨迹类型Pθtj,Pθtj只能为2或者3,分别表示速度轨迹是2段式轨迹或3段式轨迹;
步骤4、计算位置和姿态的总运行时间:
位置行程的总时间:t=t1+t2+t3,姿态行程的总时间:T=T1+T2+T3,取出t和T的较大值,记为Tmax;
步骤5、利用时间延长算法对位置和姿态的梯形轨迹参数进行时间同步处理:输入为位置和姿态的短时梯形轨迹参数:加速时间t1,T1、匀速时间t2,T2、减速时间t3,T3、可达最大速度vm,wm、可达最大加速度am,αm和速度轨迹类型Ptj,Pθtj;输出为所有位置和姿态的长时梯形轨迹参数,即修正后的参数值:修正加速时间t1′,T1′、修正匀速时间t2′,T2′、修正减速时间t3′,T3′、修正可达最大速度vm′,wm′、修正可达最大加速度am′,αm′和速度轨迹类型Ptj′,Pθtj′;
步骤6、对位置和姿态进行插补,并将修成后的位置和姿态轨迹参数下发到逆解模块中,即完成了位置和姿态的时间同步。
2.根据权利要求1所述的一种机械臂末端运动位姿时间同步方法,其特征在于:所述时间同步处理具体如下:
对于输入的位置轨迹参数;
如果是轨迹类型是2段式轨迹,那么,
修正后的匀速时间t2′=0;
修正后的减速时间t3′=t1′;
修正后的速度轨迹类型P′tj=Ptj;
如果轨迹类型是3段式轨迹,那么,
修正后的减速时间t3′=t1′;
修正后的可达最大加速度am′=am;
修正后的速度轨迹类型P′tj=Ptj;
对于输入的姿态轨迹参数,
如果轨迹类型是2段式轨迹,那么,
修正后的匀速时间T2′=0;
修正后的减速时间T3′=T1′;
修正后的速度轨迹类型Pθkj′=Pθtj;
如果轨迹类型是3段式轨迹,那么
修正后的减速时间T3′=T1′;
修正后的可达最大角加速度αm′=αm;
修正后的速度轨迹类型Pθkj′=Pθtj。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111410006.2A CN113942016B (zh) | 2021-11-24 | 2021-11-24 | 一种机械臂末端运动位姿时间同步方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111410006.2A CN113942016B (zh) | 2021-11-24 | 2021-11-24 | 一种机械臂末端运动位姿时间同步方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113942016A CN113942016A (zh) | 2022-01-18 |
CN113942016B true CN113942016B (zh) | 2023-02-14 |
Family
ID=79338707
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111410006.2A Active CN113942016B (zh) | 2021-11-24 | 2021-11-24 | 一种机械臂末端运动位姿时间同步方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113942016B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106695787A (zh) * | 2016-12-17 | 2017-05-24 | 上海新时达电气股份有限公司 | 一种速度规划方法 |
US9981381B1 (en) * | 2016-06-08 | 2018-05-29 | X Development Llc | Real time generation of phase synchronized trajectories |
CN108189038A (zh) * | 2018-01-18 | 2018-06-22 | 广东工业大学 | 一种实用的工业六轴机械臂直线运动轨迹规划方法及系统 |
CN108549322A (zh) * | 2018-04-11 | 2018-09-18 | 广州启帆工业机器人有限公司 | 一种针对机器人圆弧轨迹运动的位姿同步方法和装置 |
CN109773780A (zh) * | 2018-12-11 | 2019-05-21 | 上海新时达机器人有限公司 | 机械臂的过渡路径的位姿同步方法及装置 |
CN110900612A (zh) * | 2019-12-17 | 2020-03-24 | 东莞市三姆森光电科技有限公司 | 一种位姿同步的六轴工业机器人轨迹平顺方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4382003B2 (ja) * | 2005-03-23 | 2009-12-09 | 川崎重工業株式会社 | ロボット制御装置およびロボット制御方法 |
-
2021
- 2021-11-24 CN CN202111410006.2A patent/CN113942016B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9981381B1 (en) * | 2016-06-08 | 2018-05-29 | X Development Llc | Real time generation of phase synchronized trajectories |
CN106695787A (zh) * | 2016-12-17 | 2017-05-24 | 上海新时达电气股份有限公司 | 一种速度规划方法 |
CN108189038A (zh) * | 2018-01-18 | 2018-06-22 | 广东工业大学 | 一种实用的工业六轴机械臂直线运动轨迹规划方法及系统 |
CN108549322A (zh) * | 2018-04-11 | 2018-09-18 | 广州启帆工业机器人有限公司 | 一种针对机器人圆弧轨迹运动的位姿同步方法和装置 |
CN109773780A (zh) * | 2018-12-11 | 2019-05-21 | 上海新时达机器人有限公司 | 机械臂的过渡路径的位姿同步方法及装置 |
CN110900612A (zh) * | 2019-12-17 | 2020-03-24 | 东莞市三姆森光电科技有限公司 | 一种位姿同步的六轴工业机器人轨迹平顺方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113942016A (zh) | 2022-01-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106647282B (zh) | 一种考虑末端运动误差的六自由度机器人轨迹规划方法 | |
CN107756400B (zh) | 一种基于旋量理论的6r机器人逆运动学几何求解方法 | |
CN101402199B (zh) | 基于视觉的手眼式低伺服精度机器人抓取移动目标的方法 | |
CN110605721A (zh) | 一种基于末端六维力传感器的机械臂拖动示教方法 | |
CN113601512B (zh) | 一种机械臂奇异点的通用规避方法与系统 | |
CN106625671A (zh) | 一种空间机器人抓捕翻滚目标的最优轨迹规划方法 | |
CN110977990A (zh) | 一种基于末端六维力传感器的机械臂拖动示教方法 | |
CN109623825B (zh) | 一种移动轨迹规划方法、装置、设备和存储介质 | |
CN104647379A (zh) | 一种驱动器非线性条件下的双臂机器人运动控制方法 | |
CN109623812B (zh) | 考虑航天器本体姿态运动的机械臂轨迹规划方法 | |
CN115502966B (zh) | 用于机器人的可变导纳控制方法 | |
JP2013059815A (ja) | ロボットの位置姿勢補間方法及びロボットの制御装置 | |
CN113942016B (zh) | 一种机械臂末端运动位姿时间同步方法 | |
CN109311155A (zh) | 一种工业机器人的工具坐标系原点的标定方法及装置 | |
CN109648563B (zh) | 串联机器人运动控制方法及计算机存储介质 | |
CN106020125B (zh) | 一种基于速度连续的工业机器人运动学算法 | |
CN114378830B (zh) | 一种机器人腕关节奇异规避方法及系统 | |
CN116276990A (zh) | 基于神经网络训练的两自由度并联结构运动学正解方法 | |
JP2020171989A (ja) | ロボット教示システム | |
CN109773778A (zh) | 一种工业机器人关节空间同步运动的规划方法 | |
CN109946970B (zh) | 一种基于观测器的非完整机器人速度信息的获取方法 | |
JPH0693209B2 (ja) | ロボツトの円弧補間姿勢制御装置 | |
CN108762528B (zh) | 适用于空中飞鼠的姿态解算方法 | |
CN113119110A (zh) | 一种机器人的智能动作和目标的动态位姿实时融合的方法 | |
JPH1124718A (ja) | ロボットの制御装置及び制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |