System.ArgumentOutOfRangeException: 索引和长度必须引用该字符串内的位置。 参数名: length 在 System.String.Substring(Int32 startIndex, Int32 length) 在 zhuanliShow.Bind()
【技术实现步骤摘要】
本申请涉及自动驾驶,特别是一种轮速修正方法、系统以及车辆。
技术介绍
1、目前,在自动驾驶领域,多采用传统组合导航框架对rtk(real-time kinematic实时动态差分定位)位姿观测值和imu(inertial measurement unit惯性策略单元)惯性测量值进行松耦合,以实现对车辆的定位,但是,rtk受环境影响大,在遮挡、半遮挡,以及电磁波信号受到干扰的情况下定位精度差,并且imu由于受到传感器测量精度的影响,其惯性测量值含有噪声,长时间积分会有累积误差,在定位中必须要考虑的噪声量为零偏和随机游走,因此,上述组合导航框架下的定位技术在遇到隧道、连续高架、收费站等特殊路况时,无法提供精确的纵向定位精度。
2、针对上述问题,本申请提出了一种轮速修正方法。
技术实现思路
1、鉴于上述问题,本申请实施例提供了一种轮速修正方法、系统以及车辆,以解决现有的传统组合导航框下的定位技术无法在隧道、连续高架、收费站等特殊路况提供精确的纵向定位精度的问题。
2、本申请实施例第一方面,提供了一种轮速修正方法,所述方法包括:
3、获取车辆在里程仪坐标系下的初始速度以及所述车辆在目标时刻对应的当前帧点云数据的全局描述子;
4、获取所述车辆在所述目标时刻对应的至少一组候选帧点云数据的全局描述子;
5、根据所述当前帧点云数据的全局描述子,确定所述至少一组候选帧点云数据的全局描述子中的目标候选帧点云数据的全局描述子;
6、
7、根据所述轮速修正系数,对所述里程仪坐标系下的初始速度进行轮速修正,得到修正后的所述里程仪坐标系下的目标速度。
8、可选地,根据所述轮速修正系数,对所述里程仪坐标系下的初始速度进行轮速修正,得到修正后的所述里程仪坐标系下的目标速度之后,还包括:
9、根据所述修正后的所述里程仪坐标系下的目标速度,确定修正后的导航仪坐标系下的目标速度;
10、根据所述修正后的导航仪坐标系下的目标速度,确定所述车辆的当前位置和姿态。
11、可选地,所述根据所述目标候选帧点云数据的全局描述子,确定轮速修正系数,包括:
12、获取所述车辆在第一目标时刻对应的第一目标候选帧点云数据的第一全局描述子和所述车辆在第二目标时刻对应的第二目标候选帧点云数据的第二全局描述子;
13、根据所述第一全局描述子和所述第二全局描述子各自对应的位置坐标,确定所述车辆的位置增量;
14、根据所述车辆的位置增量,确定所述轮速修正系数。
15、可选地,所述根据所述车辆的位置增量,确定所述轮速修正系数,包括:
16、将所述位置增量输入到滑动窗口修正目标函数中,确定所述轮速修正系数;
17、所述滑动窗口修正目标函数如以下公式所示:
18、
19、其中,为滑动窗口修正目标函数的最小值对应的修正系数;为位置增量;为姿态矩阵;δkd为滑动窗口修正目标函数的修正系数;为里程仪速度;dt为时间。
20、可选地,所述根据所述当前帧点云数据的全局描述子,确定所述至少一组候选帧点云数据的全局描述子中的目标候选帧点云数据的全局描述子,包括:
21、将所述至少一组候选帧点云数据的全局描述子与所述当前帧点云数据的全局描述子进行配准,确定所述至少一组候选帧点云数据的全局描述子与所述当前帧点云数据的全局描述子之间的相似度;
22、根据所述至少一组候选帧点云数据的全局描述子与所述当前帧点云数据的全局描述子之间的相似度,确定所述目标候选帧点云数据的全局描述子。
23、可选地,所述获取所述车辆在所述目标时刻对应的至少一组候选帧点云数据的全局描述子,包括:
24、获取所述车辆在所述目标时刻对应的至少一组初选帧点云数据的全局描述子;
25、对所述至少一组初选帧点云数据的全局描述子进行初步检索,得到所述至少一组候选帧点云数据的全局描述子。
26、可选地,所述根据所述修正后的所述里程仪坐标系下的目标速度,确定修正后的导航仪坐标系下的目标速度,包括:
27、获取所述车辆的姿态矩阵;
28、根据所述车辆的姿态矩阵,将所述修正后的所述里程仪坐标系下的目标速度转化为所述修正后的所述导航仪坐标系下的目标速度。
29、可选地,所述根据所述轮速修正系数,对所述里程仪坐标系下的初始速度进行轮速修正,得到修正后的所述里程仪坐标系下的目标速度,包括:
30、识别所述车辆当前的路况;
31、在所述车辆当前的路况为特殊路况的情况下,对所述车辆在所述里程仪坐标系下的初始速度进行轮速修正,得到修正后的所述里程仪坐标系下的目标速度,其中,所述特殊路况表征所述路况中包含隧道、匝道、高架、龙门架、收费站、标志牌中的至少一者。
32、本申请实施例第二方面,提供了一种轮速修正系统,所述系统包括:
33、第一获取模块,用于获取车辆在里程仪坐标系下的初始速度以及所述车辆在目标时刻对应的当前帧点云数据的全局描述子;
34、第二获取模块,用于获取所述车辆在所述目标时刻对应的至少一组候选帧点云数据的全局描述子;
35、第一确定模块,用于根据所述当前帧点云数据的全局描述子,确定所述至少一组候选帧点云数据的全局描述子中的目标候选帧点云数据的全局描述子;
36、第二确定模块,根据所述目标候选帧点云数据的全局描述子,确定轮速修正系数;
37、修正模块,用于根据所述轮速修正系数,对所述里程仪坐标系下的初始速度进行轮速修正,得到修正后的所述里程仪坐标系下的目标速度。
38、可选地,根据所述轮速修正系数,对所述里程仪坐标系下的初始速度进行轮速修正,得到修正后的所述里程仪坐标系下的目标速度之后,还包括:
39、第三确定模块,用于根据所述修正后的所述里程仪坐标系下的目标速度,确定修正后的导航仪坐标系下的目标速度;
40、第四确定模块,用于根据所述修正后的导航仪坐标系下的目标速度,确定所述车辆的当前位置和姿态。
41、可选地,所述根据所述目标候选帧点云数据的全局描述子,确定轮速修正系数,所述第二确定模块,包括:
42、第一获取子模块,用于获取所述车辆在第一目标时刻对应的第一目标候选帧点云数据的第一全局描述子和所述车辆在第二目标时刻对应的第二目标候选帧点云数据的第二全局描述子;
43、第一确定子模块,用于根据所述第一全局描述子和所述第二全局描述子各自对应的位置坐标,确定所述车辆的位置增量;
44、第二确定子模块,用于根据所述车辆的位置增量,确定所述轮速修正系数。
45、可选地,所述根据所述车辆的位置增量,确定所述轮速修正系数,所述第二确定子模块,包括:
46、第一确本文档来自技高网...
【技术保护点】
1.一种轮速修正方法,其特征在于,所述方法包括:
2.根据权利要求1所述的轮速修正方法,其特征在于,根据所述轮速修正系数,对所述里程仪坐标系下的初始速度进行轮速修正,得到修正后的所述里程仪坐标系下的目标速度之后,还包括:
3.根据权利要求1所述的轮速修正方法,其特征在于,所述根据所述目标候选帧点云数据的全局描述子,确定轮速修正系数,包括:
4.根据权利要求3所述的轮速修正方法,其特征在于,所述根据所述车辆的位置增量,确定所述轮速修正系数,包括:
5.根据权利要求1所述的轮速修正方法,其特征在于,所述根据所述当前帧点云数据的全局描述子,确定所述至少一组候选帧点云数据的全局描述子中的目标候选帧点云数据的全局描述子,包括:
6.根据权利要求1所述的轮速修正的方法,其特征在于,所述获取所述车辆在所述目标时刻对应的至少一组候选帧点云数据的全局描述子,包括:
7.根据权利要求2所述的轮速修正方法,其特征在于,所述根据所述修正后的所述里程仪坐标系下的目标速度,确定修正后的导航仪坐标系下的目标速度,包括:
8.根
9.一种轮速修正系统,其特征在于,所述系统包括:
10.一种车辆,其特征在于,所述车辆包括如权利要求9所述的轮速修正系统。
...【技术特征摘要】
1.一种轮速修正方法,其特征在于,所述方法包括:
2.根据权利要求1所述的轮速修正方法,其特征在于,根据所述轮速修正系数,对所述里程仪坐标系下的初始速度进行轮速修正,得到修正后的所述里程仪坐标系下的目标速度之后,还包括:
3.根据权利要求1所述的轮速修正方法,其特征在于,所述根据所述目标候选帧点云数据的全局描述子,确定轮速修正系数,包括:
4.根据权利要求3所述的轮速修正方法,其特征在于,所述根据所述车辆的位置增量,确定所述轮速修正系数,包括:
5.根据权利要求1所述的轮速修正方法,其特征在于,所述根据所述当前帧点云数据的全局描述子,确定所述至少一组候选帧点云数据的全局描述子中的目标候选帧点云数据...
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。