[發明專利]田間機器人的導航方法及設備

有效

• 申請號: 201310217996.7
• 申請日: 2013-06-04
• 公開（公告）號: CN104216405B
• 公開（公告）日: 2017-12-29
• 發明（設計）人: 張志斌;王海旭;劉占;劉雙雙;徐曉東
• 申請（專利權）人: 內蒙古大學
• 主分類號: G05D1/02
• 分類號: G05D1/02
• 代理公司: 北京弘權知識產權代理事務所(普通合伙)11363
• 代理人: 陳蕾,許偉群

1.一種田間機器人的導航方法，其特征在于，所述方法包括：

接收GPS數據；

根據所述GPS數據獲取所述田間機器人的當前位置；

判斷所述田間機器人的當前位置是否在預設路徑上；

若所述當前位置不在預設路徑上，則獲取所述田間機器人當前加速度信息；

根據所述當前加速度信息，獲取所述田間機器人當前位姿；

根據所述當前位姿調整所述田間機器人的前進方向，以使所述田間機器人的行駛路徑與所述預設路徑重合。

2.根據權利要求1所述的方法，其特征在于，根據所述GPS數據獲取所述田間機器人當前位置具體包括：

讀取GPS數據；

判斷所述GPS數據是否是一條可用的數據；

若是可用數據，則從所述GPS數據中獲取定位信息；

存儲所述定位信息，所述定位信息即所述田間機器人當前位置。

3.根據權利要求1所述的方法，其特征在于，所述預設路徑根據首次獲取的所述田間機器人的當前位置為初始位置來設置，其中，所述預設路徑為直線。

4.根據權利要求1所述的方法，其特征在于，獲取所述田間機器人當前加速度信息具體包括：

通過三軸加速度傳感器獲取所述田間機器人在三個方向上的加速度信息，所述三個方向兩兩垂直且構成右手坐標系，且其中一個方向的正方向與所述田間機器人的前進方向一致。

5.根據權利要求4所述的方法，其特征在于，根據所述當前加速度信息，獲取所述田間機器人當前位姿，具體包括：

根據所述加速度值與重力加速度之間的關系，獲取所述田間機器人當前的傾斜角，所述傾斜角指示所述田間機器人的當前位姿。

6.根據權利要求1-5任一項所述的方法，其特征在于，所述方法還包括：

顯示至少一種下述信息：電子地圖、預設路徑、坐標、所述田間機器人當前位置、當前位姿，以及當前位置與預設路徑的差值，其中，所述坐標包括經緯度坐標和平面坐標。

7.一種田間機器人的導航設備，其特征在于，所述設備包括：

GPS接收機，用于接收GPS數據；

處理器，用于根據所述GPS數據獲取所述田間機器人的當前位置；

所述處理器還用于判斷所述田間機器人的當前位置是否在預設路徑上；

三軸加速度傳感器，用于若所述當前位置不在預設路徑上，則獲取所述田間機器人當前加速度信息；

所述處理器還用于根據所述當前加速度信息，獲取所述田間機器人當前位姿；

所述處理器還用于根據所述當前位姿調整所述田間機器人的前進方向，以使所述田間機器人的行駛路徑與所述預設路徑重合。

8.根據權利要求7所述的設備，其特征在于，所述處理器包括：

讀取單元，用于讀取所述GPS數據；

判斷單元，用于判斷所述GPS數據是否是一條可用的數據；

處理單元，用于若是一條可用的GPS數據，則從中獲取定位信息；

存儲單元，用于存儲所述定位信息，所述定位信息即所述田間機器人當前位置。

9.根據權利要求7所述的設備，其特征在于，所述預設路徑根據首次獲取的所述田間機器人的當前位置為初始位置來設置，其中，所述預設路徑為直線。

10.根據權利要求7所述的設備，其特征在于，所述三軸加速度傳感器具體用于：獲取所述田間機器人在三個方向上的加速度信息，所述三個方向兩兩垂直且構成右手坐標系，且其中一個方向的正方向與所述田間機器人的前進方向一致。

11.根據權利要求10所述的設備，其特征在于，所述處理器還包括：

位姿獲取單元，用于根據所述加速度值與重力加速度之間的關系，獲取所述田間機器人當前的傾斜角，所述傾斜角指示所述田間機器人當前位姿。

12.根據權利要求7至11任一項所述的設備，其特征在于，所述設備還包括：

顯示單元，用于顯示至少一種下述信息：電子地圖、預設路徑、坐標，所述田間機器人當前位置、當前位姿，以及當前位置與預設路徑的差值，其中，所述坐標包括經緯度坐標和平面坐標。