CN112720481A - 一种基于急突度的机械臂最小运动规划和控制方法 - Google Patents
一种基于急突度的机械臂最小运动规划和控制方法 Download PDFInfo
- Publication number
- CN112720481A CN112720481A CN202011534828.7A CN202011534828A CN112720481A CN 112720481 A CN112720481 A CN 112720481A CN 202011534828 A CN202011534828 A CN 202011534828A CN 112720481 A CN112720481 A CN 112720481A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- minimum motion
- degree
- jerk
- planning
- 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
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
-
- 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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1607—Calculation of inertia, jacobian matrixes and inverses
-
- 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/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
- B25J9/1625—Truss-manipulator for snake-like motion
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种基于急突度的机械臂最小运动规划和控制方法,包括以下步骤:设定机械臂最小运动规划的轨迹以及物理限制;根据所设定的轨迹以及物理限制,将机械臂的最小运动规划和控制问题转化为急突度层二次规划问题;对急突度层二次规划问题进行求解,机械臂根据求解结果进行最小运动。本发明将基于急突度的机械臂最小运动规划和控制问题转化为急突度层二次规划问题进行求解,实现控制机械臂在急突度层进行运动,并且考虑到了急突度限制,避免机械臂运动过程中超出急突度限制产生物理损坏。
Description
技术领域
本发明涉及冗余度机械臂运动规划及控制领域,更具体地,涉及一种基于急突度的机械臂最小运动规划和控制方法。
背景技术
冗余度机械臂是一种自由度大于任务空间所需最少自由度的末端能动机械装置,其运动任务包括焊接、油漆、组装、挖掘和绘图等,被广泛应用于装备制造、产品加工、机器作业等国民经济生产活动中。当冗余度机械臂各关节做最小变化运动时,称为最小运动。机械臂最小运动规划和控制方法,目的在于促使冗余度机械臂各关节做最小变化运动,并且令机械臂末端沿着预定或规划好的轨迹执行跟踪曲线任务。
以往的机械臂最小运动规划和控制方法均在速度层、加速度层或突加度层上进行,得到的结果均不为急突度(突加度的导数,snap),无法满足某些采用急突度控制的冗余度机械臂的要求,且其余层上的求解方法均未考虑到急突度限制,机械臂在运动过程中可能因超越急突度限制而产生物理损坏。
在现有技术中,公开号为CN104760041A的中国发明专利,于2015年07月08日公开了一种基于突加度的障碍物躲避运动规划方法,包括:设计基于突加度的障碍物躲避运动性能指标,所设计的运动性能指标受约束于基于突加度的雅可比矩阵等式、基于突加度的障碍物躲避不等式、关节角度极限、关节速度极限、关节加速度极限和关节突加度极限,生成二次型优化冗余度解析方案;将所生成的二次型优化冗余度解析方案转化为二次规划问题;运用二次规划求解器求解所转化的二次规划问题;将所得到的求解结果传递至下位机控制器以驱动机械臂运动。该方法同样仅在突加度层上进行,无法满足采用急突度控制冗余度机械臂的要求,且并未考虑到急突度限制,因此,急需一种基于急突度的机械臂最小运动规划和控制方法。
发明内容
本发明为解决现有技术中无法满足采用急突度控制冗余度机械臂的要求,以及并未考虑到急突度限制的问题,提供一种基于急突度的机械臂最小运动规划和控制方法。
本发明的首要目的是为解决上述技术问题,本发明的技术方案如下:
一种基于急突度的机械臂最小运动规划和控制方法,包括以下步骤:S1:设定机械臂最小运动规划的轨迹以及物理限制;S2:根据所设定的的轨迹以及物理限制,将机械臂的最小运动规划和控制问题转化为急突度层二次规划问题;S3:对急突度层二次规划问题进行求解,机械臂根据求解结果进行最小运动。
上述方案中,将基于急突度的机械臂最小运动规划和控制问题转化为急突度层二次规划问题进行求解,实现控制机械臂在急突度层进行运动。
优选地,所述步骤S1中设定的机械臂最小运动规划的轨迹为:
rd(t)
其中,rd(t)为(多关节)机械臂在t时刻末端执行器的期望(desire)坐标。
优选地,所述步骤S1中设定的物理限制为:
θ-≤θ(t)≤θ+
其中,θ(t)为机械臂各关节在t时刻的角度向量,θ+为角度向量上限,θ-为角度向量下限,为t时刻的角速度向量,为角速度向量上限,为角速度向量下限,为t时刻的角加速度向量,为角加速度向量上限,为角加速度下限,为t时刻的角突加度向量,为角突加度上限,为角突加度下限,为t时刻的角急突度向量,为角急突度上限,为角急突度下限。
上述方案中,可见,物理限制包括关节角度限制、关节速度限制、关节加速度限制、关节突加度限制和关节急突度限制。
优选地,所述步骤S2具体为:
S201:将轨迹以及物理限制转化到急突度层,得到急突度层约束,并通过在急突度层设定机械臂末端执行器回到初始点完成最小运动,得到最小化目标
S202:将急突度层约束和最小化目标组成急突度层二次规划问题。
优选地,所述步骤S201中获取的急突度层约束为:
其中,J为末端执行器的雅可比矩阵,
优选地,所述步骤S201中获取的最小化目标为:
优选地,所述步骤S3具体为:
S301:对急突度层二次规划问题进行求解;
S302:将求解结果转化为机械臂动力源的驱动信号;
S303:机械臂动力源接收到驱动信号后,驱动机械臂进行最小运动。
优选地,在所述步骤S301中,采用二次规划求解器对急突度层二次规划问题进行求解。
优选地,在所述步骤S302中,采用控制器将求解结果转化为机械臂动力源的驱动信号。
上述方案中,将求解结果输入至控制器中进行处理,在控制器中转化为机械臂动力源(如电机)的驱动信号,控制机械臂进行最小运动。
优选地,在所述步骤S303中,当机械臂所进行的最小运动结束后,获取机械臂末端的运动轨迹。
上述方案中,机械臂末端停止运动后,表示机械臂最小运动结束,此时检查其末端的运动轨迹是否与所设定的轨迹一致,并判断机械臂各关节的运动是否超出所设定的物理限制。
与现有技术相比,本发明技术方案的有益效果是:
本发明将基于急突度的机械臂最小运动规划和控制问题转化为急突度层二次规划问题进行求解,实现控制机械臂在急突度层进行运动,并且考虑到了急突度限制,避免机械臂运动过程中超出急突度限制产生物理损坏。
附图说明
图1为本发明流程示意图;
图2为实施例1机械臂模型图;
图3为实施例1机械臂末端轨迹示意图;
图4为实施例1机械臂各关节角度的轨迹图;
图5为实施例1机械臂各关节角速度的轨迹图;
图6为实施例1机械臂各关节角加速度的轨迹图;
图7为实施例1机械臂各关节角突加度的轨迹图;
图8为实施例1机械臂各关节角急突度的轨迹图。
具体实施方式
为了能够更清楚地理解本发明的上述目的、特征和优点,下面结合附图和具体实施方式对本发明进行进一步的详细描述。需要说明的是,在不冲突的情况下,本申请的实施例及实施例中的特征可以相互组合。
在下面的描述中阐述了很多具体细节以便于充分理解本发明,但是,本发明还可以采用其他不同于在此描述的其他方式来实施,因此,本发明的保护范围并不受下面公开的具体实施例的限制。
实施例1
如图1所示,一种基于急突度的机械臂最小运动规划和控制方法,包括以下步骤:S1:设定机械臂最小运动规划的轨迹以及物理限制;S2:根据所设定的轨迹以及物理限制,将机械臂的最小运动规划和控制问题转化为急突度层二次规划问题;S3:对急突度层二次规划问题进行求解,机械臂根据求解结果进行最小运动。
如图2所示,在本实施例中,进行最小运动的机械臂为一个六自由度的机械臂。该机械臂设置有六个连杆,通过关节1、关节2、关节3、关节4、关节5和关节6连接组成。
在本实施例中,期望控制和规划的机械臂轨迹为:
在本实施中:
机械臂初始位置角度设置为[π/8,π/8,π/8,π/8,π/8,π/8]T弧度;
角度上下限分别设置为[π/6,π/6,π/6,π/6,π/6,π/6]T弧度和[-π/6,-π/6,-π/6,-π/6,-π/6,-π/6]T弧度;
角速度上下限分别设置为[0.5,0.5,0.5,0.5,0.5,0.5]T弧度/秒和[-0.5,-0.5,-0.5,-0.5,-0.5,-0.5]T弧度/秒;
角加速度上下限分别设置为[0.3,0.3,0.3,0.3,0.3,0.3]T弧度/秒2和[-0.3,-0.3,-0.3,-0.3,-0.3,-0.3]T弧度/秒2;
角突加度上下限分别设置为[0.1,0.1,0.1,0.1,0.1,0.1]T弧度/秒3和[-0.1,-0.1,-0.1,-0.1,-0.1,-0.1]T弧度/秒3;
角急突度上下限分别设置为[0.1,0.1,0.1,0.1,0.1,0.1]T弧度/秒4和[-0.1,-0.1,-0.1,-0.1,-0.1,-0.1]T弧度/秒4。
根据本发明流程进行操作,最终将二次规划求解的结果传输至控制器,以控制机械臂进行最小运动。
如图3所示,机械臂成功完成了运动任务,其末端的运动轨迹形成了规划好的圆形。
此外,如图4至图8所示,机械臂各关节角度、角速度、角加速度、角突加度和角急突度均未超出所设定的物理限制。
相同或相似的标号对应相同或相似的部件;
附图中描述位置关系的用语仅用于示例性说明,不能理解为对本专利的限制;
显然,本发明的上述实施例仅仅是为清楚地说明本发明所作的举例,而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明权利要求的保护范围之内。
Claims (10)
1.一种基于急突度的机械臂最小运动规划和控制方法,其特征在于,包括以下步骤:
S1:设定机械臂最小运动规划的轨迹以及物理限制;
S2:根据所设定的轨迹以及物理限制,将机械臂的最小运动规划和控制问题转化为急突度层二次规划问题;
S3:对急突度层二次规划问题进行求解,机械臂根据求解结果进行最小运动。
2.根据权利要求1所述的一种基于急突度的机械臂最小运动规划和控制方法,其特征在于,所述步骤S1中设定的机械臂最小运动规划的轨迹为:
rd(t)
其中,rd(t)为机械臂在t时刻末端执行器的期望坐标。
4.根据权利要求1所述的一种基于急突度的机械臂最小运动规划和控制方法,其特征在于,所述步骤S2具体为:
S201:将轨迹以及物理限制转化到急突度层,得到急突度层约束,并通过在急突度层设定机械臂末端执行器回到初始点完成最小运动,得到最小化目标;
S202:将急突度层约束和最小化目标组成急突度层二次规划问题。
7.根据权利要求1所述的一种基于急突度的机械臂最小运动规划和控制方法,其特征在于,所述步骤S3具体为:
S301:对急突度层二次规划问题进行求解;
S302:将求解结果转化为机械臂动力源的驱动信号;
S303:机械臂动力源接收到驱动信号后,驱动机械臂进行最小运动。
8.根据权利要求7所述的一种基于急突度的机械臂最小运动规划和控制方法,其特征在于,在所述步骤S301中,采用二次规划求解器对急突度层二次规划问题进行求解。
9.根据权利要求7所述的一种基于急突度的机械臂最小运动规划和控制方法,其特征在于,在所述步骤S302中,采用控制器将求解结果转化为机械臂动力源的驱动信号。
10.根据权利要求7所述的一种基于急突度的机械臂最小运动规划和控制方法,其特征在于,在所述步骤S303中,当机械臂所进行的最小运动结束后,获取机械臂末端的运动轨迹。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011534828.7A CN112720481A (zh) | 2020-12-22 | 2020-12-22 | 一种基于急突度的机械臂最小运动规划和控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011534828.7A CN112720481A (zh) | 2020-12-22 | 2020-12-22 | 一种基于急突度的机械臂最小运动规划和控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112720481A true CN112720481A (zh) | 2021-04-30 |
Family
ID=75604308
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011534828.7A Pending CN112720481A (zh) | 2020-12-22 | 2020-12-22 | 一种基于急突度的机械臂最小运动规划和控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112720481A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114227686A (zh) * | 2021-12-28 | 2022-03-25 | 深圳市优必选科技股份有限公司 | 一种机器人避障控制方法、装置、终端设备及存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2010136586A1 (de) * | 2009-05-29 | 2010-12-02 | Technische Universität Ilmenau | Verfahren und vorrichtung zur echtzeitfähigen bahnplanung vierter ordnung zur generierung kontinuierlicher, rucksprungfreier sollwerttrajektorien |
CN104760041A (zh) * | 2015-03-19 | 2015-07-08 | 中山大学 | 一种基于突加度的障碍物躲避运动规划方法 |
CN105538327A (zh) * | 2016-03-03 | 2016-05-04 | 吉首大学 | 一种基于突加度的冗余度机械臂重复运动规划方法 |
CN106926238A (zh) * | 2017-02-16 | 2017-07-07 | 香港理工大学深圳研究院 | 基于突加度的多冗余度机械臂系统的协同控制方法与装置 |
CN108326844A (zh) * | 2017-01-20 | 2018-07-27 | 香港理工大学深圳研究院 | 冗余度机械臂的可操作度优化的运动规划方法和装置 |
CN111906789A (zh) * | 2020-09-02 | 2020-11-10 | 上海电机学院 | 一种机器人关节空间轨迹规划方法 |
-
2020
- 2020-12-22 CN CN202011534828.7A patent/CN112720481A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2010136586A1 (de) * | 2009-05-29 | 2010-12-02 | Technische Universität Ilmenau | Verfahren und vorrichtung zur echtzeitfähigen bahnplanung vierter ordnung zur generierung kontinuierlicher, rucksprungfreier sollwerttrajektorien |
CN104760041A (zh) * | 2015-03-19 | 2015-07-08 | 中山大学 | 一种基于突加度的障碍物躲避运动规划方法 |
CN105538327A (zh) * | 2016-03-03 | 2016-05-04 | 吉首大学 | 一种基于突加度的冗余度机械臂重复运动规划方法 |
CN108326844A (zh) * | 2017-01-20 | 2018-07-27 | 香港理工大学深圳研究院 | 冗余度机械臂的可操作度优化的运动规划方法和装置 |
CN106926238A (zh) * | 2017-02-16 | 2017-07-07 | 香港理工大学深圳研究院 | 基于突加度的多冗余度机械臂系统的协同控制方法与装置 |
CN111906789A (zh) * | 2020-09-02 | 2020-11-10 | 上海电机学院 | 一种机器人关节空间轨迹规划方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114227686A (zh) * | 2021-12-28 | 2022-03-25 | 深圳市优必选科技股份有限公司 | 一种机器人避障控制方法、装置、终端设备及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110561440B (zh) | 一种冗余度机械臂加速度层多目标规划方法 | |
CN111923039B (zh) | 一种基于强化学习的冗余机械臂路径规划方法 | |
CN108068113B (zh) | 7-dof仿人臂飞行物体作业最小加速度轨迹优化 | |
CN108908347B (zh) | 一种面向冗余移动机械臂容错型重复运动规划方法 | |
CN108772835B (zh) | 一种障碍物与物理极限躲避方法 | |
CN109623827B (zh) | 一种高性能冗余度机械臂重复运动规划方法与装置 | |
CN110561441B (zh) | 一种冗余度机械臂位姿控制的单94lvi迭代算法 | |
Muscio et al. | Experiments on coordinated motion of aerial robotic manipulators | |
CN109129486A (zh) | 一种抑制周期噪声的冗余度机械臂重复运动规划方法 | |
Walker et al. | Robot-human handovers based on trust | |
Mu et al. | A hybrid obstacle-avoidance method of spatial hyper-redundant manipulators for servicing in confined space | |
CN108098777A (zh) | 一种冗余度机械臂力矩层重复运动控制方法 | |
Lim et al. | On a control scheme for two cooperating robot arms | |
CN112720481A (zh) | 一种基于急突度的机械臂最小运动规划和控制方法 | |
CN113878578B (zh) | 适用于复合型机器人的动态自适应定位方法和系统 | |
Su et al. | Pythagorean-Hodograph curves-based trajectory planning for pick-and-place operation of Delta robot with prescribed pick and place heights | |
Mashali et al. | Controlling a non-holonomic mobile manipulator in a constrained floor space | |
CN110434854B (zh) | 一种基于数据驱动的冗余度机械臂视觉伺服控制方法与装置 | |
CN110026986B (zh) | 多臂协同作业柔顺控制方法 | |
CN116237938A (zh) | 一种基于冗余自由度利用的旋翼飞行机械臂协调运动规划方法 | |
Li et al. | Model and control of hybrid hard-soft robots using model predictive control | |
CN114851184B (zh) | 一种面向工业机器人的强化学习奖励值计算方法 | |
JP2023075884A (ja) | 動的動作計画システム | |
Li et al. | Fault-tolerant motion planning of redundant manipulator with initial position error | |
CN113084797B (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210430 |
|
RJ01 | Rejection of invention patent application after publication |