[发明专利]一种基于角度特征识别的移动装置位姿定位方法

权利要求书

1.一种基于角度特征识别的移动装置位姿定位方法，其特征在于，该方法包括下列步骤：

(1)环境信息的采集步骤

针对作为定位对象的移动装置，直接采用固设在该移动装置上的车载传感器实时采集周围的环境信息，并得到反映环境信息的多个轮廓离散点及形成点云图；

(2)离散点的角度特征获取步骤

将所述多个轮廓离散点在统一的动坐标系中进行排序，得到对应的有序坐标点集合P＝{(x_i,y_i)}，其中x_i表示编号为i的离散点在动坐标系中的X轴坐标值，y_i表示编号为i的离散点在动坐标系中的Y轴坐标值；对该有序坐标点集合进行差分求导以求出各有序坐标点的导数值，并且当所述导数值的差值超出预设的误差阈值时，则判定此处出现了角度特征并予以记录；

(3)移动装置的位姿识别步骤

使用步骤(2)所记录的角度特征，采用单一角度特征、多角度特征以及距离特征来获取不同工况下的定位结果，具体的将其与标准环境地图中所存储的参考角度特征进行匹配，其中所述标准环境地图被定义有自身的地图坐标系，并已预存有各种参考角度特征与具体位置方向值之间的一一对应关系，由此得到移动装置相对于标准环境地图的位置方向数据，进而将移动装置的位姿坐标在标准环境地图中描述出来，相应完成整体的移动装置位姿定位过程；

所述位姿识别过程为单一角度特征下的位姿识别工况，其操作过程具体如下：

当所记录的角度特征仅包含单一角度特征时，此时离散点在标准环境地图中对应的位姿矩阵为其中X_i表示编号为i的离散点在地图坐标系中的X轴坐标值，Y_i表示编号为i的离散点在地图坐标系中的Y轴坐标值；相应地，移动装置在标准环境地图中的位姿矩阵可表示为其中x＝X_i-(x_icos(θ)-y_isin(θ))，y＝Y_i-(x_isin(θ)+y_icos(θ))，θ表示移动装置的姿态值；

所述位姿识别过程为多角度特征下的位姿识别工况，其操作过程具体如下：

当所记录的角度特征为两个以上时，此时假设角度特征个数为N，各个离散点在标准环境地图中对应的位置坐标集合为{(x_j,y_j)}，姿态坐标集合为{θ_j}，其中j＝1,2,...,N；相应地，移动装置在标准环境地图中的位置坐标被计算为姿态值被计算为其中ω_j表示对不同角度特征所预设的不同权值，并且

所述位姿识别过程为多角度特征加上这些角度之间距离的位姿识别工况，其操作过程具体如下：

当所记录的角度特征为两个以上时，此时假设角度特征个数为N，各个离散点在标准环境地图中对应的位置坐标集合为{(x_j,y_j)}，姿态坐标集合为{θ_j}，其中j＝1,2,...,N；相应地，移动装置在标准环境地图中的位置坐标被计算为姿态值被计算为

2.如权利要求1所述的方法，其特征在于，上述定位过程中不再需要除车载传感器之外的其他传感元件。

3.如权利要求1或2所述的方法，其特征在于，所述移动装置包括移动机器人、自主AGV、无人驾驶车辆或者无人机。