Computational Geometric Mechanics and Control of Rigid Bodies.