getRobotPose.m findObstacles.m readRangeSensor.m tangentBug.m curveintersect.m createLines.m find2GoalDist.m find2ReachDist.m findSqDistance.m findTangentAngle.m getGoalPose.m