[發明專利]一種控制運動車體的方法及裝置

有效

• 申請號: 201510256692.0
• 申請日: 2015-05-19
• 公開（公告）號: CN105589460B
• 公開（公告）日: 2019-07-12
• 發明（設計）人: 王維;史美萍;李焱;王全;謝奇
• 申請（專利權）人: 中國人民解放軍國防科學技術大學
• 主分類號: G05D1/02
• 分類號: G05D1/02
• 代理公司: 北京弘權知識產權代理事務所(普通合伙) 11363
• 代理人: 逯長明;許偉群

本發明是關于一種控制運動車體的方法及裝置，包括：獲取運動車體的當前的運動狀態；判斷是否接收到對模擬操控裝置的控制操作；當接收到控制操作時，獲取運動車體的當前位置，以及根據控制操作和當前的運動狀態生成運動車體的目標運動狀態；根據目標運動狀態計算運動車體以當前位置為起點每運動相同路程長度的路程時的目標位置；根據目標位置生成控制指令；發送控制指令給運動車體，以使運動車體根據控制指令進行運動。如此，根據本發明的方法可以實現對無人車進行控制。

技術領域

本發明涉及計算機技術領域，尤其涉及一種控制運動車體的方法及裝置。

背景技術

無人駕駛車輛泛指車上無人、具備一定自主駕駛能力的地面無人駕駛車輛系統，簡稱無人車，既包括無人駕駛汽車，也包括小型地面移動機器人。無人車在軍用等眾多領域內具有廣闊的應用前景。

然而，目前還沒有一種控制無人車運動的方法，因此如何對無人車的運動進行控制是一個亟待解決的技術問題。

發明內容

為克服相關技術中存在的問題，本發明提供一種控制運動車體的方法及裝置。

根據本發明實施例的第一方面，提供一種控制運動車體的方法，所述方法包括：

獲取運動車體的當前的運動狀態；當前的運動狀態包括所述運動車體的當前的前輪轉向角度、所述運動車體的當前的運動速度以及所述運動車體的當前的運動加速度；

判斷是否接收到對模擬操控裝置的控制操作；

當接收到所述控制操作時，獲取所述運動車體的當前位置，以及根據所述控制操作和所述當前的運動狀態生成運動車體的目標運動狀態；目標運動狀態包括所述運動車體的目標前輪轉向角度、所述運動車體的當前的運動速度以及所述運動車體的目標運動加速度；

根據所述目標運動狀態計算所述運動車體以所述當前位置為起點每運動相同路程長度的路程時的目標位置；

根據所述目標位置生成控制指令；

發送所述控制指令給所述運動車體，以使所述運動車體根據所述控制指令進行運動。

其中，所述根據所述目標運動狀態計算所述運動車體以所述當前位置為起點每運動相同路程長度的路程時的目標位置，包括：

根據目標運動狀態計算運動車體在以當前時刻為起始時刻的預設時間段內運動的路程的路程長度；

根據運動車體的目標前輪轉向角度確定運動車體的運動方向；

根據所述路程長度和所述運動方向計算所述運動車體以所述當前位置為起點每運動相同路程長度的路程時的目標位置。

其中，所述根據運動車體的目標前輪轉向角度確定運動車體的運動方向，包括：

判斷運動車體的目標前輪轉向角度與第一預設角度閾值之間的關系，以及判斷運動車體的目標前輪轉向角度與第二預設角度閾值之間的關系；所述第一預設角度閾值小于所述第二預設角度閾值；

當運動車體的目標前輪轉向角度大于或等于第一預設角度閾值時，且小于或等于第二預設角度閾值時，確定運動車體以目標運動狀態從當前時刻開始沿著目標前輪轉向角度的方向進行直線運動；

當運動車體的目標前輪轉向角度小于第一預設角度閾值時，確定運動車體以目標運動狀態從當前時刻開始進行左轉彎運動；

當運動車體的目標前輪轉向角度大于第二預設角度閾值時，確定運動車體以目標運動狀態從當前時刻開始進行右轉彎運動。

其中，所述根據所述路程長度和所述運動方向計算所述運動車體以所述當前位置為起點每運動相同路程長度的路程時的目標位置，包括：

將計算出的路程長度進行等分得到多段路程長度；