利索能及
我要发布
收藏
专利号: 2018105485079
申请人: 安徽工程大学
专利类型:发明专利
专利状态:已下证
更新日期:2026-07-01
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种基于啮齿类动物模型的同步定位与地图构建方法,其特征在于,所述方法包括:获取摄像装置传输的机器人的当前视觉图像;

获取视觉里程计传输的关于所述当前视觉图像的特征区域的位移速度、旋转角速度和方向;

根据所述位移速度、所述旋转角速度和所述方向对位姿细胞网络进行网络活性更新;

计算所述当前视觉图像与视觉图像信息库的最大场景相似度,并获取具有最大场景相似度的模板图像对应的第一位姿坐标;

根据所述最大场景相似度对视觉图像信息库进行更新;

根据所述位姿细胞网络的活性程度、当前的视觉图像信息库、所述第一位姿坐标和预置经历图谱,确定所述机器人的当前经历点,以实现对所述机器人进行定位修正,并绘制实际经历图,进行机器人同步定位与地图构建;

所述方法还包括:

在所述最大场景相似度低于第一阈值时,获取所述机器人的当前WIFI信号强度信息;

计算所述当前WIFI信号强度信息与WIFI指纹库的最大指纹相似度,并获取具有最大指纹相似度的模板指纹对应的第二位姿坐标;

根据所述最大指纹相似度对所述WIFI指纹库进行更新;

根据所述位姿细胞网络的活性程度、当前的WIFI指纹库、所述第二位姿坐标和预置经历图谱,确定所述机器人的当前经历点,以实现对所述机器人进行定位修正,并绘制实际经历图,进行机器人同步定位与地图构建;

所述根据所述位姿细胞网络的活性程度、当前的WIFI指纹库、所述第二位姿坐标和预置经历图谱,确定所述机器人的当前经历点,包括:根据所述位姿细胞网络的活性程度、当前的WIFI指纹库和所述第二位姿坐标,计算经历活性水平和位姿细胞激活程度,并根据所述经历活性水平、所述位姿细胞激活程度和所述经历图谱,确定当前经历点。

2.根据权利要求1所述的基于啮齿类动物模型的同步定位与地图构建方法,其特征在于,所述根据所述位移速度、所述旋转角速度和所述方向对位姿细胞网络进行网络活性更新,包括:

根据所述位移速度、所述旋转角速度和所述方向,以及根据预先构建的活性更新方程,对所述位姿细胞网络中的每个位姿感知细胞进行活性更新。

3.根据权利要求2所述的基于啮齿类动物模型的同步定位与地图构建方法,其特征在于,所述活性更新方程为:

其中,δx0为在x方向被四舍五入后的整数偏差,δy0为在y方向被四舍五入后的整数偏差,δθ0为在θ方向被四舍五入后的整数偏差,δ是三维离散高斯分布的抑制权重矩阵,表示t+1时刻位姿细胞网络活性,αabc为余数矩阵,v为移动速度,ω为旋转角速度,θ为方向,kx、ky和kθ为路径积分常数。

4.根据权利要求1所述的基于啮齿类动物模型的同步定位与地图构建方法,其特征在于,所述计算所述当前视觉图像与视觉图像信息库的最大场景相似度,包括:计算所述当前视觉图像在HSV颜色空间下的颜色矩向量,并采用预先构建的匹配方程,计算所述当前视觉图像与视觉图像信息库中的每帧模板图像间的场景相似度;

和/或,计算所述当前视觉图像的特征点描述子,并根据所述特征点描述子,计算所述当前视觉图像与每帧所述模板图像间的场景相似度;

将值最大的场景相似度确定为最大场景相似度。

5.根据权利要求4所述的基于啮齿类动物模型的同步定位与地图构建方法,其特征在于,所述匹配方程为:

其中,CI(k)表示模板图像I的颜色矩向量中的第k个分量,CJ(k)表示当前视觉图像J的颜色矩向量中的第k个分量,D(I,J)为模板图像I与当前视觉图像J间的场景相似度,C为任一图像的颜色矩向量,uH,uS,uV分别表示H,S,V颜色分量上的均值,σH,σS和σV分别表示H,S,V颜色分量上的方差,sH,sS和sV分别表示H,S,V颜色分量上的坡度,ui,σi,si分别表示颜色分量i的均值、方差和斜度,sum表示图像的总像素数,pi,j表示图像中第j个像素的第i个颜色分量。

6.根据权利要求1所述的基于啮齿类动物模型的同步定位与地图构建方法,其特征在于,所述计算所述当前WIFI信号强度信息与WIFI指纹库的最大指纹相似度,包括:根据所述当前WIFI信号强度信息构建信号强度均值向量和信号强度标准差向量;

根据所述信号强度均值向量和所述信号强度标准差向量,以及根据预先构建的加权欧式距离计算公式,计算所述当前WIFI信号强度信息与WIFI指纹库中的每个模板指纹间的指纹相似度;

将值最大的指纹相似度确定为最大指纹相似度。

7.根据权利要求6所述的基于啮齿类动物模型的同步定位与地图构建方法,其特征在于,所述加权欧式距离计算公式为:i

其中,RSSI 为第i个模板指纹对应的指纹点处的信号强度均值向量,RSSI=(RSSI1,RSSI2,...,RSSIN)为机器人当前位置处的信号强度均值向量,N为信号发射装置的数量,S=(S1,S2,...,SN)为信号强度标准差向量,S1为机器人当前位置处接收到的第一个信号发射装置的信号强度的连续采样均值,为第i个指纹点对应的权重系数,且 n为指纹点的数量,

8.一种基于啮齿类动物模型的机器人同步定位与地图构建装置,其特征在于,所述装置包括:

第一获取单元,用于获取摄像装置传输的机器人的当前视觉图像;

第二获取单元,用于获取视觉里程计传输的关于所述当前视觉图像的特征区域的位移速度、旋转角速度和方向;

活性更新单元,用于根据所述位移速度、所述旋转角速度和所述方向对位姿细胞网络进行网络活性更新;

相似度计算单元,用于计算所述当前视觉图像与视觉图像信息库的最大场景相似度,并获取具有最大场景相似度的模板图像对应的第一位姿坐标;

模板更新单元,用于根据所述最大场景相似度对视觉图像信息库进行更新;

同步定位单元,用于根据所述位姿细胞网络的活性程度、当前的视觉图像信息库、所述第一位姿坐标和预置经历图谱,确定所述机器人的当前经历点,以实现对所述机器人进行定位修正,并绘制实际经历图,进行机器人同步定位与地图构建;

所述第一获取单元,还用于在最大场景相似度低于第一阈值时,获取机器人的当前WIFI信号强度信息;

所述相似度计算单元,还用于计算当前WIFI信号强度信息与WIFI指纹库的最大指纹相似度,并获取具有最大指纹相似度的模板指纹对应的第二位姿坐标;

所述模板更新单元,还用于根据最大指纹相似度对WIFI指纹库进行更新;

所述同步定位单元,还用于根据位姿细胞网络的活性程度、当前的WIFI指纹库、第二位姿坐标和预置经历图谱,确定机器人的当前经历点,以实现对机器人进行定位修正,并绘制实际经历图,进行机器人同步定位与地图构建;

所述根据所述位姿细胞网络的活性程度、当前的WIFI指纹库、所述第二位姿坐标和预置经历图谱,确定所述机器人的当前经历点,包括:根据所述位姿细胞网络的活性程度、当前的WIFI指纹库和所述第二位姿坐标,计算经历活性水平和位姿细胞激活程度,并根据所述经历活性水平、所述位姿细胞激活程度和所述经历图谱,确定当前经历点。