Balancing and walking using full dynamics LQR control with contact constraints

Torque control algorithms which consider robot dynamics and contact constraints are important for creating dynamic behaviors for humanoids. As computational power increases, algorithms tend to also increase in complexity. However, it is not clear how much complexity is really required to create controllers which exhibit good performance. In this paper, we study the capabilities of a simple approach based on contact consistent LQR controllers designed around key poses to control various tasks on a humanoid robot. We present extensive experimental results on a hydraulic, torque controlled humanoid performing balancing and stepping tasks. This feedback control approach captures the necessary synergies between the DoFs of the robot to guarantee good control performance. We show that for the considered tasks, it is only necessary to re-linearize the dynamics of the robot at different contact configurations and that increasing the number of LQR controllers along desired trajectories does not improve performance. Our result suggest that very simple controllers can yield good performance competitive with current state of the art, but more complex, optimization-based whole-body controllers. A video of the experiments can be found at https://youtu.be/5T08CNKV1hw.

[1]  Scott Kuindersma,et al.  Optimization and stabilization of trajectories for constrained dynamical systems , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[2]  Scott Kuindersma,et al.  A summary of team MIT's approach to the virtual robotics challenge , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[3]  Alexander Herzog,et al.  Balancing experiments on a torque-controlled humanoid with hierarchical inverse dynamics , 2013, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[4]  C. Atkeson,et al.  Optimization based controller design and implementation for the Atlas robot in the DARPA Robotics Challenge Finals , 2015, 2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids).

[5]  Christopher G. Atkeson,et al.  Dynamic Balance Force Control for compliant humanoid robots , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Darwin G. Caldwell,et al.  Robot impedance control and passivity analysis with inner torque and velocity feedback loops , 2014, ArXiv.

[7]  Stefan Schaal,et al.  Full dynamics LQR control of a humanoid robot: An experimental study on balancing and squatting , 2014, 2014 IEEE-RAS International Conference on Humanoid Robots.

[8]  Nicholas Rotella,et al.  Inertial sensor-based humanoid joint state estimation , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[9]  Stefan Schaal,et al.  Quadratic programming for inverse dynamics with optimal distribution of contact forces , 2012, 2012 12th IEEE-RAS International Conference on Humanoid Robots (Humanoids 2012).

[10]  Pierre-Brice Wieber,et al.  Kinematic Control of Redundant Manipulators: Generalizing the Task-Priority Framework to Inequality Task , 2011, IEEE Transactions on Robotics.

[11]  Stefan Schaal,et al.  Risk sensitive nonlinear optimal control with measurement uncertainty , 2016, ArXiv.

[12]  Twan Koolen,et al.  Summary of Team IHMC's virtual robotics challenge entry , 2013, 2013 13th IEEE-RAS International Conference on Humanoid Robots (Humanoids).

[13]  Kazuhito Yokoi,et al.  Resolved momentum control: humanoid motion planning based on the linear and angular momentum , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).