HybridTrajectoryOptimization and minor updates

Added HybridTrajectoryOptimization and Compass Gait example. Minor changes to ContactImplicitTrajectoryOptimization, particularly the initialization of slack variables.
please just replace runDircolCycle.  no need to make it runNewDircolCycle