机器人自适应地形分类方法、***与计算机可读存储介质
技术领域
本发明涉及机器人领域,特别是涉及机器人自适应地形分类方法、***与计算机可读存储介质。
背景技术
利用机器人技术实现搜救、侦查、采样等多种卫勤任务已经成为未来技术发展的重要趋势,在民用、军用领域有着广阔的应用场景。而移动机器人作为机器人技术的重要分支,引起众多研究者的关注。目前,随着机器人技术的快速发展,各类移动机器人平台的应用场景逐渐从结构化环境拓展到非结构化环境。不同于结构化环境,机器人在非结构化环境中必须面对不同的路面环境,松软、泥泞、崎岖不平的路面都有可能给机器人带来危险。这些危险路面统称为非几何特征危险。移动机器人自主识别这些非几何特征危险,即对地形进行分类,能使机器人采取与地形相适应的运动策略,安全有效地通过各类地形。地形非几何特征的分类识别方法主要包括基于振动的地形分类方法和基于视觉的地形分类方法。由于数据采集的不完备特性,导致机器人地形分类在实际运行时精度下降,为此,需要开发出一些自适应方法来解决这个问题。
发明内容
本发明技术克服现有技术的不足,解决了基于视觉或振动的地形分类中数据分布漂移的问题。
为解决上述问题,本发明公开了机器人自适应地形分类方法、***与计算机可读存储介质,所述一种机器人自适应地形分类方法,具体包括以下步骤:
S101:令时间t=0,人工确定地形感知模态,可设为振动或视觉;如果地形感知模态为振动,则人工确定机器人在时间t的基于时域特征的地形最终预测概率向量其中为中对地形i的预测概率,L为地形种类总数,的所有元素之和为1,并且确定机器人在时间t的基于频域特征的地形最终预测概率向量其中为中对地形i的预测概率,的所有元素之和为1;如果地形感知模态为视觉,则人工确定机器人在时间t的基于颜色特征的地形最终预测概率向量其中 为中对地形i的预测概率,的所有元素之和为1,并且确定机器人在时间t的基于纹理特征的地形最终预测概率向量其中为中对地形i的预测概率,的所有元素之和为1;
S102:令t自增1,如果地形感知模态为振动,则获取机器人在时间t-1至t之间的振动序列,即其中n为两个相邻时间点之间采集到的振动信号数量;如果地形感知模态为视觉,则获取机器人在时间t的地面图像It;
S103:如果地形感知模态为振动,则求取at的时域特征与频域特征,分别得到基于时域特征的样本与基于频域特征的样本如果地形感知模态为视觉,则求取It的颜色特征与纹理特征,分别得到基于颜色特征的样本与基于纹理特征的样本
S104:如果地形感知模态为振动,则将输入到基于时域特征的分类器CT中,得到时间t的基于时域特征的地形初步预测概率向量将输入到基于频域特征的分类器CF中,得到时间t的基于频域特征的地形初步预测概率向量如果地形感知模态为视觉,则将输入到基于颜色特征的分类器CC中,得到时间t的基于颜色特征的地形初步预测概率向量将输入到基于纹理特征的分类器CE中,得到时间t的基于纹理特征的地形初步预测概率向量
S105:如果地形感知模态为振动,则求取时间t的基于时域特征的地形最终预测概率向量与基于频域特征的地形最终预测概率向量方式如下:
其中,皆为大于等于0小于等于1的实数,且 之和为1,之和为1;
如果地形感知模态为视觉,则求取时间t的基于颜色特征的地形最终预测概率向量与基于纹理特征的地形最终预测概率向量方式如下:
其中,皆为大于等于0小于等于1的实数,且 之和为1,之和为1;
S106:求取地形最终预测结果如果地形感知模态为振动,则方法如下:
其中, 如果地形感知模态为视觉,则方法如下:
其中,
S107:获取新的伪标记样本并更新分类器,如果地形感知模态为振动,则方法如下:当满足且时,其中, 则用标记并利用这个伪标记样本对分类器CT进行增量训练;当满足且时,则用标记并利用这个伪标记样本对分类器CF进行增量训练;如果地形感知模态为视觉,则方法如下:当满足且时,其中,则用标记并利用这个伪标记样本对分类器CC进行增量训练;当满足且时,则用标记并利用这个伪标记样本对分类器CE进行增量训练。
其中,所述步骤S101中涉及的确定与的方法如下:
如果确切可知机器人初始位于地形h,则 对于i≠h,有
如果不可知机器人的初始地形,则对于i=1,2,…,L,有
其中,所述步骤S103中涉及的确定与的方法如下:
分别求at的均值、方差、峰度、最大值、最小值、最大最小值之差,并组成一个6维向量,即为
对at作N点-快速傅里叶变换,其中N=min{2l|l=1,2,…,且2l≥n},变换后得到的频谱向量即为
其中,所述步骤S103中涉及的确定与的方法如下:
将It在HSV空间中表示,求取色度矩阵的统计直方图,按照色度从小到大的方式,将每个色度的频数排列成一个向量,即为
求取It的局部二值模式的统计直方图,按照局部二值模式值从小到大的方式,将每个局部二值模式值的频数排列成一个向量,即为
其中,所述的分类器为支持向量机或者决策树。
本发明还提供了一种计算机可读存储介质,所述计算机可读存储介质存储有机器人自适应地形分类程序,其特征在于,所述机器人自适应地形分类程序在处理器执行时实现上面所述的任一项方法的步骤。
本发明还提供了一种一种机器人自适应地形分类***,包括:振动传感器与数据处理单元;振动传感器用于感知机器人垂直于地面的轴的振动时间序列,数据处理单元用于执行机器人自适应地形分类程序,所述机器人自适应地形分类程序在处理器执行时实现上面所述的任一项方法的步骤。
其中,所述的振动传感器为加速度计。
类似地,本发明还提供了一种一种机器人自适应地形分类***,包括:摄像头与数据处理单元;摄像头朝向地面,用于采集地形图像,数据处理单元用于执行机器人自适应地形分类程序,所述机器人自适应地形分类程序在处理器执行时实现上面所述的任一项方法的步骤。
其中,所述的摄像头采用了标准镜头。
相比已有的技术,本发明对地形分类问题中数据分布的漂移有一定的自适应能力,可在保证精度的情况下长期稳定运行。
附图说明
图1为本发明流程图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图与具体实施例对本发明进行详细说明。
一种机器人自适应地形分类方法,如图1所示,具体包括以下步骤:
S101:令时间t=0,人工确定地形感知模态,可设为振动或视觉;如果地形感知模态为振动,则人工确定机器人在时间t的基于时域特征的地形最终预测概率向量其中为中对地形i的预测概率,L为地形种类总数,的所有元素之和为1,并且确定机器人在时间t的基于频域特征的地形最终预测概率向量其中为中对地形i的预测概率,的所有元素之和为1;如果地形感知模态为视觉,则人工确定机器人在时间t的基于颜色特征的地形最终预测概率向量其中 为中对地形i的预测概率,的所有元素之和为1,并且确定机器人在时间t的基于纹理特征的地形最终预测概率向量其中为中对地形i的预测概率,的所有元素之和为1;
S102:令t自增1,如果地形感知模态为振动,则获取机器人在时间t-1至t之间的振动序列,即其中n为两个相邻时间点之间采集到的振动信号数量;如果地形感知模态为视觉,则获取机器人在时间t的地面图像It;
S103:如果地形感知模态为振动,则求取at的时域特征与频域特征,分别得到基于时域特征的样本与基于频域特征的样本如果地形感知模态为视觉,则求取It的颜色特征与纹理特征,分别得到基于颜色特征的样本与基于纹理特征的样本
S104:如果地形感知模态为振动,则将输入到基于时域特征的分类器CT中,得到时间t的基于时域特征的地形初步预测概率向量将输入到基于频域特征的分类器CF中,得到时间t的基于频域特征的地形初步预测概率向量如果地形感知模态为视觉,则将输入到基于颜色特征的分类器CC中,得到时间t的基于颜色特征的地形初步预测概率向量将输入到基于纹理特征的分类器CE中,得到时间t的基于纹理特征的地形初步预测概率向量
S105:如果地形感知模态为振动,则求取时间t的基于时域特征的地形最终预测概率向量与基于频域特征的地形最终预测概率向量方式如下:
其中,皆为大于等于0小于等于1的实数,且 之和为1,之和为1;
如果地形感知模态为视觉,则求取时间t的基于颜色特征的地形最终预测概率向量与基于纹理特征的地形最终预测概率向量方式如下:
其中,皆为大于等于0小于等于1的实数,且 之和为1,之和为1;
S106:求取地形最终预测结果如果地形感知模态为振动,则方法如下:
其中, 如果地形感知模态为视觉,则方法如下:
其中,
S107:获取新的伪标记样本并更新分类器,如果地形感知模态为振动,则方法如下:当满足且时,其中, 则用标记并利用这个伪标记样本对分类器CT进行增量训练;当满足且时,则用标记并利用这个伪标记样本对分类器CF进行增量训练;如果地形感知模态为视觉,则方法如下:当满足且时,其中,则用标记并利用这个伪标记样本对分类器CC进行增量训练;当满足且时,则用标记并利用这个伪标记样本对分类器CE进行增量训练。
S101:令时间t=0,人工确定地形感知模态,可设为振动或视觉;如果地形感知模态为振动,则人工确定机器人在时间t的基于时域特征的地形最终预测概率向量其中为中对地形i的预测概率,L为地形种类总数,的所有元素之和为1,并且确定机器人在时间t的基于频域特征的地形最终预测概率向量其中为中对地形i的预测概率,的所有元素之和为1;如果地形感知模态为视觉,则人工确定机器人在时间t的基于颜色特征的地形最终预测概率向量其中 为中对地形i的预测概率,的所有元素之和为1,并且确定机器人在时间t的基于纹理特征的地形最终预测概率向量其中为中对地形i的预测概率,的所有元素之和为1;
S102:令t自增1,如果地形感知模态为振动,则获取机器人在时间t-1至t之间的振动序列,即其中n为两个相邻时间点之间采集到的振动信号数量;如果地形感知模态为视觉,则获取机器人在时间t的地面图像It;
S103:如果地形感知模态为振动,则求取at的时域特征与频域特征,分别得到基于时域特征的样本与基于频域特征的样本如果地形感知模态为视觉,则求取It的颜色特征与纹理特征,分别得到基于颜色特征的样本与基于纹理特征的样本
S104:如果地形感知模态为振动,则将输入到基于时域特征的分类器CT中,得到时间t的基于时域特征的地形初步预测概率向量将输入到基于频域特征的分类器CF中,得到时间t的基于频域特征的地形初步预测概率向量如果地形感知模态为视觉,则将输入到基于颜色特征的分类器CC中,得到时间t的基于颜色特征的地形初步预测概率向量将输入到基于纹理特征的分类器CE中,得到时间t的基于纹理特征的地形初步预测概率向量
S105:如果地形感知模态为振动,则求取时间t的基于时域特征的地形最终预测概率向量与基于频域特征的地形最终预测概率向量方式如下:
其中,皆为大于等于0小于等于1的实数,且 之和为1,之和为1;
如果地形感知模态为视觉,则求取时间t的基于颜色特征的地形最终预测概率向量与基于纹理特征的地形最终预测概率向量方式如下:
其中,皆为大于等于0小于等于1的实数,且 之和为1,之和为1;
S106:求取地形最终预测结果如果地形感知模态为振动,则方法如下:
其中, 如果地形感知模态为视觉,则方法如下:
其中,
S107:获取新的伪标记样本并更新分类器,如果地形感知模态为振动,则方法如下:当满足且时,其中, 则用标记并利用这个伪标记样本对分类器CT进行增量训练;当满足且时,则用标记并利用这个伪标记样本对分类器CF进行增量训练;如果地形感知模态为视觉,则方法如下:当满足且时,其中,则用标记并利用这个伪标记样本对分类器CC进行增量训练;当满足且时,则用标记并利用这个伪标记样本对分类器CE进行增量训练。
优选地,所述步骤S101中涉及的确定与的方法如下:
如果确切可知机器人初始位于地形h,则 对于i≠h,有
如果不可知机器人的初始地形,则对于i=1,2,…,L,有
优选地,所述步骤S103中涉及的求取与的方法如下:
分别求at的均值、方差、峰度、最大值、最小值、最大最小值之差,并组成一个6维向量,即为
对at作N点-快速傅里叶变换,其中N=min{2l|l=1,2,…,且2l≥n},变换后得到的频谱向量即为
优选地,所述步骤S103中涉及的求取与的方法如下:
将It在HSV空间中表示,求取色度矩阵的统计直方图,按照色度从小到大的方式,将每个色度的频数排列成一个向量,即为
求取It的局部二值模式的统计直方图,按照局部二值模式值从小到大的方式,将每个局部二值模式值的频数排列成一个向量,即为
优选地,所述的分类器为支持向量机或者决策树。
本发明还公开了一种计算机可读存储介质,所述计算机可读存储介质存储有机器人自适应地形分类程序,所述机器人自适应地形分类程序在处理器执行时实现上面所述的任一项方法的步骤。
本发明还公开了一种机器人自适应地形分类***,包括:振动传感器与数据处理单元;振动传感器用于感知机器人垂直于地面的轴的振动时间序列,数据处理单元用于执行机器人自适应地形分类程序,所述机器人自适应地形分类程序在处理器执行时实现上面所述的任一项方法的步骤。
优选地,所述的振动传感器为加速度计。
类似地,本发明还公开了一种机器人自适应地形分类***,包括:摄像头与数据处理单元;摄像头朝向地面,用于采集地形图像,数据处理单元用于执行机器人自适应地形分类程序,所述机器人自适应地形分类程序在处理器执行时实现上面所述的任一项方法的步骤。
优选地,所述的摄像头采用了标准镜头。
在实际应用中,还要为上述***增加供电模块、电源管理模块、输入/输出模块、显示模块、通信模块、存储模块等辅助配件。
在实施本专利之前,分类器需要事先在其他平台上预先训练,具体如下:让机器人在期望被识别的地形上各运行一段时间,并同时采集传感器的数据。如果传感器为振动传感器,则需要对采集的振动时间序列进行分割、特征提取,以获取样本集合,并对其进行人工标记;如果传感器为摄像头,则需要对图片进行特征提取,以获取样本集合,并对其进行人工标记。从每种地形所对应的所有样本中随机选择70%个作为训练样本,剩余30%个作为测试样本,训练分类器。在训练过程中涉及的特征提取方法、振动时间序列分割方法、以及所采取的分类器与本发明的中涉及的特征提取方法、振动时间序列分割方法、以及所采取的分类器一致。
提供以上实施例仅仅是为了描述本发明的目的,而并非要限制本发明的范围。本发明的范围由所附权利要求限定。不脱离本发明的精神和原理而做出的各种等同替换和修改,均应涵盖在本发明的范围之内。