[發明專利]一種重載AGV雙車聯動運動控制方法及裝置在審
| 申請號： | 202211437813.8 | 申請日： | 2022-11-15 |
| 公開（公告）號： | CN115729241A | 公開（公告）日： | 2023-03-03 |
| 發明（設計）人： | 李楊;吳衛國;李玉河;許佳音;韓翔宇 | 申請（專利權）人： | 天津工程機械研究院有限公司 |
| 主分類號： | G05D1/02 | 分類號： | G05D1/02 |
| 代理公司： | 天津市尚文知識產權代理有限公司 12222 | 代理人： | 黃靜 |
| 地址： | 300000 天津市武清區天津*** | 國省代碼： | 天津;12 |
| 權利要求書： | 查看更多 | 說明書： | 查看更多 |
| 摘要： | |||
| 搜索關鍵詞： | 一種 重載 agv 聯動 運動 控制 方法 裝置 | ||
1.一種重載AGV雙車聯動運動控制方法，其特征在于，包括：
獲取主AGV的第一實時位姿信息和第一運動控制量，獲取從AGV的第二實時位姿信息；
根據所述第一實時位姿信息和預設的對從AGV的期望位姿計算所述從AGV的第二運動控制量；
根據所述第二運動控制量和第二位姿信息對所述從AGV執行運動控制調節，實現主AGV和從AGV的聯動。
2.根據權利要求1所述重載AGV雙車聯動運動控制方法，其特征在于，所述運動控制量包括速度和角速度，表達式如下：
3.根據權利要求1所述重載AGV雙車聯動運動控制方法，其特征在于，所述第二運動控制量的計算步驟：
獲取所述主AGV的運動控制量，將所述運動控制量由所述主AGV坐標系中轉換到場景坐標系中，表達式如下：
在所述場景坐標系中根據所述主AGV的實時位置、第一運動控制量和從AGV的期望位置計算所述從AGV的第二運動控制量，表達式如下：
將從AGV的期望位置設置在主AGV的正后方，則公式(2)可轉化為：
其中，Vxf、Vyf、ωf為從AGV在場景地圖坐標系中的運動控制量；Vxl、Vyl、ω1為主AGV在場景地圖坐標系中的運動控制量，xl、yl為主AGV實時位置；xd、yd為從AGV期望位置，D為主AGV與期望AGV之間的期望間距。
4.根據權利要求1所述重載AGV雙車聯動運動控制方法，其特征在于，所述執行運動控制調節還包括：在所述調節中加入偏差控制調節，表達式如下：
通過PID算法可將三個偏差轉化為三個運動控制量的反饋調節量，公式如下：
其中，Dx、Dy、為場景地圖坐標系下的三個偏差。
5.根據權利要求1所述重載AGV雙車聯動運動控制方法，其特征在于，所述第一位姿信息和第二位姿信息通過導航傳感器獲取。
6.一種重載AGV雙車聯動運動控制裝置，其特征在于，包括：
獲取模塊，用于獲取主AGV的第一實時位姿信息和第一運動控制量，獲取從AGV的第二實時位姿信息；
控制模塊，用于根據所述第一實時位姿信息和預設的對從AGV的期望位姿計算所述從AGV的第二運動控制量；
執行模塊，用于根據所述第二運動控制量和第二位姿信息對所述從AGV執行運動控制調節，實現主AGV和從AGV的聯動。
7.根據權利要求6所述重載AGV雙車聯動運動控制裝置，其特征在于，所述運動控制量包括速度和角速度，表達式如下：
8.根據權利要求6所述重載AGV雙車聯動運動控制裝置，其特征在于，所述第二運動控制量的計算步驟：
獲取所述主AGV的運動控制量，將所述運動控制量由所述主AGV坐標系中轉換到場景坐標系中，表達式如下：
在所述場景坐標系中根據所述主AGV的實時位置、第一運動控制量和從AGV的期望位置計算所述從AGV的第二運動控制量，表達式如下：
將從AGV的期望位置設置在主AGV的正后方，則公式(2)可轉化為：
其中，Vxf、Vyf、ωf為從AGV在場景地圖坐標系中的運動控制量；Vxl、Vyl、ω1為主AGV在場景地圖坐標系中的運動控制量，xl、yl為主AGV實時位置；xd、yd為從AGV期望位置，D為主AGV與期望AGV之間的期望間距。
該專利技術資料僅供研究查看技術是否侵權等信息，商用須獲得專利權人授權。該專利全部權利屬于天津工程機械研究院有限公司，未經天津工程機械研究院有限公司許可，擅自商用是侵權行為。如果您想購買此專利、獲得商業授權和技術合作，請聯系【客服】
本文鏈接：http://www.szxzyx.cn/pat/books/202211437813.8/1.html，轉載請聲明來源鉆瓜專利網。
