Fixed openmr trajectorycontroller for examples