modified OMPLController:invalid start point problem, inverted plotting for BasicSim problem, elevated plot problem, and changed from cover to isInside for checking if robot has arrived