一种定位方法及装置制造方法及图纸

本申请涉及通信技术领域，尤其涉及一种定位方法及装置，根据待定位的目标对象上一时刻的目标运行状态，预测所述目标对象当前时刻的预测运行状态，其中，所述预测运行状态中至少包括所述目标对象的预测位置信息；根据所述预测运行状态所对应的预测位置信息，从地图数据中获取包含所述预测位置信息的预设范围内的参数化曲线描述信息；根据获取到的参数化曲线描述信息，对所述预测运行状态进行更新，获得所述目标对象当前时刻的目标运行状态，这样，采用参数化曲线描述信息来描述地图并更新定位结果，可以节省存储资源并提高了定位精度。

【技术实现步骤摘要】
一种定位方法及装置
本申请涉及通信
，尤其涉及一种定位方法及装置。
技术介绍
目前，在自动驾驶或辅助驾驶等场景，都需要高精度定位为基础，相关技术中的高精度定位产品中，定位算法根据车辆动力学方程对车辆的运行状态进行预测，并结合其它观测数据进行约束，实现车辆运行状态的更新，其中结合高精地图进行约束更新时，通过视觉检测的结果，例如车道线，与地图中的车道线进行几何配准，获得车辆的运行状态，例如位置、姿态等信息，其中，相关技术中使用高精地图的方式，主要是基于以折线(polyline)几何为描述的高精地图，并且使用高精地图的方式是静态的，但是这种方式，高精地图采用polyline几何描述，需要存储海量的点，存储效率不高并浪费了存储资源，增加了成本，并且在实际使用时，还需要对多边线进行重采样以获得所需要位置的几何信息，增加了复杂度，影响定位效果，并且静态查询地图的方式，并没有充分发挥高精地图中丰富的道路几何约束信息，特别是静态点之间的动态轨迹约束，降低了对定位算法的约束效果，降低了定位精度。
技术实现思路
本申请实施例提供一种定位方本文档来自技高网...

【技术保护点】
1.一种定位方法，其特征在于，包括：/n根据待定位的目标对象上一时刻的目标运行状态，预测所述目标对象当前时刻的预测运行状态，其中，所述预测运行状态中至少包括所述目标对象的预测位置信息；/n根据所述预测运行状态所对应的预测位置信息，从地图数据中获取包含所述预测位置信息的预设范围内的参数化曲线描述信息；/n根据获取到的参数化曲线描述信息，对所述预测运行状态进行更新，获得所述目标对象当前时刻的目标运行状态。/n

【技术特征摘要】
1.一种定位方法，其特征在于，包括：
根据待定位的目标对象上一时刻的目标运行状态，预测所述目标对象当前时刻的预测运行状态，其中，所述预测运行状态中至少包括所述目标对象的预测位置信息；
根据所述预测运行状态所对应的预测位置信息，从地图数据中获取包含所述预测位置信息的预设范围内的参数化曲线描述信息；
根据获取到的参数化曲线描述信息，对所述预测运行状态进行更新，获得所述目标对象当前时刻的目标运行状态。


2.如权利要求1所述的方法，其特征在于，所述目标运行状态中至少包括所述目标对象的目标位置信息和目标姿态信息，所述预测运行状态中还至少包括所述目标对象的预测姿态信息；
所述目标运行状态和所述预测运行状态均由状态变量集合表示，所述状态变量集合中每个状态变量对应一个状态更新方程，各状态更新方程组合为状态更新方程组，并所述状态更新方程组的因变量为当前时刻的目标运行状态中各状态变量，自变量为上一个时刻的目标运行状态中各状态变量以及输入向量，所述输入向量包括表示加速度和角速度的各输入变量；
则根据待定位的目标对象上一时刻的目标运行状态，预测所述目标对象当前时刻的预测运行状态，包括：
获取测量的各输入变量和所述目标对象上一时刻的目标状态协方差矩阵；
基于扩展卡尔曼滤波方法，分别将所述各状态更新方程对各状态变量进行一阶求导，获得状态转移雅可比矩阵，并分别将所述各状态更新方程对所述各输入变量进行一阶求导，获得输入雅可比矩阵；
根据所述状态转移雅可比矩阵、所述输入雅可比矩阵、所述上一时刻的目标运行状态，以及获取的各输入变量，预测所述目标对象当前时刻的预测运行状态；
根据所述状态转移雅可比矩阵、所述输入雅可比矩阵、所述上一时刻的目标状态协方差矩阵，以及预设的测量噪声协方差矩阵和状态转移过程噪声协方差矩阵，预测所述目标对象当前时刻的预测状态协方差矩阵。


3.如权利要求2所述的方法，其特征在于，根据获取到的参数化曲线描述信息，对所述预测运行状态进行更新，获得所述目标对象当前时刻的目标运行状态，具体包括：
根据获取到的参数化曲线描述信息，确定所述目标对象的第一运行轨迹约束条件；
根据所述第一运行轨迹约束条件，对所述预测运行状态进行更新，获得所述目标对象当前时刻的目标运行状态。


4.如权利要求3所述的方法，其特征在于，所述参数化曲线描述信息包括所述地图数据中的道路几何信息和道路类型，则根据获取到的参数化曲线描述信息，确定所述目标对象的第一运行轨迹约束条件，包括：
根据获取到的参数化曲线描述信息，获得所述目标对象当前时刻对应的道路类型和道路中心线几何方程；
根据所述道路类型和道路中心线几何方程，分别确定当前时刻的运行状态观测量和运行状态观测值，其中，所述运行状态观测量表示能够获取到的状态变量，所述运行状态观测值为所述运行状态观测量对应的约束取值；
分别将所述当前时刻的运行状态观测量对所述各状态变量进行一阶求导，获得观测雅可比矩阵，并确定观测协方差矩阵，其中，所述观测协方差矩阵表征所述运行状态观测值的观测置信度；
将所述观测雅可比矩阵和所述观测协方差矩阵，以及所述当前时刻的运行状态观测量和所述运行状态观测值作为所述目标对象的第一运行轨迹约束条件。


5.如权利要求4所述的方法，其特征在于，根据所述道路类型和道路中心线几何方程，分别确定当前时刻的运行状态观测量和运行状态观测值，具体包括：
若所述道路类型为直线路段，道路中心线几何方程为ax+by+c＝0，则分别确定当前时刻的运行状态观测量为[c-axk-byk；thetak]，运行状态观测值为[0；atan(a/b)]，其中，xk表示当前时刻的正东方向位置，yk表示当前时刻的正北方向位置，thetak表示当前时刻的航向角。


6.如权利要求4所述的方法，其特征在于，根据所述道路类型和道路中心线几何方程，分别确定当前时刻的运行状态观测量和运行状态观测值，包括：
若所述道路类型为圆拟合路段，道路中心线几何方程为(x-xc)2+(y-yc)2＝r2，则分别确定当前时刻的运行状态观测量为：



运行状态观测值为：[0；0；theta0+s/r]；
其中，(xc,yc)为道路对应的圆弧起点位置坐标，theta0是道路对应的圆弧起点位置的航向角，r表示距离圆弧起点位置的弧线长，xk表示当前时刻的正东方向位置，yk表示当前时刻的正北方向位置，thetak表示当前时刻的航向角，vxk表示当前时刻的正东方向速度，vyk表示当前时刻的正北方向速度，omega表示当前时刻的角速度。


7.如权利要求4所述的方法，其特征在于，根据所述道路类型和道路中心线几何方程，分别确定当前时刻的运行状态观测量和运行状态观测值，包括：
若所述道路类型为圆缓圆路段，则分别确定当前时刻的运行状态观测量为：

【专利技术属性】
技术研发人员：刘春，张志斌，谷小丰，
申请(专利权)人：腾讯科技深圳有限公司，
类型：发明
国别省市：广东;44