brings up to new RobotState and planning API