Skip to content

feat(localization): 初始化与丢失重定位 #9

@creeper5820

Description

@creeper5820

对于丢失重定位,我们可以维护一个坐标历史队列,当察觉到定位漂移时,选取历史坐标中置信度最高的作为初始解进行重定位

设想中的检测条件有:

  • Odom 协方差
  • 非运动状态下坐标仍在变化
  • 短时间内坐标做出了超出物理学的变化幅度
  • 超出场地范围,到达了不可能到达的地方

Metadata

Metadata

Labels

enhancementNew feature or request

Projects

Status

In progress

Milestone

No milestone

Relationships

None yet

Development

No branches or pull requests

Issue actions