極簡(jiǎn)版VO

https://github.com/avisingh599/mono-vo

主要過程:

1. 通過FAST提取特征

FAST(img_1, keypoints_1, fast_threshold, nonmaxSuppression);

2. 利用稀疏光流,追蹤到相鄰幀的對(duì)應(yīng)特征點(diǎn)

calcOpticalFlowPyrLK(img_1, img_2, points1, points2, status, err, winSize, 3, termcrit, 0, 0.001);

3. 利用特征點(diǎn)對(duì)恢復(fù)本質(zhì)矩陣

E = findEssentialMat(currFeatures, prevFeatures, focal, pp, RANSAC, 0.999, 1.0, mask);

4. 利用本質(zhì)矩陣恢復(fù)R、t

recoverPose(E, currFeatures, prevFeatures, R, t, focal, pp, mask);

5. 結(jié)合scale,迭代計(jì)算相對(duì)起始幀的R_f、t_f,輸出最終軌跡t_f

t_f = t_f + scale*(R_f*t);

?R_f = R_f*R;?

最后編輯于
?著作權(quán)歸作者所有,轉(zhuǎn)載或內(nèi)容合作請(qǐng)聯(lián)系作者
【社區(qū)內(nèi)容提示】社區(qū)部分內(nèi)容疑似由AI輔助生成,瀏覽時(shí)請(qǐng)結(jié)合常識(shí)與多方信息審慎甄別。
平臺(tái)聲明:文章內(nèi)容(如有圖片或視頻亦包括在內(nèi))由作者上傳并發(fā)布,文章內(nèi)容僅代表作者本人觀點(diǎn),簡(jiǎn)書系信息發(fā)布平臺(tái),僅提供信息存儲(chǔ)服務(wù)。

友情鏈接更多精彩內(nèi)容