[发明专利]基于啮齿类动物模型的同步定位与地图构建方法及装置

权利要求书

1.一种基于啮齿类动物模型的同步定位与地图构建方法，其特征在于，所述方法包括：

获取摄像装置传输的机器人的当前视觉图像；

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

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

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

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

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

所述方法还包括：

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

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

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

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

所述根据所述位姿细胞网络的活性程度、当前的WIFI指纹库、所述第二位姿坐标和预置经历图谱，确定所述机器人的当前经历点，包括：

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

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

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

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

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

4.根据权利要求1所述的基于啮齿类动物模型的同步定位与地图构建方法，其特征在于，所述计算所述当前视觉图像与视觉图像信息库的最大场景相似度，包括：

计算所述当前视觉图像在HSV颜色空间下的颜色矩向量，并采用预先构建的匹配方程，计算所述当前视觉图像与视觉图像信息库中的每帧模板图像间的场景相似度；

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

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