CN112157661B - 一种基于机器人动力学的关节运动轨迹优化方法 - Google Patents
一种基于机器人动力学的关节运动轨迹优化方法 Download PDFInfo
- Publication number
- CN112157661B CN112157661B CN202011386296.7A CN202011386296A CN112157661B CN 112157661 B CN112157661 B CN 112157661B CN 202011386296 A CN202011386296 A CN 202011386296A CN 112157661 B CN112157661 B CN 112157661B
- Authority
- CN
- China
- Prior art keywords
- joint
- acceleration
- running
- speed
- calculating
- 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/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- 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/1628—Programme controls characterised by the control loop
- B25J9/1651—Programme controls characterised by the control loop acceleration, rate control
-
- 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
本发明公开了一种基于机器人动力学的关节运动轨迹优化方法,包括分别设置各关节允许的最大力矩及最大运行速度、计算各关节的匀速段运行速度以及加速时间或者减速时间等,具体是基于动力学模型实时计算后面2段程序各个关节的关节力矩。本发明的方法可以实现在保证关节力矩略小于最大关节力矩以及所有关节都同时加速、同时匀速、同时减速的前提下,实现关节加速度的最大化,从而减小加速时间,实现保证在相同的运动轨迹上机器人能运行的最快,达到提高生产效率的目的。
Description
技术领域
本发明涉及关节运动轨迹优化技术领域,特别涉及一种基于机器人动力学的关节运动轨迹优化方法。
背景技术
现有技术中,在机器人轨迹规划的时候一般采用固定的速度和加速度值或者加速度时间来进行速度规划,进而得到位置规划曲线,但规划的速度以及加速度是否超过了机器人本体能承受的极限,是否是时间最优的方式等这些都没有进行计算校核,因此,一方面存在规划的速度或者加速度过大导致损坏机器人的风险,另一方面也存在规划的速度或者加速度过小,没有达到时间最优的效果,导致效率降低。
发明内容
本发明的目的是克服上述背景技术中不足,提供一种基于机器人动力学的关节运动轨迹优化方法,在实际运行当前段程序时候,基于动力学模型实时计算后面2段程序各个关节的关节力矩,在保证关节力矩略小于最大关节力矩以及所有关节都同时加速、同时匀速、同时减速的前提下,尽可能提高关节加速度并减小加速时间,从而保证在相同的运动轨迹上能运行的最快,提高生产效率。
为了达到上述的技术效果,本发明采取以下技术方案:
一种基于机器人动力学的关节运动轨迹优化方法,包括:
S11.依次比较各关节运行时的最大力矩T是否满足以下条件:T>,若是,则将该关节的加速度降低为原来的n倍得到的新的加速度;否则,将该关节的加速度增大为原来的b倍得到的新的加速度,其中,0<a<1,b>1,0<n<1;
进一步地, b等于1.1;n等于0.9,具体的数值可以在其满足的取值范围内依据实际情况进行定值。
本发明与现有技术相比,具有以下的有益效果
本发明的基于机器人动力学的关节运动轨迹优化方法,针对现有技术存在的在机器人轨迹规划时,规划速度以及加速度的方法存在的可能过大或过小的问题,通过在实际运行当前段程序时候,基于动力学模型实时计算后面2段程序各个关节的关节力矩,在保证关节力矩略小于最大关节力矩以及所有关节都同时加速、同时匀速、同时减速的前提下,实现关节加速度的最大化,从而减小加速时间,实现保证在相同的运动轨迹上机器人能运行的最快,达到提高生产效率的目的。
附图说明
图1是本发明的基于机器人动力学的关节运动轨迹优化方法的流程示意图。
图2是本发明的一个实施例的梯形加减速速度曲线示意图。
具体实施方式
下面结合本发明的实施例对本发明作进一步的阐述和说明。
实施例:
实施例一:
如图1所示,一种基于机器人动力学的关节运动轨迹优化方法,本实施例中具体是将该方法应用于工业机器人常见的6关节机器人上,其余类型机器人以此类推,具体包括以下步骤:
步骤11.依次比较各关节运行时的最大力矩T是否满足以下条件:T>,若是,则将该关节的加速度降低为原来的n倍得到的新的加速度;否则,将该关节的加速度增大为原来的b倍得到的新的加速度,其中,0<a<1,b>1,0<n<1。
上述步骤11及步骤12对应在本实施例中具体为:
通过本发明的方法得出的运行轨迹可实现在保证关节力矩略小于最大关节力矩以及所有关节都同时加速、同时匀速、同时减速的前提下,尽可能的提高关节加速度从而减小加速时间,提升效率。
实施例二
本实施例中公开了一种计算机设备,该计算机设备可以是服务器,该计算机设备包括通过系统总线连接的处理器、存储器、网络接口和数据库。其中,该计算机设备的处理器用于提供计算和控制能力。该计算机设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统、计算机程序和数据库。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该计算机设备的数据库用于存储基于机器人动力学的关节运动轨迹优化方法中涉及到的数据。该计算机设备的网络接口用于与外部的终端通过网络连接通信。该计算机程序被处理器执行时以实现基于机器人动力学的关节运动轨迹优化方法。
在另一个实施例中,提供了一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,处理器执行计算机程序时实现上述实施例一中基于机器人动力学的关节运动轨迹优化方法的步骤。为避免重复,这里不再赘述。
在另一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现上述实施例一中基于机器人动力学的关节运动轨迹优化方法的步骤。为避免重复,这里不再赘述可以理解的是,以上实施方式仅仅是为了说明本发明的原理而采用的示例性实施方式,然而本发明并不局限于此。对于本领域内的普通技术人员而言,在不脱离本发明的精神和实质的情况下,可以做出各种变型和改进,这些变型和改进也视为本发明的保护范围。
Claims (3)
1.一种基于机器人动力学的关节运动轨迹优化方法,其特征在于,包括:
S11.依次比较各关节运行时的最大力矩T是否满足以下条件:T>,若是,则将该关节的加速度降低为原来的n倍得到的新的加速度;否则,将该关节的加速度增大为原来的b倍得到的新的加速度,其中,0<a<1,b>1,0<n<1;
2.根据权利要求1所述的一种基于机器人动力学的关节运动轨迹优化方法,其特征在于,b等于1.1。
3.根据权利要求1所述的一种基于机器人动力学的关节运动轨迹优化方法,其特征在于,n等于0.9。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011386296.7A CN112157661B (zh) | 2020-12-02 | 2020-12-02 | 一种基于机器人动力学的关节运动轨迹优化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011386296.7A CN112157661B (zh) | 2020-12-02 | 2020-12-02 | 一种基于机器人动力学的关节运动轨迹优化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112157661A CN112157661A (zh) | 2021-01-01 |
CN112157661B true CN112157661B (zh) | 2021-03-05 |
Family
ID=73865961
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011386296.7A Active CN112157661B (zh) | 2020-12-02 | 2020-12-02 | 一种基于机器人动力学的关节运动轨迹优化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112157661B (zh) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0794475A1 (en) * | 1995-09-26 | 1997-09-10 | Fanuc Ltd | Duty-based minimum-time control method for robot |
WO1999008167A1 (fr) * | 1997-08-05 | 1999-02-18 | Kabushiki Kaisha Yaskawa Denki | Procede permettant de generer une consigne d'acceleration/deceleration destinee a un robot industriel |
CN102039596A (zh) * | 2009-10-13 | 2011-05-04 | 库卡罗伯特有限公司 | 控制操纵器的方法和装置 |
CN106113034A (zh) * | 2016-06-12 | 2016-11-16 | 哈尔滨工程大学 | 一种六自由度机械臂考虑力约束的轨迹规划方法 |
US9606517B2 (en) * | 2011-08-29 | 2017-03-28 | Isuzu Motors Limited | Actuator control method and actuator control device |
WO2017189771A1 (en) * | 2016-04-27 | 2017-11-02 | Skogsrud Simen | Method of iterative motion control |
CN108068113A (zh) * | 2017-11-13 | 2018-05-25 | 苏州大学 | 7-dof仿人臂飞行物体作业最小加速度轨迹优化 |
CN108454609A (zh) * | 2017-02-20 | 2018-08-28 | Fev欧洲有限责任公司 | 用于运行车辆的混合动力系统的方法 |
CN108656112A (zh) * | 2018-05-15 | 2018-10-16 | 清华大学深圳研究生院 | 一种面向直接示教的机械臂零力控制实验系统 |
CN110058523A (zh) * | 2019-04-29 | 2019-07-26 | 杭州亿恒科技有限公司 | 基于极大似然估计的scara机器人动力学参数辨识方法 |
-
2020
- 2020-12-02 CN CN202011386296.7A patent/CN112157661B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0794475A1 (en) * | 1995-09-26 | 1997-09-10 | Fanuc Ltd | Duty-based minimum-time control method for robot |
WO1999008167A1 (fr) * | 1997-08-05 | 1999-02-18 | Kabushiki Kaisha Yaskawa Denki | Procede permettant de generer une consigne d'acceleration/deceleration destinee a un robot industriel |
CN102039596A (zh) * | 2009-10-13 | 2011-05-04 | 库卡罗伯特有限公司 | 控制操纵器的方法和装置 |
US9606517B2 (en) * | 2011-08-29 | 2017-03-28 | Isuzu Motors Limited | Actuator control method and actuator control device |
WO2017189771A1 (en) * | 2016-04-27 | 2017-11-02 | Skogsrud Simen | Method of iterative motion control |
CN106113034A (zh) * | 2016-06-12 | 2016-11-16 | 哈尔滨工程大学 | 一种六自由度机械臂考虑力约束的轨迹规划方法 |
CN108454609A (zh) * | 2017-02-20 | 2018-08-28 | Fev欧洲有限责任公司 | 用于运行车辆的混合动力系统的方法 |
CN108068113A (zh) * | 2017-11-13 | 2018-05-25 | 苏州大学 | 7-dof仿人臂飞行物体作业最小加速度轨迹优化 |
CN108656112A (zh) * | 2018-05-15 | 2018-10-16 | 清华大学深圳研究生院 | 一种面向直接示教的机械臂零力控制实验系统 |
CN110058523A (zh) * | 2019-04-29 | 2019-07-26 | 杭州亿恒科技有限公司 | 基于极大似然估计的scara机器人动力学参数辨识方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112157661A (zh) | 2021-01-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2020133270A1 (zh) | 机器人的动力学参数辨识方法、机器人和存储装置 | |
CN108568814B (zh) | 机器人以及机器人的控制方法 | |
CN108406765B (zh) | 一种开链式多臂机器人阻抗控制方法 | |
CN112528434B (zh) | 信息识别方法、装置、电子设备和存储介质 | |
CN113119111A (zh) | 机械臂及其轨迹规划方法和装置 | |
WO2023115784A1 (zh) | 机器人运动信息规划方法及相关装置 | |
CN114800489B (zh) | 基于确定学习与复合学习联合的机械臂柔顺控制方法、存储介质及机器人 | |
CN105740525A (zh) | 一种飞行器的气动力数据处理方法及气动力数据处理系统 | |
CN109683615A (zh) | 机器人连续运动的路径的速度前瞻方法及机器人控制器 | |
CN114603558A (zh) | 混合空间过渡轨迹规划方法及装置 | |
CN109634294B (zh) | 一种基于机动能力辨识的抗干扰四元数姿态机动路径规划方法 | |
CN112157661B (zh) | 一种基于机器人动力学的关节运动轨迹优化方法 | |
CN114690767A (zh) | 一种机器人轨迹规划方法、系统以及机器人 | |
CN114578697A (zh) | 一种电机驱动机械手的多约束自适应控制方法 | |
CN112668190B (zh) | 一种三指灵巧手控制器构建方法、系统、设备及存储介质 | |
WO2022179213A1 (zh) | 仿人机器人的解耦控制方法、装置和仿人机器人 | |
CN115502986A (zh) | 基于状态观测器的多关节机械臂事件驱动控制方法 | |
CN115963819A (zh) | 一种非完整移动机器人编队控制方法 | |
CN112589832B (zh) | 一种确定机器人关节最大工作力矩的方法 | |
WO2021042389A1 (zh) | 用于工业机器人的轨迹简化方法及设备、计算机存储介质以及工业机器人操作平台 | |
CN114347020B (zh) | 一种运动控制方法、运动控制装置及机器人 | |
CN114260900B (zh) | 机器人的减速控制方法和装置、机器人组件和存储介质 | |
CN112223298B (zh) | 一种确定机器人关节最大加速度和最大速度的方法 | |
CN113109852B (zh) | 一种无人机进狭窄空间的路径规划方法及装置 | |
CN113021334B (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 |
Address after: 610000 No. 42, Huatai Road, Chenghua District, Chengdu, Sichuan Patentee after: Chengdu kanop Robot Technology Co.,Ltd. Address before: No.199, Huaguan Road, Longtan Industrial Park, Chenghua District, Chengdu, Sichuan 610000 Patentee before: CHENGDU CRP AUTOMATION CONTROL TECHNOLOGY Co.,Ltd. |
|
CP03 | Change of name, title or address |