[发明专利]一种定位方法及定位系统

权利要求书

1.一种定位方法，用于车辆定位，其特征在于，包括：

第一获取步骤：建立以待定位车辆中心为原点的车辆坐标系，获得UWB定位模块和所述待定位车辆中心在所述车辆坐标系中的第一位置关系；

第二获取步骤：建立待定位车辆所在地区的全局坐标系，获得所述待定位车辆中心和所述UWB定位模块在所述全局坐标系中的第二位置关系；

UWB定位步骤：根据所述第一位置关系和所述第二位置关系获得所述待定位车辆中心在所述全局坐标系中的坐标所满足的第一函数式；

激光定位步骤：利用激光定位模块获得所述待定位车辆中心在所述全局坐标系中的坐标所满足的第二函数式；

处理步骤：根据所述第一函数式和所述第二函数式获得所述待定位车辆中心在所述全局坐标系中的坐标。

2.如权利要求1所述的方法，其特征在于，所述激光定位步骤还包括：根据所述激光定位模块获得所述待定位车辆的航向角，其中，所述航向角为所述待定位车辆的正方向与所述全局坐标系X坐标轴正方向的夹角。

3.如权利要求1所述的方法，其特征在于，所述UWB定位模块包括多个定位标签和基站，所述第一获取步骤包括：

在所述待定位车辆上固定所述多个定位标签；

建立以所述待定位车辆中心为原点的车辆坐标系，分别获取各所述定位标签在所述车辆坐标系中的坐标；

根据所述定位标签接收到基站信号时所对应的时间戳和各所述定位标签在所述车辆坐标系中的坐标建立TDOA方程组；

求解所述TDOA方程组，获得所述基站在所述车辆坐标系中的第一基站坐标；

根据所述第一基站坐标，获得在所述车辆坐标系中，所述基站与所述待定位车辆中心之间的第一基站距离。

4.如权利要求3所述的方法，其特征在于，所述基站的数量为1个，所述TDOA方程组为

其中，(x_i，y_i，z_i)代表第i个定位标签在所述车辆坐标系下的坐标，t_i代表第i个定位标签接收到所述基站信号时的时间戳，i＝1,2,3,4；(x_v，y_v，z_v)代表所述第一基站坐标，C代表所述基站信号的传播速度。

5.如权利要求1所述的方法，其特征在于，所述UWB定位模块包括基站，所述第二获取步骤包括：

建立所述待定位车辆所在地区的全局坐标系，获取所述基站在所述全局坐标系中的第二基站坐标；

根据所述第二基站坐标，获得在所述全局坐标系中，所述基站与所述待定位车辆中心的第二基站距离。

6.如权利要求3或5所述的方法，其特征在于,所述第一函数式为

其中，x，y分别代表所述待定位车辆中心在所述全局坐标系下的横坐标和纵坐标，x_bs，y_bs分别代表所述基站在所述全局坐标系中的横坐标和纵坐标，x_v，y_v分别代表所述基站在所述车辆坐标系下的横坐标和纵坐标。

7.如权利要求1所述的方法，其特征在于，所述激光定位模块包括激光雷达，所述激光定位步骤包括：

利用所述激光雷达采集行驶车道的路沿线的信息，获取所述激光雷达与所述路沿线之间的第一距离；

根据所述激光雷达与待定位车辆之间的位置关系和所述第一距离，计算所述待定位车辆中心与所述路沿线之间的第二距离；

根据所述路沿线在所述全局坐标系中的曲线方程和所述第二距离，确定所述第二函数式。

8.如权利要求7所述的方法，其特征在于，所述第二函数式为

其中，A、B、C分别为所述路沿线在所述全局坐标系中的曲线方程的参数，dis代表所述第二距离，x、y分别代表所述待定位车辆中心在所述全局坐标系中的横坐标和纵坐标。