fixed error in paramters, ... almost running ... save point
added sim-3, trajectory control