optimal control trajectory