[發明專利]一種單擺臂履帶平臺及其樓梯翻越控制方法

在審

• 申請號: 202211418660.2
• 申請日: 2022-11-14
• 公開（公告）號: CN115649311A
• 公開（公告）日: 2023-01-31
• 發明（設計）人: 李碩;朱立君
• 申請（專利權）人: 航天科工智能機器人有限責任公司
• 主分類號: B62D55/07
• 分類號: B62D55/07;B62D55/08;G01B21/22;G01B11/02;G01S17/08
• 代理公司: 北京鼎承知識產權代理有限公司 11551
• 代理人: 夏華棟

本發明提供了一種單擺臂履帶平臺及其樓梯翻越控制方法。單擺臂履帶平臺，包括前擺臂；傳動履帶；動力機構，用于驅動前擺臂和傳動履帶；傾角傳感器，用于測量單擺臂履帶平臺與水平參考平面的傾角；距離傳感器，用于測量其與前方障礙物的距離；控制器，與傾角傳感器、距離傳感器和動力機構相連，用于根據傾角傳感器測量的傾角和距離傳感器測量的距離，通過動力機構驅動前擺臂和傳動履帶。實施本發明的技術方案可以提升樓梯翻越能力。

技術領域

本發明涉及機械控制技術領域，尤其涉及一種單擺臂履帶平臺及其樓梯翻越控制方法。

背景技術

近年來機器人應用從制造領域向非制造領域發展，對機器人系統的多地形自適應越障能力提出了更高要求，樓梯翻越能力作為衡量移動機器人越障能力的一個重要指標，得到了廣泛的研究，如何提高樓梯翻越能力是急需解決的技術問題。

發明內容

為了解決現有技術中的至少一個技術問題，本發明提供了一種單擺臂履帶平臺及其樓梯翻越控制方法。

根據本發明的第一方面，提供了一種單擺臂履帶平臺，包括：

前擺臂；

傳動履帶；

動力機構，用于驅動所述前擺臂和所述傳動履帶；

傾角傳感器，用于測量所述單擺臂履帶平臺與水平參考平面的傾角；

距離傳感器，用于測量其與前方障礙物的距離；

控制器，與所述傾角傳感器、所述距離傳感器和所述動力機構相連，用于接收所述傾角傳感器測量的傾角和所述距離傳感器測量的距離，以及通過所述動力機構驅動所述前擺臂和所述傳動履帶。

可選的，所述單擺臂履帶平臺還包括：

編碼器，用于測量傳動履帶的前進距離。

可選的，所述單擺臂履帶平臺包括平臺本體，所述傾角傳感器與所述平臺本體同軸安裝。

可選的，所述距離傳感器安裝在所述平臺本體前側。

可選的，所述距離傳感器為激光雷達。

本發明的第二方面，一種本發明第一方面任一所述的單擺臂履帶平臺的樓梯翻越控制方法，包括：

在預備階段，控制所述單擺臂履帶平臺前進以及同時控制所述前擺臂上揚至第一角度，其中，所述預備階段的進入條件為所述距離傳感器測量到前方第一預設距離存在樓梯，所述預備階段的結束條件為所述距離傳感器測量到前方第二預設距離存在樓梯，其中，所述第二預設距離小于第一預設距離；

在入梯階段，控制所述單擺臂履帶平臺前進以及同時控制所述前擺臂下壓至與所述單擺臂履帶平臺的平臺主體的角度一致，其中，所述入梯階段的進入條件為預備階段結束，所述入梯階段的結束條件為所述單擺臂履帶平臺的平臺主體、所述前擺臂和所述樓梯的角度一致；

在爬行階段，控制所述單擺臂履帶平臺前進，其中，所述爬行階段的進入條件為入梯階段結束，所述爬行階段的結束條件為所述距離傳感器檢測到前方無新的臺階；

在出梯階段，控制所述單擺臂履帶平臺前進第三預設距離以及同時控制所述前擺臂下降，其中，所述出梯階段的進入條件為爬行階段結束，所述出梯階段的結束條件為所述單擺臂履帶平臺前進第三預設距離。

可選的，所述控制所述單擺臂履帶平臺前進以及同時控制所述前擺臂上揚至第一角度包括：

利用MPC控制所述單擺臂履帶平臺前進以及同時控制所述前擺臂上揚至第一角度；

其中，狀態項X、控制項U以及優化項f為：

X＝(θ_f，d)