大场景稀疏体素地图的增量构建与版本化方法、装置、设备及存储介质与流程
本技术涉及数据持久化存储,尤其涉及一种大场景稀疏体素地图的增量构建与版本化方法、装置、设备及存储介质。
背景技术:
1、随着三维地图构建技术在大范围场景中的持续应用,采集设备的连续运行导致地图覆盖范围不断扩大,地图中已观测空间单元的数量随时间持续增长,对系统的存储管理能力和数据持久化能力提出了更高要求。
2、现有的大场景三维地图构建方案中,地图数据通常采用全局连续空间管理、固定分块组织或层级空间索引方式进行存储管理;部分方案支持将地图数据持久化至磁盘,但持久化过程常采用同步写入方式,或仅以整体地图为单位进行一次性导出。上述现有方案中,地图中同一个空间位置的数据以多个独立副本分散存在于不同存储介质中,不同存储介质之间缺乏统一的版本协调机制,当同一空间区域在数据写盘过程中被再次访问时,已写入磁盘的历史数据可能被错误覆盖,正在写入过程中的数据可能被误判为缺失而触发新建空数据块,导致同一空间位置的历史观测数据丢失。
3、如何在同一空间位置的地图数据跨存储介质分布的情况下,协调不同存储介质中同一空间位置的数据版本关系以避免历史数据被错误覆盖或丢失,成为需要解决的技术问题。
4、上述内容仅用于辅助理解本技术的技术方案,并不代表承认上述内容是现有技术。
技术实现思路
1、本技术的主要目的在于提供一种大场景稀疏体素地图的增量构建与版本化方法、装置、设备及存储介质,旨在解决如何确保同一空间位置的历史地图数据不被错误覆盖或丢失的技术问题。
2、为实现上述目的,本技术提出一种大场景稀疏体素地图的增量构建与版本化方法,所述的方法包括:
3、获取内存哈希表、待写盘集合、磁盘索引和在目标场景采集的点云数据;
4、根据所述点云数据对应的世界坐标,得到目标块索引和目标块内索引;
5、根据所述目标块索引查询所述内存哈希表、所述待写盘集合或所述磁盘索引,得到目标体素块;
6、根据所述目标块内索引从所述目标体素块内的多个体素中确定目标体素;
7、根据所述点云数据在所述目标体素上进行增量更新;
8、在增量更新完成后,根据预设更新策略更新所述目标体素块的访问元数据和版本标识。
9、在一实施例中,所述根据所述点云数据对应的世界坐标,得到目标块索引和目标块内索引,包括:
10、基于预设体素边长和所述世界坐标,得到全局体素索引;
11、基于预设体素块边长和所述全局体素索引,得到目标块索引;
12、基于预设体素块边长、所述全局体素索引和所述目标块索引,得到目标块内索引。
13、在一实施例中,所述根据所述目标块索引查询所述内存哈希表、所述待写盘集合或所述磁盘索引,得到目标体素块,包括:
14、根据所述目标块索引查询所述内存哈希表,得到第一查询结果;
15、在所述第一查询结果为已查询到内存体素块时,将所述内存体素块作为目标体素块;
16、在所述第一查询结果为未查询到内存体素块时,根据所述目标块索引查询所述待写盘集合,得到第二查询结果;
17、根据所述目标块索引查询所述磁盘索引,得到第三查询结果;
18、在所述第二查询结果为已查询到待写盘记录且所述第三查询结果为已查询到磁盘已提交体素块,获取所述待写盘记录对应的待写盘版本标识和所述磁盘已提交体素块对应的磁盘已提交版本标识;
19、在所述待写盘版本标识大于所述磁盘已提交版本标识时,等待所述待写盘记录对应的写盘操作完成,并在所述写盘操作完成后,从磁盘中获取所述待写盘记录对应的体素块作为目标体素块;
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、根据预设状态有效性条件和预设累计权重阈值遍历所述待写盘集合,得到多个有效待写盘记录;
47、等待各所述有效待写盘记录对应的写盘操作完成后,从磁盘中获取各所述有效待写盘记录对应的有效待写盘体素块;
48、根据预设状态有效性条件和预设累计权重阈值遍历所述磁盘索引,得到多个有效磁盘已提交体素块;
49、根据预设导出条件对所述有效内存体素块、所述有效待写盘体素块和所述有效磁盘已提交体素块进行筛选,得到待导出有效体素块;
50、将所述待导出有效体素块中各体素的块索引和块内索引还原为世界坐标;
51、根据所述世界坐标合并各所述待导出有效体素块中各体素存储的点云数据,得到所述目标场景的完整地图。
52、此外,为实现上述目的,本技术还提出一种大场景稀疏体素地图的增量构建与版本化装置,所述大场景稀疏体素地图的增量构建与版本化装置包括:
53、输入模块,用于获取内存哈希表、待写盘集合、磁盘索引和在目标场景采集的点云数据;
54、分解模块,用于根据所述点云数据对应的世界坐标,得到目标块索引和目标块内索引;
55、查询模块,用于根据所述目标块索引查询所述内存哈希表、所述待写盘集合或所述磁盘索引,得到目标体素块;
56、定位模块,用于根据所述目标块内索引从所述目标体素块内的多个体素中确定目标体素;
57、增量模块,用于根据所述点云数据在所述目标体素上进行增量更新;
58、更新模块,用于在增量更新完成后,根据预设更新策略更新所述目标体素块的访问元数据和版本标识。
59、此外,为实现上述目的,本技术还提出一种大场景稀疏体素地图的增量构建与版本化设备,所述设备包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述计算机程序配置为实现如上文所述的大场景稀疏体素地图的增量构建与版本化方法的步骤。
60、此外,为实现上述目的,本技术还提出一种存储介质,所述存储介质为计算机可读存储介质,所述存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如上文所述的大场景稀疏体素地图的增量构建与版本化方法的步骤。
61、此外,为实现上述目的,本技术还提供一种计算机程序产品,所述计算机程序产品包括计算机程序,所述计算机程序被处理器执行时实现如上文所述的大场景稀疏体素地图的增量构建与版本化方法的步骤。
62、本技术提出的一个或多个技术方案,至少具有以下技术效果:
63、获取内存哈希表、待写盘集合、磁盘索引和在目标场景采集的点云数据;根据所述点云数据对应的世界坐标,得到目标块索引和目标块内索引;根据所述目标块索引查询所述内存哈希表、所述待写盘集合或所述磁盘索引,得到目标体素块;根据所述目标块内索引从所述目标体素块内的多个体素中确定目标体素;根据所述点云数据在所述目标体素上进行增量更新;在增量更新完成后,根据预设更新策略更新所述目标体素块的访问元数据和版本标识。通过获取内存哈希表、待写盘集合和磁盘索引,并以统一块索引作为同一空间位置地图数据在不同存储介质中的身份标识,使得在查询目标体素块时能够依据该块索引在内存哈希表、待写盘集合和磁盘索引之间依次查找并获取处于可访问状态的目标体素块,从而在点云增量更新过程中对同一块索引对应的跨存储介质数据版本实施统一的定位与访问控制。由于每次访问均以块索引为唯一查询依据,并根据各存储介质中该块索引对应的实际存在状态返回可访问版本,因此避免了在数据写盘期间因存储位置判断不准确而加载旧版本或创建空块覆盖历史数据的问题。由此解决了如何确保跨存储介质分布的同一空间位置的历史地图数据不被错误覆盖或丢失的技术问题,实现了同一块索引对应的地图数据在跨存储介质分布状态下版本统一访问和历史数据完整保留的效果。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com