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

to be included in drake v 0.9.7
+1 for `ConstantConstraint` here.