CN114310921B - 一种最小曲率的直线过渡路径生成方法 - Google Patents
一种最小曲率的直线过渡路径生成方法 Download PDFInfo
- Publication number
- CN114310921B CN114310921B CN202210256214.XA CN202210256214A CN114310921B CN 114310921 B CN114310921 B CN 114310921B CN 202210256214 A CN202210256214 A CN 202210256214A CN 114310921 B CN114310921 B CN 114310921B
- Authority
- CN
- China
- Prior art keywords
- transition path
- straight
- path
- acceleration
- minimum curvature
- 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
- 230000007704 transition Effects 0.000 title claims abstract description 50
- 238000000034 method Methods 0.000 title claims abstract description 18
- 230000001133 acceleration Effects 0.000 claims abstract description 20
- 230000008569 process Effects 0.000 claims abstract description 4
- 125000004432 carbon atom Chemical group C* 0.000 claims description 3
- 241000022852 Letis Species 0.000 claims description 2
- 230000033001 locomotion Effects 0.000 abstract description 6
- 230000003252 repetitive effect Effects 0.000 description 2
- 101100391182 Dictyostelium discoideum forI gene Proteins 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000033764 rhythmic process Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
- Feedback Control In General (AREA)
- Numerical Control (AREA)
Abstract
Description
技术领域
本发明涉及机器人技术领域,特别涉及一种最小曲率的直线过渡路径生成方法。
背景技术
经过几十年的发展,机器人已经渗透了人们生产生活中的各个部分,特别是工业机械人,开始大规模取代工厂中重复性工作。工业机器人一般从事简单、重复性工作,如搬运、分拣、打磨、焊接等,这就要求机器人具有高的运动速度和高的轨迹精度,以提高效率。特别是搬运、分拣等任务中,运行节拍是衡量机器人运动性能的一个重要指标。工业机器人最常用的路径形式一般是直线、圆弧,为了提高节拍,需要在直线-直线、圆弧-圆弧、直线-圆弧路径中加入过渡路径段,使机器人平滑的从一段路径过渡到另一段路径。然而不用的过渡路径,将严重影响机器人运行的平滑性、节拍等性能。
一种常用的过渡路径生成方法是使用五次多项式,来满足两端点处位置、速度和加速度约束。然而,这将使机械臂在过渡路径过程中经历加速、减速过程,需要额外的力来克服因加速、减速引起的惯性力。对于一个设计好的机器人来说,关节电机出力总是有限的,因为电机的一部分力矩不得不克服过渡路径中的惯性力,因此必须降低机械臂运动速度,从而使运行节拍变慢。
发明内容
本发明的目的旨在至少解决所述技术缺陷之一。
为此,本发明的目的在于提出一种最小曲率的直线过渡路径生成方法。
为了实现上述目的,本发明的实施例提供一种最小曲率的直线过渡路径生成方法,包括如下步骤:
步骤S1,设置机器人行进过程中,连接两段路径的过渡路径采用下式表示:
其中,为第一段直线路径,为第二段直线路径,为生成过渡路径的多项式,需要满足边界条件,并规定;为补偿项,用于补偿引入的过渡路径中的加减速,使的加速度最小;u为一个额外的自由度来改变过渡路径点的加速度,满足边界条件的的表达式为
进一步,k为调整曲线形状系数,通过调整k值来改变过渡路径形状;
本发明附加的方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1为根据本发明实施例的最小曲率的直线过渡路径生成方法的流程图。
具体实施方式
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。
如图1所示,本发明实施例的最小曲率的直线过渡路径生成方法,包括如下步骤:
步骤S1,相较于采用固定的五次多项式来连接两端直线路径形成过渡路径的方案,本发明增加额外一部分可变的多项式来减小加减速过程中的过大的加速度。
设置机器人行进过程中,连接两段路径的过渡路径采用下式表示:
k为调整曲线形状系数,通过改变上式中的k可以调整曲线形状;
现在,过渡路径可以表示为
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、 “示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。本发明的范围由所附权利要求及其等同限定。
Claims (3)
1.一种最小曲率的直线过渡路径生成方法,其特征在于,包括如下步骤:
步骤S1,设置机器人行进过程中,连接两段路径的过渡路径采用下式表示:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210256214.XA CN114310921B (zh) | 2022-03-16 | 2022-03-16 | 一种最小曲率的直线过渡路径生成方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210256214.XA CN114310921B (zh) | 2022-03-16 | 2022-03-16 | 一种最小曲率的直线过渡路径生成方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114310921A CN114310921A (zh) | 2022-04-12 |
CN114310921B true CN114310921B (zh) | 2022-06-10 |
Family
ID=81033025
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210256214.XA Active CN114310921B (zh) | 2022-03-16 | 2022-03-16 | 一种最小曲率的直线过渡路径生成方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114310921B (zh) |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR940006719A (ko) * | 1992-09-18 | 1994-04-25 | 윤종용 | 로보트의 구동경로 계획방법 |
WO1999001805A1 (fr) * | 1997-07-03 | 1999-01-14 | Fanuc Ltd | Procede de conversion de programme d'apprentissage robotique |
CN102799145A (zh) * | 2012-08-13 | 2012-11-28 | 中国科学院数学与***科学研究院 | 拐角多周期恒加加速度过渡的s曲线加减速直线插补方法 |
CN105500354A (zh) * | 2016-02-02 | 2016-04-20 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人应用的过渡轨迹规划方法 |
WO2017113416A1 (zh) * | 2015-12-31 | 2017-07-06 | 深圳配天智能技术研究院有限公司 | 加工轨迹平滑转接的方法及加工装置 |
CN107030697A (zh) * | 2017-04-28 | 2017-08-11 | 广州大学 | 一种机器人笛卡尔空间平滑轨迹的规划方法 |
WO2018119745A1 (zh) * | 2016-12-28 | 2018-07-05 | 深圳配天智能技术研究院有限公司 | 机器人运动控制方法及相关装置 |
WO2018126355A1 (zh) * | 2017-01-04 | 2018-07-12 | 深圳配天智能技术研究院有限公司 | 机器人运动轨迹规划方法及相关装置 |
CN109623820A (zh) * | 2018-12-25 | 2019-04-16 | 哈工大机器人(合肥)国际创新研究院 | 一种机器人空间轨迹过渡方法 |
CN113334385A (zh) * | 2021-06-24 | 2021-09-03 | 安徽理工大学 | 一种自驱动关节臂测量机直线轨迹间平滑过渡的规划方法 |
CN113635301A (zh) * | 2021-07-29 | 2021-11-12 | 中国地质大学(武汉) | 一种六轴机械臂运动速度控制改进方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7067289B2 (ja) * | 2018-06-08 | 2022-05-16 | トヨタ自動車株式会社 | 動作計画装置及び動作計画方法 |
-
2022
- 2022-03-16 CN CN202210256214.XA patent/CN114310921B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR940006719A (ko) * | 1992-09-18 | 1994-04-25 | 윤종용 | 로보트의 구동경로 계획방법 |
WO1999001805A1 (fr) * | 1997-07-03 | 1999-01-14 | Fanuc Ltd | Procede de conversion de programme d'apprentissage robotique |
CN102799145A (zh) * | 2012-08-13 | 2012-11-28 | 中国科学院数学与***科学研究院 | 拐角多周期恒加加速度过渡的s曲线加减速直线插补方法 |
WO2017113416A1 (zh) * | 2015-12-31 | 2017-07-06 | 深圳配天智能技术研究院有限公司 | 加工轨迹平滑转接的方法及加工装置 |
CN105500354A (zh) * | 2016-02-02 | 2016-04-20 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人应用的过渡轨迹规划方法 |
WO2018119745A1 (zh) * | 2016-12-28 | 2018-07-05 | 深圳配天智能技术研究院有限公司 | 机器人运动控制方法及相关装置 |
WO2018126355A1 (zh) * | 2017-01-04 | 2018-07-12 | 深圳配天智能技术研究院有限公司 | 机器人运动轨迹规划方法及相关装置 |
CN107030697A (zh) * | 2017-04-28 | 2017-08-11 | 广州大学 | 一种机器人笛卡尔空间平滑轨迹的规划方法 |
CN109623820A (zh) * | 2018-12-25 | 2019-04-16 | 哈工大机器人(合肥)国际创新研究院 | 一种机器人空间轨迹过渡方法 |
CN113334385A (zh) * | 2021-06-24 | 2021-09-03 | 安徽理工大学 | 一种自驱动关节臂测量机直线轨迹间平滑过渡的规划方法 |
CN113635301A (zh) * | 2021-07-29 | 2021-11-12 | 中国地质大学(武汉) | 一种六轴机械臂运动速度控制改进方法 |
Non-Patent Citations (2)
Title |
---|
一种基于优化方法的曲率最优过渡曲线生成算法;蔡亮等;《电气传动》;20180620(第06期);全文 * |
多路径段平滑过渡的自适应前瞻位姿插补算法;王斌锐等;《控制与决策》;20180604(第06期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN114310921A (zh) | 2022-04-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105500354B (zh) | 一种工业机器人应用的过渡轨迹规划方法 | |
JP4779969B2 (ja) | 電動機制御装置 | |
CN105785921B (zh) | 一种工业机器人nurbs曲线插补时的速度规划方法 | |
CN1283426C (zh) | 机器人的控制装置 | |
CN109623810B (zh) | 一种机器人平滑的时间最优轨迹规划的方法 | |
US20100109360A1 (en) | Gripping device and system including the same | |
CN114310921B (zh) | 一种最小曲率的直线过渡路径生成方法 | |
JP2004272883A (ja) | サーボ制御装置 | |
WO1990011562A1 (fr) | Unite de commande a action directe pour servomoteurs | |
CN113059464A (zh) | 一种恒力抛光机构及抛光设备 | |
JP2004326252A (ja) | ツイン同期制御方法 | |
Saied et al. | A novel model-based robust super-twisting sliding mode control of PKMs: Design and real-time experiments | |
CN110989504B (zh) | 一种五轴加工进给速度的区间自适应规划方法 | |
JP4781000B2 (ja) | サーボ制御装置 | |
JP6068779B2 (ja) | 直進型及び回転型ロボットの制御装置 | |
CN107443367A (zh) | 一种六轴机器人 | |
JPS616711A (ja) | ロボツトの位置サ−ボ制御装置 | |
CN113276116B (zh) | 一种误差可控的机器人轨迹同步过渡方法 | |
JP4171192B2 (ja) | サーボ制御装置 | |
WO1992004668A1 (en) | System for controlling servomotor | |
CN1332151C (zh) | 冗余度单层并联三自由度一体式柔顺精密定位平台 | |
CN113704909B (zh) | 一种凸轮从动件运动规律的设计方法及得到的凸轮 | |
Wu et al. | Design of a Novel Passive Polishing End-Effector With Adjustable Constant Force and Wide Operating Angle | |
JP2001277160A (ja) | ロボットの経路生成方法 | |
KR102641604B1 (ko) | 스카라 로봇의 작업 공간상의 직선 궤적을 생성하는 방법 |
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 |