Automatic differentiation of rigid body dynamics for optimal control and estimation
- 8 November 2017
- journal article
- research article
- Published by Taylor & Francis in Advanced Robotics
- Vol. 31 (22) , 1225-1237
Abstract
Many algorithms for control, optimization and estimation in robotics depend on derivatives of the underlying system dynamics, e.g. to compute linearizations, sensitivities or gradient directions. However, we show that when dealing with rigid body dynamics, these derivatives are difficult to derive analytically and to implement efficiently. To overcome this issue, we extend the modelling tool ‘RobCoGen’ to be compatible with Automatic Differentiation. Additionally, we propose how to automatically obtain the derivatives and generate highly efficient source code. We highlight the flexibility and performance of the approach in two application examples. First, we show a trajectory optimization example for the quadrupedal robot HyQ, which employs auto-differentiation on the dynamics including a contact model. Second, we present a hardware experiment in which a six-DoF robotic arm avoids a randomly moving obstacle in a go-to task by fast, dynamic replanning.Keywords
All Related Versions
Funding Information
- Schweizerischer Nationalfonds zur Förderung der Wissenschaftlichen Forschung (141853,160592)
- Swiss National Science Foundation (10.13039/501100002339)
- National Centre of Competence in Research
This publication has 25 references indexed in Scilit:
- Performance of automatic differentiation tools in the dynamic simulation of multibody systemsAdvances in Engineering Software, 2014
- Energy Efficient Trajectories for an Industrial ABB RobotProcedia CIRP, 2014
- Design of HyQ – a hydraulically and electrically actuated quadruped robotProceedings of the Institution of Mechanical Engineers, Part I: Journal of Systems and Control Engineering, 2011
- ACADO toolkit—An open‐source framework for automatic control and dynamic optimizationOptimal Control Applications and Methods, 2011
- Fast Direct Multiple Shooting Algorithms for Optimal Robot Control2007
- On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programmingMathematical Programming, 2005
- SNOPT: An SQP Algorithm for Large-Scale Constrained OptimizationSIAM Review, 2005
- A Real-Time Iteration Scheme for Nonlinear Optimization in Optimal Feedback ControlSIAM Journal on Control and Optimization, 2005
- Automatic differentiation of numerical integration algorithmsMathematics of Computation, 1999
- A Second-order Gradient Method for Determining Optimal Trajectories of Non-linear Discrete-time SystemsInternational Journal of Control, 1966