Misc cleanup of DirectCollocation
Fixed bug in DirectSingleShooting
Misc cleanup of DirectMultipleShooting