[實用新型]一種機器人航向測定裝置及包含該裝置的機器人

有效

• 申請號: 201520026019.3
• 申請日: 2015-01-14
• 公開（公告）號: CN204329976U
• 公開（公告）日: 2015-05-13
• 發明（設計）人: 章征貴
• 申請（專利權）人: 上海物景智能科技有限公司
• 主分類號: G01C21/16
• 分類號: G01C21/16
• 代理公司: 上海碩力知識產權代理事務所 31251
• 代理人: 郭桂峰

技術領域

本實用新型涉及機器人領域，尤其涉及一種機器人定位裝置。

背景技術

隨著科學技術的不斷發展，機器人在工業自動化領域中的應用日趨廣泛，例如各種工業機器手、工業自動化生產線等。但是當需要圍繞目標主體進行作業時，固定式的機器人將不能滿足要求，此時移動機器人以其具有大范圍活動能力的優點將可以完成任務。

移動機器人在進行現場作業時需要在一個空間中按照規劃的路線進行移動，掌握機器人在移動時的位置信息尤為關鍵，這就涉及到機器人的定位技術。

從使用場景來看，定位技術分為室外定位導航技術和室內定位導航技術。室外定位導航通常會使用全球定位系統(Global?Positioning?System，以下簡稱GPS)技術以及其他定位導航技術。室內定位通常沒有GPS信號，且往往要求比室外定位具有更高的精度，因此目前室內定位導航技術通常會使用到無線保真(WIreless-FIdelity，簡稱WI-FI)、射頻識別(Radio?Frequency?Identification，簡稱RFID)技術、視覺、慣性等定位導航技術，或者使用多種技術進行融合定位。當使用慣性定位導航的技術時，航向測定在機器人定位與導航系統中扮演著十分重要的角色，精確的航向測定為機器人精度定位提供了保證。

實用新型內容

本實用新型要解決的技術問題是提供一種機器人航向測定裝置及包含該裝置的機器人，能夠獲得機器人精準的航向信息。

本實用新型采用的技術方案是：

一種機器人航向測定裝置，包括傳感器模塊和主控芯片，傳感器模塊包括加速度計、陀螺儀和磁力計；

加速度計測量機器人運動時的線加速度；陀螺儀測量機器人運動時的角加速度；磁力計測量機器人運動時的地磁場強度；

加速度計、陀螺儀和磁力計分別與主控芯片連接并分別發送測量的數據至主控芯片；

主控芯片對接收的測量數據進行預處理并融合預處理后的數據獲得機器人的航向。

進一步優選地，還包括供電設備，供電設備與主控芯片連接。

進一步優選地，加速度計、陀螺儀和磁力計為三軸。

進一步優選地，加速計、陀螺儀、磁力計為相互獨立或任意方式集成在一起。

進一步優選地，加速度計和陀螺儀選用MPU-6050模塊，MPU-6050模塊同時集合了加速度計和陀螺儀。

進一步優選地，磁力計選用HMC5883L模塊。

進一步優選地，加速計、陀螺儀、磁力計通過集成電路總線(Inter-Integrated?Circuit，以下簡稱IIC)接口連接到主控芯片上。

本實用新型還提供了一種機器人，其包含上述一種機器人航向測定裝置。

本實用新型通過加速度計、陀螺儀和磁力計采集機器人運動時的數據并傳送到主控芯片，主控芯片對采集到的數據進行計算融合處理得到機器人的航向信息。本實用新型融合了加速度計、陀螺儀、磁力計三者采集的數據，比單一地使用加速度計或陀螺儀或磁力計估算航向的方法更精確、可靠，而且對傳感器要求較低、對傳感器數據采樣率要求較低，具有更優的技術效果。

附圖說明

下面結合附圖和具體實施方式對本實用新型作進一步詳細說明：

圖1為本實用新型一種機器人航向測定裝置結構框圖；

圖2為本實用新型中機器人圍繞矩形區域行走一圈的航向變化圖。

附圖標號：

100.傳感器模塊，101.加速度計，102.陀螺儀，103.磁力計，200.主控芯片。

具體實施方式

為了更清楚地說明本實用新型實施例或現有技術中的技術方案，下面將對實施例或現有技術描述中所需要使用的附圖作簡單地介紹，顯而易見地，下面描述中的附圖僅僅是本實用新型的一些實施例，對于本領域普通技術人員來說，在不付出創造性勞動的前提下，還可以根據這些附圖獲得其他的附圖。

圖1為本實用新型一種機器人航向測定裝置結構框圖，作為本實用新型的一個具體實施例一，一種機器人航向測定裝置，包括傳感器模塊和主控芯片。

傳感器模塊100包括加速度計101、陀螺儀102和磁力計103；

加速度計101測量機器人運動時的線加速度；陀螺儀102測量機器人運動時的角加速度；磁力計103測量機器人運動時的地磁場強度；

加速度計101、陀螺儀102和磁力計103分別與主控芯片200連接并分別發送測量的數據至主控芯片200；