LocalMapping

CreateNewMapPoints()共視程度較高的關(guān)鍵幀通過(guò)三角化恢復(fù)一些MapPoints

  • 在當(dāng)前關(guān)鍵幀的共視關(guān)鍵幀中找到共視程度最高的nn幀相鄰幀vpNeighKFs
  • 遍歷相鄰關(guān)鍵幀
    • 這個(gè)過(guò)程很耗時(shí),如果有新的關(guān)鍵幀需要處理就return
    • 根據(jù)兩個(gè)關(guān)鍵幀位姿計(jì)算他們之間的基本矩陣
      -SearchForTriangulation通過(guò)極線約束限制匹配時(shí)的搜索范圍,進(jìn)行特征點(diǎn)匹配
    • 通過(guò)三角化生成3D點(diǎn)歼冰,生成之后還為該點(diǎn)添加屬性:觀測(cè)到該店的關(guān)鍵幀,描述子褪那,平均觀測(cè)方向和深度范圍

SearchForTriangulation通過(guò)極線約束限制匹配時(shí)的搜索范圍,進(jìn)行特征點(diǎn)匹配

  • 將屬于同一節(jié)點(diǎn)的ORB特征進(jìn)行匹配
    這里和SearchbyBow差不多式塌,如果同屬于同意節(jié)點(diǎn)則遍歷第一幀該節(jié)點(diǎn)中的特征點(diǎn)博敬,每個(gè)特征點(diǎn)和該節(jié)點(diǎn)中第二幀特征點(diǎn)的描述子計(jì)算距離進(jìn)行匹配。
  • 和其他匹配不同的是峰尝,這里還利用基礎(chǔ)矩陣計(jì)算特征點(diǎn)kp2到kp1極線(kp1對(duì)應(yīng)pKF2的一條極線)的距離是否小于閾值
  • 匹配過(guò)程還對(duì)旋轉(zhuǎn)進(jìn)行直方圖統(tǒng)計(jì)偏窝,去除直方圖中值最大的三個(gè)index,剔除除這三個(gè)最大index的特征點(diǎn)武学。因?yàn)閮蓭瑘D像之間的匹配點(diǎn)旋轉(zhuǎn)應(yīng)該是相同的

三角法恢復(fù)特征點(diǎn)

已知兩幀圖像相機(jī)位姿和兩幀圖像對(duì)應(yīng)匹配點(diǎn)xx'祭往,恢復(fù)出世界點(diǎn)在三維世界的坐標(biāo)。
已知點(diǎn)xx'和兩個(gè)圖像的投影矩陣PP',根據(jù)相機(jī)投影模型火窒,對(duì)應(yīng)3D點(diǎn)X滿足:
x=PX\ \ \ \ \ \ \ x'=P'X
三角法使用的是直接線性變化(DLT)對(duì)點(diǎn)的世界坐標(biāo)進(jìn)行求解硼补。使用DLT需要改成AX=0的形式。利用外積的性質(zhì):
x×(PX)=0\ \ \ \ \ \ x'×(P'X)=0
在按照十四講中方法外積可以改寫(xiě)成
\begin{equation} \begin{bmatrix} 0 & -1 & y\\ 1 & 0 & -x\\ -y & x & 0 \end{bmatrix} \begin{bmatrix} P^{1T}X\\P^{2T}X\\P^{3T}X \end{bmatrix} = 0 \end{equation}
即:\begin{equation} \begin{split} x(P^{3T}X)-(P^{1T}X)=0\\ y(P^{3T}X)-(P^{2T}X)=0\\ x(P^{2T}X)-y(P^{1T}X)=0\\ \end{split} \end{equation}
可見(jiàn)第三個(gè)式子可以由上兩個(gè)式子線性表示沛鸵,所以只需要取前連個(gè)式子即可括勺,從而有形如AX=0的方程缆八,其中:
\begin{equation} A =\begin{bmatrix} xP^{3T}-P^{1T}\\ yP^{3T}-P^{2T}\\ x'P'^{3T}-P'^{1T}\\ y'P'^{3T}-P'^{2T}\\ \end{bmatrix} \end{equation}
對(duì)A進(jìn)行SVD分解曲掰,方程的解為A的最小奇異值對(duì)應(yīng)的單位奇異矢量,解得X=(x,y,z,w)奈辰,則最后令X縮放使得的最后一項(xiàng)為1即可得到我們所求的3D點(diǎn)X的坐標(biāo)栏妖。

最后編輯于
?著作權(quán)歸作者所有,轉(zhuǎn)載或內(nèi)容合作請(qǐng)聯(lián)系作者
  • 序言:七十年代末,一起剝皮案震驚了整個(gè)濱河市奖恰,隨后出現(xiàn)的幾起案子吊趾,更是在濱河造成了極大的恐慌,老刑警劉巖瑟啃,帶你破解...
    沈念sama閱讀 218,451評(píng)論 6 506
  • 序言:濱河連續(xù)發(fā)生了三起死亡事件论泛,死亡現(xiàn)場(chǎng)離奇詭異,居然都是意外死亡蛹屿,警方通過(guò)查閱死者的電腦和手機(jī)屁奏,發(fā)現(xiàn)死者居然都...
    沈念sama閱讀 93,172評(píng)論 3 394
  • 文/潘曉璐 我一進(jìn)店門(mén),熙熙樓的掌柜王于貴愁眉苦臉地迎上來(lái)错负,“玉大人坟瓢,你說(shuō)我怎么就攤上這事勇边。” “怎么了折联?”我有些...
    開(kāi)封第一講書(shū)人閱讀 164,782評(píng)論 0 354
  • 文/不壞的土叔 我叫張陵粒褒,是天一觀的道長(zhǎng)。 經(jīng)常有香客問(wèn)我诚镰,道長(zhǎng)奕坟,這世上最難降的妖魔是什么? 我笑而不...
    開(kāi)封第一講書(shū)人閱讀 58,709評(píng)論 1 294
  • 正文 為了忘掉前任清笨,我火速辦了婚禮执赡,結(jié)果婚禮上,老公的妹妹穿的比我還像新娘函筋。我一直安慰自己沙合,他們只是感情好,可當(dāng)我...
    茶點(diǎn)故事閱讀 67,733評(píng)論 6 392
  • 文/花漫 我一把揭開(kāi)白布跌帐。 她就那樣靜靜地躺著首懈,像睡著了一般。 火紅的嫁衣襯著肌膚如雪谨敛。 梳的紋絲不亂的頭發(fā)上究履,一...
    開(kāi)封第一講書(shū)人閱讀 51,578評(píng)論 1 305
  • 那天,我揣著相機(jī)與錄音脸狸,去河邊找鬼最仑。 笑死,一個(gè)胖子當(dāng)著我的面吹牛炊甲,可吹牛的內(nèi)容都是我干的泥彤。 我是一名探鬼主播,決...
    沈念sama閱讀 40,320評(píng)論 3 418
  • 文/蒼蘭香墨 我猛地睜開(kāi)眼卿啡,長(zhǎng)吁一口氣:“原來(lái)是場(chǎng)噩夢(mèng)啊……” “哼吟吝!你這毒婦竟也來(lái)了?” 一聲冷哼從身側(cè)響起颈娜,我...
    開(kāi)封第一講書(shū)人閱讀 39,241評(píng)論 0 276
  • 序言:老撾萬(wàn)榮一對(duì)情侶失蹤剑逃,失蹤者是張志新(化名)和其女友劉穎,沒(méi)想到半個(gè)月后官辽,有當(dāng)?shù)厝嗽跇?shù)林里發(fā)現(xiàn)了一具尸體蛹磺,經(jīng)...
    沈念sama閱讀 45,686評(píng)論 1 314
  • 正文 獨(dú)居荒郊野嶺守林人離奇死亡,尸身上長(zhǎng)有42處帶血的膿包…… 初始之章·張勛 以下內(nèi)容為張勛視角 年9月15日...
    茶點(diǎn)故事閱讀 37,878評(píng)論 3 336
  • 正文 我和宋清朗相戀三年同仆,在試婚紗的時(shí)候發(fā)現(xiàn)自己被綠了萤捆。 大學(xué)時(shí)的朋友給我發(fā)了我未婚夫和他白月光在一起吃飯的照片。...
    茶點(diǎn)故事閱讀 39,992評(píng)論 1 348
  • 序言:一個(gè)原本活蹦亂跳的男人離奇死亡,死狀恐怖鳖轰,靈堂內(nèi)的尸體忽然破棺而出清酥,到底是詐尸還是另有隱情,我是刑警寧澤蕴侣,帶...
    沈念sama閱讀 35,715評(píng)論 5 346
  • 正文 年R本政府宣布焰轻,位于F島的核電站,受9級(jí)特大地震影響昆雀,放射性物質(zhì)發(fā)生泄漏辱志。R本人自食惡果不足惜,卻給世界環(huán)境...
    茶點(diǎn)故事閱讀 41,336評(píng)論 3 330
  • 文/蒙蒙 一狞膘、第九天 我趴在偏房一處隱蔽的房頂上張望揩懒。 院中可真熱鬧,春花似錦挽封、人聲如沸已球。這莊子的主人今日做“春日...
    開(kāi)封第一講書(shū)人閱讀 31,912評(píng)論 0 22
  • 文/蒼蘭香墨 我抬頭看了看天上的太陽(yáng)智亮。三九已至,卻和暖如春点待,著一層夾襖步出監(jiān)牢的瞬間阔蛉,已是汗流浹背。 一陣腳步聲響...
    開(kāi)封第一講書(shū)人閱讀 33,040評(píng)論 1 270
  • 我被黑心中介騙來(lái)泰國(guó)打工癞埠, 沒(méi)想到剛下飛機(jī)就差點(diǎn)兒被人妖公主榨干…… 1. 我叫王不留状原,地道東北人。 一個(gè)月前我還...
    沈念sama閱讀 48,173評(píng)論 3 370
  • 正文 我出身青樓苗踪,卻偏偏與公主長(zhǎng)得像颠区,于是被迫代替她去往敵國(guó)和親。 傳聞我的和親對(duì)象是個(gè)殘疾皇子徒探,可洞房花燭夜當(dāng)晚...
    茶點(diǎn)故事閱讀 44,947評(píng)論 2 355

推薦閱讀更多精彩內(nèi)容