cleanup trajectory optimization examples (now everything uses the new interface)

to be included in drake v 0.9.7
`prog` should be a `DirectTrajectoryOptimization` object. `NonlinearProgram` does not have method `addStateConstraint`