Trajectory Optimization for Hybrid Wheeled-Legged Robots in Challenging Terrain
Resumo
Wheeled-legged robots are a promising solution for agile locomotion in challenging terrain, combining the speed of the wheels with the ability of the legs to cope with unstructured environments. This paper presents a trajectory optimization framework that allows wheeled-legged robots to navigate in challenging terrain, e.g., steps, slopes, gaps, while negotiating these obstacles with dynamic motions. The framework generates the robot’s base motion as well as the wheels’ positions and contact forces along the trajectory, accounting for the terrain map and the dynamics of the robot. The knowledge of the terrain map allows the optimizer to generate feasible motions for obstacle negotiation in a dynamic manner, at higher speeds. To take full advantage of the hybrid nature of wheeled-legged robots, driving and stepping motions are both considered in a single planning problem that can generate trajectories with purely driving motions or hybrid driving-stepping motions. The optimization is formulated as a Nonlinear Programming Problem (NLP) employing a phase-based parametrization to optimize over the wheels’ motion and contact forces. The reference trajectories are tracked by a hierarchical whole-body controller that computes the torque actuation commands for the robot. The motion plans are verified on the quadrupedal robot ANYmal equipped with non-steerable torque-controlled wheels in simulations and experimental tests. Agile hybrid motions are demonstrated in simulations with discontinuous obstacles, such as floating steps and gaps, at an average speed of 0.75 m/s.
Referências
Bjelonic, M., Bellicoso, C.D., de Viragh, Y., Sako, D., Tresoldi, F.D., Jenelten, F., Hutter, M.: Keep rollinwhole-body motion control and planning for wheeled quadrupedal robots. IEEE Robotics and Automation Letters 4(2), 2116–2123 (2019).
Bjelonic, M., Sankar, P.K., Bellicoso, C.D., Vallery, H., Hutter, M.: Rolling in the deep hybrid locomotion for wheeled-legged robots using online trajectory optimization. IEEE Robotics and Automation Letters 5(2), 3626–3633 (2020).
Cordes, F., Kirchner, F., Babu, A.: Design and field testing of a rover with an actively articulated suspension system in a mars analog terrain. Journal of Field Robotics 35(7), 1149–1181 (2018).
de Viragh, Y., Bjelonic, M., Bellicoso, C.D., Jenelten, F., Hutter, M.: Trajectory optimization for wheeled-legged quadrupedal robots using linearized zmp constraints. IEEE Robotics and Automation Letters 4(2), 1633–1640 (April 2019).
Fankhauser, P., Bloesch, M., Hutter, M.: Probabilistic terrain mapping for mobile robots with uncertain localization. IEEE Robotics and Automation Letters 3(4), 3019–3026 (Oct 2018).
Geilinger, M., Poranne, R., Desai, R., Thomaszewski, B., Coros, S.: Skaterbots: Optimization-based design and motion synthesis for robotic creatures with legs and wheels. In: on Graphics (TOG), A.T. (ed.) Proceedings of ACM SIGGRAPH. vol. 37. ACM (August 2018).
Grand, C., Benamar, F., Plumet, F.: Motion kinematics analysis of wheeled–legged rover over 3d surface with posture adaptation. Mechanism and Machine Theory 45(3), 477–495 (2010).
Hargraves, C., Paris, S.: Direct trajectory optimization using nonlinear programming and collocation. Journal of Guidance, Control, and Dynamics 10(4), 338–342 (1987).
Jelavic, E., Hutter, M.: Whole-body motion planning for walking excavators. In: 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). pp. 2292–2299 (2019).
Klamt, T., Behnke, S.: Anytime hybrid driving-stepping locomotion planning. In: 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). pp. 4444–4451 (Sep 2017).
Klamt, T., Rodriguez, D., Schwarz, M., Lenz, C., Pavlichenko, D., Droeschel, D., Behnke, S.: Supervised autonomous locomotion and manipulation for disaster response with a centaur-like robot. In: 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). pp. 1–8 (Oct 2018).
Koenig, N., Howard, A.: Design and use paradigms for gazebo, an open-source multi-robot simulator. In: 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). vol. 3, pp. 2149–2154 (Sep 2004).
Medeiros, V.S., Jelavic, E., Bjelonic, M., Siegwart, R., Meggiolaro, M.A., Hutter, M.: Trajectory optimization for wheeled-legged quadrupedal robots driving in challenging terrain. IEEE Robotics and Automation Letters 5(3), 4172–4179 (2020).
Reid, W., Prez-Grau, F.J., Gktoan, A.H., Sukkarieh, S.: Actively articulated suspension for a wheel-on-leg rover operating on a martian analog surface. In: 2016 IEEE International Conference on Robotics and Automation (ICRA). pp. 5596– 5602 (May 2016).
Smith, R.: Open dynamics engine (2008), http://www.ode.org/.
Sun, J., You, Y., Zhao, X., Adiwahono, A.H., Chew, C.M.: Towards more possibilities: Motion planning and control for hybrid locomotion of wheeled-legged robots. IEEE Robotics and Automation Letters 5(2), 3723–3730 (2020).
Wächter, A., Biegler, L.T.: On the implementation of an interior-point filter linesearch algorithm for large-scale nonlinear programming. Mathematical Programming 106(1), 25–57 (Mar 2006).
Winkler, A.W., Bellicoso, C.D., Hutter, M., Buchli, J.: Gait and trajectory optimization for legged systems through phase-based end-effector parameterization. IEEE Robotics and Automation Letters 3(3), 1560–1567 (July 2018).
Winkler, A.W.: Ifopt A modern, light-weight, Eigen-based C++ interface to Nonlinear Programming solvers Ipopt and Snopt. (2018).
