机器人行走路径规划装置和方法制造方法及图纸

本发明专利技术提供一种机器人行走路径规划装置和方法。该装置包括规划器、低通滤波器、伺服控制器和伺服马达。所述方法包括如下步骤：收到对应于预定目标位置的信号输入以后，计算初始速度分布曲线；通过使用一个单级低通滤波器，对初始速度分布曲线进行内插处理而获得经滤波处理的速度分布曲线；以及利用经滤波处理的速度分布曲线来控制伺服马达的加速和减速。（*该技术在2018年保护过期，可自由使用*）

【技术实现步骤摘要】

本专利技术涉及一种控制机器人运动的装置，特别是涉及一种控制机器人行走的路径规划装置和方法。对于工业用途的机器人来说，其行走路径规划是机器人领域的技术人员首要关心的问题。特别是，准确地沿一个预定路径行走，以及平稳和可靠地实现直线和曲线路径之间的过渡是机器人必须具有的能力。现在这些可通过使用尽量以平稳速度实现这种变化过渡的加速/减速技术来实现。一个使用线性滤波器的线性加速/减速控制系统是此类加速/减速技术的一种类型。该线性控制系统允许相对快的加速和减速，但它的缺陷是运动太突然。如此突然地加速和减速在机器人身体和相关部件上会产生过度的应力。附图说明图1显示了一个机器人传统行走路径规划装置方框图。传统的行走路径规划装置包括一个规划器10、一个内插器20、一个伺服控制器30和一个伺服马达40，规划器10接收目标位置信息，使用该目标位置信息进行计算以获得一个速度分布曲线，然后输出该速度分布曲线；内插器20从规划器10接收速度分布曲线，通过对接收到的速度分布曲线，进行路径内插处理并输出结果，即一个更平稳的速度分布曲线；伺服控制器30从内插器20接收速度分布曲线并输出相应的控制信号；伺服马达40由从伺服控制器30接收到的信号控制。内插器20是一个线性滤波器，如图2所示，它包括至少一个单位延迟21、一个加法器22和一个系数乘法器23。图中字母“F”表示滤波器的级数和加速/减速部分的持续时间。参考图3和图4，在这样一个传统行走路径规划装置中，规划器10将计算到达目标位置所需的初始速度分布曲线Va，并将该初始速度分布曲线输出给内插器20，内插器20对接收到的速度分布曲线Va进行路径内插处理，并获得一个经滤波处理的速度分布曲线Vb。经滤波处理的速度分布曲线Vb由内插器20输出给伺服控制器30，根据速度分布曲线Vb，伺服控制器30输出控制信号来驱动伺服马达40。如图4所示，通过对经滤波处理的速度分布曲线Vb求微分，获得一个加速度分布曲线A，然后对该加速度分布曲线A求微分，获得一个脉冲分布曲线(jerk profile)J，在此脉冲是一个矢量，表示加速度和减速度随时间的变化率。因此脉冲分布曲线J表示作用在机器人身体上的突变力的程度以及在受到一个突变力的情况下机器人运动的程度。连续地受到突然冲击的作用对机器人身体和相关部件会造成损害。如图4所示，产生在机器人传统行走路径规划装置中的脉冲分布曲线J是急剧突变的。美国专利5,434,489披露了一种机器人行走路径规划装置，在该装置中，通过使用两个线性滤波器，使使用在机器人身体上的突变力达到最小。图5是该专利机器人行走路径规划装置的方框图。由于该专利仅内插器20与上述的机器人行走路径规划装置不同，因此，对于其它部件将使用相同的标号。如图所示，内插器20包括一个第一线性滤波器24和一个第二线性滤波器25。根据这种结构，当初始速度分布曲线Va由规划器10传送给内插器20时，内插器20输出经滤波处理的速度分布曲线Vb′，如图6所示，相应于加速和减速的部分是二阶函数曲线。从上述经滤波处理的速度分布曲线Vb′可得到一个加速速度分布曲线A′和一个脉冲分布曲线J′。如图所示，使用二个线性滤波器24和25而获得的脉冲分布曲线J′比仅利用一个线性滤波器获得的脉冲分布曲线更光滑，因此减小了对机器人身体的损害和机器人运动的突然性。尽管如此，对于机器人受到突然冲击的问题仍然存在，并存在同样的负作用。更进一步地说，第二滤波器的使用增加了计算时间，因此机器人的整个反应时间被延迟。本专利技术就是用来解决上述问题的。本专利技术的一个目的是提供一种，其受到的冲击不是突然的，以减小对机器人身体的损害，从而使机器人运动平稳。本专利技术的另一个目的是提供一种，以改善机器人反应时间。为实现上述专利技术目的，本专利技术提供一种。该装置包括一个规划器、一个低通滤波器、一个伺服控制器和一个伺服马达。所述规划器接收目标位置信息，利用该信息进行计算以获得一个初始速度分布曲线，然后输出该初始速度分布曲线；所述低通滤波器作为一个内插器使用，它从规划器处接收初始速度分布曲线，并进行一个预定的运算处理，同样获得一个比初始速度分布曲线更光滑的经滤波处理的速度分布曲线，然后输出该经滤波处理的速度分布曲线；所述伺服控制器接收低通滤波器的输出速度分布曲线，并根据低通滤波器输出的速度分布曲线，输出加速和减速控制信号；所述伺服马达由从伺服控制器接收到的信号控制。按照本专利技术的一个特点，低通滤波器包括多个串联的单位延迟、多个第一乘法器、一个加法器和一个第二乘法器，所述单位延迟输出延迟信号；所述第一乘法器将预定增益值与单位延迟输出的每一个延迟信号相乘；所述加法器将所述第一乘法器输出值相加并将其和输出；所述第二乘法器将加法器的输出值与所有增益值之和的倒数(inverse)相乘，以获得经滤波处理的速度分布曲线。最可取的是，单位延迟是移位寄存器。本专利技术机器人行走路径规划方法包括如下步骤收到对应于预定目标位置的信号输入以后，计算初始速度分布曲线；通过使用一个单级低通滤波器，对初始速度分布曲线进行内插处理而获得经滤波处理的速度分布曲线；利用经滤波处理的速度分布曲线来控制伺服马达的加速和减速。按照本专利技术所述方法的一个特点，所述获得经滤波处理的速度分布曲线的方法进一步包括如下步骤通过依次延迟输入信号而输出一系列具有连续延迟值的延迟信号；将预定增益值与每一个延迟信号相乘，并输出结果；将预定增益值与各个延迟信号相乘的结果相加，并输出其结果；将输出的结果与所有增益值之和的倒数相乘。按照本专利技术所述方法的另一个特点，在经低通滤波器滤波处理之前，计算所有增益值之和并将其作为一个初始值。按照本专利技术所述方法的又一个特点，调整增益值以控制伺服马达的加速和减速。按照本专利技术所述装置和方法的一个特点，当增益值是关于时间的一次函数时，该一次函数由下列方程表示 这里t代表时间，k(t)代表增益值，F是伺服马达加速时间段的大小，a是随机数，a≥0。按照本专利技术所述装置和方法的另一个特点，当增益值是关于时间的二次函数时，该二次函数由下列方程表示k(t)=-at(t-F),0＜t＜F这里t代表时间，k(t)代表增益值，F是伺服马达加速时间段的大小，a是随机数，a≥0。说明书中的附图作为说明书的一部分，表示本专利技术的一个实施例，并与说明书一起用于解释本专利技术的技术方案。图1是一个机器人传统行走路径规划装置方框图；图2是图1所示的内插器的方框图；图3是输入图1所示的内插器的速度分布曲线坐标图；图4是图1所示内插器输出的一条速度分布曲线以及由该速度分布曲线微分求得的一条加速度分布曲线和一条脉冲分布曲线坐标图；图5是由两个线性滤波器所组成内插器的机器人传统行走路径规划装置方框图；图6是图5所示内插器输出的一条速度分布曲线以及由该速度分布曲线微分求得的一条加速度分布曲线和一条脉冲分布曲线坐标图；图7是本专利技术最佳实施例中的机器人行走路径规划装置方框图；图8是图7所示的低通滤波器的方框图；图9a和图9b是图7所示的低通滤波器的增益值曲线坐标图；图10是图7所示低通滤波器输出的一条速度分布曲线以及由该速度分布曲线微分求得的一条加速度分布曲线和一条脉冲分布曲线坐标图。下面将结合附图详细描述本专利技术最佳实施例。图7是本专利技术最佳实施例中的机本文档来自技高网...

【技术保护点】
一种机器人行走路径规划装置，其包括： 一个规划器，接收目标位置信息，利用该信息进行计算以获得一个初始速度分布曲线，然后输出该初始速度分布曲线； 一个低通滤波器，从规划器处接收初始速度分布曲线，并进行一个预定的运算处理，同样获得一个比初始速度分布曲线更光滑的经滤波处理的速度分布曲线，然后输出该经滤波处理的速度分布曲线； 一个伺服控制器，接收所述低通滤波器的输出，并根据所述低通滤波器输出，输出加速和减速控制信号；及 一个伺服马达，由从所述伺服控制器接收到的信号控制。

【技术特征摘要】
...

【专利技术属性】
技术研发人员：金泳尚，
申请(专利权)人：三星电子株式会社，
类型：发明
国别省市：KR[韩国]