CN114378833A - 一种基于鲁棒约束控制的机械臂轨迹规划方法 - Google Patents
一种基于鲁棒约束控制的机械臂轨迹规划方法 Download PDFInfo
- Publication number
- CN114378833A CN114378833A CN202210284910.1A CN202210284910A CN114378833A CN 114378833 A CN114378833 A CN 114378833A CN 202210284910 A CN202210284910 A CN 202210284910A CN 114378833 A CN114378833 A CN 114378833A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- constraint
- joint
- task
- control
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 33
- 230000001133 acceleration Effects 0.000 claims description 16
- 239000011159 matrix material Substances 0.000 claims description 16
- 238000013016 damping Methods 0.000 claims description 3
- 238000009795 derivation Methods 0.000 claims description 3
- 230000000737 periodic effect Effects 0.000 claims description 3
- 239000000463 material Substances 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005457 optimization Methods 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)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明提出了一种基于鲁棒约束控制的机械臂轨迹规划方法,包括:步骤S1,根据机械臂本体限制,对机械臂的相关约束进行建模;步骤S2,对机械臂的运行轨迹进行规划;步骤S3,对机械臂的参考估计进行调整;步骤S4,调节每个周期输入量以保证系统的鲁棒性。
Description
技术领域
本发明涉及机器人技术领域,特别涉及一种基于鲁棒约束控制的机械臂轨迹规划方法。
背景技术
随着经济社会的发展,机械臂在越来越多的场景中被应用。这使得机械臂面临的工作环境越来越复杂,同时也对机械臂的性能提出了更高的要求。良好的轨迹规划和控制策略是保证机械臂能够在复杂环境中,依然能够高质量完成任务的保障。
目前已有的机械臂轨迹规划方案有如下几类:
1.不考虑约束的运动规划。该方法中不考虑机械臂的性能和环境的约束,采用理想的数学模型输出运动指令,依赖机械臂本身性能保障任务的完成质量。使用该类方法的机械臂往往只能进行简单场景的任务。
2.离线调整运动规划。该类方法为了使得机械臂能够在新的场景中工作,需要实现不断调整机械臂的轨迹,调整机械臂的参数,进而安排机械臂进行任务。使用该类方法,往往需要在任务开始前,反复调整参数和轨迹,工作人员需要进行大量的调试和编程工作,大大降低了工作效率。
同时这些方案未将外部的干扰因素考虑进规划控制算法之中,当机械臂受到外部干扰时,难以自我调节,从而降低作业质量。
发明内容
本发明的目的旨在至少解决所述技术缺陷之一。
为此,本发明的目的在于提出一种基于鲁棒约束控制的机械臂轨迹规划方法。
为了实现上述目的,本发明的实施例提供一种基于鲁棒约束控制的机械臂轨迹规划方法,包括如下步骤:
步骤S1,根据机械臂本体限制,对机械臂的相关约束进行建模,其中,建模过程如下:
每个关节角度满足约束:
同时,由于电机转速和电机力矩限制,机械臂在运动过程中分别面临速度和力矩约束:
步骤S2,对机械臂的运行轨迹进行规划;
步骤S3,对机械臂的参考估计进行调整,其中,
调整后的参考轨迹为
步骤S4,调节每个周期输入量以保证系统的鲁棒性。
进一步,在所述步骤S2中,
将机械臂的任务采用一系列任务空间的目标点表示,将这些目标点平滑连接,构成机械臂的任务曲线。其中,X表示任务曲线上的任意一点,则机械臂的任务曲线和其关节角度的关系表示为:
其中,U表示系统的输入,上式表示将机械臂的角加速度作为系统的输入;
在机械臂运动过程中需要将任务离散化:
同时系统的控制量在面对任务时,需要满足如下的约束:
进一步,在所述步骤S2中,每一步规划过程如下表示:
S22:计算机械臂硬约束和运动学参数;
S23:依据约束求解下一步的期望状态;
S24:依据约束求解系统控制量U的可行范围;
S25:求解下述多约束下的最优解:
(1) 约束:
(2)优化目标:
S26:刷新输出量:
进一步,在所述步骤S3中,当受到外力干扰时,采用如下的导纳滤波器调整机械臂参考轨迹:
则调整后的参考轨迹为
进一步,在所述步骤S4中,
则在周期性控制中,有如下关系:
其中:
针对每一步,角度、角速度和角加速度需要满足如下关系
其中,i表示关节序号,m表示最大关节序号;
将满足上述约束的集合表示为:
由前述推导可知,每一步更新时满足:
同时将角加速度的约束表示为
则每一步的角度和角加速度控制量需要满足:
其中⊕表示求解闵可夫斯基和;
同时力矩需要满足:
根据本发明实施例的基于鲁棒约束控制的机械臂轨迹规划方法,提出基于鲁棒约束控制的机械臂轨迹规划方法、轨迹与力矩规划算子、鲁棒输入调节算子等技术点。本发明实现机械臂自动依据外界环境调整规划和控制输入量,省去的人工调整路径的繁琐;将约束分为机械臂硬约束和任务约束,将任务与指令直接联系起来。
本发明附加的方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1为根据本发明实施例的基于鲁棒约束控制的机械臂轨迹规划方法的流程图。
具体实施方式
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。
本发明提出一种基于鲁棒约束控制的机械臂轨迹规划方法,实现将约束优化和轨迹规划相结合的方法进行机械臂的运动规划。在该方法中,机械臂的运动跟踪于一条不断更新矫正的参考轨迹,同时结合了反应控制,不断调整整个控制系统的输入量,保证机械臂即使在面对复杂环境时也能高质量地作业。
如图1所示,本发明实施例的基于鲁棒约束控制的机械臂轨迹规划方法,包括如下步骤:
步骤S1,根据机械臂本体限制,对机械臂的相关约束进行建模。
具体的,依据机械臂本体限制,将相关约束建模如下:
首先,每个关节角度满足约束:
同时,由于电机转速和电机力矩限制,机械臂在运动过程中分别面临速度和力矩约束:
步骤S2,对机械臂的运行轨迹进行规划。
在本步骤中,机械臂的任务可以用一系列任务空间的目标点表示,将这些目标点平滑连接构成任务曲线。X表示任务曲线上的任意一点,则机械臂的任务曲线和其关节角度的关系可以表示为:
另外记
其中U表示系统的输入,上式表示将机械臂的角加速度作为系统的输入。
在机械臂运动过程中需要将任务离散化:
同时系统的控制量在面对任务时,需要满足如下的约束:
则每一步规划过程可以如下表示:
具体步骤如下:
S22:计算机械臂硬约束和运动学参数,包括:雅克比矩阵,任务向量;
S23:依据约束求解下一步的期望状态;
S24:依据约束求解系统控制量U的可行范围;
S25:求解下述多约束下的最优解:
(1)约束:
(2) 优化目标:
S26:刷新输出量。
步骤S3,对机械臂的参考估计进行调整。
在复杂环境中,机械臂运动时不可避免地受到外力干扰。由于外力干扰时,需要调整机械臂的运动指令,使得机械臂的运动保持平稳。
当受到外力干扰时,采用如下的导纳滤波器调整机械臂参考轨迹:
则调整后的参考轨迹为
步骤S4,调节每个周期输入量以保证系统的鲁棒性。
首先,记:
则在周期性控制中,有如下关系:
其中:
其中,针对每一步,角度、角速度和角加速度需要满足如下关系:
其中,i表示关节序号,m表示最大关节序号
将满足上述约束的集合表示为:
由前述推导可知,每一步更新时满足:
同时将角加速度的约束表示为
则每一步的角度和角加速度控制量需要满足:
其中⊕表示求解闵可夫斯基和。
另外,角加速度需满足:
同时力矩需要满足:
依据上述方法对每个控制周期的角度、角速度和角加加速,关节力矩进行调节保证系统鲁棒性。
根据本发明实施例的基于鲁棒约束控制的机械臂轨迹规划方法,提出基于鲁棒约束控制的机械臂轨迹规划方法、轨迹与力矩规划算子、鲁棒输入调节算子等技术点。本发明实现机械臂自动依据外界环境调整规划和控制输入量,省去的人工调整路径的繁琐;将约束分为机械臂硬约束和任务约束,将任务与指令直接联系起来。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、 “示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。本发明的范围由所附权利要求及其等同限定。
Claims (5)
1.一种基于鲁棒约束控制的机械臂轨迹规划方法,其特征在于,包括如下步骤:
步骤S1,根据机械臂本体限制,对机械臂的相关约束进行建模,其中,建模过程如下:
每个关节角度满足约束:
同时,由于电机转速和电机力矩限制,机械臂在运动过程中分别面临速度和力矩约束:
步骤S2,对机械臂的运行轨迹进行规划;
步骤S3,对机械臂的参考估计进行调整,其中,
调整后的参考轨迹为
步骤S4,调节每个周期输入量以保证系统的鲁棒性。
2.如权利要求1所述的基于鲁棒约束控制的机械臂轨迹规划方法,其特征在于,在所述步骤S2中,
将机械臂的任务采用一系列任务空间的目标点表示,将这些目标点平滑连接,构成机械臂的任务曲线;其中,X表示任务曲线上的任意一点,则机械臂的任务曲线和其关节角度的关系表示为:
其中,U表示系统的输入,上式表示将机械臂的角加速度作为系统的输入;
在机械臂运动过程中需要将任务离散化:
同时系统的控制量在面对任务时,需要满足如下的约束:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210284910.1A CN114378833B (zh) | 2022-03-23 | 2022-03-23 | 一种基于鲁棒约束控制的机械臂轨迹规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210284910.1A CN114378833B (zh) | 2022-03-23 | 2022-03-23 | 一种基于鲁棒约束控制的机械臂轨迹规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114378833A true CN114378833A (zh) | 2022-04-22 |
CN114378833B CN114378833B (zh) | 2022-07-08 |
Family
ID=81205204
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210284910.1A Active CN114378833B (zh) | 2022-03-23 | 2022-03-23 | 一种基于鲁棒约束控制的机械臂轨迹规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114378833B (zh) |
Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5959861A (en) * | 1996-10-31 | 1999-09-28 | Fujitsu Limited | Adaptive robust control device |
US20030108415A1 (en) * | 2001-07-13 | 2003-06-12 | Martin Hosek | Trajectory planning and motion control strategies for a planar three-degree-of-freedom robotic arm |
CN101927495A (zh) * | 2010-08-25 | 2010-12-29 | 中山大学 | 一种冗余度机械臂重复运动规划方法 |
CN102528802A (zh) * | 2010-12-31 | 2012-07-04 | 中国科学院计算技术研究所 | 九自由度机器人的运动驱动方法 |
CN103624784A (zh) * | 2013-11-06 | 2014-03-12 | 北京控制工程研究所 | 一种空间多臂复杂连接联合体自适应控制方法 |
CN105751196A (zh) * | 2016-04-12 | 2016-07-13 | 华南理工大学 | 一种基于主从式的工业机器人协作作业方法 |
CN105772917A (zh) * | 2014-12-16 | 2016-07-20 | 苏州继企机电科技有限公司 | 一种三关节点焊机器人轨迹跟踪控制方法 |
CN106068175A (zh) * | 2014-03-14 | 2016-11-02 | 索尼公司 | 机器人手臂设备、机器人手臂控制方法及程序 |
CN108621158A (zh) * | 2018-04-27 | 2018-10-09 | 上海师范大学 | 一种关于机械臂的时间最优轨迹规划控制方法及装置 |
CN109927032A (zh) * | 2019-03-28 | 2019-06-25 | 东南大学 | 一种基于高阶滑模观测器的机械臂轨迹跟踪控制方法 |
CN110262255A (zh) * | 2019-07-16 | 2019-09-20 | 东南大学 | 一种基于自适应终端滑模控制器的机械臂轨迹跟踪控制方法 |
CN111152212A (zh) * | 2019-12-05 | 2020-05-15 | 北京蒂斯科技有限公司 | 一种基于功率最优的机械臂移动轨迹规划方法及装置 |
US20210011458A1 (en) * | 2017-03-27 | 2021-01-14 | South China University Of Technology | Method for programming repeating motion of redundant robotic arm |
CN113843791A (zh) * | 2021-09-11 | 2021-12-28 | 杭州锐沃机器人科技有限公司 | 一种机械臂多点运动轨迹规划方法 |
US20220010878A1 (en) * | 2019-03-27 | 2022-01-13 | Vitesco Technologies Germany Gmbh | Method of Controlling a Dog Clutch |
-
2022
- 2022-03-23 CN CN202210284910.1A patent/CN114378833B/zh active Active
Patent Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5959861A (en) * | 1996-10-31 | 1999-09-28 | Fujitsu Limited | Adaptive robust control device |
US20030108415A1 (en) * | 2001-07-13 | 2003-06-12 | Martin Hosek | Trajectory planning and motion control strategies for a planar three-degree-of-freedom robotic arm |
CN101927495A (zh) * | 2010-08-25 | 2010-12-29 | 中山大学 | 一种冗余度机械臂重复运动规划方法 |
CN102528802A (zh) * | 2010-12-31 | 2012-07-04 | 中国科学院计算技术研究所 | 九自由度机器人的运动驱动方法 |
CN103624784A (zh) * | 2013-11-06 | 2014-03-12 | 北京控制工程研究所 | 一种空间多臂复杂连接联合体自适应控制方法 |
CN106068175A (zh) * | 2014-03-14 | 2016-11-02 | 索尼公司 | 机器人手臂设备、机器人手臂控制方法及程序 |
CN105772917A (zh) * | 2014-12-16 | 2016-07-20 | 苏州继企机电科技有限公司 | 一种三关节点焊机器人轨迹跟踪控制方法 |
CN105751196A (zh) * | 2016-04-12 | 2016-07-13 | 华南理工大学 | 一种基于主从式的工业机器人协作作业方法 |
US20210011458A1 (en) * | 2017-03-27 | 2021-01-14 | South China University Of Technology | Method for programming repeating motion of redundant robotic arm |
CN108621158A (zh) * | 2018-04-27 | 2018-10-09 | 上海师范大学 | 一种关于机械臂的时间最优轨迹规划控制方法及装置 |
US20220010878A1 (en) * | 2019-03-27 | 2022-01-13 | Vitesco Technologies Germany Gmbh | Method of Controlling a Dog Clutch |
CN109927032A (zh) * | 2019-03-28 | 2019-06-25 | 东南大学 | 一种基于高阶滑模观测器的机械臂轨迹跟踪控制方法 |
CN110262255A (zh) * | 2019-07-16 | 2019-09-20 | 东南大学 | 一种基于自适应终端滑模控制器的机械臂轨迹跟踪控制方法 |
CN111152212A (zh) * | 2019-12-05 | 2020-05-15 | 北京蒂斯科技有限公司 | 一种基于功率最优的机械臂移动轨迹规划方法及装置 |
CN113843791A (zh) * | 2021-09-11 | 2021-12-28 | 杭州锐沃机器人科技有限公司 | 一种机械臂多点运动轨迹规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN114378833B (zh) | 2022-07-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105772917B (zh) | 一种三关节点焊机器人轨迹跟踪控制方法 | |
JP5480198B2 (ja) | 学習制御機能を備えたスポット溶接ロボット | |
Eom et al. | Disturbance observer based path tracking control of robot manipulator considering torque saturation | |
CN112171673B (zh) | 机械臂作业控制方法、控制设备及计算机可读存储介质 | |
CN108621163A (zh) | 一种面向汇榫工艺的冗余双臂机器人协作控制方法 | |
Ferretti et al. | Toward the implementation of hybrid position/force control in industrial robots | |
CN109623812B (zh) | 考虑航天器本体姿态运动的机械臂轨迹规划方法 | |
CN107422739B (zh) | 一种空间机器人基座姿态的鲁棒控制方法 | |
JP2017209762A (ja) | ロボット装置、ロボット制御方法、プログラム、記録媒体及び物品の製造方法 | |
CN115723137A (zh) | 一种基于平面恒定力的柔顺任务控制方法 | |
CN114310914A (zh) | 多自由度机械臂模糊自适应迭代轨迹跟踪控制方法及系统 | |
Zhou et al. | Neural network-based variable stiffness impedance control for internal/external forces tracking of dual-arm manipulators under uncertainties | |
JP3936242B2 (ja) | サーボモータ制御用コントローラにおけるゲイン設定法、コントローラの有効性検証法およびロボット制御法 | |
CN114378833B (zh) | 一种基于鲁棒约束控制的机械臂轨迹规划方法 | |
Mitrovic et al. | Optimal feedback control for anthropomorphic manipulators | |
CN110900613A (zh) | 一种面向移动机器人的不停车控制方法及系统 | |
CN116810792A (zh) | 基于神经网络的引信与传爆管双机器人装配柔性控制方法 | |
Shen et al. | Optimal trajectory planning of manipulators subject to motion constraints | |
Ghasemi et al. | Adaptive image-based visual servoing of 6 DOF robots using switch approach | |
Yan et al. | Integrated Drill Boom Hole-Seeking Control via Reinforcement Learning | |
CN117400237A (zh) | 火箭固体燃料整形机器人的轨迹跟踪和力柔顺控制方法 | |
Sun | Research on contact force control of grinding robot based on adaptive impedance control | |
Zhang et al. | Motion Control of Disc Cutter Changing Robot Body for Tunnel Boring Machine | |
Seifried et al. | Analysis of feed-forward control design approaches for flexible multibody systems | |
CN117733829B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CP03 | Change of name, title or address | ||
CP03 | Change of name, title or address |
Address after: 272000, No. 888 Huarun Road, Zhongxin Electromechanical Industrial Park, Zhongdian Town, Zoucheng City, Jining City, Shandong Province Patentee after: Luoshi (Shandong) Robot Group Co.,Ltd. Country or region after: China Address before: 100097 1-01, floor 7, building a, Beijing Haiqing Shuguang real estate development center (Office) and postal branch project, East wangfuyuan District, Haidian District, Beijing Patentee before: ROKAE, Inc. Country or region before: China |