一种机器人运动曲线处理方法及系统与流程
本发明涉及机器人技术，特别涉及一种机器人运动曲线处理方法及系统。
背景技术：
随着机器人技术的不断进步，新型机器人已经能够代替人类执行一些任务。
机器人在执行任务时面对的环境是复杂的，不确定的，很有可能会因为一些突发的情况导致机器人无法顺利完成任务，因此机器人需要获取运动数据来对下一个操作进行分析，描述存在的运动错误以及矫正错误。
现有技术中对于机器人运动数据的分析采用位姿估计的方法来分析处理，帮助机器人了解自我运动的状态。但是采用位姿估计的方法不能采用一些比较低层次的数据，来进行分析处理得到机器人可以利用的数据，例如机器人的运动曲线。总的来说，利用现有技术中的方法，在控制机器人执行任务时，无法把低层次的运动数据经过处理后得到机器人能够利用的高层次数据，从而限制了机器人的智能化程度。
技术实现要素：
有鉴于此，本发明的目的在于提供一种机器人运动曲线处理方法及系统，通过处理机器人的运动曲线数据，得到机器人可以使用的高层次数据。其具体方案如下：
一种机器人运动曲线处理方法，包括：
对运动曲线进行分割处理，得到离散化曲线向量；
对所述离散化曲线向量进行编码处理，得到曲线方向编码；
对所述曲线方向编码进行分类处理，得到运动状态。
优选地，所述对运动曲线进行分割处理的过程，包括：
对所述运动曲线进行离散化处理，得到离散化曲线，所述离散化曲线包括一系列点xk；
对所述离散化曲线进行弗勒内坐标系赋值，得到所述离散化曲线向量，其中，所述离散化曲线向量包括所述离散化曲线的正切向量
其中，k＝1,2,3,....。
优选地，所述弗勒内坐标系赋值计算公式为：
式中，xk表示所述离散化曲线上的第k个点，
优选地，所述对运动曲线进行分割处理的过程，包括：
对所述运动曲线进行离散化处理，得到离散化曲线，所述离散化曲线包括一系列点xk；
对所述离散化曲线进行积累弗勒内坐标系赋值，得到所述离散化曲线向量，其中，所述离散化曲线向量包括所述离散化曲线的积累正切向量
当所述积累正切向量
其中，k＝1,2,3,....。
优选地，所述对所述曲线方向编码进行分类处理的过程，包括
利用监督分类算法对所述曲线方向编码进行分类处理。
优选地，所述对所述离散化曲线向量进行编码处理的过程，包括：
利用直接曲线编码法对所述离散化曲线向量进行编码处理。
本发明还公开了一种机器人运动曲线处理系统，包括：
运动曲线分割模块，用于对运动曲线进行分割处理，得到离散化曲线向量；
运动曲线编码模块，用于对所述离散化曲线向量进行编码处理，得到曲线方向编码；
运动曲线分类模块，用于对所述曲线方向编码进行分类处理，得到运动状态。
优选地，所述运动曲线分割模块，包括：
离散化单元，用于对所述运动曲线进行离散化处理，得到离散化曲线，所述离散化曲线包括一系列点xk；
弗勒内坐标系赋值单元，用于对所述离散化曲线进行弗勒内坐标系赋值，得到所述离散化曲线向量，其中，所述离散化曲线向量包括所述离散化曲线的正切向量
其中，k＝1,2,3,....。
优选地，所述运动曲线分割模块，包括：
离散化单元，用于对所述运动曲线进行离散化处理，得到离散化曲线，所述离散化曲线包括一系列点xk；
积累弗勒内坐标系赋值单元，用于对对所述离散化曲线进行积累弗勒内坐标系赋值，得到所述离散化曲线向量，其中，所述离散化曲线向量包括所述离散化曲线的积累正切向量
积累弗勒内坐标系赋值更新单元，用于当所述积累正切向量
其中，k＝1,2,3,....。
优选地，所述运动曲线编码模块为dcc编码模块，用于利用直接曲线编码法对所述离散化曲线向量进行编码处理。
本发明中，机器人运动曲线处理方法包括：对运动曲线进行分割处理，得到离散化曲线向量；对离散化曲线向量进行编码处理，得到曲线方向编码；对曲线方向编码进行分类处理，得到运动状态。可见，本发明在对机器人运动曲线处理的过程中，对运动曲线进行分割处理得到离散化的曲线后再进行编码，能够有效的获得离散化曲线上运动方向的变化。根据运动方向的变化进行编码可以更好的在运动曲线上对不同方向的轨迹进行分类，从而获得机器人可以利用的运动状态数据。总的来说，利用本发明所提供的机器人运动曲线处理方法，在控制机器人执行任务时，可以把机器人低层次的运动曲线数据经过处理后得到机器人能够利用的高层次数据，这样有利于提升机器人对历史数据的有效利用率，以便通过这些数据感知自身的运动轨迹，从而提高了机器人的智能化程度。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据提供的附图获得其他的附图。
图1为本发明实施例公开的一种机器人运动曲线处理方法流程图；
图2为本发明实施例公开的一种机器人运动曲线处理方法示意图；
图3为本发明实施例公开运动曲线进行分割处理的方法流程图；
图4为本发明实施例公开另一种运动曲线进行分割处理的方法流程图；
图5为本发明实施例公开的第三种具体的机器人运动曲线处理方法流程图；
图6为本发明公开的一种机器人运动曲线处理系统结构示意图；
图7为本发明公开的运动曲线分割模块结构示意图；
图8为本发明公开的另一种运动曲线分割模块结构示意图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
本发明实施例公开了一种机器人运动曲线处理方法，参见图1和图2所示，图1为该方法的流程图，图2为该方法处理机器人运动曲线的示意图。该方法包括：
步骤11：对运动曲线进行分割处理，得到离散化曲线向量。
本实施例中，上述运动曲线为机器人在执行任务时运动的轨迹曲线，由于执行任务的环境复杂，因此这个曲线可以是一个复杂的空间曲线，例如在机器人执行爬坡以及下坡任务时，运动的空间曲线应该是一段竖直方向上的圆弧。该运动曲线可以利用机器人的定位器获得，通过定位器可以获得机器人运动的空间曲线以及曲线的长度等信息。
对运动曲线进行分割处理，主要是将运动曲线进行离散化，将原本连续的曲线离散成点。也可以对曲线进行分帧处理，将原本连续的曲线分成多段单位帧。然后通过离散化的点之间方向的变化，就能映射出运动曲线方向的变化。得到的离散化向量曲线向量，实质上就是离散化曲线上点的方向的表示。
步骤12：对离散化曲线向量进行编码处理，得到曲线方向编码。
上述步骤后得到的离散化曲线向量是离散化曲线上点的方向，不同的方向可以利用编码的方式来表示，以便进行区分，例如，可以使用基本的正交方向来表示各个离散化曲线向量：前、后、上、下、左、右以及不动，相应的可以使用7个不同的字符进行编码表示，以方便机器人理解。
当然，为了使离散化曲线向量编码能够更加精确的表示离散曲线上点的方向，可以增加表示方向的编码基本数的数量。这里的编码基本数的数量对应的是关于空间划分方向的数量，例如上述例子的正交方向就是对于空间进行了7个方向的均匀划分。因此为了使离散化曲线向量编码能够更加精确，可以增加编码基本数的数量，例如编码基本数为19。还可以对空间进行不均匀划分产生相应的编码基本数的数量。例如编码基本数为91以及2891等。
步骤13：对曲线方向编码进行分类处理，得到运动状态。
这里的分类处理，指的是将离散化曲线上连续以及具有相同编码的点进行归类，实际上也是对具有相同方向且连续的点进行归类，每一类方向编码以及里面的离散化点数就可以表示一个运动状态，例如机器人向前运动一段距离后左转运动，这时的分类处理就可以将离散化的曲线根据方向编码分为两个运动状态，向前运动为一个运动状态，向左运动为运动状态，还可以根据运动状态中的离散化曲线点数计算出运动的距离。
可见，本发明实施例在对机器人运动曲线处理的过程中，对运动曲线进行分割处理得到离散化的曲线后再进行编码，能够有效的获得离散化曲线上运动方向的变化。根据运动方向的变化进行编码可以更好的在运动曲线上对不同方向的轨迹进行分类，从而获得机器人可以利用的运动状态数据。总的来说，利用本发明所提供的机器人运动曲线处理方法，在控制机器人执行任务时，可以把机器人低层次的运动曲线数据经过处理后得到机器人能够利用的高层次数据，这样有利于提升机器人对历史数据的有效利用率，以便通过这些数据感知自身的运动轨迹，从而提高了机器人的智能化程度。
本发明实施例公开了一种具体的机器人运动曲线处理方法，相对于上一实施例，本实施例对技术方案作了进一步的说明和优化。具体的：
参见图3所示，上述实施例步骤11中，对运动曲线进行分割处理的方法，包括：
步骤21：对运动曲线进行离散化处理，得到离散化曲线，离散化曲线包括一系列点xk。
本申请实施例中，对运动曲线进行离散化处理可以利用采样的方法来实现，例如可以根据预先设定的采样时长对曲线进行采样，得到的离散化曲线的点之间的时间间隔应该是一致的，还可以根据预先设定的采样距离对曲线进行采样，得到的离散化曲线的点之间的距离间隔应该是一直的。得到的离散化曲线的点xk是散布在空间上的点，将这些点进行连接可以近似获得原来的运动曲线，其中采样点越多就越能近似原来的运动曲线，对于后续步骤的运动状态的分类也就越精确。
步骤22：对所述离散化曲线进行弗勒内坐标系赋值，得到离散化曲线向量，其中，离散化曲线向量包括离散化曲线的正切向量
其中，k＝1,2,3,....。
弗勒内坐标系的基本坐标轴由三个正交的向量组成，当一条曲线可以利用离散化的点表示时，可以获得点相应的弗勒内坐标系的基本坐标轴来表示点的方向。使用
如果使用xk来表示离散化曲线上的点，则
式中，xk表示所述离散化曲线上的第k个点，
本发明实施例公开了另一种具体的机器人运动曲线处理方法，相对于上述两个实施例，本实施例对技术方案作了进一步的说明和优化。具体的：
参见图4所示，上述实施例步骤11中，对运动曲线进行分割处理的方法，包括：
步骤31：对运动曲线进行离散化处理，得到离散化曲线，离散化曲线包括一系列点xk；
本步骤相应的说明已经在前述实施例中公开，可以参考前述实施例中相应的内容，这里不再进行赘述。
步骤32：对离散化曲线进行积累弗勒内坐标系赋值，得到离散化曲线向量，其中，离散化曲线向量包括离散化曲线的积累正切向量
区别于前述实施例，本实施例对离散曲线进行积累弗勒内坐标系赋值。在一些比较平滑的机器人运动曲线上，例如机器人在执行任务时进行弧度较小的曲线运动，由于方向的变化很小，导致弗勒内坐标系赋值不能充分的表示曲线运动方向的变化。采用积累弗勒内坐标系赋值得到的积累正切向量
同样的，积累正交向量为当前离散化曲线上点的正交向量与该点之前所有点的正交向量的积累，积累副法线向量为当前离散化曲线上点的积累副法线向量与该点之前所有点的积累副法线向量的积累。通过积累弗勒内坐标系赋值能充分的表示曲线运动方向的变化。
步骤33：当积累正切向量
其中，k＝1,2,3,....。
本实施例中预先设定的阈值可以是一个固定的角度值，例如π/4等。也可以根据确定编码基本数的数量时，对应划分空间的方向之间的角度作为这个阈值，例如编码基本数的数量为9时，对应划分空间的方向有8个和1个无运动方向，这时8个方向之间的角度应为π/8。
更新更新积累弗勒内坐标系赋值，指的是当离散化曲线上某个点的积累正切向量
本发明实施例公开了第三种具体的机器人运动曲线处理方法，参见图5所示，相对于上述三个实施例，本实施例对技术方案作了进一步的说明和优化。具体的：
步骤12中，对离散化曲线向量进行编码处理，得到曲线方向编码的过程，包括：
步骤41：利用直接曲线编码法对离散化曲线向量进行编码处理，得到曲线方向编码。
直接曲线编码在本实施例中，可以使用一些字符串来直接表示离散化曲线向量的方向，例如使用0、1、2、3、4、5和6分别表示前、后、上、下、左、右以及不动。当划分空间方向较多时，也可以使用这种编码的方法。
步骤13中，对曲线方向编码进行分类处理，得到运动状态的过程，包括：
步骤42：利用监督分类算法对曲线方向编码进行分类，得到运动状态。
这里的监督分类算法，指的是建立一个函数算法，来进行曲线方向编码的统计和识别，依据已有的运动状态样本进行对曲线方向编码判别和归类，得到运动状态。
本发明还公开了一种机器人运动曲线处理系统，参见图6所示，该系统包括：
运动曲线分割模块51：用于对运动曲线进行分割处理，得到离散化曲线向量。
运动曲线编码模块52：用于对离散化曲线向量进行编码处理，得到曲线方向编码。
运动曲线分类模块53：用于对曲线方向编码进行分类处理，得到运动状态。
参见图7所示，运动曲线分割模块51，包括：
离散化单元61：用于对所述运动曲线进行离散化处理，得到离散化曲线，所述离散化曲线包括一系列点xk；
弗勒内坐标系赋值单元62：用于对离散化曲线进行弗勒内坐标系赋值，得到离散化曲线向量，其中，离散化曲线向量包括所述离散化曲线的正切向量
参见图8所示，运动曲线分割模块51，包括：
离散化单元71：用于对运动曲线进行离散化处理，得到离散化曲线，所述离散化曲线包括一系列点xk；
积累弗勒内坐标系赋值单元72：用于对对离散化曲线进行积累弗勒内坐标系赋值，得到离散化曲线向量，其中，离散化曲线向量包括所述离散化曲线的积累正切向量
积累弗勒内坐标系赋值更新单元73：用于当积累正切向量
其中，k＝1,2,3,....。
本实施例中的运动曲线编码模块为dcc编码模块，用于利用直接曲线编码对所述离散化曲线向量进行编码处理。
关于上述各个模块和各个单元更加详细的工作过程可以参考前述实施例中公开的相应内容，在此不再进行赘述。
最后，还需要说明的是，在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
以上对本发明所提供的一种机器人运动曲线处理方法及系统进行了详细介绍，本文中应用了具体个例对本发明的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本发明的方法及其核心思想；同时，对于本领域的一般技术人员，依据本发明的思想，在具体实施方式及应用范围上均会有改变之处，综上所述，本说明书内容不应理解为对本发明的限制。
- 还没有人留言评论。精彩留言会获得点赞！