Updating controller, motionmodel, separatedcontroller to
work with native ompl control types.