CN114833836A - 一种高效的时间最优轨迹在线生成方法 - Google Patents
一种高效的时间最优轨迹在线生成方法 Download PDFInfo
- Publication number
- CN114833836A CN114833836A CN202210785281.0A CN202210785281A CN114833836A CN 114833836 A CN114833836 A CN 114833836A CN 202210785281 A CN202210785281 A CN 202210785281A CN 114833836 A CN114833836 A CN 114833836A
- Authority
- CN
- China
- Prior art keywords
- track
- test
- period
- planning
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 23
- 238000004364 calculation method Methods 0.000 claims abstract description 14
- 230000001133 acceleration Effects 0.000 claims abstract description 10
- 230000008685 targeting Effects 0.000 claims description 4
- 239000000126 substance Substances 0.000 claims 2
- 238000005516 engineering process Methods 0.000 description 4
- 238000004519 manufacturing process Methods 0.000 description 3
- 150000001875 compounds Chemical class 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000033764 rhythmic process Effects 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000002427 irreversible effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003252 repetitive 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)
- Manipulator (AREA)
Abstract
Description
技术领域
本发明涉及工业机器人技术领域,特别涉及一种高效的时间最优轨迹在线生成方法。
背景技术
经过几十年的发展,机器人已经渗透了人们生产生活中的各个部分,特别是工业机械臂,开始大规模取代工厂中重复性工作。尽管机械臂轨迹规划技术日趋完善,大量时间最优轨迹规划技术如基于动态规划法、变结构滤波器法、凸规划法等被相继提出,然而一方面,大部分技术主要针对离线轨迹规划,即使是在线规划也面临计算量较大的问题,很难直接应用到工业机械臂上:机械臂在运行过程中一旦发生意外或者人为要求需要机械臂立刻停止,离线规划只能采用电机下电抱闸的方式停止,这样会对机械臂本体产生不可逆转的损坏,减少其使用寿命。而一般工业机械臂出于成本的考虑,控制系统算力有限,计算量过大的在线轨迹规划会减小控制系统带宽,影响机械臂性能。另一方面,机械臂驱动器的实际驱动能力有物理约束,而机械臂是一个复杂的多自由度非线性系统,传统的“T型”、“S型”轨迹规划很难处理时变约束,难以使电机时刻工作在最佳性能上,充分发挥电机的实际性能,更难生成时间最优轨迹。
现有的机械臂在运行中面临着控制系统算力有限,实际环境复杂需要可靠安全的急停,因此在线轨迹生成是机器人系统不可或缺的一项技术。
发明内容
本发明的目的旨在至少解决所述技术缺陷之一。
为此,本发明的目的在于提出一种高效的时间最优轨迹在线生成方法。
为了实现上述目的,本发明的实施例提供一种高效的时间最优轨迹在线生成方法,包括如下步骤:
步骤S1,利用弧长参数化,将预定义路径的长度和约束信息转换至弧长s域中,将机械臂轨迹规划由关节空间或笛卡尔空间的高维转换至一维的s域规划;
步骤S3,计算出一条试验轨迹序列
步骤S7,递增k:k=k+1,并转至步骤S3;
步骤S8,输出规划的整条轨迹,并满足终点约束。
进一步,在所述步骤S1中,将机械臂轨迹规划由关节空间或笛卡尔空间的高维转换至一维的s域规划,得到
进一步,在步骤S3中,采用求解线性常微分方程中的打靶法计算出一条试验轨迹序列。
根据本发明实施例的高效的时间最优轨迹在线生成方法,解决了现有的机械臂在运行中面临着控制系统算力有限的问题,满足实际环境复杂需要可靠安全的急停,同时,为了提高生产效率,加快机器人运行节拍,要求轨迹满足时间最优。
本发明将轨迹由轨迹规划由高维的关节空间或笛卡尔空间转换至一维的s域规划,可以极大的减小规划复杂度,提高计算效率。计算量小,能够满足时变约束下的在线计算,提高控制系统带宽。计算的轨迹满足机械臂驱动器的实际约束,充分发挥驱动器性能。
本发明附加的方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1为根据本发明实施例的高效的时间最优轨迹在线生成方法的流程图。
具体实施方式
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。
如图1所示,本发明实施例的高效的时间最优轨迹在线生成方法,包括如下步骤:
步骤S1,利用弧长参数化,将预定义路径的长度和约束信息转换至弧长s域中,将机械臂轨迹规划由关节空间或笛卡尔空间的高维转换至一维的s域规划,并计算s域对应的约束。
在步骤S1中,将机械臂轨迹规划由关节空间或笛卡尔空间的高维转换至一维的s域规划,得到
步骤S3,计算出一条试验轨迹序列
在本发明的实施例中,采用求解线性常微分方程中的打靶法计算出一条试验轨迹序列。
步骤S7,递增k:k=k+1,并转至步骤S3。
步骤S8,输出规划的整条轨迹,并满足终点约束。
综上,本发明采用求解线性常微分方程中的打靶法,在线更新系统的状态方程,在每个控制周期中生成一条试验轨迹,如果试验轨迹不超过物理约束,则使用该控制周期生成的试验轨迹,否则使用上个周期生成的试验轨迹。为了保证加速度连续,采用三阶系统,加加速度有界,通过求解加速度的加速和减速时间生成一条试验轨迹,生成的轨迹满足时间最优,而且保证加速度连续及加加速度有界,可以有效的减小轨迹不必要的抖动。
根据本发明实施例的高效的时间最优轨迹在线生成方法,解决了现有的机械臂在运行中面临着控制系统算力有限的问题,满足实际环境复杂需要可靠安全的急停,同时,为了提高生产效率,加快机器人运行节拍,要求轨迹满足时间最优。
本发明将轨迹由轨迹规划由高维的关节空间或笛卡尔空间转换至一维的s域规划,可以极大的减小规划复杂度,提高计算效率。计算量小,能够满足时变约束下的在线计算,提高控制系统带宽。计算的轨迹满足机械臂驱动器的实际约束,充分发挥驱动器性能。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、 “示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。本发明的范围由所附权利要求及其等同限定。
Claims (3)
1.一种高效的时间最优轨迹在线生成方法,其特征在于,包括如下步骤:
步骤S1,利用弧长参数化,将预定义路径的长度和约束信息转换至弧长s域中,将机械臂轨迹规划由关节空间或笛卡尔空间的高维转换至一维的s域规划;
步骤S3,计算出一条试验轨迹序列
步骤S7,递增k:k=k+1,并转至步骤S3;
步骤S8,输出规划的整条轨迹,并满足终点约束。
3.如权利要求1所述的高效的时间最优轨迹在线生成方法,其特征在于,在步骤S3中,采用求解线性常微分方程中的打靶法计算出一条试验轨迹序列。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210785281.0A CN114833836B (zh) | 2022-07-06 | 2022-07-06 | 一种高效的时间最优轨迹在线生成方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210785281.0A CN114833836B (zh) | 2022-07-06 | 2022-07-06 | 一种高效的时间最优轨迹在线生成方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114833836A true CN114833836A (zh) | 2022-08-02 |
CN114833836B CN114833836B (zh) | 2022-09-20 |
Family
ID=82575301
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210785281.0A Active CN114833836B (zh) | 2022-07-06 | 2022-07-06 | 一种高效的时间最优轨迹在线生成方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114833836B (zh) |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106003104A (zh) * | 2015-07-03 | 2016-10-12 | 中国运载火箭技术研究院 | 一种适用于多约束条件下视觉信息导引的机械臂规划方法 |
WO2018137432A1 (zh) * | 2017-08-10 | 2018-08-02 | 南京埃斯顿机器人工程有限公司 | 机器人关节空间点到点运动的轨迹规划方法 |
CN108621158A (zh) * | 2018-04-27 | 2018-10-09 | 上海师范大学 | 一种关于机械臂的时间最优轨迹规划控制方法及装置 |
WO2019019707A1 (zh) * | 2017-07-28 | 2019-01-31 | 珞石(山东)智能科技有限公司 | 非零初始状态s型停止曲线速度规则及其在线求解方法 |
CN109434841A (zh) * | 2019-01-07 | 2019-03-08 | 南京航空航天大学 | 一种工业机器人动态调速的全局时间最优轨迹规划方法 |
GB201908281D0 (en) * | 2019-06-10 | 2019-07-24 | Glowbuzzer Ltd | Method and apparatus for trajectory-planning |
CN111399514A (zh) * | 2020-03-30 | 2020-07-10 | 浙江钱江机器人有限公司 | 一种机器人时间最优轨迹规划方法 |
CN111806467A (zh) * | 2020-07-27 | 2020-10-23 | 福州大学 | 一种基于车辆行驶规律的变速动态换道轨迹规划方法 |
CN112757306A (zh) * | 2021-01-25 | 2021-05-07 | 北京交通大学 | 一种机械臂逆解多解选择和时间最优轨迹规划算法 |
CN113341731A (zh) * | 2021-06-29 | 2021-09-03 | 西北工业大学 | 一种基于序列凸优化的空间机器人轨迹规划方法 |
CN114211492A (zh) * | 2021-12-22 | 2022-03-22 | 武汉鼎元同立科技有限公司 | 一种基于模型的多自由度机械臂的最优轨迹规划方法 |
-
2022
- 2022-07-06 CN CN202210785281.0A patent/CN114833836B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106003104A (zh) * | 2015-07-03 | 2016-10-12 | 中国运载火箭技术研究院 | 一种适用于多约束条件下视觉信息导引的机械臂规划方法 |
WO2019019707A1 (zh) * | 2017-07-28 | 2019-01-31 | 珞石(山东)智能科技有限公司 | 非零初始状态s型停止曲线速度规则及其在线求解方法 |
WO2018137432A1 (zh) * | 2017-08-10 | 2018-08-02 | 南京埃斯顿机器人工程有限公司 | 机器人关节空间点到点运动的轨迹规划方法 |
CN108621158A (zh) * | 2018-04-27 | 2018-10-09 | 上海师范大学 | 一种关于机械臂的时间最优轨迹规划控制方法及装置 |
CN109434841A (zh) * | 2019-01-07 | 2019-03-08 | 南京航空航天大学 | 一种工业机器人动态调速的全局时间最优轨迹规划方法 |
GB201908281D0 (en) * | 2019-06-10 | 2019-07-24 | Glowbuzzer Ltd | Method and apparatus for trajectory-planning |
CN111399514A (zh) * | 2020-03-30 | 2020-07-10 | 浙江钱江机器人有限公司 | 一种机器人时间最优轨迹规划方法 |
CN111806467A (zh) * | 2020-07-27 | 2020-10-23 | 福州大学 | 一种基于车辆行驶规律的变速动态换道轨迹规划方法 |
CN112757306A (zh) * | 2021-01-25 | 2021-05-07 | 北京交通大学 | 一种机械臂逆解多解选择和时间最优轨迹规划算法 |
CN113341731A (zh) * | 2021-06-29 | 2021-09-03 | 西北工业大学 | 一种基于序列凸优化的空间机器人轨迹规划方法 |
CN114211492A (zh) * | 2021-12-22 | 2022-03-22 | 武汉鼎元同立科技有限公司 | 一种基于模型的多自由度机械臂的最优轨迹规划方法 |
Non-Patent Citations (2)
Title |
---|
赫建立等: "基于遗传算法的6-DOF机器人最优时间轨迹规划", 《机械传动》 * |
钱东海等: "多约束条件下的机器人时间最优轨迹规划", 《制造业自动化》 * |
Also Published As
Publication number | Publication date |
---|---|
CN114833836B (zh) | 2022-09-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107263484B (zh) | 机器人关节空间点到点运动的轨迹规划方法 | |
CN112757306B (zh) | 一种机械臂逆解多解选择和时间最优轨迹规划算法 | |
CN107290956B (zh) | 一种基于状态反馈的单关节柔性机械臂的位置控制方法 | |
CN110340894B (zh) | 一种基于模糊逻辑的遥操作系统自适应多边控制方法 | |
JP2019530936A (ja) | 非ゼロ初期状態におけるs型の停止曲線の速度ルール及びそのオンライン求解方法 | |
CN114077226B (zh) | S型曲线速度规划方法、控制终端及计算机可读存储介质 | |
CN105676896A (zh) | 一种应用于机器人伺服系统的前馈控制方法 | |
Pham et al. | On the structure of the time-optimal path parameterization problem with third-order constraints | |
CN112338913A (zh) | 一种多关节柔性机械臂的轨迹跟踪控制方法及系统 | |
CN110673544A (zh) | 基于自适应在线学习的上肢康复机器人控制方法 | |
CN114833836B (zh) | 一种高效的时间最优轨迹在线生成方法 | |
CN115723137A (zh) | 一种基于平面恒定力的柔顺任务控制方法 | |
CN115107035B (zh) | 一种机器人单关节人工免疫系统监控的混合控制方法 | |
JPH0683427A (ja) | 柔軟マニピュレータの作業点位置制御システム | |
CN113359468A (zh) | 基于鲁棒自适应与滑模变结构控制的风电机组容错控制方法 | |
Dian et al. | A Novel Disturbance-Rejection Control Framework for Cable-Driven Continuum Robots With Improved State Parameterizations | |
CN111181467B (zh) | 一种基于三维模糊控制的伺服电机转速调节方法及系统 | |
CN217982200U (zh) | 一种智能运动控制系统 | |
Gavtham Hari Kumar | Adaptive Dynamic Programming Based Linear Quadratic Regulator Design for Rotary Inverted Pendulum System | |
CN114488953B (zh) | 基于轴物理限制的传动机构进给率规划方法 | |
WO2024024578A1 (ja) | ロボットの制御方法及びロボットの制御装置 | |
Wang et al. | Tracking and Synchronization Control for Multimotor Servo Systems Based on Fixed-Time Command Filtered Approach | |
Wang et al. | Simulation and research of double motor anti-backlash technology based on fuzzy control | |
CN117584930A (zh) | 一种混合动力自适应控制方法、系统、装置、设备及介质 | |
Wang et al. | Model-based Robust Control of Permanent Magnet Synchronous Motor for Joint Module of Cooperative Robot |
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 | ||
TR01 | Transfer of patent right |
Effective date of registration: 20231009 Address after: Room 204, 2nd Floor, Building 23, No. 79 Shuangying West Road, Science and Technology Park, Changping District, Beijing 102200 Patentee after: Luoshi (Beijing) Robotics Co.,Ltd. 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. |
|
TR01 | Transfer of patent right |