結合多體動力學及限制型卡曼濾波器建構輪腳機構地面接觸力估測

Ground Contact Force Estimation of a Leg-wheel Module Using a Multi-body Dynamic Model and a Constrained Kalman Filter

劉育如(Yu-Ju Liu)

指導教授 ： 林沛群

國立臺灣大學/工學院/機械工程學研究所/碩士(2022年)

https://doi.org/10.6342/NTU202202912

摘要

本文主要探討多連桿輪腳複合機構之外力估測，此輪腳機構為五連桿內接七連桿的雙自由度機構，可以透過連桿幾何形狀的主動控制，在輪模式及腳模式平滑轉換，此機構特性讓新型四足輪腳複合機器人得以在平坦地形上使用輪型式移動，在崎嶇地形則切換至腳模式，藉由步態選擇、踏點控制或是跳躍的方式，跨越障礙物，為使足類機器人可以在各式各樣未知的地形上穿梭，需要知道機器人目前的機身狀態，並透過狀態資訊即時更新命令，而足類機器人的機身動態主要取決於足部末端與地面的接觸力，由於此輪腳複合機構較複雜，且因應輪模式下連續旋轉的限制，不易在機構末端安裝力感測器，因而無法直接取得機構末端與地面接觸的交互作用力，本研究使用間接的方式取得地面接觸力。
本研究透過多體動力學方式建構輪腳機構之動力學模型，模型主要透過幾何限制以及接觸限制條件約束系統運動行為，由於實際系統中存在許多其他未知的干擾因素，以及無法建模的損耗，因此設計一個具有限制條件的卡曼濾波器，不僅確保在使用感測器量測值更新模型預測之系統狀態時，仍滿足系統設定之限制條件，且可同時修正模型預測之接觸力。

關鍵字

仿生機器人 ； 輪腳複合模組 ； 多體動力學 ； 地面作用力 ； 限制型卡曼濾波器 ； 接觸力估測器

並列摘要

This paper mainly discussed the ground reaction force estimation of a complex 11-linkage and closed-chain leg-wheel module. This leg-wheel module has two degrees of freedom and is capable of transforming between wheel mode and leg mode rapidly yet smoothly. Therefore, the new quadruped composed of 4 leg-wheel modules is able to cruise on flat terrains with wheels efficiently, while traversing uneven terrains in leg mode. In order to enable the legged robot to traverse diverse unknown terrains, it is crucial to track the status of the robot. The dynamic of the legged robot mainly depends on the ground reaction forces and the contact status. Due to the complexity of the leg-wheel module and the limitation of continuous rotating in wheel mode, it is difficult to mount force sensors on the legs. Therefore, in this paper, we establish the dynamic model of the leg-wheel module using the multibody dynamic approach. The contact-constrained Kalman filter developed in this paper can not only ensure the constraints are satisfied through the measurement update, but also correct the contact forces predicted by the dynamic model.

並列關鍵字

Bio-inspired robot ； leg-wheel module ； multibody dynamics ； ground reaction force ； constrained Kalman filter ； contact force estimation

參考文獻

[1] M. Hutter, C. Gehring, M. A. Höpflinger, M. Blösch, and R. Siegwart, "Toward combining speed, efficiency, versatility, and robustness in an autonomous quadruped," IEEE Transactions on Robotics, vol. 30, no. 6, pp. 1427-1440, 2014.

[2] M. Hutter et al., "Anymal-a highly mobile and dynamic quadrupedal robot," in 2016 IEEE/RSJ international conference on intelligent robots and systems (IROS), 2016: IEEE, pp. 38-44.

[3] G. Fink and C. Semini, "Proprioceptive sensor fusion for quadruped robot state estimation," in 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2020: IEEE, pp. 10914-10920.

[4] M. Bloesch et al., "State estimation for legged robots-consistent fusion of leg kinematics and IMU," Robotics, vol. 17, pp. 17-24, 2013.

[5] M. Bloesch, C. Gehring, P. Fankhauser, M. Hutter, M. A. Hoepflinger, and R. Siegwart, "State estimation for legged robots on unstable and slippery terrain," in 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2013: IEEE, pp. 6058-6064.