HybridTrajectoryOptimization and minor updates

Added HybridTrajectoryOptimization and Compass Gait example. Minor changes to ContactImplicitTrajectoryOptimization, particularly the initialization of slack variables.
I could rephrase, but the point is that the pre-compiled obj will not be directly associated with the solution from the solve call.