点云地图定位能力测评系统和方法技术方案

本申请涉及一种点云地图的定位能力评估系统，其中，该系统应用在增强现实场景下，通过数据采集模块在目标场景下采集轨迹数据；通过预处理模块对轨迹数据进行筛选得到目标轨迹数据；真值制作模块用于将目标轨迹数据注册至视觉定位地图，得到测评点对应的位姿真值；测评模块用于获取各个测评点在点云地图中对应的定位结果，通过对比相同测评点的定位结果和位姿真值，得到点云地图的定位能力测评结果。相比较于现有依赖于实体标定物的、对环境要求较高的真值获取方式，通过本系统，可以不受实际场景的限制，方便快捷的获取用于参照的位姿真值，进而通过将该位姿真值与定位结果做对比，可以对点云地图的定位精度进行全面、精准的评测。的评测。的评测。

【技术实现步骤摘要】
点云地图定位能力测评系统和方法


[0001]本申请涉及增强现实领域，特别是涉及一种点云地图定位能力测评系统、方法、计算机设备和计算机可读存储介质。

技术介绍

[0002]AR设备的跟踪系统长时间运行后会固定地产生累计误差，为了长时间保持AR体验的稳定性以及虚实内容的贴合度，通常会利用预建地图，定时或定策略对AR设备的当前位姿进行更新校准。
[0003]预建地图的质量高低和定位算法的精度，直接决定了定位结果的准确度；与地图质量相关的条目包括：点云地图的尺寸准确度、3D点数量、3D点的位置准确度、3D点对应的特征点数量等。
[0004]由于场景中光照条件、纹理结构、动态变化等因素影响，导致同一定位算法在不同场景下的定位精度不同；在同一场景内的不同位置或不同朝向，定位精度也可能不同。为获得更好的AR体验，以及为目标场景下AR体验内容的设计提供数据支持，需要对具体场景下的视觉定位能力进行测评，即在某个特定的点云地图中，测评该地图的质量以及定位算法在该地图下的定位表现。
[0005]在相关技术中，场景下视觉定位质量评估方法包括如下几种：
[0006]1.通过昂贵的真值制作系统(例如vicon标定系统)，在目标场地下进行实物布置之后，通过采集、分析处理包含标定实物的场景图像获得真值，最后，将该真值与地图定位结果进行对比，以测评地图的定位精度；
[0007]一种常见的基于vicon标定系统获取真值的做法是：在场景中多个位置架设钢架，该钢架上布置有多个小球，在布置且标定完成之后，相机利用当前视场图像中各个小球的反光强度来获得位姿真值。
[0008]然而，上述方案中存在如下缺陷：
[0009](1)价格昂贵：作为参照物的真值实物通常批量化制作，对于小型SLAM项目来说成本较高，并且，无法针对类型繁多的各种AR应用场景制作相匹配的真值实物，更无法灵活地应用于ToC或其他定制化AR项目中；
[0010](2)空间限制性较高：由于Vicon系统需要在受控的空间(如环境光恒定的室内场景)下进行运动捕捉，因此，对于大型SLAM项目(景区、商场)或者在复杂环境下进行的SLAM项目(如山体、建筑)来说，难以进行实物布置及标定，因此空间限制较大；
[0011](3)对被跟踪物体要求较高：Vicon系统对被跟踪的物体要求较高，需要在物体表面上贴有反光球或反光贴纸，对于部分应用场景无法适用。
[0012]2.使用原生传感器获取的参数作为评估基准，与算法输出的定位结果进行对比以实现地图的定位能力测评；
[0013]但是，传感器能够获取的参数只能覆盖测评指标的一部分，无法全面的反映地图定位精度，如惯性传感器(Inertial Measurement Unit，IMU)仅可测评朝向而无法测评位
置；地球导航卫星系统(Global Navigation Satellite System，GNSS)仅可用于测评位置而无法测评朝向。
[0014]另外，IMU数据和GNSS数据本身存在固定误差，因此，使用该类数据作为真值进行定位测评时，由于无法避免误差，所以会影响到测评结果的准确性。同时，由于IMU数据和GNSS数据在某些环境下可能会失效或失准，因此，也无法适用于所有应用场景；例如，IMU数据可能会受到震动或其他因素干扰而导致测量误差；在室内或在高楼大厦附近，GNSS信号可能会受到遮挡或反射的影响而变得不准确。
[0015]另外，由于真值系统的坐标系与待评测地图的坐标系是相互独立的，因此，上述两种方案均必须使用SE3或SIM3变换将两者的坐标系对齐，而坐标系对齐又要求用于评测的轨迹必须具有一定的长度和满足一定的走向，否则对齐精度较差；即使在轨迹满足要求的情况下，仍无法避免的会出现对齐误差，也会影响定位地图能力评测的准确性。

技术实现思路

[0016]本申请实施例提供了一种点云地图定位能力测评系统、方法、计算机设备和计算机可读存储介质，以至少解决相关技术中测评方法适用场景受限的问题。
[0017]第一方面，本申请实施例提供了一种点云地图定位能力测评系统，所述系统包括：数据采集模块、预处理模块、真值制作模块和测评模块，其中，
[0018]所述数据采集模块，用于在目标场景下采集轨迹数据，其中，所述轨迹数据由多个连续的测评点组成，所述测评点包括图像帧及其对应的跟踪位姿；
[0019]所述预处理模块，用于根据预设筛选规则，从所述轨迹数据中筛选满足预设条件的目标轨迹数据；
[0020]所述真值制作模块，用于将所述目标轨迹数据注册至视觉定位地图，得到所述测评点对应的位姿真值；
[0021]所述测评模块，用于获取各个测评点在所述点云地图中对应的定位结果，通过对比相同测评点的定位结果和位姿真值，得到所述点云地图的定位能力测评结果。
[0022]在其中一些实施例中，所述真值制作模块包括：轨迹注册模块、真值筛选模块和真值输出模块，其中，
[0023]所述轨迹注册模块用于，将所述目标轨迹数据中连续的多帧测评点，注册至所述点云地图，得到各个评测点对应在所述点云地图中的位姿真值，
[0024]所述真值筛选模块用于，在所述目标轨迹数据注册完成之后，删除所述位姿真值中注册失败和注册质量不佳的测评点，得到筛选之后的位姿真实；
[0025]所述真值输出模块用于，将所述筛选之后的位姿真值，合并为真值数据包并发送至所述评测模块。
[0026]在其中一些实施例中，所述轨迹注册模块包括第一注册模块、第二注册模块和第三注册模块，其中，
[0027]所述第一注册模块，用于获取各个测评点之间的关联信息，结合所述关联信息，将所述目标轨迹数据中连续的测评点注册至所述所述点云地图，得到各个测评点在所述点云地图中的位姿真值；
[0028]所述第二注册模块，用于将所述目标轨迹数据中的各个测评点独立注册至所述点
云地图之后，对所述注册完成的测评点进行BA优化，得到各个测评点在所述点云地图中的位姿真值；
[0029]所述第三注册模块，用于根据所述点云地图和所述目标轨迹数据，构建因子图优化问题，
[0030]通过求解所述因子图优化问题，得到所述目标轨迹数据与点云地图坐标系之间的转换关系，根据所述转换关系，得到各个测评点在所述点云地图中的位姿真值。
[0031]在其中一些实施例中，所述真值筛选模块，通过比较相邻测评点的第一相对位姿和第二相对位姿，查找所述注册质量不佳的测评点，
[0032]其中，所述第一相对位姿是跟踪系统坐标系下相邻测评点的相对位姿，所述第二相对位姿是点云地图坐标系下相邻测评点的相对位姿。
[0033]在其中一些实施例中，所述数据采集模块包括：路线设计模块、采样点选取模块和获取模块，其中，
[0034]所述路线设计模块，用于获取AR内容在目标场景下的分布信息，根据所述分布信息生成对应的采样路线，其中，所述采集路线包括：环绕式路线、导览式路线和漫游式路线；
[0035]本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种点云地图定位能力测评系统，其特征在于，所述系统包括：数据采集模块、预处理模块、真值制作模块和测评模块，其中，所述数据采集模块，用于在目标场景下采集轨迹数据，其中，所述轨迹数据由多个连续的测评点组成，所述测评点包括图像帧及其对应的跟踪位姿；所述预处理模块，用于根据预设筛选规则，从所述轨迹数据中筛选满足预设条件的目标轨迹数据；所述真值制作模块，用于将所述目标轨迹数据注册至视觉定位地图，得到所述测评点对应的位姿真值；所述测评模块，用于获取各个测评点在所述点云地图中对应的定位结果，通过对比相同测评点的定位结果和位姿真值，得到所述点云地图的定位能力测评结果。2.根据权利要求1所述的系统，其特征在于，所述真值制作模块包括：轨迹注册模块、真值筛选模块和真值输出模块，其中，所述轨迹注册模块用于，将所述目标轨迹数据中连续的多帧测评点，注册至所述点云地图，得到各个评测点对应在所述点云地图中的位姿真值，所述真值筛选模块用于，在所述目标轨迹数据注册完成之后，删除所述位姿真值中注册失败和注册质量不佳的测评点，得到筛选之后的位姿真实；所述真值输出模块用于，将所述筛选之后的位姿真值，合并为真值数据包并发送至所述评测模块。3.根据权利要求2所述的系统，其特征在于，所述轨迹注册模块包括第一注册模块、第二注册模块和第三注册模块，其中，所述第一注册模块，用于获取各个测评点之间的关联信息，结合所述关联信息，将所述目标轨迹数据中连续的测评点注册至所述所述点云地图，得到各个测评点在所述点云地图中的位姿真值；所述第二注册模块，用于将所述目标轨迹数据中的各个测评点独立注册至所述点云地图之后，对所述注册完成的测评点进行BA优化，得到各个测评点在所述点云地图中的位姿真值；所述第三注册模块，用于根据所述点云地图和所述目标轨迹数据，构建因子图优化问题，通过求解所述因子图优化问题，得到所述目标轨迹数据与点云地图坐标系之间的转换关系，根据所述转换关系，得到各个测评点在所述点云地图中的位姿真值。4.根据权利要求2所述的系统，其特征在于，所述真值筛选模块，通过比较相邻测评点的第一相对位姿和第二相对位姿，查找所述注册质量不佳的测评点，其中，所述第一相对位姿是跟踪系统坐标系下相邻测评点的相对位姿，所述第二相对位姿是点云地图坐标系下相邻测评点的相对位姿。5.根据权利要求1所述的系统，其特征在于，所述数据采集模块包括：路线设计模块、采样点选取模块和获取模块，其中，所述路线设计模块，用于获取AR内容在目标场景下的分布信息，根据所述分布信息生成对应的采样路线，其中，所述采集路线包括：环绕式路线、导览式路线和漫游式路线；所述采样点选取模块，用于根据预设时间，和/或AR体验移动距离，和/或AR体验角度变
换量确定带采样的测评点；所述获取模块，用于根据所述采样路线，在所述目标场景中获取所述轨迹数据。6.根据权利要求5所述的系统，其特征在于，所述轨迹数据还包括：采集时间、采集设备、跟踪系统信息、各个测评点对应的时间戳和辅助传感器信息。7.根据权利要求6所述的系统，其特征在于，所述跟踪系统信息...

【专利技术属性】
技术研发人员：张双力，丛林，
申请(专利权)人：杭州易现先进科技有限公司，
类型：发明
国别省市：