CN113495565A - 一种机器人及其轨迹规划和平滑过渡方法、***及介质 - Google Patents
一种机器人及其轨迹规划和平滑过渡方法、***及介质 Download PDFInfo
- Publication number
- CN113495565A CN113495565A CN202110955714.8A CN202110955714A CN113495565A CN 113495565 A CN113495565 A CN 113495565A CN 202110955714 A CN202110955714 A CN 202110955714A CN 113495565 A CN113495565 A CN 113495565A
- Authority
- CN
- China
- Prior art keywords
- arc
- calculating
- robot
- straight line
- path
- 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
- 230000007704 transition Effects 0.000 title claims abstract description 38
- 238000000034 method Methods 0.000 title claims abstract description 31
- 230000001133 acceleration Effects 0.000 claims abstract description 35
- 230000036461 convulsion Effects 0.000 claims abstract description 8
- 239000000126 substance Substances 0.000 claims description 12
- 238000004590 computer program Methods 0.000 claims description 3
- 230000008569 process Effects 0.000 abstract description 6
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明提供了一种机器人轨迹规划和平滑过渡方法,包括输入机器人工作区域的n个特征点P1,P2……Pn;计算总路径L;输入总路径L、最大速度、最大加速度、最大加加速度,计算总的运动时间T、加速时间Ta、减速度时间Td、匀速时间Tv、所能达到的最大速度Vlim和最大加速度Alim;将运动时间离散化,计算每个插值点的位置p、速度v和加速度a,根据插值点的位置p和各个笛卡尔空间路径长度li和cj,确定当前所在笛卡尔空间的线段,计算对应的笛卡尔空间位置P;控制机器人按照指定路径运行。本发明机器人速度曲线更加平滑,机器人运行过程中冲击更小;且多段路径衔接平滑,避免机器人频繁加减速。
Description
技术领域
本发明涉及机器人轨迹规划的技术领域,具体地,涉及一种机器人及其轨迹规划和平滑过渡方法、***及介质。
背景技术
机器人在笛卡尔空间进行轨迹规划时,为了必满冲击,需要满足一定的速度、加速度和加加速度限制,单纯采用直线加减速,梯形加减速不能满足这些要求。
在公开号为CN103645725A的中国发明专利中公开了一种机器人示教轨迹规划方法和***,涉及工业过程中的机器人示教领域,其包括:在对机器人进行示教过程中,采集示教轨迹的空间关键点;根据示教轨迹的空间关键点,用多结点样条插值函数以及最小二乘拟合方法,得到示教轨迹曲线。本发明还用一个弧长误差控制的插补算法,实现示教再现动作的平滑。
机器人在执行任务过程中,为了精确到达轨迹点,速度必须降为零,下一段路径再从零开始加速,影响工作效率,采用圆弧过渡能够将轨迹平滑的衔接起来。
发明内容
针对现有技术中的缺陷,本发明的目的是提供一种机器人及其轨迹规划和平滑过渡方法、***及介质。
根据本发明提供的一种机器人轨迹规划和平滑过渡方法,所述方法包括如下步骤:
步骤S1:输入机器人工作区域的n个特征点P1,P2···Pn;
步骤S2:将特征点用直线连接起来,在连接处采用圆弧过渡,将n-1条线段分为n-1条小线段和n-2条圆弧;
步骤S3:计算总路径L,总路径L为n-1条小线段的长度和n-2条圆弧长的总和;
步骤S4:输入总路径L、最大速度、最大加速度、最大加加速度,计算总的运动时间T、加速时间Ta、减速度时间Td、匀速时间Tv、所能达到的最大速度Vlim和最大加速度Alim;
步骤S5:将运动时间离散化,计算每个插值点的位置p、速度v和加速度a,根据插值点的位置p和各个笛卡尔空间路径长度li和cj,确定当前所在笛卡尔空间的线段,计算对应的笛卡尔空间位置P;
步骤S6:控制机器人按照指定路径运行。
优选地,所述步骤S2中的圆弧过渡方法包括如下步骤:
步骤S2.1:根据直线P2P1和P2P3,计算直线的夹角alpha;
步骤S2.2:根据夹角alpha和圆弧半径r,分别计算圆弧与直线P2P1和P2P3的切点P1t和P2t作为圆弧的起始点;
步骤S2.3:根据圆弧的圆心角和半径计算圆弧的弧长C1,得到圆弧的路径。
本发明还提供一种机器人轨迹规划和平滑过渡***,所述***包括如下模块:
模块M1:输入机器人工作区域的n个特征点P1,P2···Pn;
模块M2:将特征点用直线连接起来,在连接处采用圆弧过渡,将n-1条线段分为n-1条小线段和n-2条圆弧;
模块M3:计算总路径L,总路径L为n-1条小线段的长度和n-2条圆弧长的总和;
模块M4:输入总路径L、最大速度、最大加速度、最大加加速度,计算总的运动时间T、加速时间Ta、减速度时间Td、匀速时间Tv、所能达到的最大速度Vlim和最大加速度Alim;
模块M5:将运动时间离散化,计算每个插值点的位置p、速度v和加速度a,根据插值点的位置p和各个笛卡尔空间路径长度li和cj,确定当前所在笛卡尔空间的线段,计算对应的笛卡尔空间位置P;
模块M6:控制机器人按照指定路径运行。
优选地,所述模块M2中的圆弧过渡方法包括如下步骤:
模块M2.1:根据直线P2P1和P2P3,计算直线的夹角alpha;
模块M2.2:根据夹角alpha和圆弧半径r,分别计算圆弧与直线P2P1和P2P3的切点P1t和P2t作为圆弧的起始点;
模块M2.3:根据圆弧的圆心角和半径计算圆弧的弧长C1,得到圆弧的路径。
本发明还提供一种存储有计算机程序的计算机可读存储介质,所述计算机程序被处理器执行时实现上述中的方法的步骤。
本发明还提供一种机器人,所述机器人包含上述中的一种机器人轨迹规划和平滑过渡***。
与现有技术相比,本发明具有如下的有益效果:
1、本发明机器人速度曲线更加平滑,机器人运行过程中冲击更小;
2、本发明多段路径衔接平滑,避免机器人频繁加减速。
附图说明
通过阅读参照以下附图对非限制性实施例所作的详细描述,本发明的其它特征、目的和优点将会变得更明显:
图1为本发明笛卡尔位置曲线图;
图2为本发明笛卡尔速度曲线图。
具体实施方式
下面结合具体实施例对本发明进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本发明,但不以任何形式限制本发明。应当指出的是,对本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变化和改进。这些都属于本发明的保护范围。
本发明提供的一种机器人轨迹规划和平滑过渡方法、***及介质,实现机器人在连续路径中满足一定速度、加速度、加加速度条件运动,减小运动过程中的冲击。多段轨迹采用圆弧过渡衔接为连续轨迹。
本发明采用的技术方案如下:输入机器人工作区域的n个特征点p1,p2···pn,将特征点用直线连接起来,在连接处采用圆弧过渡,将n-1条线段分为n-1条小线段和n-2条圆弧。
圆弧过渡的方法为:根据直线p2p1和p2p3,计算直线的夹角其中,表示直线段P2P1的向量,表示直线段P2P3的向量,|p2p1|表示直线段P2P1的模,|p2p3|表示直线段P2P3的模;根据夹角alpha和圆弧半径r,圆弧半径是圆弧过渡参数,根据实际情况确定,分别计算圆弧与直线p2p1和p2p3的切点p1t和p2t作为圆弧的起始点,根据圆弧的圆心角和半径计算圆弧的弧长c1,即圆弧的路径。
根据运动路径L、最大速度、最大加速度和最大加加速度,通过s形速度规划算法,计算总的运动时间T、加速时间Ta、减速度时间Td、匀速时间Tv以及所能达到的最大速度Vlim和最大加速度Alim等运动信息。
将运动时间离散化,根据每个插值周期时间和总运动时间T,计算运动时间序列,计算每个插值点的位置p,速度v和加速度a,将时间序列带入到s形规划算法的轨迹公式,就可以计算每个插值插值点的位置,速度,加速度,根据某一时刻位置p和各个笛卡尔空间路径长度li和cj,Li是第i条直线段长度:比如P1,笛卡尔坐标为(x1,y1,z1)到P2,笛卡尔坐标为(x2,y2,z2)的线段,直线段长度 cj是第j条圆弧长度:cj=alpha*r,alpha表示圆弧的圆心角,r表示半径。确定当前所在笛卡尔空间的线段,计算对应的笛卡尔空间位置P,根据某一时刻的位置p确定所在笛卡尔空间的路径,如果在直线段上,得到所在直线段长度dl:笛卡尔空间的位置其中P和P1表示笛卡尔空间坐标,表示线段向量,|p2p1|表示线段长度。如果在圆弧上,(1)计算当前时刻所在圆弧路径圆形角theta=dl/r,其中dl是所在圆弧的路径长度,r为圆弧半径,(2)以圆弧圆心O为原点,为x轴,垂直平面的法向量为z轴建立坐标系,在圆弧平面内计算位置parc,parc(1)=r*cos(theta),parc(2)=r*sin(theta),parc(3)=0,(3)笛卡尔空间的位置P=c+rot*parc,其中c为圆心坐标,rot为圆弧坐标系相对于全局坐标系的变换关系,parc为圆弧坐标系下的坐标。根据计算的笛卡尔空间位置P,控制机器人按照指定路径运行。
本发明还提供一种机器人轨迹规划和平滑过渡***,***包括如下模块:
模块M1:输入机器人工作区域的n个特征点P1,P2···Pn。
模块M2:将特征点用直线连接起来,在连接处采用圆弧过渡,将n-1条线段分为n-1条小线段和n-2条圆弧;模块M2.1:根据直线P2P1和P2P3,计算直线的夹角alpha:其中,表示直线段P2P1的向量,表示直线段P2P3的向量,|p2p1|表示直线段P2P1的模,|p2p3|表示直线段P2P3的模;模块M2.2:根据夹角alpha和圆弧半径r,分别计算圆弧与直线P2P1和P2P3的切点P1t和P2t作为圆弧的起始点;模块M2.3:根据圆弧的圆心角和半径计算圆弧的弧长C1,得到圆弧的路径。
模块M4:输入总路径L、最大速度、最大加速度、最大加加速度,计算总的运动时间T、加速时间Ta、减速度时间Td、匀速时间Tv、所能达到的最大速度Vlim和最大加速度Alim。
模块M5:将运动时间离散化,计算每个插值点的位置p、速度v和加速度a,根据插值点的位置p和各个笛卡尔空间路径长度li和cj,确定当前所在笛卡尔空间的线段,计算对应的笛卡尔空间位置P。
模块M6:控制机器人按照指定路径运行。
本发明还提供一种存储有计算机程序的计算机可读存储介质,计算机程序被处理器执行时实现上述中的方法的步骤。
本发明还提供一种机器人,机器人包含上述中的一种机器人轨迹规划和平滑过渡***。
本发明的机器人速度曲线更加平滑,机器人运行过程中冲击更小;且多段路径衔接平滑,避免机器人频繁加减速。
本领域技术人员知道,除了以纯计算机可读程序代码方式实现本发明提供的***及其各个装置、模块、单元以外,完全可以通过将方法步骤进行逻辑编程来使得本发明提供的***及其各个装置、模块、单元以逻辑门、开关、专用集成电路、可编程逻辑控制器以及嵌入式微控制器等的形式来实现相同功能。所以,本发明提供的***及其各项装置、模块、单元可以被认为是一种硬件部件,而对其内包括的用于实现各种功能的装置、模块、单元也可以视为硬件部件内的结构;也可以将用于实现各种功能的装置、模块、单元视为既可以是实现方法的软件模块又可以是硬件部件内的结构。
以上对本发明的具体实施例进行了描述。需要理解的是,本发明并不局限于上述特定实施方式,本领域技术人员可以在权利要求的范围内做出各种变化或修改,这并不影响本发明的实质内容。在不冲突的情况下,本申请的实施例和实施例中的特征可以任意相互组合。
Claims (10)
1.一种机器人轨迹规划和平滑过渡方法,其特征在于,所述方法包括如下步骤:
步骤S1:输入机器人工作区域的n个特征点P1,P2···Pn;
步骤S2:将特征点用直线连接起来,在连接处采用圆弧过渡,将n-1条线段分为n-1条小线段和n-2条圆弧;
步骤S3:计算总路径L,总路径L为n-1条小线段的长度和n-2条圆弧长的总和;
步骤S4:输入总路径L、最大速度、最大加速度、最大加加速度,计算总的运动时间T、加速时间Ta、减速度时间Td、匀速时间Tv、所能达到的最大速度Vlim和最大加速度Alim;
步骤S5:将运动时间离散化,计算每个插值点的位置p、速度v和加速度a,根据插值点的位置p和各个笛卡尔空间路径长度li和cj,确定当前所在笛卡尔空间的线段,计算对应的笛卡尔空间位置P;
步骤S6:控制机器人按照指定路径运行。
2.根据权利要求1所述的一种机器人轨迹规划和平滑过渡方法,其特征在于,所述步骤S2中的圆弧过渡方法包括如下步骤:
步骤S2.1:根据直线P2P1和P2P3,计算直线的夹角alpha;
步骤S2.2:根据夹角alpha和圆弧半径r,分别计算圆弧与直线P2P1和P2P3的切点P1t和P2t作为圆弧的起始点;
步骤S2.3:根据圆弧的圆心角和半径计算圆弧的弧长C1,得到圆弧的路径。
5.一种机器人轨迹规划和平滑过渡***,其特征在于,所述***包括如下模块:
模块M1:输入机器人工作区域的n个特征点P1,P2···Pn;
模块M2:将特征点用直线连接起来,在连接处采用圆弧过渡,将n-1条线段分为n-1条小线段和n-2条圆弧;
模块M3:计算总路径L,总路径L为n-1条小线段的长度和n-2条圆弧长的总和;
模块M4:输入总路径L、最大速度、最大加速度、最大加加速度,计算总的运动时间T、加速时间Ta、减速度时间Td、匀速时间Tv、所能达到的最大速度Vlim和最大加速度Alim;
模块M5:将运动时间离散化,计算每个插值点的位置p、速度v和加速度a,根据插值点的位置p和各个笛卡尔空间路径长度li和cj,确定当前所在笛卡尔空间的线段,计算对应的笛卡尔空间位置P;
模块M6:控制机器人按照指定路径运行。
6.根据权利要求5所述的一种机器人轨迹规划和平滑过渡***,其特征在于,所述模块M2中的圆弧过渡方法包括如下步骤:
模块M2.1:根据直线P2P1和P2P3,计算直线的夹角alpha;
模块M2.2:根据夹角alpha和圆弧半径r,分别计算圆弧与直线P2P1和P2P3的切点P1t和P2t作为圆弧的起始点;
模块M2.3:根据圆弧的圆心角和半径计算圆弧的弧长C1,得到圆弧的路径。
9.一种存储有计算机程序的计算机可读存储介质,其特征在于,所述计算机程序被处理器执行时实现权利要求1-4中任一项所述的方法的步骤。
10.一种机器人,其特征在于,所述机器人包含如权利要求5-8任一项所述的一种机器人轨迹规划和平滑过渡***。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110955714.8A CN113495565A (zh) | 2021-08-19 | 2021-08-19 | 一种机器人及其轨迹规划和平滑过渡方法、***及介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110955714.8A CN113495565A (zh) | 2021-08-19 | 2021-08-19 | 一种机器人及其轨迹规划和平滑过渡方法、***及介质 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113495565A true CN113495565A (zh) | 2021-10-12 |
Family
ID=77996832
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110955714.8A Pending CN113495565A (zh) | 2021-08-19 | 2021-08-19 | 一种机器人及其轨迹规划和平滑过渡方法、***及介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113495565A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114012214A (zh) * | 2021-11-17 | 2022-02-08 | 佛山市南海区广工大数控装备协同创新研究院 | 一种焊缝跟踪运动控制方法 |
CN114179085A (zh) * | 2021-12-16 | 2022-03-15 | 上海景吾智能科技有限公司 | 机器人控制、轨迹衔接与平滑处理的方法及*** |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107030697A (zh) * | 2017-04-28 | 2017-08-11 | 广州大学 | 一种机器人笛卡尔空间平滑轨迹的规划方法 |
CN111791236A (zh) * | 2020-07-17 | 2020-10-20 | 广东拓斯达科技股份有限公司 | 一种工业机器人笛卡尔空间轨迹过渡方法 |
CN112077851A (zh) * | 2020-09-17 | 2020-12-15 | 南京埃斯顿自动化股份有限公司 | 一种基于混合空间的工业机器人过渡轨迹规划方法 |
-
2021
- 2021-08-19 CN CN202110955714.8A patent/CN113495565A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107030697A (zh) * | 2017-04-28 | 2017-08-11 | 广州大学 | 一种机器人笛卡尔空间平滑轨迹的规划方法 |
CN111791236A (zh) * | 2020-07-17 | 2020-10-20 | 广东拓斯达科技股份有限公司 | 一种工业机器人笛卡尔空间轨迹过渡方法 |
CN112077851A (zh) * | 2020-09-17 | 2020-12-15 | 南京埃斯顿自动化股份有限公司 | 一种基于混合空间的工业机器人过渡轨迹规划方法 |
Non-Patent Citations (2)
Title |
---|
郭建根: "基于ROS的轮式移动机械臂轨迹规划研究", 中国优秀硕士论文全文数据库(电子期刊), no. 09, pages 140 - 398 * |
韩业鹏等: "S 曲线加减速控制在数控机床研究中的应用进展", 机电工程技术, vol. 49, no. 03, pages 170 - 173 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114012214A (zh) * | 2021-11-17 | 2022-02-08 | 佛山市南海区广工大数控装备协同创新研究院 | 一种焊缝跟踪运动控制方法 |
CN114179085A (zh) * | 2021-12-16 | 2022-03-15 | 上海景吾智能科技有限公司 | 机器人控制、轨迹衔接与平滑处理的方法及*** |
CN114179085B (zh) * | 2021-12-16 | 2024-02-06 | 上海景吾智能科技有限公司 | 机器人控制、轨迹衔接与平滑处理的方法及*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112378408B (zh) | 一种实现轮式移动机器人实时避障的路径规划方法 | |
CN113495565A (zh) | 一种机器人及其轨迹规划和平滑过渡方法、***及介质 | |
Sundar et al. | Optimal obstacle avoidance based on the Hamilton-Jacobi-Bellman equation | |
JP7332199B2 (ja) | 共用ワークスペースにおける複数のロボットの動作計画 | |
CN108153310B (zh) | 一种基于人类行为模拟的移动机器人实时运动规划方法 | |
EP3403772A1 (en) | Robot motion planning for avoiding collision with moving obstacles | |
CN111158318B (zh) | 一种非对称性四次曲线柔性加减速规划方法 | |
CN114952868B (zh) | 7自由度srs型机械臂控制方法及装置、弹琴机器人 | |
Liu et al. | Online time-optimal trajectory planning for robotic manipulators using adaptive elite genetic algorithm with singularity avoidance | |
CN108772835B (zh) | 一种障碍物与物理极限躲避方法 | |
CN113031621B (zh) | 一种桥式起重机安全避障路径规划方法及*** | |
CN109866222B (zh) | 一种基于天牛须优化策略的机械臂运动规划方法 | |
CN110561420A (zh) | 臂型面约束柔性机器人轨迹规划方法及装置 | |
CN112925342A (zh) | 基于改进相互速度障碍法的无人机动态避障方法 | |
CN113741336A (zh) | 基于实时运动的笛卡尔空间轨迹规划方法和*** | |
WO2022161315A1 (zh) | 机器人路径规划方法、运行方法、机器人以及介质 | |
CN114274147A (zh) | 目标跟踪控制方法及装置、机械臂控制设备和存储介质 | |
CN115922684A (zh) | 用于六轴机器人的奇异点处理方法、装置、设备及介质 | |
Ji et al. | A computational interactive approach to multi-agent motion planning | |
Xiong et al. | Analysis of an efficient rule-based motion planning system for simulating human crowds | |
CN117301063A (zh) | 工业机器人在线前瞻轨迹规划方法、电子设备及存储介质 | |
Fan et al. | Research and implementation of multi-robot path planning based on genetic algorithm | |
CN108415239B (zh) | 一种基于动态构建可达集的直接控制分配方法 | |
Xiong et al. | A rule-based motion planning for crowd simulation | |
CN112904855B (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 | ||
CB02 | Change of applicant information | ||
CB02 | Change of applicant information |
Address after: 311231 building 3, No. 477, Hongxing Road, Qiaonan block, economic and Technological Development Zone, Xiaoshan District, Hangzhou City, Zhejiang Province Applicant after: Hangzhou Jingwu Intelligent Technology Co.,Ltd. Address before: Room 12, 3rd floor, No.2 Lane 1446, Yunguan Road, Lingang New District, Pudong New Area pilot Free Trade Zone, Shanghai, 201306 Applicant before: Shanghai Jingwu Intelligent Technology Co.,Ltd. |