CN115008468A - 一种机械臂姿态速度规划控制方法 - Google Patents
一种机械臂姿态速度规划控制方法 Download PDFInfo
- Publication number
- CN115008468A CN115008468A CN202210785947.2A CN202210785947A CN115008468A CN 115008468 A CN115008468 A CN 115008468A CN 202210785947 A CN202210785947 A CN 202210785947A CN 115008468 A CN115008468 A CN 115008468A
- Authority
- CN
- China
- Prior art keywords
- rotation
- coordinate system
- mechanical arm
- angle
- tail end
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 13
- 239000011159 matrix material Substances 0.000 claims abstract description 24
- 230000009466 transformation Effects 0.000 claims abstract description 16
- 238000013016 damping Methods 0.000 claims abstract description 5
- 230000008859 change Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
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
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种机械臂姿态速度规划控制方法,属于轨迹规划领域。本发明包括:步骤一,获取机械臂末端连杆坐标系当前姿态与目标姿态之间的旋转变换矩阵,并将其表示成欧拉角形式。步骤二,将欧拉角的各个角度乘以阻尼系数,得到机械臂末端连杆坐标系下期望旋转速度,然后通过机器人正向运动学矩阵,将其转换到机械臂基坐标系下。步骤三,按按照欧拉角的旋转次序依次对绕基坐标系各个轴的旋转进行速度控制,三个控制周期后重复上述两个步骤,直到机械臂末端到达目标姿态。
Description
技术领域
本发明涉及轨迹规划领域,具体地说是一种机械臂姿态速度规划控制方法。
背景技术
在控制机械臂运动时,一般需要首先对从起始点到终止点之间的路径进行规划,以实现避障,同时使机械臂运动轨迹更加平滑,进而确保安全性和顺滑性。轨迹具体的方法有多项式插值的轨迹规划,贝塞尔曲线轨迹规划,基于B样条插值的轨迹规划等。在对姿态规划的时候,首先需要使用四元数等适合姿态插值的方式进行表示,再使用轨迹规划方法进行规划出各个路径点的角度,角速度等值。
发明内容
本发明解决的是在控制机械臂姿态调整时,必须先进行姿态规划的问题。通过使用欧拉角表示期望旋转,并在阻尼系数的作用下,得到机械臂末端连杆坐标系下旋转的速度表示。最后将其转换到机械臂基坐标系下,然后按照欧拉角旋转次序分别对绕各个坐标系的旋转速度进行控制,实现不需要提前规划就可以实现姿态平滑变化的效果。
本发明采用的技术方案是:
一种机械臂姿态速度规划控制方法,包括以下步骤。
步骤1:获取机械臂末端连杆坐标系当前姿态与目标姿态之间的旋转变换矩阵,并将其表示成欧拉角形式;
步骤2:将欧拉角的各个角度分别乘以阻尼系数,得到机械臂末端连杆坐标系下的期望旋转速度;然后通过机器人正向运动学矩阵,将其转换到机械臂基坐标系下,得到机械臂基坐标系下的基坐标下末端连杆坐标系的期望速度。
步骤3:按照欧拉角的旋转次序依次对绕基坐标系各个轴的旋转进行速度控制,三个控制周期后重复上述两个步骤,直到机械臂末端到达目标姿态。
所述将旋转矩阵转换成内旋形式表达的欧拉角包括:
定义旋转次序:β、γ、α;
计算旋转矩阵到内旋形式欧拉角的变换公式如下:
所述基坐标下末端连杆坐标系的期望速度为:[wx,wy,wz],用于利用雅可比矩阵,通过机械臂微分运动学对机械臂进行速度控制。
所述按照欧拉角的旋转次序,一个周期内只对期望旋转速度中的一个分量进行控制;且因为仅对姿态进行控制,因此单一周期的速度分量有如下三种情况:
其中,v中前3个分量为线速度,后3个分量为角速度,分别对应当前周期的期望旋转速度。
本发明具有的有益效果和有点:
在姿态规划控制时,不需要经过姿态规划,就可以直接根据实时计算的欧拉角进行控制,可以实现姿态平滑变化的效果。
附图说明
图1为姿态速度规划控制流程图。
具体实施方式
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图对本发明的具体实施方法做详细的说明。在下面的描述中阐述了很多具体细节以便于充分理解本发明。但本发明能够以很多不同于在此描述的其他方式来实施,本领域技术人员可以在不违背发明内涵的情况下做类似改进,因此本发明不受下面公开的具体实施的限制。
除非另有定义,本文所使用的所有技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在发明的说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本发明。
本发明是一种机械臂姿态速度规划控制方法,其具体实施步骤如下:
步骤1:
首先,得到目标姿态在机械臂末端连杆坐标系中的旋转变换矩阵形式表示,旋转变换矩阵为控制器根据目标姿态和机械臂末端当前姿态自动进行坐标系变换计算得到。
然后,将旋转变换矩阵转换成内旋形式表达的欧拉角。在旋转时首先绕着z轴旋转β角度,然后绕着旋转后坐标系的y轴旋转γ角度,最后绕着旋转后坐标系的x轴旋转α角度。得到的旋转矩阵到内旋形式欧拉角的变换公式如下所示。
步骤2:
首先,将欧拉角中每个分量分别乘以阻尼系数,得到末端连杆坐标系下三个方向的旋转速度;
然后,利用机械臂正向运动学矩阵,将其转换到机械臂基坐标系下,即得到了基坐标下末端连杆坐标系的三个方向的期望速度;
进而可以利用雅可比矩阵,通过机械臂微分运动学对机械臂进行速度控制。步骤3:
首先,按照欧拉角的旋转次序依次对绕基坐标系各个轴的旋转进行速度控制,即对期望速度进行控制操作,每周期只对期望旋转速度中的一个分量进行控制。
且因为仅对姿态进行控制,因此某一周期的速度分量可能有如下三种情况。
其中,v中前3个分量为线速度,后3个分量为角速度,分别对应当前周期的期望旋转速度。
然后,三个控制周期后重复上述两个步骤,直到机械臂末端到达目标姿态。
以上所述的具体实施例,对本发明的目的、技术方案和有益效果进行了进一步详细说明,应理解的是,以上所述仅为本发明的具体实施例而已,并不用于限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换等,均应包含在本发明的保护范围之内。
Claims (4)
1.一种机械臂姿态速度规划控制方法,其特征如下,包括以下步骤。
步骤1:获取机械臂末端连杆坐标系当前姿态与目标姿态之间的旋转变换矩阵,并将其表示成欧拉角形式;
步骤2:将欧拉角的各个角度分别乘以阻尼系数,得到机械臂末端连杆坐标系下的期望旋转速度;然后通过机器人正向运动学矩阵,将其转换到机械臂基坐标系下,得到机械臂基坐标系下的基坐标下末端连杆坐标系的期望速度。
步骤3:按照欧拉角的旋转次序依次对绕基坐标系各个轴的旋转进行速度控制,三个控制周期后重复上述两个步骤,直到机械臂末端到达目标姿态。
3.根据权力要求书1所述的一种机械臂姿态速度规划控制方法,其特征在于,所述基坐标下末端连杆坐标系的期望速度为:[wx,wy,wz],用于利用雅可比矩阵,通过机械臂微分运动学对机械臂进行速度控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210785947.2A CN115008468A (zh) | 2022-07-04 | 2022-07-04 | 一种机械臂姿态速度规划控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210785947.2A CN115008468A (zh) | 2022-07-04 | 2022-07-04 | 一种机械臂姿态速度规划控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115008468A true CN115008468A (zh) | 2022-09-06 |
Family
ID=83079811
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210785947.2A Pending CN115008468A (zh) | 2022-07-04 | 2022-07-04 | 一种机械臂姿态速度规划控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115008468A (zh) |
Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6267606A (ja) * | 1985-09-20 | 1987-03-27 | Hitachi Ltd | 産業用ロボツトの制御方法 |
JP2007319970A (ja) * | 2006-05-31 | 2007-12-13 | Daihen Corp | 産業用ロボットのツールの位置・姿勢制御方法及び制御システム |
CN106514636A (zh) * | 2016-12-16 | 2017-03-22 | 宁波帝洲自动化科技有限公司 | 一种机器人末端位姿分析方法 |
CN107696033A (zh) * | 2017-09-18 | 2018-02-16 | 北京控制工程研究所 | 一种基于视觉测量的空间机械臂轨迹滚动规划方法 |
CN108334114A (zh) * | 2017-12-29 | 2018-07-27 | 舒天艺 | 基于运动学正解的三自由度并联机构的姿态角控制方法 |
CN108748160A (zh) * | 2018-06-21 | 2018-11-06 | 河南大学 | 基于多种群粒子群算法的机械臂运动规划方法 |
CN109159151A (zh) * | 2018-10-23 | 2019-01-08 | 北京无线电测量研究所 | 一种机械臂空间轨迹跟踪动态补偿方法和*** |
WO2020093254A1 (zh) * | 2018-11-06 | 2020-05-14 | 深圳配天智能技术研究院有限公司 | 机器人的运动控制方法、控制***和存储装置 |
CN111656298A (zh) * | 2018-09-30 | 2020-09-11 | 深圳市大疆创新科技有限公司 | 云台的控制方法、云台、可移动平台及可读存储介质 |
KR102225348B1 (ko) * | 2019-10-30 | 2021-03-09 | 주식회사 뉴로메카 | 로봇 자세 정의를 위한 기준점 기반의 좌표계 특정 시스템 및 방법 |
CN112549017A (zh) * | 2020-10-27 | 2021-03-26 | 南京凌华微电子科技有限公司 | 避免关节极限的双臂机器人协作空间求解方法 |
CN112643656A (zh) * | 2020-11-17 | 2021-04-13 | 天启控制技术(深圳)有限公司 | 串联六关节机械手的姿态控制方法及*** |
WO2021217371A1 (zh) * | 2020-04-27 | 2021-11-04 | 深圳市大疆创新科技有限公司 | 可移动平台的控制方法和装置 |
CN114274147A (zh) * | 2022-02-10 | 2022-04-05 | 北京航空航天大学杭州创新研究院 | 目标跟踪控制方法及装置、机械臂控制设备和存储介质 |
CN114489094A (zh) * | 2020-10-27 | 2022-05-13 | 中国科学院沈阳自动化研究所 | 一种基于加速度反馈增强的旋翼无人机抗风扰控制方法 |
-
2022
- 2022-07-04 CN CN202210785947.2A patent/CN115008468A/zh active Pending
Patent Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6267606A (ja) * | 1985-09-20 | 1987-03-27 | Hitachi Ltd | 産業用ロボツトの制御方法 |
JP2007319970A (ja) * | 2006-05-31 | 2007-12-13 | Daihen Corp | 産業用ロボットのツールの位置・姿勢制御方法及び制御システム |
CN106514636A (zh) * | 2016-12-16 | 2017-03-22 | 宁波帝洲自动化科技有限公司 | 一种机器人末端位姿分析方法 |
CN107696033A (zh) * | 2017-09-18 | 2018-02-16 | 北京控制工程研究所 | 一种基于视觉测量的空间机械臂轨迹滚动规划方法 |
CN108334114A (zh) * | 2017-12-29 | 2018-07-27 | 舒天艺 | 基于运动学正解的三自由度并联机构的姿态角控制方法 |
CN108748160A (zh) * | 2018-06-21 | 2018-11-06 | 河南大学 | 基于多种群粒子群算法的机械臂运动规划方法 |
CN111656298A (zh) * | 2018-09-30 | 2020-09-11 | 深圳市大疆创新科技有限公司 | 云台的控制方法、云台、可移动平台及可读存储介质 |
CN109159151A (zh) * | 2018-10-23 | 2019-01-08 | 北京无线电测量研究所 | 一种机械臂空间轨迹跟踪动态补偿方法和*** |
WO2020093254A1 (zh) * | 2018-11-06 | 2020-05-14 | 深圳配天智能技术研究院有限公司 | 机器人的运动控制方法、控制***和存储装置 |
KR102225348B1 (ko) * | 2019-10-30 | 2021-03-09 | 주식회사 뉴로메카 | 로봇 자세 정의를 위한 기준점 기반의 좌표계 특정 시스템 및 방법 |
WO2021217371A1 (zh) * | 2020-04-27 | 2021-11-04 | 深圳市大疆创新科技有限公司 | 可移动平台的控制方法和装置 |
CN112549017A (zh) * | 2020-10-27 | 2021-03-26 | 南京凌华微电子科技有限公司 | 避免关节极限的双臂机器人协作空间求解方法 |
CN114489094A (zh) * | 2020-10-27 | 2022-05-13 | 中国科学院沈阳自动化研究所 | 一种基于加速度反馈增强的旋翼无人机抗风扰控制方法 |
CN112643656A (zh) * | 2020-11-17 | 2021-04-13 | 天启控制技术(深圳)有限公司 | 串联六关节机械手的姿态控制方法及*** |
CN114274147A (zh) * | 2022-02-10 | 2022-04-05 | 北京航空航天大学杭州创新研究院 | 目标跟踪控制方法及装置、机械臂控制设备和存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107363813B (zh) | 一种基于可穿戴设备的桌面工业机器人示教***和方法 | |
CN108068113B (zh) | 7-dof仿人臂飞行物体作业最小加速度轨迹优化 | |
US8600554B2 (en) | System and method for robot trajectory generation with continuous accelerations | |
CN112757306A (zh) | 一种机械臂逆解多解选择和时间最优轨迹规划算法 | |
CN111923039B (zh) | 一种基于强化学习的冗余机械臂路径规划方法 | |
CN113601512B (zh) | 一种机械臂奇异点的通用规避方法与*** | |
CN110605721A (zh) | 一种基于末端六维力传感器的机械臂拖动示教方法 | |
CN107263466B (zh) | 空间机器人基于二次规划问题的基座无扰控制方法 | |
CN113127989B (zh) | 一种六自由度机械臂逆运动学解析求解控制方法 | |
JP2013184245A (ja) | ロボット制御装置、ロボット装置、ロボット制御方法、プログラム及び記録媒体 | |
CN110977990A (zh) | 一种基于末端六维力传感器的机械臂拖动示教方法 | |
CN111890349A (zh) | 一种四自由度机械臂运动规划方法 | |
CN113084821A (zh) | 一种基于动力学的喷涂机器人时间最优轨迹规划方法 | |
CN114670191B (zh) | 一种七自由度肘偏置机械臂轨迹规划方法 | |
CN108189034A (zh) | 一种机器人连续轨迹实现方法 | |
CN116125906A (zh) | 一种数控加工的运动规划方法、装置、设备和存储介质 | |
CN110695994B (zh) | 一种面向双臂机械手协同重复运动的有限时间规划方法 | |
CN111168680A (zh) | 一种基于神经动力学方法的软体机器人控制方法 | |
CN112847373B (zh) | 一种机器人轨迹同步控制方法、计算机可读存储介质 | |
CN115008468A (zh) | 一种机械臂姿态速度规划控制方法 | |
CN113103240A (zh) | 用于实现c2连续的机器人轨迹规划方法、装置及*** | |
CN112356032A (zh) | 一种姿态平滑过渡方法及*** | |
CN111515954A (zh) | 一种机械臂高质量运动路径生成方法 | |
CN114670177B (zh) | 一种两转一移并联机器人姿态规划方法 | |
CN115808904A (zh) | 一种工业机器人圆弧过辅助点轨迹规划方法 |
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 |