[發明專利]一種機器人位姿確定方法、裝置、可讀存儲介質及機器人

有效

• 申請號: 202010054418.6
• 申請日: 2020-01-17
• 公開（公告）號: CN111319041B
• 公開（公告）日: 2021-04-16
• 發明（設計）人: 白龍彪;劉志超;龐建新;熊友軍
• 申請（專利權）人: 深圳市優必選科技股份有限公司
• 主分類號: B25J9/16
• 分類號: B25J9/16;B25J13/08
• 代理公司: 深圳中一聯合知識產權代理有限公司 44414
• 代理人: 劉永康

本申請屬于機器人技術領域，尤其涉及一種機器人位姿確定方法、裝置、計算機可讀存儲介質及機器人。所述方法獲取當前時刻的相機位姿，所述相機位姿為機器人的相機在視覺SLAM坐標系下的位姿；根據所述當前時刻的相機位姿計算原始的機器人位姿，所述機器人位姿為所述機器人在里程計坐標系下的位姿；將所述原始的機器人位姿投影至所述機器人的行進路徑上，得到校正的機器人位姿。通過本申請，可以實時計算得到機器人在任一時刻的位姿，從而得到連續的位姿信息，使得腿式機器人也可以適用于常見的ROS局部路徑規劃算法。

技術領域

本申請屬于機器人技術領域，尤其涉及一種機器人位姿確定方法、裝置、計算機可讀存儲介質及機器人。

背景技術

腿式機器人的自主導航是其實現智能化服務的關鍵支撐技術，而有效的自主導航需要建立在穩定可靠定位的基礎上，腿式機器人與輪式機器人在運動過程中的一個明顯的區別是，輪式機器人是比較平穩順滑的移動，而腿式機器人在行走中有比較顯著的左右晃動過程，且僅在某一足落地時才更新機器人位姿，從而導致得到的位姿是離散的、非實時的，無法適用常見的ROS局部路徑規劃算法。

發明內容

有鑒于此，本申請實施例提供了一種機器人位姿確定方法、裝置、計算機可讀存儲介質及機器人，以解決現有的腿式機器人的位姿確定方法得到的位姿是離散的、非實時的，無法適用常見的ROS局部路徑規劃算法的問題。

本申請實施例的第一方面提供了一種機器人位姿確定方法，可以包括：

獲取當前時刻的相機位姿，所述相機位姿為機器人的相機在視覺SLAM坐標系下的位姿；

根據所述當前時刻的相機位姿計算原始的機器人位姿，所述機器人位姿為所述機器人在里程計坐標系下的位姿；

將所述原始的機器人位姿投影至所述機器人的行進路徑上，得到校正的機器人位姿。

進一步地，所述根據所述當前時刻的相機位姿計算原始的機器人位姿包括：

獲取所述當前時刻之前的各組歷史位姿數據，其中，每組歷史位姿數據均包括同一時刻的相機位姿和機器人位姿；

根據所述各組歷史位姿數據計算第一轉換矩陣，所述第一轉換矩陣為從所述視覺SLAM坐標系至所述里程計坐標系的轉換矩陣；

將所述當前時刻的相機位姿變換為第二轉換矩陣，所述第二轉換矩陣為從相機坐標系至所述視覺SLAM坐標系的轉換矩陣；

根據所述第一轉換矩陣、所述第二轉換矩陣和預設的第三轉換矩陣計算第四轉換矩陣，所述第三轉換矩陣為從機器人坐標系至所述相機坐標系的轉換矩陣，所述第四轉換矩陣為從所述機器人坐標系至所述里程計坐標系的轉換矩陣；

將所述第四轉換矩陣變換為所述原始的機器人位姿。

進一步地，在將所述原始的機器人位姿投影至所述機器人的行進路徑上之前，還包括：

獲取所述機器人在第一落腳時刻的第一中心位置和速度控制指令，所述第一落腳時刻為所述當前時刻之前的第一個落腳時刻；

根據所述第一中心位置和所述速度控制指令確定所述機器人在第二落腳時刻的第二中心位置，所述第二落腳時刻為所述當前時刻之后的第一個落腳時刻；

將由所述第一中心位置至所述第二中心位置的路徑確定為所述機器人的行進路徑。

進一步地，所述根據所述第一中心位置和所述速度控制指令確定所述機器人在第二落腳時刻的第二中心位置包括：

若所述速度控制指令中的速度為0，且角速度不為0時，則根據預設的原地旋轉模型確定所述第二中心位置。

進一步地，所述根據所述第一中心位置和所述速度控制指令確定所述機器人在第二落腳時刻的第二中心位置包括：