基于改進(jìn)李群非線性優(yōu)化的行車吊臂空間位姿測量方法
基本信息
申請?zhí)?/td> | CN202010304889.8 | 申請日 | - |
公開(公告)號 | CN111681279A | 公開(公告)日 | 2020-09-18 |
申請公布號 | CN111681279A | 申請公布日 | 2020-09-18 |
分類號 | G06T7/70(2017.01)I | 分類 | - |
發(fā)明人 | 牛丹;傅星瑜;李奇;陳夕松;李世華;楊俊;劉進(jìn)波 | 申請(專利權(quán))人 | 南京聞望自動化有限公司 |
代理機(jī)構(gòu) | 南京蘇高專利商標(biāo)事務(wù)所(普通合伙) | 代理人 | 東南大學(xué);南京科遠(yuǎn)智慧科技集團(tuán)股份有限公司;南京聞望自動化有限公司 |
地址 | 211189江蘇省南京市江寧區(qū)東南大學(xué)路2號 | ||
法律狀態(tài) | - |
摘要
摘要 | 本發(fā)明公開了一種基于改進(jìn)李群非線性優(yōu)化的行車吊臂空間位姿測量方法,包括:S1:利用相機(jī)采集合作四個呈矩形分布的靶標(biāo)目標(biāo)點(diǎn),并對采集到的圖像中紅外光標(biāo)提取四個重心坐標(biāo);S2:對采集相機(jī)進(jìn)行內(nèi)外參數(shù)標(biāo)定,確定成像中心、畸變系數(shù),對步驟S1采集到的圖像做成像畸變參數(shù)矯正;S3:將相機(jī)與合作靶標(biāo)的相對位姿問題轉(zhuǎn)換為最小化重投影問題;S4:利用EPNP法計算相機(jī)相對位姿初始旋轉(zhuǎn)矩陣和平移量;S5:利用高斯牛頓法進(jìn)行非線性迭代后最終收斂到真實(shí)解,得到旋轉(zhuǎn)矩陣和平移量。本發(fā)明不僅提高了測量結(jié)果的精度,還提高了檢測和計算速度,可以進(jìn)行快速的目標(biāo)檢測和空間參數(shù)獲取,提升了無人行車吊臂空間角度測量的實(shí)時性和準(zhǔn)確性。?? |
