一種基于激光雷達(dá)的機(jī)器人精確姿態(tài)矯正方法及裝置
基本信息
申請?zhí)?/td> | CN201911180747.9 | 申請日 | - |
公開(公告)號 | CN111060131B | 公開(公告)日 | 2021-08-10 |
申請公布號 | CN111060131B | 申請公布日 | 2021-08-10 |
分類號 | G01C25/00(2006.01)I | 分類 | 測量;測試; |
發(fā)明人 | 彭倍;王龍;曾博才;包楊川;何明 | 申請(專利權(quán))人 | 四川阿泰因機(jī)器人智能裝備有限公司 |
代理機(jī)構(gòu) | 四川力久律師事務(wù)所 | 代理人 | 林秋雅 |
地址 | 610000四川省成都市天府新區(qū)華陽街道天府大道南段846號 | ||
法律狀態(tài) | - |
摘要
摘要 | 本發(fā)明涉及一種基于激光雷達(dá)的機(jī)器人精確姿態(tài)矯正方法及裝置,其中方法包括:采集機(jī)器人周圍環(huán)境的點(diǎn)云信息數(shù)據(jù),所述周圍環(huán)境包括平整墻面;將所述點(diǎn)云信息數(shù)據(jù)轉(zhuǎn)換成二維笛卡爾坐標(biāo)數(shù)據(jù);從所述二維笛卡爾坐標(biāo)數(shù)據(jù)提取參考點(diǎn)云的坐標(biāo)數(shù)據(jù);對所述參考點(diǎn)云的坐標(biāo)數(shù)據(jù)進(jìn)行線性擬合,得到擬合直線段;根據(jù)所述擬合直線段的斜率得到機(jī)器人當(dāng)前姿態(tài)的角度值;將所述機(jī)器人當(dāng)前姿態(tài)的角度值與標(biāo)準(zhǔn)設(shè)定值進(jìn)行比較,得到比較差值,基于所述比較差值利用PID控制算法計(jì)算得到矯正值,基于所述矯正值對機(jī)器人進(jìn)行姿態(tài)矯正。本發(fā)明利用激光雷達(dá)采集點(diǎn)云數(shù)據(jù)并進(jìn)行處理,能夠準(zhǔn)確得到機(jī)器人當(dāng)前姿態(tài),利用PID控制算法能夠精確快速的矯正機(jī)器人姿態(tài)。 |
