Fast optimal control resolution

Summary
Open source software implementing an efficient optimal-control solver tailored to the project robots.