orbslam2 localMapping流程图

flowchart TB

%% ========== 1. 入口 & 初始化检测 ==========

T0"Track() 入口"

T1{{mState == NO_IMAGES_YET?}}

T2"mState ← NOT_INITIALIZED"

%% ========== 2. 获取地图互斥锁 ==========

LOCK"unique_lock(mpMap-\>mMutexMapUpdate)"

%% ========== 3. 尚未初始化 ==========

INIT_CHK{{mState == NOT_INITIALIZED?}}

STEREO_INIT"StereoInitialization() / MonocularInitialization()"

DRAW_INIT"mpFrameDrawer-\>Update(this)"

RET_NOT_OK{{初始化后 mState != OK?}}

RET_EARLY"return (等待下一帧)"

%% ========== 4. 系统已初始化 ==========

MAIN"-- 进入正常跟踪流程 --"

ONLY_TRACK{{mbOnlyTracking?}}

REPLACED"CheckReplacedInLastFrame()"

MM_EMPTY{{mVelocity.empty()?}}

TRACK_MM"TrackWithMotionModel()"

RELOC"Relocalization()"

BOOL_OR"bOK = bOK_MM ∥ bOK_Reloc"

SET_REF"若缺失, mpReferenceKF → mCurrentFrame.mpReferenceKF"

%% ========== 5. 局部地图跟踪 ==========

LOCAL_TRACK_CHK{{可调用 TrackLocalMap?}}

LOCAL_TRACK"bOK = TrackLocalMap()"

%% ========== 6. 跟踪结果判定 ==========

SET_STATE"mState = (bOK ? OK : LOST)"

DRAW_FRAME"mpFrameDrawer-\>Update(this)"

%% ========== 7. 跟踪成功后的更新 ==========

OK_CHK{{bOK?}}

UPDATE_VEL"mVelocity ← Tcw_now × (Tcw_last)\^-1"

SET_CAMPOSE"mpMapDrawer-\>SetCurrentCameraPose()"

CLEAN_VO"清空仅 VO 匹配点"

DEL_TEMP"删除 mlpTemporalPoints"

NEEDKF{{NeedNewKeyFrame()?}}

NEWKF"CreateNewKeyFrame()"

%% ========== 8. 跟踪失败后的处理 ==========

LOST_CHK{{mState == LOST ∧ Map KFs ≤ 5?}}

SYS_RESET"mpSystem-\>Reset(); return"

%% ========== 9. 收尾:更新 mLastFrame 等 ==========

FILL_REFKF"若仍缺失 → mCurrentFrame.mpReferenceKF = mpReferenceKF"

SAVE_LAST"mLastFrame = Frame(mCurrentFrame)"

STORE_POSE"记录相对位姿 / 时间戳向量"

%% ---------- 连线 ----------

T0 --> T1

T1 -- 是 --> T2 --> LOCK

T1 -- 否 --> LOCK

LOCK --> INIT_CHK

INIT_CHK -- 是 --> STEREO_INIT --> DRAW_INIT --> RET_NOT_OK

RET_NOT_OK -- 是 --> RET_EARLY

RET_NOT_OK -- 否 --> MAIN

INIT_CHK -- 否 --> MAIN

%% ---- 正常跟踪主干 ----

MAIN --> ONLY_TRACK

ONLY_TRACK -- 否 -->|LocalMapping 开启| \

REPLACED --> MM_EMPTY

ONLY_TRACK -- 是 -->|仅跟踪模式| MM_EMPTY

MM_EMPTY -- 否 --> TRACK_MM

MM_EMPTY -- 是 --> TRACK_MM

TRACK_MM --> RELOC

RELOC --> BOOL_OR

BOOL_OR --> SET_REF

SET_REF --> LOCAL_TRACK_CHK

LOCAL_TRACK_CHK -- 可调用 --> LOCAL_TRACK --> SET_STATE

LOCAL_TRACK_CHK -- 不可调用 --> SET_STATE

SET_STATE --> DRAW_FRAME --> OK_CHK

%% ---- 跟踪成功路径 ----

OK_CHK -- 是 --> UPDATE_VEL --> SET_CAMPOSE --> CLEAN_VO --> DEL_TEMP --> NEEDKF

NEEDKF -- 是 --> NEWKF --> LOST_CHK

NEEDKF -- 否 --> LOST_CHK

%% ---- 跟踪失败路径 ----

OK_CHK -- 否 --> LOST_CHK

LOST_CHK -- 是 --> SYS_RESET

LOST_CHK -- 否 --> FILL_REFKF --> SAVE_LAST --> STORE_POSE

相关推荐
斯普信专业组16 天前
Kafka 消费者 poll() 流程与原理详解
kafka·流程图
学IT的周星星22 天前
LangGraph:用「流程图」的方式编排 Agent
数据库·人工智能·大模型·llm·流程图·agent
钛生智能22 天前
OA 流程定制全参数详解(十):画流程图与美化——从“能跑”到“好看”的最后一公里
流程图·办公自动化·oa·协同办公·oa办公系统
ixiaoyang81 个月前
ioDraw v3.7.0 发布:AI 助手完成会话化改造,图表生成一次升级
ai·流程图·甘特图·思维导图·绘图软件·1024程序员节·mermaid
神色自若1 个月前
Net10 Avalonia UI漂亮美观的流程图设计器重磅开源了
流程图
Keith Guo1 个月前
ESP32-S31 分区表的访问流程图
流程图·esp32
学术 学术 Fun1 个月前
AI 流程图图片怎样变成可编辑文件?先修文字,再核对逻辑
流程图
学术 学术 Fun1 个月前
截图转可编辑 PPT:旧流程图改步骤,不再靠白色方块遮字
powerpoint·流程图
tedcloud1231 个月前
Docker Compose 部署 Immich:手机照片自动备份与常见故障排查
运维·前端·docker·容器·智能手机·开源·流程图
weixin_416660071 个月前
AI 生成的 Mermaid 流程图和 LaTeX 公式,怎么一起导出到 Word?
人工智能·word·流程图·豆包