智能轮椅的障碍物检测与自主避障方法技术

本发明专利技术提供了一种智能轮椅的障碍物检测与自主避障方法，包括以下步骤：通过里程计估计轮椅的行进位姿，建立运动模型和观测模型；激光测距传感器采集周围环境数据，通过单目视觉传感器收集并检测视频内障碍物轮廓；通过基于图优化的建图算法对周围环境进行局部建图；根据局部建图结果，通过栅格法生成全局一致的地图；根据地图中障碍物与轮椅之间的位姿状态关系，通过斥力势场法规划轮椅避障方向。

Obstacle detection and autonomous obstacle avoidance of intelligent wheelchair

The invention provides an obstacle detection and autonomous obstacle avoidance method for an intelligent wheelchair, which comprises the following steps: estimating the walking position and posture of the wheelchair through a odometer, establishing a motion model and an observation model; collecting surrounding environment data by a laser ranging sensor, collecting and detecting the contour of the video internal obstacle through a monocular vision sensor; and building the surrounding environment through a graph optimization based mapping algorithm According to the results of local mapping, the grid method is used to generate a global consistent map; according to the position and posture relationship between the obstacle and wheelchair in the map, the repulsion potential field method is used to plan the direction of wheelchair obstacle avoidance.

【技术实现步骤摘要】
智能轮椅的障碍物检测与自主避障方法
本专利技术涉及一种避障技术，特别是一种智能轮椅的障碍物检测与自主避障方法。
技术介绍
智能轮椅是在电动轮椅的基础上融入了移动机器人技术，用于协助老年人和残疾人的行动能力，降低对使用者的使用要求，提高轮椅的安全性。目前智能轮椅的开发主要在自主导航和人机交互两个方面。在自主导航避障方面，现有的多数停留在应用于特定场合或设定路标条件下的自主导航及避障，环境适应性较差，无法满足使用者的实际需求。SLAM技术被用来使移动机器人在未知环境中依靠所测得的传感器数据来对环境进行定位并创建增量式地图。多数情况下的建图方式为基于滤波的方法，主要依据递归贝叶斯状态估计系统状态的后验概率，但其缺陷使在创建增量式地图时，传感器的测量误差及实际的系统误差会不断累积，最终难以得到全局一致的地图，不适合运用于规模较大的环境中。
技术实现思路
本专利技术的目的在于提供一种智能轮椅的障碍物检测与自主避障方法。实现本专利技术目的的技术方案为：一种智能轮椅的障碍物检测与自主避障方法，包括以下步骤：通过里程计估计轮椅的行进位姿，建立运动模型和观测模型；激光测距传感器采集周围环境数据，通过单目视觉传感器收集并检测视频内障碍物轮廓；通过基于图优化的建图算法对周围环境进行局部建图；根据局部建图结果，通过栅格法生成全局一致的地图；根据地图中障碍物与轮椅之间的位姿状态关系，通过斥力势场法规划轮椅避障方向。进一步地，运动模型为其中，xi、yi为本时刻采样的轮椅坐标，xi-1、yi-1为上一时刻采样的轮椅坐标，θi为本时刻采样的轮椅相位角，θi-1为上一时刻采样的轮椅相位角，w(i)为系统噪声，；观测模型为：其中，pi、θi为极坐标系下的传感器观测的距离和相位角，xz、yz为环境障碍的位置坐标，xj(i)、yj(i)、θj(i)为传感器的位姿状态坐标，λ(i)为传感器的噪声。进一步地，局部建图具体包括：对于传感器测得的融合后的环境数据相邻两帧，前一帧中的采样点，从后一帧中选取与它的欧氏距离最近的点，一一对应地生成点对集；在满足误差函数最小的条件下求得旋转矩阵R和对比点集P，t为平移矩阵，pi为当前帧的点集，pi'为pi在参数(R,t)下旋转变换得到的新点集，n表示每一帧中采样的点集中的元素个数；计算新点集与前一帧对应的采样点之间的配准误差重新选取采样点进行迭代，直到满足阈值条件即该次所得的配准误差小于给定的阈值或者达到设定的最大迭代次数，获得旋转变换矩阵(R,t)作为相邻帧的匹配参数。进一步地，所述融合后的环境数据为激光传感器在某一时刻观测到的局部环境障碍物的方位角及距离和视觉传感器检测到的障碍物边缘的方位角及距离之间相互修正得到的环境数据帧，即用激光传感器获取的障碍物距离信息替代视觉传感器获取的障碍物距离信息，用视觉传感器获取的确定障碍物方位角信息替代激光传感器获取的方位角信息。进一步地，栅格法具体为：以轮椅为中心所建立起的局部地图分割为N×N的栅格地图，并对每个栅格赋予权值，栅格权值为栅格与轮椅距离的平方；在轮椅的行进中，通过比较每一帧中对应的栅格地图的权值来选定权值最大的局部栅格地图来拼凑成全图地图。进一步地，通过斥力势场法规划轮椅避障的转向角及速度具体包括：构建斥力场函数其中，k表示斥力场增益函数，为所选障碍点坐标向量，为当前时刻智能轮椅的坐标向量；将地图中的所有障碍点的斥力场合成得到一个斥力向量，该斥力向量与轮椅的速度向量进行向量相加，得到的和向量为轮椅的算术避障向量，即得到轮椅避障方向。本专利技术与现有技术相比，具有以下优点：(1)针对激光传感器，其在一些透明障碍物、低矮障碍如台阶和坑洼地面的弊端较为明显，本专利方法通过视觉传感器弥补激光传感器的识别盲区，增加障碍物识别的识全率；(2)针对单一的视觉传感器，特别是单目视觉传感器，其在距离测量(特别是运动中的动态测量)方面的准确不足，本专利通过讲激光传感器的测量数据融合进来，使得轮椅对障碍物的环境建图更为精确；(3)在局部建图和全局建图中增加回环检测来不断修正建图数据，降低里程误差和观测误差的累积。下面结合说明书附图对本专利技术作进一步描述。附图说明图1为本专利技术所提供的智能轮椅自主避障避障及导航方法的框架流程示意图。图2为本专利技术所提供的智能轮椅基于图优化的环境局部建图方法示意图。具体实施方式结合图1，一种智能轮椅的障碍物检测与自主避障方法，包括以下步骤：步骤1，坐标系模型、运动模型、激光传感器观测模型，通过里程数估计轮椅的行进位姿；步骤2，通过视觉传感器检测行进中的环境障碍物并确定障碍物边缘轮廓；步骤3，通过图优化的建图算法创建局部地图；步骤4，根据局部建图结果，通过栅格法生成全局一致的地图；步骤5，根据障碍物与轮椅位姿状态，通过斥力势场法规划轮椅避障的方向及速度。步骤1，智能轮椅为两轮差动，通过历计的差分运算可建立轮椅的运动模型，进行位姿预测。传感器观测模型可通过前、后两个位置激光传感器提取局部环境点云数据的特征，以前传感器为主、后为辅来进行观测信息融合。步骤2，单目视觉传感器分布于智能轮椅前方，采用光流法检测视频流中物体的模糊距离：主要是根据行进中的轮椅上视觉传感器的视频流中，比较相邻帧中图像的像素变化率，距离轮椅较近的物体其随时间的像素变化率会比较大，超过阈值时被认为是该时刻的主要障碍物。确定主要目标障碍物后，并通过边缘检测确定障碍物轮廓，构建障碍物的坐标信息，并与激光传感器所捕捉的观测信息进行融合。步骤3，将传感器测得的融合后的环境数据进行相邻帧的匹配，进行局部环境建图：主要是对采集的点云数据的前后两帧进行匹配。在对两帧的点集进行预处理(剔除孤立点)后，对于前一帧中的每个点，从后一帧中选取与它的欧氏距离最近的点，一一对应地生成点对集，在满足误差函数最小的条件下求得旋转矩阵R和对比点集P，t为平移矩阵，pi为当前帧的点集，pi'为pi在参数(R,t)下旋转变换得到的新点集，通过迭代直到新点集与对应点集的配准误差最小或达到最大迭代次数，n表示每一帧中采样的点集中的元素个数。步骤4，根据局部建图结果，通过栅格法生成全局一致的地图。回环检测用于判断该时刻所生成的局部地图是否在之前的建图中出现过，用以检测当前观测点与已有观测点之间的关系，增加当前帧与观测帧之间的约束，降低累计误差。由于单帧的激光数据包含的环境特征较少且回环匹配效率较低，本方法将全局地图划分为局部地图，减少了里程误差和观测误差的累积。参照图2，为增加建图的快速性，通过多分辨率搜索的方法来增加建图的准确性和快速性。通过传感器测得的参考观测数据建立高、低分辨率的两种查找表，先取低分辨率的数据结合当前观测值进行局部地图的粗匹配，确定局部环境信息，然后用完整的高分辨率点云数据修正局部地图。步骤5，通过斥力势场法规划轮本文档来自技高网...

【技术保护点】
1.一种智能轮椅的障碍物检测与自主避障方法，其特征在于，包括以下步骤：/n通过里程计估计轮椅的行进位姿，建立运动模型和观测模型；/n激光测距传感器采集周围环境数据，通过单目视觉传感器收集并检测视频内障碍物轮廓；/n通过基于图优化的建图算法对周围环境进行局部建图；/n根据局部建图结果，通过栅格法生成全局一致的地图；/n根据地图中障碍物与轮椅之间的位姿状态关系，通过斥力势场法规划轮椅避障方向。/n

【技术特征摘要】
1.一种智能轮椅的障碍物检测与自主避障方法，其特征在于，包括以下步骤：
通过里程计估计轮椅的行进位姿，建立运动模型和观测模型；
激光测距传感器采集周围环境数据，通过单目视觉传感器收集并检测视频内障碍物轮廓；
通过基于图优化的建图算法对周围环境进行局部建图；
根据局部建图结果，通过栅格法生成全局一致的地图；
根据地图中障碍物与轮椅之间的位姿状态关系，通过斥力势场法规划轮椅避障方向。


2.根据权利要求1所述的方法，其特征在于，运动模型为



其中，xi、yi为本时刻采样的轮椅坐标，xi-1、yi-1为上一时刻采样的轮椅坐标，θi为本时刻采样的轮椅相位角，θi-1为上一时刻采样的轮椅相位角，w(i)为系统噪声，；
观测模型为：



其中，pi、θi为极坐标系下的传感器观测的距离和相位角，xz、yz为环境障碍的位置坐标，xj(i)、yj(i)、θj(i)为传感器的位姿状态坐标，λ(i)为传感器的噪声。


3.根据权利要求1所述的方法，其特征在于，局部建图具体包括：
对于传感器测得的融合后的环境数据相邻两帧，前一帧中的采样点，从后一帧中选取与它的欧氏距离最近的点，一一对应地生成点对集；
在满足误差函数最小的条件下求得旋转矩阵R和对比点集P，t为平移矩阵，pi为当前帧的点集，pi'为pi在参数(R,t)下旋转变换得到的...

【专利技术属性】
技术研发人员：李昊，彭富明，孙瑜，汪凯鑫，庄纪岩，
申请(专利权)人：南京理工大学，
类型：发明
国别省市：江苏;32