状态估计方法、装置、自动驾驶车辆及电子设备与流程
本公开涉及数据处理领域,尤其涉及自动驾驶、地图、感知、大模型等,特别的涉及状态估计方法、装置、自动驾驶车辆及电子设备。
背景技术:
1、在自动驾驶系统中,bev(bird's-eye-view,鸟俯视图)真值数据是感知模型训练的基础,需要为场景中每个障碍物提供准确的bev检测框(包含位置、朝向、尺寸)以及运动状态(包含速度、角速度等)。当前生产流程中,通常采用预标注模型直接输出障碍物的bev检测结果,再辅以人工审核和修正。然而,预标注模型的输出存在检测框尺寸不一致、检测框位置不准确、检测框过大不紧凑、缺少速度信息等问题。
技术实现思路
1、本公开提供了一种状态估计方法、装置、自动驾驶车辆及电子设备,可解决相关技术中预标注模型的输出存在检测框尺寸不一致、检测框位置不准确、检测框过大不紧凑、缺少速度信息等问题。
2、根据本公开实施例的第一方面,提供了一种状态估计方法,包括:
3、对预标注模型输出的障碍物检测结果进行多目标跟踪,得到每个障碍物的跟踪轨迹;其中,每条所述跟踪轨迹包括同一障碍物在其生命周期内所有帧的检测结果序列;
4、对于每条所述跟踪轨迹,基于所述跟踪轨迹对应的障碍物检测结果,构建面向自车与多目标联合位姿估计的因子图;
5、基于所述构建的因子图进行全局优化计算,以得到优化后的检测框信息和运动状态估计信息。
6、根据本公开实施例的第二方面,提供了一种状态估计装置,包括:
7、获取模块,用于对预标注模型输出的障碍物检测结果进行多目标跟踪,得到每个障碍物的跟踪轨迹;其中,每条所述跟踪轨迹包括同一障碍物在其生命周期内所有帧的检测结果序列;
8、构建模块,用于对于每条所述跟踪轨迹,基于所述跟踪轨迹对应的障碍物检测结果,构建面向自车与多目标联合位姿估计的因子图;
9、优化计算模块,用于基于所述构建的因子图进行全局优化计算,以得到优化后的检测框信息和运动状态估计信息。
10、根据本公开实施例的第三方面,提供了一种自动驾驶车辆,包括:域控制器,用于执行前述第一方面所述的方法。
11、根据本公开实施例的第四方面,提供了一种电子设备,包括:
12、至少一个处理器;以及
13、与所述至少一个处理器通信连接的存储器;其中,
14、所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够执行前述第一方面所述的方法。
15、根据本公开实施例的第五方面,提供了一种存储介质,所述存储介质存储有指令,其中,当所述指令在电子设备上运行时,使得所述电子设备执行前述第一方面所述的方法。
16、根据本公开实施例的第六方面,提供了一种程序产品,包括程序、指令的至少之一,其中,所述程序、指令的至少之一被电子设备执行实现前述第一方面所述方法的步骤。
17、根据本公开的技术方案,通过对预标注模型输出的障碍物进行多目标跟踪建立时序关联,以形成每个障碍物的跟踪轨迹;对于每条跟踪轨迹,基于跟踪轨迹对应的障碍物检测结果,构建面向自车与多目标联合位姿估计的因子图;基于因子图进行全局优化计算,以得到各障碍物优化后的检测框信息和运动状态估计信息。本公开可解决相关技术中预标注模型的输出存在检测框尺寸不一致、检测框位置不准确、检测框过大不紧凑、缺少速度信息等问题,可实现紧凑检测框和准确运动状态的同时估计,可应用于自动驾驶bev真值数据自动化生产流程中。
18、应当理解,本部分所描述的内容并非旨在标识本公开的实施例的关键或重要特征,也不用于限制本公开的范围。本公开的其它特征将通过以下的说明书而变得容易理解。
1.一种状态估计方法,包括:
2.根据权利要求1所述的方法,其中,所述对于每条所述跟踪轨迹,基于所述跟踪轨迹对应的障碍物检测结果,构建面向自车与多目标联合位姿估计的因子图,包括:
3.根据权利要求2所述的方法,其中,所述多类型约束因子包括以下两项或多项:先验因子;运动因子;检测因子;运动平滑因子;里程计因子。
4.根据权利要求1所述的方法,其中,所述基于所述构建的因子图进行全局优化计算,以得到优化后的检测框信息和运动状态估计信息,包括:
5.根据权利要求4所述的方法,其中,构建先验因子的局部代价函数,包括:
6.根据权利要求4所述的方法,其中,构建运动因子的局部代价函数,包括:
7.根据权利要求4所述的方法,其中,构建检测因子的局部代价函数,包括:
8.根据权利要求4所述的方法,其中,构建运动平滑因子的局部代价函数,包括:
9.根据权利要求4所述的方法,其中,构建里程计因子的局部代价函数,包括:
10.一种状态估计装置,包括:
11.一种自动驾驶车辆,包括:
12.一种电子设备,包括:
13.一种存储介质,所述存储介质存储有指令,其中,当所述指令在电子设备上运行时,使得所述电子设备执行权利要求1-9中任一项所述的方法。
14.一种程序产品,包括程序、指令的至少之一,其中,所述程序、指令的至少之一被电子设备执行实现权利要求1-9中任一项所述方法的步骤。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com