CN108513636A - 机器人运动控制方法及相关装置 - Google Patents

Abstract

一种机器人运动控制方法及相关装置，使用关于路径的三阶Bezier曲线作为机器人从前段轨迹运动至后段轨迹的平滑轨迹，并且使用关于时间的三阶Bezier曲线对运动速度进行规划，规划的速度用于确定每个控制周期内机器人需运动至的位置点，各个位置点组成上述平滑轨迹，本申请的控制精准度较高且应用范围较广。

Description

机器人运动控制方法及相关装置 技术领域

本发明涉及运动控制领域，更具体地说，涉及机器人运动控制技术。

背景技术

机器人的运动，是按照预先规划的轨迹进行的。规划的运动轨迹，可以分解为多段，见图1a，一段运动轨迹包含lc及ln两段，机器人需要从轨迹lc运动到轨迹ln上，轨迹lc可以称为前段轨迹，ln可以称为后段轨迹。

两段轨迹的过渡方式可以是尖角转接，如图1a所示，机器人运动到轨迹lc的末端(点O处)后，速度降为0，然后再以一定的速度在轨迹ln上运动。该种过渡方式中，单段轨迹(lc或ln)上的初速度和末速度均为0，会大大降低机器人的工作效率，且频繁的加减速运动也会对电机及减速器的使用寿命产生影响。

为了解决以上问题，可以在两端轨迹之间使用平滑转接方式。即在两段轨迹之间规划平滑曲线，机器人以平滑曲线方式从一段轨迹过渡到另一段轨迹时，速度不为0。目前规划平滑曲线的方法有矢量加减法及圆弧转接法。

见图1b，矢量加减法是通过空间向量加法，使前段轨迹lc从拐点到交点O的插补点，与后段轨迹ln从拐点到交点O的插补点重合，被叠加后的插补点会组成空间的一段弧形，使轨迹平滑。但是，该种叠加的平滑轨迹是不确定的，会随着前后两段轨迹速度的变化而变化，精准度较低。

见图1c，圆弧转接法中，确定前段轨迹lc的拐出点A及后段轨迹ln上的拐出点B，求经过拐出点及拐入点的前后两段轨迹的公切圆，该公切圆上由拐出点及拐入点组成的圆弧AB为平滑转接轨迹。但是，该种方式的应用范围较小，只有在两段轨迹需均为直线的情况下肯定适用。但机器人的运动轨迹除了包含直线与直线转接，还包含直线与圆弧转接、圆弧与圆弧转接。在后两种转接中，由于直线与圆弧、圆弧与圆弧不一定共面，因此，并不一定能找到公切圆，从而导致该方式并不能适用。

因此，需要为机器人规划一种过渡的平滑轨迹，并使机器人可以速度不为0地通过该平滑轨迹。

发明内容

有鉴于此，本发明提供了一种机器人运动控制方法，用于控制机器人按照预先构建的关于路径的三阶Bezier曲线表示的平滑轨迹进行运动。

本申请提供如下技术方案：

一方面，本申请提供了一种机器人运动控制方法，用于控制机器人按照预先构建的关于路径的三阶Bezier曲线表示的平滑轨迹进行运动，所述控制方法用于在多个控制周期中的每个控制周期内确定机器人需运动至的位置点，其中每个控制周期内包括以下步骤：

确定从首个控制周期到当前控制周期的时长值；使用预先构建的关于时间的三阶Bezier曲线的表达式，求解所述时长值对应的Bezier参数的值；其中，所述关于时间的三阶Bezier曲线表示的是Bezier参数与时长之间的曲线关系；将所述Bezier参数的值代入所述关于路径的三阶Bezier曲线的表达式中，获得位置坐标值；其中，所述关于路径的三阶Bezier曲线表示的是Bezier参数与位置坐标之间的曲线关系；向驱动装置发送所述位置坐标值，以使所述驱动装置将所述机器人移动至所述位置坐标值表示的位置点。

在一个可能的设计中，所述构建关于时间的三阶Bezier曲线的方法包括：

依据关于路径的三阶Bezier曲线的位置特征点、预设的起始点的速度及预设的终止点的速度，确定所述关于时间的三阶Bezier曲线的时间特征点T₀、T₁、T₂及T₃；依据所述时间特征点T₀、T₁、T₂及T₃，构建的关于时间的三阶Bezier曲线的表达式为：T(u)＝T₀(1-u)³+3T₁u(1-u)²+3T₂u²(1-u)+T₃u³，其中，u为Bezier参数且u∈[0,1]，T(u)表示沿着所述关于路径的三阶Bezier曲线表示的平滑轨迹运动所需的时长。

在一个可能的设计中，所述依据关于路径的三阶Bezier曲线的位置特征点、预设的起始点的速度及预设的终止点的速度，确定所述关于时间的三阶Bezier曲线的时间特征点T₀、T₁、T₂及T₃，包括：

确定时间特征点T₀为0；将位置特征点P₀、位置特征点P₁及速度υ_s代入表达式求解时间特征点T₁，其中，所述速度υ_s为预先设置的机器人在所述平滑轨迹的起始点的速度；将位置特征点P₂、位置特征点P₃及速度υ_f代入表达式求解时间特征点T₃与时间特征点T₂的差值T_3-2，其中，所述速度υ_f为预先设置的机器人在所述平滑轨迹的终止点的速度；依据所述差值T_3-2，确定T₂及T₃。

在一个可能的设计中，所述依据所述差值T_3-2，确定T₂及T₃，包括：

获取预先设置的时间特征点T₃，将所述时间特征点T₃减去所述差值T_3-2，获得时间特征点T₂。

在一个可能的设计中，所述依据所述差值T_3-2，确定T₂及T₃，包括：

将位置特征点P₁、位置特征点P₂、速度υ_s、速度υ_f及时间特征点T₁代入表达式求解时间特征点T₂；

将所述时间特征点T₂加上所述差值T_3-2，获得时间特征点T₃。

在一个可能的设计中，所述关于路径的三阶Bezier曲线作为机器人从前段轨迹运动到后段轨迹的平滑轨迹，所述关于路径的三阶Bezier曲线的构建步骤包括：

根据所述前段轨迹及所述后段轨迹确定三阶Bezier曲线的位置特征点，根据所述位置特征点，构建关于路径的三阶Bezier曲线；其中，所述位置特征点中包含起始点及终止点，所述前段轨迹具有拐出点，所述后段轨迹具有拐入点，且所述起始点与所述拐出点重合，所述终止点与所述拐入点重合，所述起始点的切矢量方向与所述拐出点的切矢量方向相同，所述终止点的切矢量方向与所述拐入点的切矢量方向相同。

另一方面，本申请提供了一种机器人运动控制装置，该装置具有实现上述方法中机器人运动控制行为的功能。所述功能可以通过硬件实现，也可以 通过硬件执行相应的软件实现。所述硬件或软件包括一个或多个与上述功能相对应的模块。

在一个可能的设计中，机器人运动控制装置包括通信接口、处理器以及存储器，所述通信接口与驱动装置相连，所述存储器中存储有安装于该机器人运动控制装置中的程序代码以及数据，所述处理器用于调用所述存储器中的程序代码以及数据以确定机器人在多个控制周期中的每个控制周期内所需运动至的位置点，具体执行以下步骤：

确定从首个控制周期到当前控制周期的时长值；

使用预先构建的关于时间的三阶Bezier曲线的表达式，求解所述时长值对应的Bezier参数的值；其中，所述关于时间的三阶Bezier曲线表示的是Bezier参数与时长之间的曲线关系；

将所述Bezier参数的值代入所述关于路径的三阶Bezier曲线的表达式中，获得位置坐标值；其中，所述关于路径的三阶Bezier曲线表示的是Bezier参数与位置坐标之间的曲线关系；

通过所述通信接口向驱动装置发送所述位置坐标值，以使所述驱动装置将所述机器人移动至所述位置坐标值表示的位置点。

再一方面，本发明实施例提供了一种机器人，其包括上述的机器人运动控制装置，以及驱动所述机器人移动至所述位置坐标值表示的位置点的驱动装置。

相较于现有技术，本申请使用关于路径的三阶Bezier曲线作为机器人从前段轨迹运动至后段轨迹的平滑轨迹，并且使用关于时间的三阶Bezier曲线对运动速度进行规划，规划的速度用于确定每个控制周期内机器人需运动至的位置点，各个位置点组成上述平滑轨迹，本申请的控制精准度较高且应用范围较广。

附图说明

为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面 描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。

图1a为机器人运动轨迹的一种示意图；

图1b为现有技术中矢量加减法进行路径规划的示意图；

图1c为现有技术中圆弧转接法进行路径规划的示意图；

图2为本申请提供的关于路径的三阶Bezier曲线的示意图；

图3为本申请提供的控制机器人沿三阶Bezier曲线运动的示意图；

图4为本申请提供的机器人运动控制方法的一个流程图；

图5为本申请提供的机器人运动控制装置的一个结构示意图；

图6为本申请提供的机器人运动控制装置的另一结构示意图；

图7为本申请提供的机器人运动控制装置的硬件结构示意图。

具体实施方式

本发明可能使用的技术名词、简写或缩写如下：

TCP点：工具坐标中心点；

直线运动：机器人TCP点在笛卡尔空间内沿直线轨迹运动；

圆弧运动：机器人TCP点在笛卡尔空间内沿圆弧轨迹运动；

CP：连续运动，笛卡尔空间下的轨迹运动方式，包括直线运动和圆弧运动；

PTP：点到点运动，关节空间下的轨迹运动方式；

Bezier(贝塞尔)曲线，是由线段及节点组成的曲线，可以使用阶来表示不同形态的贝塞尔曲线。

n阶Bezier曲线的公式为：其中b_i,n(t)为Bernstein基函数，P₀-P_n可以称为Bezier曲线的特征点或控制点，特征点可以用来定义Bezier曲线，特征点组成的多边形称为特征多边形。t＝0对应Beizer曲线的起始点P₀，t＝1对应Beizer曲线的终止点P_n。

根据以上n阶Bezier曲线的通用公式可知三阶Bezier曲线的公式，即将n＝3代入公式得出三阶Bezier曲线为：

B(t)＝P₀(1-t)³+3P₁t(1-t)²+3P₂t²(1-t)+P₃t³，t∈[0，1]。

如图2所示的三阶Bezier曲线P₀P₃，其中，P₀、P₁、P₂及P₃四个点可定义该Bezier曲线。该曲线起始于P₀走向P₁，从P₁方向到P₂，并从P₂方向到P₃。需要说明的是，一般三阶Bezier曲线不经过P₁、P₂，这两个点只提供方向而已。

对Bezier曲线求导，便可获得Bezier曲线在始末点的切矢量为则：

当t＝0时，B′(0)＝n(P₁-P₀)，B′(0)即为n阶Bezier曲线在起始点的切矢量；

当t＝1时，B′(1)＝n(P_n-P_n-1)，B′(1)即为n阶Bezier曲线在终止点的切矢量。

其中，切矢量即切线方向，由上述切矢量可知，n阶Bezier曲线在起始点和终止点处的切线方向和特征多边形的第一条边及最后一条边走向一致。以图2所示三阶Bezier曲线为例，B′(0)＝3(P₁-P₀)，B′(1)＝3(P₃-P₂)，而图2的第一条边是P₁P₀，最后一条边是P₃P₂。

本申请使用Bezier曲线作为转接两段轨迹的平滑轨迹。机器人从前段轨迹通过Bezier曲线过渡到后段轨迹上，且过渡运动的速度不为0。

本申请中，将三阶Bezier曲线作为平滑轨迹，当然，平滑轨迹还可以使用其他阶数的Bezier曲线。以三阶Bezier曲线为例，介绍三阶Bezier曲线的构建方式，需要说明的是，此处的三阶Bezier曲线可以称为关于路径的三阶Bezier曲线，以便与下文关于时间的三阶Bezier曲线区分。

根据前段轨迹及后段轨迹确定三阶Bezier曲线的位置特征点，根据确定出的位置特征点，构建三阶Bezier曲线作为平滑轨迹。其中，位置特征点中包含起始点及终止点。

可以理解的是，如图2所示，运动过程中，机器人在前段轨迹lc的末端及后段轨迹ln的初端会脱离原来的轨迹，因此，在前端轨迹lc的末端有拐出点A，在后段轨迹ln的初端有拐入点B。

在构建关于路径的三阶Bezier曲线时，需要保证Bezier曲线的起始点与前段轨迹的拐出点重合，Bezier曲线的终止点与后段轨迹的拐入点重合，且Bezier曲线在起始点的切矢量方向与前段轨迹在拐出点的切矢量方向相同、 Bezier曲线在终止点的切矢量方向与后段轨迹在拐入点的切矢量方向相同。

以上构建的关于路径的三阶Bezier曲线可以作为转接前段轨迹及后段轨迹的平滑轨迹。

本申请提供了一种机器人运动控制方法，该方法用于控制机器人按照上述关于路径的三阶Bezier曲线表示的平滑轨迹进行运动。控制方法用于在多个控制周期(也可以称为插补周期)中的每个控制周期内确定机器人需运动至的位置点，如图3所示，三阶Bezier曲线表示的平滑轨迹上的各个小圆点，表示的是各个控制周期内机器人运动到的位置点。

如图4所示，在每个控制周期执行以下步骤S41～S41。

步骤S41：确定从首个控制周期到当前控制周期的时长值。

其中，时长值为从首个控制周期到当前控制周期的时间长度，例如控制周期为1毫秒，当前控制周期为第81个控制周期，则从首个控制周期到当前控制周期的时长值为0.08s。

步骤S42：使用关于时间的三阶Bezier曲线的表达式，求解时长值对应的Bezier参数的值。

其中，关于时间的三阶Bezier曲线的表达式为预先构建的，所述关于时间的三阶Bezier曲线表示的是Bezier参数与时长之间的关系。

构建的关于时间的三阶Bezier曲线的表达式为：

T(u)＝T₀(1-u)³+3T₁u(1-u)²+3T₂u²(1-u)+T₃u³。

其中，T(u)表示沿着所述关于路径的三阶Bezier曲线表示的平滑轨迹运动所需的时长，T₀、T₁、T₂及T₃为所述关于时间的三阶Bezier曲线的时间特征点，在已构建的上述表达式中，时间特征点T₀、T₁、T₂及T₃为已知值，关于如何确定四个时间特征点的值请见下文，此处并不赘述。

将步骤S41确定的时长值作为T(u)代入已构建的上述表达式中，可求得时长值对应的Bezier参数u的值，Bezier参数可简称为参数。需要说明的是，求解到的Bezier参数u有三个，由于u∈[0,1]，因此将属于[0,1]范围内的值确定为Bezier参数u的值。

步骤S43：将Bezier参数的值代入关于路径的三阶Bezier曲线的表达式中，获得位置坐标值。

其中，所述关于路径的三阶Bezier曲线表示的是Bezier参数与位置坐标之间的关系，表达式为：

P(u)＝P₀(1-u)³+3P₁u(1-u)²+3P₂u²(1-u)+P₃u³。

其中，P(u)表示关于路径的三阶Bezier曲线中的位置坐标，P₀、P₁、P₂及P₃为关于路径的三阶Bezier曲线的位置特征点，在已构建的上述表达式中，P₀、P₁、P₂及P₃均为已知值。

需要说明的是，关于路径的三阶Bezier曲线与关于时间的三阶Bezier曲线是具有关联关系的，两个表达式中的Bezier参数u为相同值。因此，将步骤S42中根据关于时间的三阶Bezier曲线求解到的Bezier参数u的值代入上述关于路径的三阶Bezier曲线的表达式，便可求解出P(u)。

步骤S44：向驱动装置发送位置坐标值，以使驱动装置将机器人移动至位置坐标值表示的位置点。

其中，机器人中设置驱动装置(如驱动控制器等)，以控制机器人的移动旋转等动作。向驱动装置发送步骤S43求解到的位置坐标值P(u)，驱动装置根据位置坐标值生成相应的移动命令，并向机械臂等运动部件发送该移动命令，以控制机器人移动至该位置坐标值所表示的位置点。如图3所示，若当前控制周期为首个控制周期，则控制机器人移动至第一个小圆点处，若当前控制周期为第二个控制周期，则控制机器人移动至第二个小圆点处，以此类推，在最后一个控制周期，控制机器人移动至平滑轨迹的终点。

以上机器人运动控制方法中，使用关于路径的三阶Bezier曲线作为机器人从前段轨迹运动至后段轨迹的平滑轨迹，并且使用关于时间的三阶Bezier曲线对运动速度进行规划，规划的速度用于确定每个控制周期内机器人需运动至的位置点，各个位置点组成上述平滑轨迹。

在本申请中，机器人可以速度不为0地从前段轨迹转接至后段轨迹，该转接轨迹为关于路径的三阶Bezier曲线，由于曲线的构建并不需要依赖机器人在前后两段轨迹上的速度，因此，可以避免矢量加减法构建的平滑轨迹精准度较低的问题。并且，该曲线并非确定前段轨迹与后段轨迹的公切圆，可以解决适用性较小的问题，本申请可以应用在各种形状的轨迹转接场景中，应用范围较广。

构建平滑轨迹后，需要控制机器人按照该平滑轨迹运动。控制过程中包括速度规划过程，速度规划过程即确定机器人以怎样的速度通过该平滑轨迹。

可以理解的是，速度与时间及路径是有关联关系的，规划的速度需要转化为路径上的位置点，控制机器人在一定时间内移动至该位置点，便可以体现出机器人是按照规划的速度运动。因此，以上图4所示的机器人运动控制方法中，为每个控制周期确定所需运动到的位置点，从整个运动过程来看，机器人是按照一定的速度运动的。

目前的速度规划方案有S型速度规划及T型速度规划，该两种速度规划方案中已知路径长度及始末速度，对目标速度或目标时间进行速度规划。该两种速度规划方案中，需要保证等差参数对应等差路径长度，因此，只能适用于直线或者圆弧。

然而，本申请使用Bezier曲线作为平滑轨迹，Bezier曲线为参数曲线，路径长度无法精确计算，只能通过数值积分计算得出，且由于路径点稀疏密集程度不同，等差参数不一定对应等差路径长度，因此，现有的速度规划方案并不能精确地对Bezier曲线进行速度规划。

对此，本申请针对关于路径的三阶Bezier曲线，确定相对应的速度规划方案，即在Bezier曲线坐标维度的基础上，增加时间维度。通过控制时间维度上的时间特征点，来控制机器人满足预先设置的始末速度，这样，速度规划的插补周期与Bezier曲线的参数一一对应，并且，Bezier曲线的每个点都是通过时间来控制速度变化，从而达到始末速度连续的目的。

其中，增加时间维度的Bezier曲线可以为上述关于时间的三阶Bezier曲线的表达式，即：

T(u)＝T₀(1-u)³+3T₁u(1-u)²+3T₂u²(1-u)+T₃u³。

可以理解的是，该表达式中Bezier参数u为变量，但需确定出时间控制点T₀、T₁、T₂及T₃的值。确定出该四个时间特征点后，代入上述表达式便可以构建出关于时间的三阶Bezier曲线。

以下介绍如何确定该四个时间特征点的值。

其中，依据关于路径的三阶Bezier曲线的位置特征点(P₀、P₁、P₂及P₃)、 预设的起始点的速度及预设的终止点的速度，确定所述关于时间的三阶Bezier曲线的时间特征点T₀、T₁、T₂及T₃。

具体地，可以将时间特征点T₀确定为0。

将位置特征点P₀、位置特征点P₁及速度υ_s代入表达式求解时间特征点T₁，其中，所述速度υ_s为预先设置的机器人在所述平滑轨迹的起始点的速度，起始点即位置特征点P₀。

将位置特征点P₂、位置特征点P₃及速度υ_f代入表达式求解时间特征点T₃与时间特征点T₂的差值T_3-2，其中，所述速度υ_f为预先设置的机器人在所述平滑轨迹的终止点的速度，终止点为位置特征点P₃。

依据所述差值T_3-2，确定T₂及T₃。

需要说明的是，以上根据位置特征点及预先设置的始末速度，可以精确地计算出T₀及T₁。至于T₂及T₃，可以计算出T₃与T₂的差值T_3-2，因此，只需要T₃与T₂的差值满足T_3-2即可，也就是说满足两者之间的差值为T_3-2的任意T₃与T₂的值均可以。本申请可以提供以下两种确定方式，需要说明的是，并不局限于以下两种。

在一个具体示例中，可以预先设置时间特征点T₃的值，该值表示经过该平滑轨迹的总时长，将所述时间特征点T₃减去所述差值T_3-2，获得时间特征点T₂。

在另一具体示例中，可以将位置特征点P₁、位置特征点P₂、速度υ_s、速度υ_f及时间特征点T₁代入表达式求解时间特征点T₂；将所述时间特征点T₂加上所述差值T_3-2，获得时间特征点T₃。

其中，表达式及的获得方式为：

分别对关于路径的三阶Bezier曲线的表达式 P(u)＝P₀(1-u)³+3P₁u(1-u)²+3P₂u²(1-u)+P₃u³在起始点P₀及终止点P₃处求导，获得P'(0)＝-3P₀+3P₁及P'(1)＝-3P₂+3P₃；

分别对关于时间的三阶Bezier曲线的表达式T(u)＝T₀(1-u)³+3T₁u(1-u)²+3T₂u²(1-u)+T₃u³在起始点P₀及终止点P₃处求导，获得T'(0)＝-3T₀+3T₁及T'(1)＝-3T₂+3T₃。

其中，u＝0对应的是起始点P₀，u＝1对应的是终止点P₃。

根据P'(0)＝-3P₀+3P₁及T'(0)＝-3T₀+3T₁可以得出有关起始点处速度的以下表达式：

根据P'(1)＝-3P₂+3P₃及T'(1)＝-3T₂+3T₃可以得出有关终止点处速度的以下表达式：

其中，T₃-T₂可以表示为T_3-2。

设T₀为0，根据以上两个表达式可以得出表达式及

另外，若设以上表达式可以写为：进一步地，可以将写为

以上推导过程中，使用Bezier曲线的一阶导公式推导出时间特征点对于始末速度的影响，再由始末速度及特征点空间关系推导出每个位置特征点上的时间。

见图5，其示出了本申请提供的机器人运动控制装置的结构。

机器人运动控制装置应用于机器人中，具体可为机器人的控制器或处理器，用于控制机器人按照预先构建的关于路径的三阶Bezier曲线表示的平滑轨迹进行运动，所述控制装置在每个控制周期内确定机器人需运动至的位置点。

其中，如图5所示，所述控制装置具体包括：

时长值确定单元51，用于确定从首个控制周期到当前控制周期的时长值；

参数值确定单元52，用于使用预先构建的关于时间的三阶Bezier曲线的表达式，求解所述时长值对应的Bezier参数的值；其中，所述关于时间的三阶Bezier曲线表示的是Bezier参数与时长之间的曲线关系；

坐标值确定单元53，用于将所述Bezier参数的值代入所述关于路径的三阶Bezier曲线的表达式中，获得位置坐标值；其中，所述关于路径的三阶Bezier曲线表示的是Bezier参数与位置坐标之间的曲线关系；

移动至坐标值单元54，用于向驱动装置发送所述位置坐标值，以使所述驱动装置将所述机器人移动至所述位置坐标值表示的位置点。

见图6，其示出了本申请提供的机器人运动控制装置的另一种结构。该控制装置在上述图5所示的控制装置的基础上，还可以包括：时间曲线构建单元55及路径曲线构建单元56。需要说明的是，图6中的部件51～54可以参见上述说明，此处并不赘述。

时间曲线构建单元55，用于构建关于时间的三阶Bezier曲线；

路径曲线构建单元56，用于构建关于路径的三阶Bezier曲线，所述关于路径的三阶Bezier曲线作为机器人从前段轨迹运动到后段轨迹的平滑轨迹。

其中，在所述构建关于路径的三阶Bezier曲线的方面，所述路径曲线构建单元具体用于：

根据所述前段轨迹及所述后段轨迹确定三阶Bezier曲线的位置特征点，根据所述位置特征点，构建关于路径的三阶Bezier曲线；其中，所述位置特征点中包含起始点及终止点，所述前段轨迹具有拐出点，所述后段轨迹具有拐入点，且所述起始点与所述拐出点重合，所述终止点与所述拐入点重合，所述起始点的切矢量方向与所述拐出点的切矢量方向相同，所述终止点的切 矢量方向与所述拐入点的切矢量方向相同。

其中，所述在构建关于时间的三阶Bezier曲线的方面，所述时间曲线构建单元具体用于：

依据关于路径的三阶Bezier曲线的位置特征点P₀、P₁、P₂及P₃，确定所述关于时间的三阶Bezier曲线的时间特征点T₀、T₁、T₂及T₃；

依据所述时间特征点T₀、T₁、T₂及T₃，构建的关于时间的三阶Bezier曲线的表达式为：

T(u)＝T₀(1-u)³+3T₁u(1-u)²+3T₂u²(1-u)+T₃u³，其中，u为Bezier参数且u∈[0,1]，T(u)表示沿着所述关于路径的三阶Bezier曲线表示的平滑轨迹运动所需的时长。

其中，在依据关于路径的三阶Bezier曲线的位置特征点P₀、P₁、P₂及P₃，确定所述关于时间的三阶Bezier曲线的时间特征点T₀、T₁、T₂及T₃的方面，所述时间曲线构建单元具体用于：

确定时间特征点T₀为0；

将位置特征点P₀、位置特征点P₁及速度υ_s代入表达式求解时间特征点T₁，其中，所述速度υ_s为预先设置的机器人在所述平滑轨迹的起始点的速度；

将位置特征点P₂、位置特征点P₃及速度υ_f代入表达式求解时间特征点T₃与时间特征点T₂的差值T_3-2，其中，所述速度υ_f为预先设置的机器人在所述平滑轨迹的终止点的速度；

依据所述差值T_3-2，确定T₂及T₃。

在一个示例中，在所述依据所述差值T_3-2，确定T₂及T₃的方面，所述时间曲线构建单元具体用于：

获取预先设置的时间特征点T₃，将所述时间特征点T₃减去所述差值T_3-2，获得时间特征点T₂。

在另一示例中，在所述依据所述差值T_3-2，确定T₂及T₃的方面，所述时间曲线构建单元具体用于：

将位置特征点P₁、位置特征点P₂、速度υ_s、速度υ_f及时间特征点T₁代入表达式求解时间特征点T₂；

将所述时间特征点T₂加上所述差值T_3-2，获得时间特征点T₃。

见图7，其示出了本申请提供的机器人运动控制装置的硬件结构示意图。如图7所示，该机器人运动控制装置可以包括：处理器1，通信接口2，存储器3以及通信总线4，其中处理器1、通信接口2以及存储器3通过通信总线4完成相互间的通信。

存储器3，用于存放安装于该机器人运动控制装置中的程序代码以及数据。存储器3可以是高速RAM存储器，也可以是非易失性存储器(non-volatile memory)，例如磁盘存储器。所述程序代码包括处理器的操作指令。

处理器1可能是一个中央处理器CPU，或者是特定集成电路ASIC(Application Specific Integrated Circuit)，或者是被配置成实施本申请实施例的一个或多个集成电路。

所述处理器1用于调用所述存储器3中的程序代码以及数据以确定机器人在多个控制周期中的每个控制周期内所需运动至的位置点，从而控制机器人按照预先构建的关于路径的三阶Bezier曲线表示的平滑轨迹进行运动。所述处理器1调用所述存储器3中的程序代码以及数据以确定机器人在多个控制周期中的每个控制周期内所需运动至的位置点，具体包括以下步骤：

确定从首个控制周期到当前控制周期的时长值；

使用预先构建的关于时间的三阶Bezier曲线的表达式，求解所述时长值对应的Bezier参数的值；其中，所述关于时间的三阶Bezier曲线表示的是Bezier参数与时长之间的曲线关系；

将所述Bezier参数的值代入所述关于路径的三阶Bezier曲线的表达式中，获得位置坐标值；其中，所述关于路径的三阶Bezier曲线表示的是Bezier参数与位置坐标之间的曲线关系；

通过所述通信接口2向驱动装置发送所述位置坐标值，以使所述驱动装 置将所述机器人移动至所述位置坐标值表示的位置点。所述通信接口2用于与驱动装置相连，从而向驱动装置发送位置坐标。所述通信接口2可以为通信模块的接口，如GSM模块的接口，PCI模块的接口等。

本申请还提供了一种机器人，包括机器人运动控制装置及驱动装置，其中：

所述机器人运动控制装置，用于在每个控制周期内确定机器人需运动至的位置点；其中，每个控制周期执行以下步骤：确定确定从首个控制周期到当前控制周期的时长值；使用预先构建的关于时间的三阶Bezier曲线的表达式，求解所述时长值对应的Bezier参数的值；其中，所述关于时间的三阶Bezier曲线表示的是Bezier参数与时长之间的曲线关系；将所述Bezier参数的值代入所述关于路径的三阶Bezier曲线的表达式中，获得位置坐标值；其中，所述关于路径的三阶Bezier曲线表示的是Bezier参数与位置坐标之间的曲线关系；向所述驱动装置发送所述位置坐标值；

所述驱动装置，用于驱动所述机器人移动至所述位置坐标值表示的位置点。

其中，机器人可以具体为机械臂。

结合本发明公开内容所描述的方法或者算法的步骤可以硬件的方式来实现，也可以是由处理器执行软件指令的方式来实现。软件指令可以由相应的软件模块组成，软件模块可以被存放于RAM存储器、闪存、ROM存储器、EPROM存储器、EEPROM存储器、寄存器、硬盘、移动硬盘、CD-ROM或者本领域熟知的任何其它形式的存储介质中。一种示例性的存储介质耦合至处理器，从而使处理器能够从该存储介质读取信息，且可向该存储介质写入信息。当然，存储介质也可以是处理器的组成部分。处理器和存储介质可以位于ASIC中。

本领域技术人员应该可以意识到，在上述一个或多个示例中，本发明所描述的功能可以用硬件、软件、固件或它们的任意组合来实现。当使用软件实现时，可以将这些功能存储在可读介质中或者作为可读介质上的一个或多个指令或代码进行传输。

以上所述的具体实施方式，对本发明的目的、技术方案和有益效果进行 了进一步详细说明，所应理解的是，以上所述仅为本发明的具体实施方式而已，并不用于限定本发明的保护范围，凡在本发明的技术方案的基础之上，所做的任何修改、等同替换、改进等，均应包括在本发明的保护范围之内。

Claims (14)

1. 一种机器人运动控制方法，其特征在于，用于控制机器人按照预先构建的关于路径的三阶Bezier曲线表示的平滑轨迹进行运动，所述控制方法用于在多个控制周期中的每个控制周期内确定机器人需运动至的位置点，其中每个控制周期内包括以下步骤：

   确定从首个控制周期到当前控制周期的时长值；

   使用预先构建的关于时间的三阶Bezier曲线的表达式，求解所述时长值对应的Bezier参数的值；其中，所述关于时间的三阶Bezier曲线表示的是Bezier参数与时长之间的曲线关系；

   将所述Bezier参数的值代入所述关于路径的三阶Bezier曲线的表达式中，获得位置坐标值；其中，所述关于路径的三阶Bezier曲线表示的是Bezier参数与位置坐标之间的曲线关系；

   向驱动装置发送所述位置坐标值，以使所述驱动装置将所述机器人移动至所述位置坐标值表示的位置点。
2. 根据权利要求1所述的机器人运动控制方法，其特征在于，构建所述关于时间的三阶Bezier曲线的方法包括：

   依据关于路径的三阶Bezier曲线的位置特征点、预设的起始点的速度及预设的终止点的速度，确定所述关于时间的三阶Bezier曲线的时间特征点T₀、T₁、T₂及T₃；

   依据所述时间特征点T₀、T₁、T₂及T₃，构建的关于时间的三阶Bezier曲线的表达式为：

   T(u)＝T₀(1-u)³+3T₁u(1-u)²+3T₂u²(1-u)+T₃u³，其中，u为Bezier参数且u∈[0,1]，T(u)表示沿着所述关于路径的三阶Bezier曲线表示的平滑轨迹运动所需的时长。
3. 根据权利要求2所述的机器人运动控制方法，其特征在于，所述依据关于路径的三阶Bezier曲线的位置特征点、预设的起始点的速度及预设的终止点的速度，确定所述关于时间的三阶Bezier曲线的时间特征点T₀、T₁、T₂及T₃，包括：

   确定时间特征点T₀为0；

   将位置特征点P₀、位置特征点P₁及速度υ_s代入表达式求解时间特征点T₁，其中，所述速度υ_s为预先设置的机器人在所述平滑轨迹的起始点的速度；

   将位置特征点P₂、位置特征点P₃及速度υ_f代入表达式求解时间特征点T₃与时间特征点T₂的差值T_3-2，其中，所述速度υ_f为预先设置的机器人在所述平滑轨迹的终止点的速度；

   依据所述差值T_3-2，确定T₂及T₃。
4. 根据权利要求3所述的机器人运动控制方法，其特征在于，所述依据所述差值T_3-2，确定T₂及T₃，包括：

   获取预先设置的时间特征点T₃，将所述时间特征点T₃减去所述差值T_3-2，获得时间特征点T₂。
5. 根据权利要求3所述的机器人运动控制方法，其特征在于，所述依据所述差值T_3-2，确定T₂及T₃，包括：

   将位置特征点P₁、位置特征点P₂、速度υ_s、速度υ_f及时间特征点T₁代入表达式求解时间特征点T₂；

   将所述时间特征点T₂加上所述差值T_3-2，获得时间特征点T₃。
6. 根据权利要求1所述的机器人运动控制方法，其特征在于，所述关于路径的三阶Bezier曲线作为机器人从前段轨迹运动到后段轨迹的平滑轨迹，构建所述关于路径的三阶Bezier曲线的方法包括：

   根据所述前段轨迹及所述后段轨迹确定三阶Bezier曲线的位置特征点，根据所述位置特征点，构建关于路径的三阶Bezier曲线；

   其中，所述位置特征点中包含起始点及终止点，所述前段轨迹具有拐出 点，所述后段轨迹具有拐入点，且所述起始点与所述拐出点重合，所述终止点与所述拐入点重合，所述起始点的切矢量方向与所述拐出点的切矢量方向相同，所述终止点的切矢量方向与所述拐入点的切矢量方向相同。
7. 一种机器人运动控制装置，其特征在于，用于控制机器人按照预先构建的关于路径的三阶Bezier曲线表示的平滑轨迹进行运动，所述控制装置用于在多个控制周期中的每个控制周期内确定机器人需运动至的位置点；所述控制装置包括：

   时长值确定单元，用于确定从首个控制周期到当前控制周期的时长值；

   参数值确定单元，用于使用预先构建的关于时间的三阶Bezier曲线的表达式，求解所述时长值对应的Bezier参数的值；其中，所述关于时间的三阶Bezier曲线表示的是Bezier参数与时长之间的曲线关系；

   坐标值确定单元，用于将所述Bezier参数的值代入所述关于路径的三阶Bezier曲线的表达式中，获得位置坐标值；其中，所述关于路径的三阶Bezier曲线表示的是Bezier参数与位置坐标之间的曲线关系；

   移动至坐标值单元，用于向驱动装置发送所述位置坐标值，以使所述驱动装置将所述机器人移动至所述位置坐标值表示的位置点。
8. 根据权利要求7所述的机器人运动控制装置，其特征在于，还包括：

   时间曲线构建单元，用于构建所述关于时间的三阶Bezier曲线；

   其中，所述在构建关于时间的三阶Bezier曲线的方面，所述时间曲线构建单元具体用于：

   依据关于路径的三阶Bezier曲线的位置特征点、预设的起始点的速度及预设的终止点的速度，确定所述关于时间的三阶Bezier曲线的时间特征点T₀、T₁、T₂及T₃；

   依据所述时间特征点T₀、T₁、T₂及T₃，构建的关于时间的三阶Bezier曲线的表达式为：

   T(u)＝T₀(1-u)³+3T₁u(1-u)²+3T₂u²(1-u)+T₃u³，其中，u为Bezier参数且u∈[0,1]，T(u)表示沿着所述关于路径的三阶Bezier曲线表示的平滑轨迹运动所需的时长。
9. 根据权利要求7所述的机器人运动控制装置，其特征在于，在依据关于路径的三阶Bezier曲线的位置特征点、预设的起始点的速度及预设的终止点的速度，确定所述关于时间的三阶Bezier曲线的时间特征点T₀、T₁、T₂及T₃的方面，所述时间曲线构建单元具体用于：

   确定时间特征点T₀为0；

   将位置特征点P₀、位置特征点P₁及速度υ_s代入表达式求解时间特征点T₁，其中，所述速度υ_s为预先设置的机器人在所述平滑轨迹的起始点的速度；

   将位置特征点P₂、位置特征点P₃及速度υ_f代入表达式求解时间特征点T₃与时间特征点T₂的差值T_3-2，其中，所述速度υ_f为预先设置的机器人在所述平滑轨迹的终止点的速度；

   依据所述差值T_3-2，确定T₂及T₃。
10. 根据权利要求9所述的机器人运动控制装置，其特征在于，在所述依据所述差值T_3-2，确定T₂及T₃的方面，所述时间曲线构建单元具体用于：

    获取预先设置的时间特征点T₃，将所述时间特征点T₃减去所述差值T_3-2，获得时间特征点T₂。
11. 根据权利要求9所述的机器人运动控制装置，其特征在于，在所述依据所述差值T_3-2，确定T₂及T₃的方面，所述时间曲线构建单元具体用于：

    将位置特征点P₁、位置特征点P₂、速度υ_s、速度υ_f及时间特征点T₁代入表达式求解时间特征点T₂；

    将所述时间特征点T₂加上所述差值T_3-2，获得时间特征点T₃。
12. 根据权利要求7所述的机器人运动控制装置，其特征在于，还包括：

    路径曲线构建单元，用于构建所述关于路径的三阶Bezier曲线，所述关于 路径的三阶Bezier曲线作为机器人从前段轨迹运动到后段轨迹的平滑轨迹；

    其中，在所述构建关于路径的三阶Bezier曲线的方面，所述路径曲线构建单元具体用于：

    根据所述前段轨迹及所述后段轨迹确定三阶Bezier曲线的位置特征点，根据所述位置特征点，构建关于路径的三阶Bezier曲线；其中，所述位置特征点中包含起始点及终止点，所述前段轨迹具有拐出点，所述后段轨迹具有拐入点，且所述起始点与所述拐出点重合，所述终止点与所述拐入点重合，所述起始点的切矢量方向与所述拐出点的切矢量方向相同，所述终止点的切矢量方向与所述拐入点的切矢量方向相同。
13. 一种机器人运动控制装置，其特征在于，包括通信接口、处理器以及存储器，所述通信接口与驱动装置相连，所述存储器中存储有安装于该机器人运动控制装置中的程序代码以及数据，所述处理器用于调用所述存储器中的程序代码以及数据以确定机器人在多个控制周期中的每个控制周期内所需运动至的位置点，具体包括以下步骤：

    确定从首个控制周期到当前控制周期的时长值；

    使用预先构建的关于时间的三阶Bezier曲线的表达式，求解所述时长值对应的Bezier参数的值；其中，所述关于时间的三阶Bezier曲线表示的是Bezier参数与时长之间的曲线关系；

    将所述Bezier参数的值代入预先构建的关于路径的三阶Bezier曲线的表达式中，获得位置坐标值；其中，所述关于路径的三阶Bezier曲线表示的是Bezier参数与位置坐标之间的曲线关系；

    通过所述通信接口向驱动装置发送所述位置坐标值，以使所述驱动装置将所述机器人移动至所述位置坐标值表示的位置点。
14. 一种机器人，其特征在于，包括：机器人运动控制装置及驱动装置，其中：

    所述机器人运动控制装置，用于在多个控制周期中的每个控制周期内确定机器人需运动至的位置点；其中，每个控制周期执行以下步骤：确定从首个控制周期到当前控制周期的时长值；使用预先构建的关于时间的三阶Bezier曲线的表达式，求解所述时长值对应的Bezier参数的值；其中，所述关于时 间的三阶Bezier曲线表示的是Bezier参数与时长之间的曲线关系；将所述Bezier参数的值代入预先构建的关于路径的三阶Bezier曲线的表达式中，获得位置坐标值；其中，所述关于路径的三阶Bezier曲线表示的是Bezier参数与位置坐标之间的曲线关系；向所述驱动装置发送所述位置坐标值；

    所述驱动装置，用于驱动所述机器人移动至所述位置坐标值表示的位置点。