CN107390634A - 一种工业机器人轨迹五次多项式规划方法 - Google Patents
一种工业机器人轨迹五次多项式规划方法 Download PDFInfo
- Publication number
- CN107390634A CN107390634A CN201710770454.0A CN201710770454A CN107390634A CN 107390634 A CN107390634 A CN 107390634A CN 201710770454 A CN201710770454 A CN 201710770454A CN 107390634 A CN107390634 A CN 107390634A
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- mtd
- mtr
- msup
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/404—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/35—Nc in input of data, input till input file format
- G05B2219/35408—Calculate new position data from actual data to compensate for contour error
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明公开了一种工业机器人轨迹五次多项式规划方法。该方法根据轨迹的起止位移、速度和加速度信息，利用S型轨迹规划的速度趋势，拟合出五次多项式轨迹规划的插补时间，进一步确定出五次多项式轨迹规划模型。本发明所提出的五次多项式规划方法，根据S型轨迹规划的速度运行趋势确定出五次多项式轨迹规划模型，能够解决五次多项式曲线形状不固定，易发生扭摆的情况，保证规划过程中速度的变化成单调性，不会发生较大的凸度和反向的情况，保证所规划的轨迹在轨迹的起点到终点的各个时刻均可以满足机器人固有的运动参数限制，且相较于常用的梯形规划和S型规划模型规划曲线更加平滑，轨迹运行过程更加平稳。
Description
技术领域
本发明涉及一种工业机器人的轨迹规划方法，具体说，是一种工业机器人轨迹五次多项式规划方法。
背景技术
轨迹规划是机器人技术应用的基础。机器人轨迹规划是规划机器人末端或各个关节在起点和终点之间的路径、速度、加速度及加加速度等信息。机器人轨迹规划在两种空间中进行：关节空间和笛卡尔空间，但无论在哪个空间进行轨迹规划，均要保证所规划的轨迹是连续的、平滑的，并且满足机器人固有的运动参数要求，保证机器人平稳的运动。
经文献研究，目前常见的工业机器人轨迹规划有梯形规划、S型规划及多项式规划，多项式规划中较多的是五次多项式规划。梯形规划最简单，但是由于其阶数较低，单段运动中加速度是不连续的，这样会带来机器人振动，对机器产生强烈的冲击；S型规划相较于梯形规划最高阶次多一阶，可以保证单段运动中加速度是连续的，但是加加速度是不连续的，依然会带来机械上的冲击，而且多段运动时，段与段之间的加速度的连续性是不能保证的，在段与段的衔接处很容易引起机械抖动；五次多项式轨迹，阶数上比S型曲线更高，因此其更为平滑，可以保证单段运动中位移、速度、加速度、加加速度均连续，且可以保证段与段之间的加速度连续，运动平稳。五次多项式的规划在过渡规划中应用较多，如文献《机械手笛卡尔空间轨迹规划研究[J]》(林仕高，刘晓麟，欧元贤，《机械设计与制造》，2013(3)：49-52)，在连续轨迹的两条曲线间采用五次多项式过渡，使得机械手末端轨迹速度连续平滑和加速度平滑。
但是五次多项式规划最大的问题，就是五次多项式曲线形状的不固定性，曲线容易出现摇摆，若规划的时间选取的不好，规划过程中很容易出现位移、速度、加速度曲线摇摆，不受控制，很可能超出机器人本身的运动参数限制，导致超速、超加速度等问题而使机器人异常停机。
发明内容
本发明所要解决的技术问题在于，克服现有技术存在的上述缺陷，提出了一种工业机器人轨迹五次多项式规划方法。本发明方法能够保证规划曲线运动趋势类似S型规划，形状固定，使得规划过程中各个点均满足机器人本身运动参数的限制，同时保留上述五次曲线固有的优势。
本发明提出一种工业机器人轨迹五次多项式规划方法，目的是解决由于五次多项式曲线形状不固定而带来所规划曲线的过程中会出现超出机器人本身运动参数限制的问题，保证所规划的轨迹各个时刻位移、速度、加速度连续，曲线平滑，且满足机器人固有的运动参数限制。
本发明所提出的一种工业机器人轨迹五次多项式规划方法，模型为：
s(t)＝a5t5+a4t4+a3t3+a2t2+a1t+a0 (1)
式中，s(t)为关节空间的位移或笛卡尔空间的位移；a0,a1,a2,a3,a4,a5为五次多项式系数；t为插补时间。
轨迹的起始位移s0、起始速度v0、起始加速度acc0，终止位移se、终止速度ve、终止加速度acce已知，满足：
六个方程，七个未知数(a0,a1,a2,a3,a4,a5及插补总时间te)，无法得到所有未知数。因此，先人为设定出插补总时间，再利用上述条件去确定五次多项式的系数，但是如果插补总时间不同，五次多项式的形状也不同。如附图1～附图3：同样的起止条件(s0＝0,v0＝0,acc0＝0，se＝100,ve＝100,acce＝0)，不同的插补时间(te＝0.4s,2s,10s)的曲线图。由图可以看出，图2的规划最好，图1由于插补时间选择的较短，速度凸度较大，最大速度很高，超过本身的速度约束(最大速度为100)，图3由于插补时间选择的较长，运动过程中位移和速度出现反向，曲线形状发生扭摆，而且时间选择的较长降低机器人运行效率。
基于此，本发明所提出的工业机器人轨迹五次多项式规划方法(简称五次规划)，根据S型规划曲线形状固定的原理，巧妙设计五次多项式规划的插补时间，排除曲线形状发生扭摆的情况。
本发明为实现发明目的，所提出的工业机器人轨迹五次多项式规划方法，其步骤如下：
步骤1，确定轨迹的起止位移、速度、加速度信息
轨迹预处理模块根据示教出的起止位置点，结合固有的运动参数限制，确定出轨迹的有效起止位移、速度和加速度信息，并输入给轨迹规划模块。起点信息：起始位移s0、起始速度v0、起始加速度acc0。终止信息：终止位移se、终止速度ve、终止加速度acce。步骤2，确定五次多项式轨迹规划插补时间
结合S型轨迹规划曲线形状的固定性，利用S型轨迹规划的速度趋势，拟合出五次多项式轨迹规划插补时间：
步骤3，确定五次多项式轨迹规划模型
根据步骤1确定的路径起止信息及步骤2确定的插补时间，确定出五次多项式模型参数a0,a1,a2,a3,a4,a5。
由公式(1)可以推出以下公式：
将公式(2)满足的条件，代入公式(4)，得到系数a0,a1,a2,a3,a4,a5：
其中，C(1)为矩阵C的第一个元素，C(2)为矩阵C的第二个元素，C(3)为矩阵C的第三个元素，矩阵C满足下式。
C＝A-1*B
步骤4，确定细插补周期进行五次多项式规划
根据细插补周期，按步骤3确定出的五次多项式规划模型，实时地输出起点到终点各个时刻的位置，完成起点到终点间的轨迹规划。
本发明方法，运用S型规划所具有的曲线固定的特性，根据S型轨迹规划的速度运行趋势，拟合出五次多项式规划的插补时间，解决了五次多项式曲线形状不固定，易发生扭摆的情况，保证规划过程中速度的变化成单调性，不会发生较大的凸度和反向的情况，保证所规划的轨迹在轨迹的起点到终点的各个时刻均可以满足机器人固有的运动参数限制。本发明方法关键在于所设计的插补时间，解决了五次多项式曲线易发生扭摆的现象，保证所规划的轨迹在轨迹的各个时刻均满足固有的运动参数限制。
本发明方法，相较于常用的梯形规划和S型规划模型阶数更高，因此规划曲线更加平滑，运行过程更加平稳。采用五次多项式的规划，可以保证轨迹起止点间位置、速度、加速度和加加速度均连续，且可以保证多段运动过程中段与段之间位置、速度和加速度也是连续的，使得段与段的衔接处运动依然平稳。
附图说明
图1是本发明方法t＝0.4s的五次规划曲线。
图2是本发明方法t＝2s的五次规划曲线。
图3是本发明方法t＝10s的五次规划曲线。
图4是本发明工业机器人轨迹五次多项式规划方法流程图。
图5是本发明用于工业机器人过渡的五次规划曲线(位移)。
图6是本发明用于工业机器人过渡的五次规划曲线(速度)。
图7是本发明用于工业机器人过渡的五次规划曲线(加速度)。
具体实施方式
下面结合具体实施例，对本发明方法作进一步详细说明。
实施例
以某工业机器人直线间过渡为例，采用五次多项式轨迹规划。
1、确定轨迹的起止位移、速度、加速度信息
轨迹预处理模块根据示教出的起止位置点，结合固有的运动参数限制，确定出轨迹的有效起止位移、速度和加速度信息。
s0＝0，v0＝20，acc0＝0；
se＝100，ve＝82，acce＝0。
2、确定五次规划插补时间
公式(3)确定出插补时间1.961s,由于系统的细插补周期为0.004s，取插补时间为细插补周期的整数倍，向上取整，确定五次规划插补时间te＝1.964s。
3、确定五次规划模型
公式(5)和(6)确定出五次规划模型。
a0＝0，a1＝20，a2＝0，a3＝15.8570，
a4＝-3.9267，a5＝-0.0337
4、确定细插补周期进行五次规划
系统细插补模块确定出细插补周期为0.004s，根据细插补周期进行过渡段五次规划，规划曲线如附图5所示。
Claims (1)
1.一种工业机器人轨迹五次多项式规划方法，
五次多项式模型为：
s(t)＝a5t5+a4t4+a3t3+a2t2+a1t+a0
式中，s(t)为关节空间的位移或笛卡尔空间的位移；a0,a1,a2,a3,a4,a5为五次多项式系数；t为插补时间；
其规划步骤如下：
步骤1，确定轨迹的起止位移、速度、加速度信息
轨迹预处理模块根据示教出的起止位置点，结合固有的运动参数限制，确定出轨迹的有效起止位移、速度和加速度信息，并输入给轨迹规划模块；起点信息：起始位移s0、起始速度v0、起始加速度acc0。终止信息：终止位移se、终止速度ve、终止加速度acce；
步骤2，确定五次多项式轨迹规划插补时间：
<mrow>
<msub>
<mi>t</mi>
<mi>e</mi>
</msub>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>(</mo>
<msub>
<mi>s</mi>
<mi>e</mi>
</msub>
<mo>-</mo>
<msub>
<mi>s</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
<mo>/</mo>
<msub>
<mi>v</mi>
<mi>e</mi>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>(</mo>
<msub>
<mi>v</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<msub>
<mi>v</mi>
<mi>e</mi>
</msub>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>s</mi>
<mi>e</mi>
</msub>
<mo>-</mo>
<msub>
<mi>s</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>/</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>v</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<msub>
<mi>v</mi>
<mi>e</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>(</mo>
<msub>
<mi>v</mi>
<mn>0</mn>
</msub>
<mo>&NotEqual;</mo>
<msub>
<mi>v</mi>
<mi>e</mi>
</msub>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
步骤3，确定五次多项式轨迹规划模型参数
根据步骤1确定的起止信息及步骤2确定的插补时间，确定出五次多项式模型参数：
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<msub>
<mi>s</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>v</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>acc</mi>
<mn>0</mn>
</msub>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mi>C</mi>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>4</mn>
</msub>
<mo>=</mo>
<mi>C</mi>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mn>5</mn>
</msub>
<mo>=</mo>
<mi>C</mi>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中，C(1)为矩阵C的第一个元素，C(2)为矩阵C的第二个元素，C(3)为矩阵C的第三个元素，矩阵C满足：
C＝A-1*B
<mrow>
<mi>A</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>t</mi>
<mi>e</mi>
</msub>
<mn>5</mn>
</msup>
</mrow>
</mtd>
<mtd>
<mrow>
<msup>
<msub>
<mi>t</mi>
<mi>e</mi>
</msub>
<mn>4</mn>
</msup>
</mrow>
</mtd>
<mtd>
<mrow>
<msup>
<msub>
<mi>t</mi>
<mi>e</mi>
</msub>
<mn>3</mn>
</msup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mn>5</mn>
<msup>
<msub>
<mi>t</mi>
<mi>e</mi>
</msub>
<mn>4</mn>
</msup>
</mrow>
</mtd>
<mtd>
<mrow>
<mn>4</mn>
<msup>
<msub>
<mi>t</mi>
<mi>e</mi>
</msub>
<mn>3</mn>
</msup>
</mrow>
</mtd>
<mtd>
<mrow>
<mn>3</mn>
<msup>
<msub>
<mi>t</mi>
<mi>e</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mn>20</mn>
<msup>
<msub>
<mi>t</mi>
<mi>e</mi>
</msub>
<mn>3</mn>
</msup>
</mrow>
</mtd>
<mtd>
<mrow>
<mn>12</mn>
<msup>
<msub>
<mi>t</mi>
<mi>e</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mtd>
<mtd>
<mrow>
<mn>6</mn>
<msub>
<mi>t</mi>
<mi>e</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<mi>B</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>s</mi>
<mi>e</mi>
</msub>
<mo>-</mo>
<msub>
<mi>a</mi>
<mn>0</mn>
</msub>
<mo>-</mo>
<msub>
<mi>a</mi>
<mn>1</mn>
</msub>
<msub>
<mi>t</mi>
<mi>e</mi>
</msub>
<mo>-</mo>
<msub>
<mi>a</mi>
<mn>2</mn>
</msub>
<msup>
<msub>
<mi>t</mi>
<mi>e</mi>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>v</mi>
<mi>e</mi>
</msub>
<mo>-</mo>
<msub>
<mi>a</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mn>2</mn>
<msub>
<mi>a</mi>
<mn>2</mn>
</msub>
<msub>
<mi>t</mi>
<mi>e</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>acc</mi>
<mi>e</mi>
</msub>
<mo>-</mo>
<mn>2</mn>
<msub>
<mi>a</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
步骤4，确定细插补周期进行五次多项式规划
根据细插补周期，按步骤3确定出的五次多项式规划模型，实时地输出起点到终点各个时刻的位置，完成起点到终点间的轨迹规划。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710770454.0A CN107390634B (zh) | 2017-08-31 | 2017-08-31 | 一种工业机器人轨迹五次多项式规划方法 |
| PCT/CN2017/117062 WO2019041657A1 (zh) | 2017-08-31 | 2017-12-19 | 一种工业机器人轨迹五次多项式规划方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710770454.0A CN107390634B (zh) | 2017-08-31 | 2017-08-31 | 一种工业机器人轨迹五次多项式规划方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107390634A true CN107390634A (zh) | 2017-11-24 |
| CN107390634B CN107390634B (zh) | 2019-11-12 |
Family
ID=60347224
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710770454.0A Active CN107390634B (zh) | 2017-08-31 | 2017-08-31 | 一种工业机器人轨迹五次多项式规划方法 |
Country Status (2)
| Country | Link |
|---|---|
| CN (1) | CN107390634B (zh) |
| WO (1) | WO2019041657A1 (zh) |
Cited By (18)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108646674A (zh) * | 2018-07-20 | 2018-10-12 | 深圳市众为创造科技有限公司 | 位置s型平滑指令产生方法、系统和电子设备 |
| CN108994418A (zh) * | 2018-07-26 | 2018-12-14 | 上海工程技术大学 | 一种管-管相贯线机器人运动轨迹规划方法 |
| CN109108983A (zh) * | 2018-10-12 | 2019-01-01 | 中国航天空气动力技术研究院 | 基于分拣工艺的机械手轨迹规划方法 |
| WO2019041657A1 (zh) * | 2017-08-31 | 2019-03-07 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人轨迹五次多项式规划方法 |
| CN109505069A (zh) * | 2018-11-19 | 2019-03-22 | 杰克缝纫机股份有限公司 | 运动轨迹规划方法及其装置、贴袋机和存储介质 |
| CN109551478A (zh) * | 2018-11-16 | 2019-04-02 | 重庆邮电大学 | 一种基于集散控制系统的双机器人主从协调控制方法 |
| CN109814568A (zh) * | 2019-02-19 | 2019-05-28 | 百度在线网络技术（北京）有限公司 | 速度轨迹的生成方法、装置和存储介质 |
| CN109933008A (zh) * | 2019-03-28 | 2019-06-25 | 佛山智能装备技术研究院 | 一种非实时系统和机器人控制器的双插补方法及装置 |
| CN109968357A (zh) * | 2019-03-27 | 2019-07-05 | 杭州电子科技大学 | 一种直线轨迹间过渡运动的快速规划方法 |
| CN110231041A (zh) * | 2018-03-06 | 2019-09-13 | 北京京东尚科信息技术有限公司 | 一种车道切换的导航方法和装置 |
| CN110307853A (zh) * | 2018-03-27 | 2019-10-08 | 北京京东尚科信息技术有限公司 | 一种导航控制方法和装置 |
| CN111015669A (zh) * | 2019-12-27 | 2020-04-17 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人停止运动轨迹规划方法 |
| CN113110423A (zh) * | 2021-03-26 | 2021-07-13 | 深圳市优必选科技股份有限公司 | 步态轨迹规划方法、装置、计算机可读存储介质及机器人 |
| CN113110484A (zh) * | 2021-04-30 | 2021-07-13 | 深圳市优必选科技股份有限公司 | 一种步态轨迹规划方法、装置、可读存储介质及机器人 |
| CN113230093A (zh) * | 2021-06-17 | 2021-08-10 | 广西大学 | 适用于下肢康复机器人被动训练的可变类圆周步态规划 |
| CN113334385A (zh) * | 2021-06-24 | 2021-09-03 | 安徽理工大学 | 一种自驱动关节臂测量机直线轨迹间平滑过渡的规划方法 |
| CN116610070A (zh) * | 2023-07-20 | 2023-08-18 | 杭州芯控智能科技有限公司 | 基于笛卡尔空间的轨迹匀速过渡方法和装置 |
| CN117687417A (zh) * | 2024-01-29 | 2024-03-12 | 安徽大学 | 一种工业机器人外部运动轨迹规划方法及系统 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN1971457A (zh) * | 2005-11-25 | 2007-05-30 | 中国科学院沈阳计算技术研究所有限公司 | 一种用于数控机床的加减速控制方法 |
| CN102566511A (zh) * | 2010-12-09 | 2012-07-11 | 中国科学院沈阳计算技术研究所有限公司 | 五轴数控系统刀心点插补路径插值方法 |
| MX2012015057A (es) * | 2012-12-18 | 2014-06-20 | Itesm | Metodo quintico para la solucion de ecuaciones diferenciales no lineales. |
| CN105353725A (zh) * | 2015-11-18 | 2016-02-24 | 南京埃斯顿机器人工程有限公司 | 用于工业机器人的过辅助点姿态空间圆弧插补方法 |
| CN106863306A (zh) * | 2017-03-31 | 2017-06-20 | 华南理工大学 | 一种机器人关节空间平滑轨迹规划方法 |
Family Cites Families (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP3586110B2 (ja) * | 1998-08-13 | 2004-11-10 | 三菱電機株式会社 | 軌跡制御装置 |
| CN101525011A (zh) * | 2008-03-04 | 2009-09-09 | 王慧娟 | 一种跳跃机器人及采用惯性匹配的运动优化方法 |
| CN101733750B (zh) * | 2009-11-05 | 2011-05-04 | 浙江大学 | 基于动态响应谱的关节含间隙机器人轨迹规划方法 |
| CN102510793B (zh) * | 2010-06-04 | 2015-01-28 | 中国科学院自动化研究所 | 加速度连续的机器人轨迹生成系统和方法 |
| CN103235513B (zh) * | 2013-04-24 | 2016-12-28 | 武汉科技大学 | 一种基于遗传算法的移动机械臂轨迹规划优化方法 |
| CN107390634B (zh) * | 2017-08-31 | 2019-11-12 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人轨迹五次多项式规划方法 |
-
2017
- 2017-08-31 CN CN201710770454.0A patent/CN107390634B/zh active Active
- 2017-12-19 WO PCT/CN2017/117062 patent/WO2019041657A1/zh active Application Filing
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN1971457A (zh) * | 2005-11-25 | 2007-05-30 | 中国科学院沈阳计算技术研究所有限公司 | 一种用于数控机床的加减速控制方法 |
| CN102566511A (zh) * | 2010-12-09 | 2012-07-11 | 中国科学院沈阳计算技术研究所有限公司 | 五轴数控系统刀心点插补路径插值方法 |
| MX2012015057A (es) * | 2012-12-18 | 2014-06-20 | Itesm | Metodo quintico para la solucion de ecuaciones diferenciales no lineales. |
| CN105353725A (zh) * | 2015-11-18 | 2016-02-24 | 南京埃斯顿机器人工程有限公司 | 用于工业机器人的过辅助点姿态空间圆弧插补方法 |
| CN106863306A (zh) * | 2017-03-31 | 2017-06-20 | 华南理工大学 | 一种机器人关节空间平滑轨迹规划方法 |
Non-Patent Citations (1)
| Title |
|---|
| 陈憾: "空间冗余机械臂的路径规划算法研究", 《上海航天》 * |
Cited By (29)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2019041657A1 (zh) * | 2017-08-31 | 2019-03-07 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人轨迹五次多项式规划方法 |
| CN110231041A (zh) * | 2018-03-06 | 2019-09-13 | 北京京东尚科信息技术有限公司 | 一种车道切换的导航方法和装置 |
| CN110231041B (zh) * | 2018-03-06 | 2021-05-25 | 北京京东尚科信息技术有限公司 | 一种车道切换的导航方法和装置 |
| CN110307853A (zh) * | 2018-03-27 | 2019-10-08 | 北京京东尚科信息技术有限公司 | 一种导航控制方法和装置 |
| CN110307853B (zh) * | 2018-03-27 | 2021-11-02 | 北京京东尚科信息技术有限公司 | 一种导航控制方法和装置 |
| CN108646674A (zh) * | 2018-07-20 | 2018-10-12 | 深圳市众为创造科技有限公司 | 位置s型平滑指令产生方法、系统和电子设备 |
| CN108994418A (zh) * | 2018-07-26 | 2018-12-14 | 上海工程技术大学 | 一种管-管相贯线机器人运动轨迹规划方法 |
| CN109108983A (zh) * | 2018-10-12 | 2019-01-01 | 中国航天空气动力技术研究院 | 基于分拣工艺的机械手轨迹规划方法 |
| CN109551478A (zh) * | 2018-11-16 | 2019-04-02 | 重庆邮电大学 | 一种基于集散控制系统的双机器人主从协调控制方法 |
| CN109505069A (zh) * | 2018-11-19 | 2019-03-22 | 杰克缝纫机股份有限公司 | 运动轨迹规划方法及其装置、贴袋机和存储介质 |
| US11511748B2 (en) | 2019-02-19 | 2022-11-29 | Apollo Intelligent Driving Technology (Beijing) Co., Ltd. | Velocity trajectory generation method, apparatus, and storage medium |
| CN109814568A (zh) * | 2019-02-19 | 2019-05-28 | 百度在线网络技术（北京）有限公司 | 速度轨迹的生成方法、装置和存储介质 |
| CN109814568B (zh) * | 2019-02-19 | 2022-05-03 | 阿波罗智能技术(北京)有限公司 | 无人车速度轨迹的生成方法、装置和存储介质 |
| CN109968357A (zh) * | 2019-03-27 | 2019-07-05 | 杭州电子科技大学 | 一种直线轨迹间过渡运动的快速规划方法 |
| CN109968357B (zh) * | 2019-03-27 | 2022-04-05 | 杭州电子科技大学 | 一种直线轨迹间过渡运动的快速规划方法 |
| CN109933008A (zh) * | 2019-03-28 | 2019-06-25 | 佛山智能装备技术研究院 | 一种非实时系统和机器人控制器的双插补方法及装置 |
| CN109933008B (zh) * | 2019-03-28 | 2021-11-09 | 佛山智能装备技术研究院 | 一种非实时系统和机器人控制器的双插补方法及装置 |
| CN111015669B (zh) * | 2019-12-27 | 2022-03-11 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人停止运动轨迹规划方法 |
| CN111015669A (zh) * | 2019-12-27 | 2020-04-17 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人停止运动轨迹规划方法 |
| WO2022198995A1 (zh) * | 2021-03-26 | 2022-09-29 | 深圳市优必选科技股份有限公司 | 步态轨迹规划方法、装置、计算机可读存储介质及机器人 |
| CN113110423A (zh) * | 2021-03-26 | 2021-07-13 | 深圳市优必选科技股份有限公司 | 步态轨迹规划方法、装置、计算机可读存储介质及机器人 |
| CN113110423B (zh) * | 2021-03-26 | 2024-04-26 | 深圳市优必选科技股份有限公司 | 步态轨迹规划方法、装置、计算机可读存储介质及机器人 |
| CN113110484A (zh) * | 2021-04-30 | 2021-07-13 | 深圳市优必选科技股份有限公司 | 一种步态轨迹规划方法、装置、可读存储介质及机器人 |
| CN113110484B (zh) * | 2021-04-30 | 2024-06-21 | 深圳市优必选科技股份有限公司 | 一种步态轨迹规划方法、装置、可读存储介质及机器人 |
| CN113230093A (zh) * | 2021-06-17 | 2021-08-10 | 广西大学 | 适用于下肢康复机器人被动训练的可变类圆周步态规划 |
| CN113334385A (zh) * | 2021-06-24 | 2021-09-03 | 安徽理工大学 | 一种自驱动关节臂测量机直线轨迹间平滑过渡的规划方法 |
| CN116610070A (zh) * | 2023-07-20 | 2023-08-18 | 杭州芯控智能科技有限公司 | 基于笛卡尔空间的轨迹匀速过渡方法和装置 |
| CN116610070B (zh) * | 2023-07-20 | 2023-10-20 | 杭州芯控智能科技有限公司 | 基于笛卡尔空间的轨迹匀速过渡方法和装置 |
| CN117687417A (zh) * | 2024-01-29 | 2024-03-12 | 安徽大学 | 一种工业机器人外部运动轨迹规划方法及系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107390634B (zh) | 2019-11-12 |
| WO2019041657A1 (zh) | 2019-03-07 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107390634A (zh) | 一种工业机器人轨迹五次多项式规划方法 | |
| CN102799145B (zh) | 拐角多周期恒加加速度过渡的s曲线加减速直线插补方法 | |
| CN105082135B (zh) | 一种机器人点动操作的速度控制方法 | |
| CN104020665B (zh) | 基于多目标粒子群算法的机械臂最小跃度轨迹优化方法 | |
| CN103336855B (zh) | 一种基于多子群粒子群算法的二维不规则排样方法 | |
| US9764471B2 (en) | Trajectory generation apparatus for robot to generate trajectory including curved portion | |
| CN101130413A (zh) | 切纸机推纸器高速定位运动加减速控制方法 | |
| CN109426151B (zh) | 基于自适应前瞻和预测校正的实时柔性加减速控制算法 | |
| CN103454978B (zh) | 点胶、涂胶设备圆弧过渡轨迹速度规划方法 | |
| CN106950923A (zh) | 一种定插补周期的速度规划方法 | |
| CN106644382A (zh) | 基于多稳态分析的超空泡航行体运动轨迹规划方法 | |
| CN101508113A (zh) | 一种基于余弦二阶的机器人轨迹规划方法 | |
| CN111002308A (zh) | 基于分段多阶次多项式插值的工业机械臂路径规划方法 | |
| CN103970019A (zh) | 一种基于加速度动态配置的空间机器人抖动抑制轨迹规划方法 | |
| CN102023569B (zh) | 两轮轮式机器人点镇定增量式智能控制方法 | |
| CN117331381A (zh) | 一种雷达倒伏装置的加减速控制方法及系统 | |
| CN116610070A (zh) | 基于笛卡尔空间的轨迹匀速过渡方法和装置 | |
| CN103123668B (zh) | 一种基于混合单元法的空间绳系机器人系统的仿真方法 | |
| CN104950821B (zh) | 一种基于分数阶微积分的数控系统速度规划方法 | |
| CN103326646A (zh) | 一种基于步进电机的运动控制器速度控制方法 | |
| CN110450154A (zh) | 一种基于动力学的机械臂柔性控制方法 | |
| CN111045461B (zh) | 一种裁床的连续小线段离散速度控制方法 | |
| CN101997480A (zh) | 马达控制方法 | |
| CN103732007B (zh) | 基于四轴联动贴片机的贴装头运动路径优化方法 | |
| CN102880118B (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 | ||
| CB03 | Change of inventor or designer information |
Inventor after: Pan Tingting Inventor after: Jing Shuyi Inventor after: Feng Riyue Inventor after: Xia Zhengxian Inventor after: Wang Jihu Inventor after: Wang Jiegao Inventor before: Feng Riyue Inventor before: Wang Jihu Inventor before: Jing Shuyi Inventor before: Pan Tingting Inventor before: Ding Yadong Inventor before: Xia Zhengxian |
|
| CB03 | Change of inventor or designer information | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |