面向空间地图的对象定位保持方法、系统、设备及介质与流程
本技术涉及同步定位与地图构建,具体涉及面向空间地图的对象定位保持方法、系统、设备及介质。
背景技术:
1、在移动机器人、自动驾驶及空间扫描等应用中,同步定位与地图构建(slam)系统通过持续优化地图节点的位姿来提高环境感知的精度。在实际应用中,通常需要在地图上标记充电桩、停靠点、语义标签等空间,以供导航或任务规划使用。
2、然而,现有的空间对象管理方法通常将对象直接绑定于绝对坐标系或特定地图节点。当系统执行局部束调整、回环检测或多地图合并等优化操作时,地图节点的位姿会发生修正,若空间对象仅保存创建时的绝对坐标,则会出现对象与优化后地图错位的问题;若将空间对象与特定地图节点进行强绑定以继承位姿更新,则在该节点因冗余被剔除时,往往需要强制保留该节点或导致对象丢失,从而造成地图存储膨胀或数据完整性受损。
3、因此,有必要提供面向空间地图的对象定位保持方法、系统、设备及介质解决上述技术问题。
技术实现思路
1、针对现有技术存在的空间对象坐标更新与地图节点生命周期管理相冲突的问题,本技术通过面向空间地图的对象定位保持方法、系统、设备及介质,实现空间对象位姿随地图优化的自适应更新以及参考节点变更时的无损迁移。
2、为实现上述目的,本技术采用如下技术方案:
3、面向空间地图的对象定位保持方法,包括:维护空间地图中空间对象的双位姿表达,双位姿表达包括空间对象在全局坐标系下的全局位姿,以及空间对象相对于当前关联的参考节点的相对位姿;当参考节点的位姿被优化修正时,基于参考节点的修正后的位姿与相对位姿,更新空间对象的全局位姿;当参考节点满足预设剔除条件时,确定替代节点;若成功确定替代节点,则基于参考节点的修正后的位姿和相对位姿重新计算空间对象的全局位姿,并基于重新计算的全局位姿和替代节点的位姿,确定空间对象相对于替代节点的更新相对位姿,将空间对象从参考节点迁移至替代节点;若未成功确定替代节点,则执行异常处理。
4、作为优选,当参考节点的位姿被优化修正时,基于参考节点的修正后的位姿与相对位姿,更新空间对象的全局位姿,包括:当接收到针对空间对象的查询请求、地图保存指令或周期性更新触发事件时,获取参考节点的修正后的位姿;将相对位姿通过修正后的位姿对应的正变换参数变换至全局坐标系,得到更新后的全局位姿。
5、作为优选,确定替代节点,包括:在空间地图的节点集合中,优先查找与参考节点存在时序邻接关系的有效节点作为替代节点,时序邻接关系包括时间序列上的前驱节点或后继节点;若不存在与参考节点存在时序邻接关系的有效节点,则基于空间地图的节点空间索引,以参考节点的传感器中心位置为查询基准,查找与参考节点的三维欧氏距离最小的存活节点作为替代节点;若未查找到任何存活节点,则判断当前是否处于地图保存状态;若未处于地图保存状态,则删除参考节点关联的空间对象;若正处于地图保存状态,则暂时保留空间对象的记录及其最后有效的全局位姿,并在后续查询时返回最后有效的全局位姿并标记参考节点为不可用状态。
6、作为优选,基于参考节点的修正后的位姿和相对位姿重新计算空间对象的全局位姿,并基于重新计算的全局位姿和替代节点的位姿,确定空间对象相对于替代节点的更新相对位姿,包括:将相对位姿通过参考节点的修正后的位姿对应的正变换参数变换至全局坐标系,得到重新计算的全局位姿;将重新计算的全局位姿通过替代节点的位姿对应的逆变换参数变换至替代节点的局部坐标系,得到更新相对位姿;其中,迁移前后的空间对象在全局坐标系下的空间位置保持一致。
7、作为优选,该方法还包括:维护空间对象与参考节点之间的关联关系,关联关系包括:以空间对象的标识为索引的对象集合,用于保存空间对象的双位姿表达及关联的参考节点的标识;反向关联索引,用于保存一个参考节点的标识与一个或多个空间对象的标识之间的反向映射,在参考节点满足预设剔除条件时定位关联的空间对象;节点引用索引,用于保存以参考节点的标识为键、指向参考节点的内存对象的非阻塞式引用,非阻塞式引用配置为在查询时临时获取有效引用,且引用失效时不阻塞参考节点的内存释放。
8、作为优选,该方法还包括:在维护关联关系后,执行地图保存操作前,生成一致性快照,依次根据参考节点的修正后的位姿更新空间对象的全局位姿,并序列化存储空间对象的标识、名称、业务属性、全局位姿、相对位姿、当前地图标识和参考节点的标识,同时在地图元数据中保存空间对象总数和下一可用标识值;在执行地图加载操作时,优先加载传感器参数、地图结构、地图节点和地图点云,并按空间对象总数加载空间对象,恢复对象集合及反向关联索引;遍历已加载的地图节点,根据参考节点的标识重建节点引用索引,统计重建失败的异常空间对象,并对异常空间对象执行邻近节点重关联、告警或降级处理。
9、作为优选,该方法还包括:在地图加载操作后,若涉及多个子地图合并为全局地图集,当参考节点由原属子地图转移至目标子地图时,空间对象通过参考节点的标识继续关联同一参考节点;在下一次触发全局位姿更新时,读取参考节点当前所属的地图标识,并将空间对象的当前地图标识同步更新为参考节点当前所属的地图标识;其中,全局地图集内的参考节点的标识保持全局唯一。
10、此外,本技术还提供了面向空间地图的对象定位保持系统,包括:位姿维护模块,用于维护空间地图中空间对象的双位姿表达,双位姿表达包括空间对象在全局坐标系下的全局位姿,以及空间对象相对于当前关联的参考节点的相对位姿;位姿更新模块,用于当参考节点的位姿被优化修正时,基于参考节点的修正后的位姿与相对位姿,更新空间对象的全局位姿;锚点迁移模块,用于当参考节点满足预设剔除条件时,确定替代节点;若成功确定替代节点,则基于参考节点的修正后的位姿和相对位姿重新计算空间对象的全局位姿,并基于重新计算的全局位姿和替代节点的位姿,确定空间对象相对于替代节点的更新相对位姿,以将空间对象从参考节点迁移至替代节点;若未成功确定替代节点,则执行异常处理。
11、此外,本技术还提供了一种电子设备,包括:至少一个处理器;以及与至少一个处理器通信连接的存储器;其中,存储器存储有可被至少一个处理器执行的指令,指令被至少一个处理器执行,以使至少一个处理器能够执行如上述方案所述的面向空间地图的对象定位保持方法。
12、此外,本技术还提供了一种计算机可读存储介质,计算机可读存储介质存储有计算机指令,计算机指令用于使计算机执行如上述方案所述的面向空间地图的对象定位保持方法。
13、有益效果:
14、本技术提供的技术方案,通过为空间对象建立包含全局位姿与相对位姿的双位姿表达体系,采用相对位姿建立空间对象与地图优化结果之间的稳定约束连接关系。当参考节点位姿发生修正时,无需将空间对象作为优化变量加入后端图优化,仅需基于修正后的参考节点位姿与保持不变的相对位姿,即可按需恢复准确的全局位姿,从而在保证坐标一致性的同时,显著降低了后端优化的计算维度与开销。进一步地,在参考节点满足剔除条件时,通过全局位姿构建中间转换链路,实现坐标变换,将相对约束无损迁移至替代节点,保证了迁移前后空间对象在全局坐标系下的位置恒定性,使得空间对象的存续不再依赖于参考节点的生命周期,解决了为保留空间对象而强制保留冗余节点导致的地图存储膨胀问题,实现了对象状态管理与地图节点资源管理的完全解耦。此外,通过集中式的非阻塞式关联索引管理,避免了在每个地图节点内嵌对象容器造成的内存碎片与释放阻塞,配合持久化重建与多地图标识同步机制,确保了空间对象在地图保存、加载及合并过程中的关联鲁棒性与归属准确性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com