Implementations for Trajectory Optimization of Rigid Bodies Through Contact - View it on GitHub