CN107598921A - 一种应用于六轴机械手臂的空间平滑停止控制方法 - Google Patents
一种应用于六轴机械手臂的空间平滑停止控制方法 Download PDFInfo
- Publication number
- CN107598921A CN107598921A CN201710747184.1A CN201710747184A CN107598921A CN 107598921 A CN107598921 A CN 107598921A CN 201710747184 A CN201710747184 A CN 201710747184A CN 107598921 A CN107598921 A CN 107598921A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- axis robot
- robot arm
- 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
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明提供一种应用于六轴机械手臂的空间平滑停止控制方法,包括以下步骤,测得并输入六轴机械手臂开始减速的初始点信息,包括位置,速度和加速度,并且假设六轴机械手臂经过时间段T,减速后停止点信息是速度为0,加速度为0。采用五次方程式作为减速阶段的位置插补算法,计算出位置,速度和加速度分别和任一插补采样时间点的关系,从而实现对六轴机械手臂的空间平滑停止控制。该控制方法采用5次线性方程推导出减速停止过程中机械手臂的减速运动曲线,使其从减速到停止更为平滑,更符合电机运转特性,对电机冲力较小,起到了很好的保护作用,延长了使用寿命。
Description
技术领域
本发明涉及机器人技术领域,更具体地,涉及一种应用于六轴机械手臂的 空间平滑停止控制方法。
背景技术
六轴机械手臂是目前集运动控制算法、空间轨迹规划算法、动力学算法、 伺服驱动控制及伺服电机、减速机等高科技含量的综合型智能设备。其中基于 运动控制和轨迹规划为核心的控制器又是机械手臂的大脑中枢,能够控制机械 手臂精准完成复杂、重复的动作,运动控制过程中运动控制的平滑性和轨迹规 划的合理性会影响机械手臂相关硬件设备的寿命与用户使用体验。机器人关节 空间平滑停止算法是全部六轴机械手臂众多运动控制算法中的一种,能够避免 机械手臂在正常停止过程中因速度产生骤变而损坏电机设备。
目前六轴机械手臂从正常运转状态减速转变为正常停止时,由于机械手臂 在运动过程中的惯性,停止时会产生较大的扭转力矩,这对电机承担的冲力较 大,且容易损坏电机齿轮。使用此控制算法后,在停止时,会提前发送缓冲减 速指令,在空间与时间允许的条件下减速停止。
发明内容
本发明要解决的技术问题在于,针对现有技术中机械手臂在运动过程中的 惯性,停止时会产生较大的扭转力矩,这对电机承担的冲力较大,且容易损坏 电机齿轮等缺陷,提供一种从减速到停止更为平滑,更符合电机运转特性,对 电机冲力较小的应用于六轴机械手臂的空间平滑停止控制方法。
本发明解决其技术问题所采用的技术方案是:提供一种应用于六轴机械手 臂的空间平滑停止控制方法,包括以下步骤:
测得并输入六轴机械手臂开始减速的初始点信息,位置P0,速度V0,加 速度A0,并且假设六轴机械手臂经过时间段T,减速后停止点信息是速度为0, 加速度为0,位置PT;
采用五次方程式作为减速阶段的位置插补算法,
P(t)=a0+a1t+a2t2+a3t3+a4t4+a5t5, (1)
其中,t是减速时间段T内任一插补采样时间点,P(t)为任一插补采样时 间点对应的位置,而a0,a1,a2,a3,a4和a5是系数;
假设位置曲线对称,则在时间t=0时,机械手臂处于初始状态(P0,V0),
在时间t=2T时,机械手臂处于状态(P0,-V0),
而在时间t=T时,机械手臂处于状态(PT,0);
在时间段T内任一插补采样时间点t的位置P(t)、速度V(t)以及加速度A(t) 如下,从而实现对六轴机械手臂的空间平滑停止控制:
P(t)=a0+a1t+a2t2+a3t3+a4t4+a5t5, (2)
V(t)=P’(t)=a1+2a2t+3a3t2+4a4t3+5a5t4, (3)
A(t)=P”(t)=2a2+6a3t+12a4t2+20a5t3, (4)
其中,a0=P0, (5)
a1=V0, (6)
优选地,基于公式(2),(3)和(4)得到如下约束条件:
P(0)=P0, (11)
P′(0)=V0, (12)
P”(0)=A0, (13)
P’(T)=0, (14)
P”(T)=0, (15)
P’(2T)=-V0, (16)
根据公式(11),(12),(13),(14),(15)和(16)联立求解得到公式(5), (6),(7),(8),(9)和(10)。
优选地,在时间t=T时,机械手臂处于状态(PT,0),该状态为减速到完 全停止,速度为0的减速终止状态。
优选地,位置曲线对称的假设指的是六轴机械手臂从位置P0开始减速并停 止于位置PT之后,又从位置PT以大小相同,但方向相反的加速度开始加速并 经过位置P0,经过位置P0时速度大小与从位置P0开始减速时的速度大小相同, 但是方向相反。
优选地,若在时间t=T时,机械手臂处于状态(PT,0),且位置PT超过六 轴机械手臂的实际限位值,则重新设置减速后停止点的位置为实际限位值Pm, 且速度和加速度仍然为0。
优选地,在位置PT超过六轴机械手臂的实际限位值,且实际限位值为Pm的情况下,在时间t=0时,机械手臂处于初始状态(P0,V0,A0);在时间t=T 时,机械手臂处于停止状态(Pm,0,0),则在时间段T内任一插补采样时间 点t的位置、速度以及加速度如公式(2),(3)和(4)所示,实现对六轴机 械手臂的空间平滑停止控制,但是系数如下:
a0=P0, (17)
a1=V0, (18)
优选地,在位置PT超过六轴机械手臂的实际限位值,且实际限位值为Pm的情况下,基于公式(2),(3)和(4)得到如下约束条件:
P(0)=a0=P0, (23)
P’(0)=a1=V0, (24)
P”(0)=2a2=A0, (25)
P(T)=0, (26)
P’(T)=0, (27)
P”(2T)=-V0, (28)
根据公式(23),(24),(25),(26),(27)和(28)联立求解得到公式(17), (18),(19),(20),(21)和(22)。
本发明的有益效果在于,该控制方法采用5次线性方程推导出减速停止过 程中机械手臂的减速运动曲线,使其从减速到停止更为平滑,更符合电机运转 特性,对电机冲力较小,起到了很好的保护作用,延长了使用寿命。
附图说明
下面将结合附图及实施例对本发明作进一步说明,附图中:
图1是本发明应用于六轴机械手臂的空间平滑停止控制方法优选实施例 的流程示意图;
图2是本发明应用于六轴机械手臂的空间平滑停止控制方法优选实施例 中假设机械手臂加减速运动的位置曲线对称的示意图;
图3是本发明应用于六轴机械手臂的空间平滑停止控制方法优选实施例 中机械手臂基于平滑减速算法进行减速的位置变化曲线示意图;
图4是本发明应用于六轴机械手臂的空间平滑停止控制方法优选实施例 中机械手臂基于平滑减速算法进行减速的速度变化曲线示意图;
图5是本发明应用于六轴机械手臂的空间平滑停止控制方法优选实施例 中机械手臂基于平滑减速算法进行减速的加速度变化曲线示意图;
图6是本发明应用于六轴机械手臂的空间平滑停止控制方法优选实施例 中机械手臂基于常规通用减速算法进行减速的位置变化曲线示意图;
图7是本发明应用于六轴机械手臂的空间平滑停止控制方法优选实施例 中机械手臂基于常规通用减速算法进行减速的速度变化直线示意图;
图8是本发明应用于六轴机械手臂的空间平滑停止控制方法优选实施例 中机械手臂基于常规通用减速算法进行减速的加速度变化直线示意图;
图9是本发明应用于六轴机械手臂的空间平滑停止控制方法优选实施例 中机械手臂分别基于平滑减速算法和常规通用减速算法进行减速的加速度变 化直线对比示意图。
具体实施方式
为了对本发明的技术特征、目的和效果有更加清楚的理解,现对照附图详 细说明本发明的具体实施方式。
图1是本发明应用于六轴机械手臂的空间平滑停止控制方法优选实施例 的流程示意图。该控制方法,包括以下步骤:测得并输入六轴机械手臂开始减 速的初始点信息,位置P0,速度V0,加速度A0,并且假设六轴机械手臂经过 时间段T,减速后停止点信息是速度为0,加速度为0,位置PT;采用五次方 程式作为减速阶段的位置插补算法,公式如下所示。
P(t)=a0+a1t+a2t2+a3t3+a4t4+a5t5, (1)
其中,t是减速时间段T内任一插补采样时间点,P(t)为任一插补采样时 间点对应的位置,而a0,a1,a2,a3,a4和a5是系数。
图2是本发明应用于六轴机械手臂的空间平滑停止控制方法优选实施例 中假设机械手臂加减速运动的位置曲线对称的示意图。假设机械手臂加速和减 速运动的位置曲线对称,则该位置曲线的性质如图2所示,在时间t=0时,机 械手臂处于初始状态(P0,V0),在时间t=2T时,机械手臂处于状态(P0,-V0), 而在时间t=T时,机械手臂处于状态(PT,0)。
在时间段T内任一插补采样时间点t的位置P(t)、速度V(t)以及加速度A(t) 如下,从而实现对六轴机械手臂的空间平滑停止控制:
P(t)=a0+a1t+a2t2+a3t3+a4t4+a5t5, (2)
V(t)=P’(t)=a1+2a2t+3a3t2+4a4t3+5a5t4, (3)
A(t)=P”(t)=2a2+6a3t+12a4t2+20a5t3, (4)
其中,a0=P0, (5)
a1=V0, (6)
然后,基于公式(2),(3)和(4)得到如下约束条件:
P(0)=P0, (11)
P’(0)=V0, (12)
P”(0)=A0, (13)
P’(T)=0, (14)
P”(T)=0, (15)
P’(2T)=-V0, (16)
根据公式(11),(12),(13),(14),(15)和(16)联立求解得到公式(5), (6),(7),(8),(9)和(10),从而求解得到各个系数。
在时间t=T时,机械手臂处于状态(PT,0),该状态为减速到完全停止, 速度为0的减速终止状态。
位置曲线对称的假设指的是六轴机械手臂从位置P0开始减速并停止于位 置PT之后,又从位置PT以大小相同,但方向相反的加速度开始加速并经过位 置P0,经过位置P0时速度大小与从位置P0开始减速时的速度大小相同,但是方 向相反。
若在时间t=T时,机械手臂处于状态(PT,0),且位置PT超过六轴机械手 臂的实际限位值,则重新设置减速后停止点的位置为实际限位值Pm,且速度和 加速度仍然为0。
在位置PT超过六轴机械手臂的实际限位值,且实际限位值为Pm的情况下, 在时间t=0时,机械手臂处于初始状态(P0,V0,A0);在时间t=T时,机械 手臂处于停止状态(Pm,0,0),则在时间段T内任一插补采样时间点t的位 置、速度以及加速度如公式(2),(3)和(4)所示,实现对六轴机械手臂的 空间平滑停止控制,但是系数如下:
a0=P0, (17)
a1=V0, (18)
在位置PT超过六轴机械手臂的实际限位值,且实际限位值为Pm的情况下, 基于公式(2),(3)和(4)得到如下约束条件:
P(0)=a0=P0, (23)
P’(0)=a1=V0, (24)
P”(0)=2a2=A0, (25)
P(T)=0, (26)
P’(T)=0, (27)
P”(2T)=-V0, (28)
根据公式(23),(24),(25),(26),(27)和(28)联立求解得到公式(17), (18),(19),(20),(21)和(22),从而求解达到各个系数。
在一个优选实施例中,假设六轴机械手臂在某一轴上匀速运动状态下,需 要立刻减速。此时机器人的位置P0=2rad,速度V0=1rad/s,加速度A0=0 rad/s2,减速时间要求是T=0.5s。将以上的数据代入平滑减速算法的系数计 算公式(11),(12),(13),(14),(15)和(16)中,可以计算求解得到如下 六个系数:
a0=P0=2
a1=V0=1
将计算得到的a0,a1,a2,a3,a4,a5代入减速阶段的五次插补方程中, 可以得到任一插补采样时间点t的位置P(t)、速度V(t)以及加速度A(t)如下, 从而实现对六轴机械手臂的空间平滑停止控制:
位置:P(t)=2+t-5.3333t3+8t4-3.2t5,t∈[0,0.5]
速度:P′(t)=1-15.9999t2+32t3-16t4,t∈[0,0.5]
加速度:P″(t)=-31.9998t+96t2-64t3,t∈[0,0.5]
假设以0.001s为基础时间间隔进行插补采样,控制机械手臂的减速,将 插补时间t代入方程,即可求得每个插补点期望的位置、速度、加速度的一组 输出值,在0.5秒内得到500个插补点,共500组数值。分别对0.5秒内500 个插补采样点的位置、速度、加速度的数值通过图形描绘,生成图3,图4和 图5所示的曲线。
如果使用常规普通的梯形减速算法,得到任一插补采样点t的位置P(t)、 速度V(t)以及加速度A(t)如下:
位置:
速度:P′(t)=V0+At
加速度:
将该减速运动过程中的初始状态代入以上方程,可以得到:
位置:P(t)=2+t-t2,t∈[0,0.5]
速度:P′(t)=1-2t,t∈[0,0.5]
加速度:P″(t)=-2,t∈[0,0.5]
同样假设以0.001s为基础时间间隔进行插补采样,控制机械手臂的减速, 将插补采样点t代入方程,即可求得每个插补采样点期望的位置、速度、加速 度的一组输出值,在0.5秒内得到500个插补采样点,共500组数值。分别对 0.5秒内500个插补采样点的位置、速度、加速度的数值通过图形描绘,生成 图6,图7和图8所示的曲线。
图3是机械手臂基于平滑减速算法进行减速的位置变化曲线示意图;而图 6是机械手臂基于常规通用减速算法进行减速的位置变化曲线示意图。
图4是机械手臂基于平滑减速算法进行减速的速度变化曲线示意图;而图 7是机械手臂基于常规通用减速算法进行减速的速度变化直线示意图。
图5是机械手臂基于平滑减速算法进行减速的加速度变化曲线示意图;而 图8是机械手臂基于常规通用减速算法进行减速的加速度变化直线示意图。
基于以上图中曲线的对比可以看出,运用本发明的平滑减速算法从速度 1rad/s减速到停止的减速距离为0.2333rad,而应用常规普通减速算法从速 度1rad/s减速到停止的减速距离为0.25rad。首先从减速距离上来说,本发 明的平滑减速算法所需的减速距离显著少于常规普通减速算法。另外,平滑减 速算法进行减速的速度变化曲线更为平滑和顺畅,这意味着对电机更小的冲击 和损害。另外重要的是,初速度V0越大、减速时间段T越短,本发明算法的优 势越明显,即本发明平滑减速算法的减速距离与常规普通算法的减速距离之间 的差距也会越大。在较为极限的情况下,减速距离之间的差距可达10%左右。
而且,本发明算法可以在减速距离更短的情况下,同时保证更平滑的速度 减速曲线,通过加速度大小的自动变化,最大程度减少对电机的冲击和磨损。
图9是本发明应用于六轴机械手臂的空间平滑停止控制方法优选实施例 中机械手臂分别基于平滑减速算法和常规通用减速算法进行减速的加速度变 化直线对比示意图。从图9中可以明显地看出,本发明平滑减速算法所得到的 加速度以平滑的方式变化,减速过程中的加速度由小变化到大,又由大变化到 小,该种方式尽量减少了因为突然出现大的加速度而对电机产生的冲击,大大 改善了整个减速过程的平稳性,避免过冲现象的发生,保护电机并延长了其使 用寿命。
上面结合附图对本发明的实施例进行了描述,但是本发明并不局限于上述 的具体实施方式,上述的具体实施方式仅仅是示意性的,而不是限制性的,本 领域的普通技术人员在本发明的启示下,在不脱离本发明宗旨和权利要求所保 护的范围情况下,还可做出很多形式,这些均属于本发明的保护之内。
Claims (7)
1.一种应用于六轴机械手臂的空间平滑停止控制方法,其特征在于,包括以下步骤:
测得并输入六轴机械手臂开始减速的初始点信息,位置P0,速度V0,加速度A0,并且假设六轴机械手臂经过时间段T,减速后停止点信息是速度为0,加速度为0,位置PT;
采用五次方程式作为减速阶段的位置插补算法,
P(t)=a0+a1t+a2t2+a3t3+a4t4+a5t5, (1)
其中,t是减速时间段T内任一插补采样时间点,P(t)为任一插补采样时间点对应的位置,而a0,a1,a2,a3,a4和a5是系数;
假设位置曲线对称,则在时间t=0时,机械手臂处于初始状态(P0,V0),
在时间t=2T时,机械手臂处于状态(P0,-V0),
而在时间t=T时,机械手臂处于状态(PT,0);
在时间段T内任一插补采样时间点t的位置P(t)、速度V(t)以及加速度A(t)如下,从而实现对六轴机械手臂的空间平滑停止控制:
P(t)=a0+a1t+a2t2+a3t3+a4t4+a5t5, (2)
V(t)=P’(t)=a1+2a2t+3a3t2+4a4t3+5a5t4, (3)
A(t)=P”(t)=2a2+6a3t+12a4t2+20a5t3, (4)
其中,a0=P0, (5)
a1=V0, (6)
<mrow>
<msub>
<mi>a</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfrac>
<msub>
<mi>A</mi>
<mn>0</mn>
</msub>
<mn>2</mn>
</mfrac>
<mo>,</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>a</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<msub>
<mi>V</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mn>7</mn>
<msub>
<mi>A</mi>
<mn>0</mn>
</msub>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mn>9</mn>
<msup>
<mi>t</mi>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mo>,</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>a</mi>
<mn>4</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>12</mn>
<msub>
<mi>V</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mn>5</mn>
<msub>
<mi>A</mi>
<mn>0</mn>
</msub>
<mi>t</mi>
</mrow>
<mrow>
<mn>12</mn>
<msup>
<mi>t</mi>
<mn>3</mn>
</msup>
</mrow>
</mfrac>
<mo>,</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>a</mi>
<mn>5</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<msub>
<mi>V</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mn>5</mn>
<msub>
<mi>A</mi>
<mn>0</mn>
</msub>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mn>15</mn>
<msup>
<mi>t</mi>
<mn>4</mn>
</msup>
</mrow>
</mfrac>
<mo>,</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
2.根据权利要求1所述的应用于六轴机械手臂的空间平滑停止控制方法,其特征在于,基于公式(2),(3)和(4)得到如下约束条件:
P(0)=P0, (11)
P’(0)=V0, (12)
P”(0)=A0, (13)
P’(T)=0, (14)
P”(T)=0, (15)
P’(2T)=-V0, (16)
根据公式(11),(12),(13),(14),(15)和(16)联立求解得到公式(5),(6),(7),(8),(9)和(10)。
3.根据权利要求2所述的应用于六轴机械手臂的空间平滑停止控制方法,其特征在于,在时间t=T时,机械手臂处于状态(PT,0),该状态为减速到完全停止,速度为0的减速终止状态。
4.根据权利要求3所述的应用于六轴机械手臂的空间平滑停止控制方法,其特征在于,位置曲线对称的假设指的是六轴机械手臂从位置P0开始减速并停止于位置PT之后,又从位置PT以大小相同,但方向相反的加速度开始加速并经过位置P0,经过位置P0时速度大小与从位置P0开始减速时的速度大小相同,但是方向相反。
5.根据权利要求2所述的应用于六轴机械手臂的空间平滑停止控制方法,其特征在于,若在时间t=T时,机械手臂处于状态(PT,0),且位置PT超过六轴机械手臂的实际限位值,则重新设置减速后停止点的位置为实际限位值Pm,且速度和加速度仍然为0。
6.根据权利要求5所述的应用于六轴机械手臂的空间平滑停止控制方法,其特征在于,在位置PT超过六轴机械手臂的实际限位值,且实际限位值为Pm的情况下,在时间t=0时,机械手臂处于初始状态(P0,V0,A0);在时间t=T时,机械手臂处于停止状态(Pm,0,0),则在时间段T内任一插补采样时间点t的位置、速度以及加速度如公式(2),(3)和(4)所示,实现对六轴机械手臂的空间平滑停止控制,但是系数如下:
a0=P0, (17)
a1=V0, (18)
<mrow>
<msub>
<mi>a</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfrac>
<msub>
<mi>A</mi>
<mn>0</mn>
</msub>
<mn>2</mn>
</mfrac>
<mo>,</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>19</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>a</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>20</mn>
<msub>
<mi>P</mi>
<mi>m</mi>
</msub>
<mo>-</mo>
<mn>20</mn>
<msub>
<mi>P</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mn>12</mn>
<msub>
<mi>V</mi>
<mn>0</mn>
</msub>
<mi>T</mi>
<mo>-</mo>
<mn>3</mn>
<msub>
<mi>A</mi>
<mn>0</mn>
</msub>
<msup>
<mi>T</mi>
<mn>2</mn>
</msup>
</mrow>
<mrow>
<mn>2</mn>
<msup>
<mi>T</mi>
<mn>3</mn>
</msup>
</mrow>
</mfrac>
<mo>,</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>20</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>a</mi>
<mn>4</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>30</mn>
<msub>
<mi>P</mi>
<mn>0</mn>
</msub>
<mo>-</mo>
<mn>30</mn>
<msub>
<mi>P</mi>
<mi>m</mi>
</msub>
<mo>+</mo>
<mn>16</mn>
<msub>
<mi>V</mi>
<mn>0</mn>
</msub>
<mi>T</mi>
<mo>+</mo>
<mn>3</mn>
<msub>
<mi>A</mi>
<mn>0</mn>
</msub>
<msup>
<mi>T</mi>
<mn>2</mn>
</msup>
</mrow>
<mrow>
<mn>2</mn>
<msup>
<mi>T</mi>
<mn>4</mn>
</msup>
</mrow>
</mfrac>
<mo>,</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>21</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>a</mi>
<mn>5</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>12</mn>
<msub>
<mi>P</mi>
<mi>m</mi>
</msub>
<mo>-</mo>
<mn>12</mn>
<msub>
<mi>P</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<mn>6</mn>
<msub>
<mi>V</mi>
<mn>0</mn>
</msub>
<mi>T</mi>
<mo>-</mo>
<msub>
<mi>A</mi>
<mn>0</mn>
</msub>
<msup>
<mi>T</mi>
<mn>2</mn>
</msup>
</mrow>
<mrow>
<mn>2</mn>
<msup>
<mi>T</mi>
<mn>5</mn>
</msup>
</mrow>
</mfrac>
<mo>,</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>22</mn>
<mo>)</mo>
</mrow>
</mrow>
7.根据权利要求6所述的应用于六轴机械手臂的空间平滑停止控制方法,其特征在于,在位置PT超过六轴机械手臂的实际限位值,且实际限位值为Pm的情况下,基于公式(2),(3)和(4)得到如下约束条件:
P(0)=a0=P0, (23)
P’(0)=a1=V0, (24)
P”(0)=2a2=A0, (25)
P(T)=0, (26)
P’(T)=0, (27)
P”(2T)=-V0, (28)
根据公式(23),(24),(25),(26),(27)和(28)联立求解得到公式(17),(18),(19),(20),(21)和(22)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710747184.1A CN107598921B (zh) | 2017-08-25 | 2017-08-25 | 一种应用于六轴机械手臂的空间平滑停止控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710747184.1A CN107598921B (zh) | 2017-08-25 | 2017-08-25 | 一种应用于六轴机械手臂的空间平滑停止控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107598921A true CN107598921A (zh) | 2018-01-19 |
CN107598921B CN107598921B (zh) | 2018-07-03 |
Family
ID=61056105
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710747184.1A Active CN107598921B (zh) | 2017-08-25 | 2017-08-25 | 一种应用于六轴机械手臂的空间平滑停止控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107598921B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113771031A (zh) * | 2021-09-07 | 2021-12-10 | 苏州艾利特机器人有限公司 | 一种机器人自适应调速方法及多关节机器人 |
CN118174597A (zh) * | 2024-02-27 | 2024-06-11 | 广州致远电子股份有限公司 | 一种电机减速控制方法、装置、运动控制器及存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61278906A (ja) * | 1985-06-03 | 1986-12-09 | Hitachi Ltd | ロボツトの制御方法 |
US5130632A (en) * | 1989-12-06 | 1992-07-14 | Hitachi, Ltd. | Manipulator and control method therefor |
JPH0550388A (ja) * | 1991-02-19 | 1993-03-02 | Tokico Ltd | 工業用ロボツト |
EP2345511A2 (de) * | 2010-01-13 | 2011-07-20 | KUKA Laboratories GmbH | Steuerung für einen Manipulator |
CN105082135A (zh) * | 2015-09-11 | 2015-11-25 | 东南大学 | 一种机器人点动操作的速度控制方法 |
CN105500361A (zh) * | 2014-09-23 | 2016-04-20 | 上海通用汽车有限公司 | 一种连杆结构机械手的运动控制方法及系统 |
CN105785921A (zh) * | 2016-03-25 | 2016-07-20 | 华南理工大学 | 一种工业机器人nurbs曲线插补时的速度规划方法 |
-
2017
- 2017-08-25 CN CN201710747184.1A patent/CN107598921B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61278906A (ja) * | 1985-06-03 | 1986-12-09 | Hitachi Ltd | ロボツトの制御方法 |
US5130632A (en) * | 1989-12-06 | 1992-07-14 | Hitachi, Ltd. | Manipulator and control method therefor |
JPH0550388A (ja) * | 1991-02-19 | 1993-03-02 | Tokico Ltd | 工業用ロボツト |
EP2345511A2 (de) * | 2010-01-13 | 2011-07-20 | KUKA Laboratories GmbH | Steuerung für einen Manipulator |
CN105500361A (zh) * | 2014-09-23 | 2016-04-20 | 上海通用汽车有限公司 | 一种连杆结构机械手的运动控制方法及系统 |
CN105082135A (zh) * | 2015-09-11 | 2015-11-25 | 东南大学 | 一种机器人点动操作的速度控制方法 |
CN105785921A (zh) * | 2016-03-25 | 2016-07-20 | 华南理工大学 | 一种工业机器人nurbs曲线插补时的速度规划方法 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113771031A (zh) * | 2021-09-07 | 2021-12-10 | 苏州艾利特机器人有限公司 | 一种机器人自适应调速方法及多关节机器人 |
WO2023036116A1 (zh) * | 2021-09-07 | 2023-03-16 | 苏州艾利特机器人有限公司 | 一种机器人自适应调速方法及多关节机器人 |
CN113771031B (zh) * | 2021-09-07 | 2023-11-28 | 苏州艾利特机器人有限公司 | 一种机器人自适应调速方法及多关节机器人 |
CN118174597A (zh) * | 2024-02-27 | 2024-06-11 | 广州致远电子股份有限公司 | 一种电机减速控制方法、装置、运动控制器及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN107598921B (zh) | 2018-07-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106313044B (zh) | 一种工业机器人前馈力矩补偿方法 | |
CN108319228B (zh) | 一种数控系统轨迹规划中加减速控制方法 | |
WO2020133270A1 (zh) | 机器人的动力学参数辨识方法、机器人和存储装置 | |
CN109623810B (zh) | 一种机器人平滑的时间最优轨迹规划的方法 | |
CN105892402A (zh) | 机械臂点到点运动控制方法 | |
CN103701368A (zh) | 双电机节能消隙控制方法 | |
CN103941647A (zh) | 用于嵌入式数控设备的柔性加减速控制插补方法 | |
CN109901518B (zh) | 一种恒力约束条件下的数控机床加减速速度规划方法 | |
CN103563245A (zh) | 驱动机械的负荷特性推测装置 | |
CN107598921A (zh) | 一种应用于六轴机械手臂的空间平滑停止控制方法 | |
CN106533291A (zh) | 一种基于惯量辨识和负载转矩观测的速度环响应提升方法 | |
CN105511510A (zh) | 仓储安全距离的扫描监测系统及其定位控制方法 | |
CN104360596A (zh) | 机电伺服系统有限时间摩擦参数辨识和自适应滑模控制方法 | |
CN110480639A (zh) | 一种工业机器人监控区域边界运动规划的方法 | |
CN107450466A (zh) | 一种冲压机器人控制器及其高速平稳控制方法 | |
CN107315389A (zh) | 一种多次方变形凸轮曲线的设计方法 | |
CN104635621A (zh) | 基于现场总线的xy工作台过象限凸起补偿方法 | |
CN107390643B (zh) | 急动速度线性连续的数控装置高速进给加减速方法 | |
CN116483026A (zh) | 多模式多类型非对称s型柔性速度曲线双向快速规划方法 | |
JP4627740B2 (ja) | 数値制御装置 | |
CN101246353A (zh) | Ic材料线切割机床多电机系统速度同步自适应逆控制方法 | |
CN102082545B (zh) | 马达速度控制器及其控制方法 | |
CN110989504A (zh) | 一种五轴加工进给速度的区间自适应规划方法 | |
Gavel et al. | Decentralized adaptive control experiments with the PUMA robot arm | |
Arolovich et al. | Control improvement of under-damped systems and structures by input shaping |
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 |