- Add computation of foot dynamics matrices
- Move interpolation to RBS::generate_trajectories
- Move initialize_dynamics to RBS
- Add enum types FootType PhaseType
- Move solution_t, support_state_t to privatepgtypes
- Add a margin of -T_/10 to TimeLimit
- Clean up