一种基于时间‑空间特征的机器人示教轨迹生成方法

暂无

一种基于时间-空间特征的机器人示教轨迹生成方法\n技术领域\n[0001] 本发明涉及一种应用于无人驾驶车辆和多关节机器人的轨迹生成技术，尤其是涉及一种基于时间-空间特征的机器人示教轨迹生成方法。\n背景技术\n[0002] 机器人的轨迹规划，特别是对于高维多关节机器人的轨迹规划一直是机器人领域的重点和难点，传统机器人轨迹规划的方法可以分为基于采样的和基于优化的轨迹规划方法两种，这两种方法都需要定义一个合适的目标函数，用来优化所生成的轨迹。因此，目标函数实际上决定了生成轨迹的可行性。目标函数一般包含起始和目标状态，动力学与运动学模型，障碍物信息等。\n[0003] 示教学习，作为一种拟人的轨迹生成方法，通过学习示教轨迹，期望生成满足当前任务目标轨迹生成动态系统。对于示教学习来说，轨迹的适应性和泛化性决定了能否生成满足实际需要的轨迹。由于算法本身的限制，很多算法只能针对某种特定场合的应用，而且往往要求和示教轨迹在时间和空间上差别较小，否则并不能生成期望的轨迹。而且，对于自由度较多，需要多个关节自由度和示教轨迹组合时，一些经典算法往往无能为力。\n发明内容\n[0004] 本发明的目的就是为了克服上述现有技术存在的缺陷而提供一种基于时间-空间特征的机器人示教轨迹生成方法。\n[0005] 本发明的目的可以通过以下技术方案来实现：\n[0006] 一种基于时间-空间特征的机器人示教轨迹生成方法，其特征在于，包括以下步骤：\n[0007] 1)通过操作机器人，等采样时间间隔记录机器人末端各个自由度的示教轨迹，并多次对同类轨迹进行示教；\n[0008] 2)对多条同种类型轨迹提取其共同的时间-空间特征，生成轨迹模板；\n[0009] 3)构建满足时间-空间特征的目标方程，并通过协变梯度下降法求解机器人运动轨迹；\n[0010] 4)将求得的运动轨迹作为参考轨迹，输入到机器人的执行机构，机器人通过自已控制器进行轨迹跟踪，使得生成的轨迹和参考轨迹相一致。\n[0011] 所述的生成轨迹模板具体为：\n[0012] 21)通过公式(1)，生成M条示教轨迹的模板；\n[0013]\n[0014] 其中X为示教轨迹，V为空间规整的矩阵，当V的维数小于X的维数时，表示将多维轨迹进行降维，W为时间规整矩阵，负责将轨迹进行拉伸和缩短，同时保证轨迹的时间上的单调性，φ(Vi)和ψ(Wi)分别为空间和时间的正则化项，Jgctw用来衡量M条轨迹两两之间所提取特征差异的和，‖·‖F代表Frobenius范数；\n[0015] 通过求解上述方程，对于每条轨迹X可以求得与其对应的V和W；\n[0016]\n[0017] 通过求得M条示教轨迹的算术平均值，得到轨迹模板K。\n[0018] 所述的构建满足时间-空间特征的目标方程，并通过协变梯度下降法求解机器人运动轨迹具体为：\n[0019] 31)构建满足时间-空间特征的目标方程如下：\n[0020]\n[0021] 其中Vξ为空间规整矩阵、Xξ为轨迹矩阵、Wξ为时间规整矩阵、Fs-i用来比较所生成轨迹的时间空间特征与特征模板K的大小；\n[0022] Vξ通过计算XζWξ和K的Pearson相关系数ρ最大得到\n[0023]\n[0024]\n[0025] Va表示为XξWξ具有最大相关系数的典型变量矩阵，Vb表示为K具有最大相关系数的典型变量矩阵；\n[0026] 32)根据实际的应用，需要对初始和结束状态、轨迹的光滑性、环境的避障以及机器人的运动学约束建立相应的目标函数如下所示\n[0027]\n[0028] 其中Fprior[Xξ]代表轨迹的初始、终点状态约束和光滑约束，Fobstacles[Xξ]表示障碍物约束，a、b和c分别代表了各个约束的系数，其大小可以通过经验设定，也可以通过计算得出，通过采用协变梯度下降法求解目标方程，所得到的轨迹Xξ既能满足任务需要，又能保存原本的时间-空间特征。\n[0029] 与现有技术相比，本发明具有以下优点：\n[0030] 1、在满足原本约束的基础上增加了从示教轨迹学习得到的时间-空间特征，通过增加这个约束条件，可以限制轨迹的搜索空间，加快求解速度；\n[0031] 2、所生成的轨迹能够尽可能的保持示教轨迹的相似性，生成的轨迹更易于满足执行机构的物理结构，特别适用于编程规划复杂但人类示教容易的情况。\n[0032] 3、特别适用于无人驾驶汽车这种和人类进行交互的执行机构的轨迹生成。\n附图说明\n[0033] 图1为本发明具体的流程图。\n具体实施方式\n[0034] 下面结合附图和具体实施例对本发明进行详细说明。\n[0035] 实施例\n[0036] 如图1所示，本发明基于时间-空间特征的机器人示教轨迹生成方法，包括以下步骤：\n[0037] 1)通过操作机器人，等采样时间间隔记录机器人的末端各个自由度的示教轨迹，通过多次对同类轨迹进行示教，避免单个示教轨迹局部扰动所造成的影响。对于多关节自由度机器人来说，还可以记录关节点各个自由度的轨迹信息；\n[0038] 2)对多条同种类型轨迹提取其共同的时间-空间特征，生成轨迹的模板K[0039]\n[0040]\n[0041] 3)构建保持示教轨迹时间-空间特征的轨迹目标方程，同时需要满足\n[0042]\n[0043] 由于该方程非凸函数，需要求解三个未知量空间规整矩阵Vξ，时间规整矩阵Wξ，轨迹矩阵Xξ。首先输入一个与期望轨迹时间-空间特征类似的轨迹，可以采用一个示教轨迹作为初始轨迹Xξ，并求得所对相应的时间和空间规整矩阵。并通过协变梯度下降法求解机器人运动轨迹。\n[0044]\n[0045] 将所得到的轨迹带入(15)式，重新求得对应的空间规整矩阵Vξ和时间规整矩阵Wξ，并将其输入到(6)式。反复迭代，直到u[Xξ]满足事先预定的较小值ε或者超过最大迭代次数，此时得到的轨迹即为满足时间-空间特征以及起始、终点以及环境约束的轨迹；\n[0046] 4)将期望轨迹作为参考信号输入到图1的轨迹跟踪系统，轨迹跟踪系统负责输出控制信号给机器人的执行机构，调节机器人的运动，使得机器人能够时刻跟踪参考轨迹。