def test_obstacle_dead_ahead(self): sensors = Sensors({"LeftBumper": False, "RightBumper": False, "LeftSonar": 0.3, "RightSonar": 0.3}) ev = ObstacleDetected("LeftSonar", sensors, [0.0, 0.0, 0.0, 0.0, 0.0, 0.0]) (tmin, tmax) = event_to_obstruction_direction(ev) print "tmin = " + str(tmin) + ", tmax = " + str(tmax) self.assertGreaterEqual(tmin, math.pi / 2, "Must turn at least 90 degrees right") self.assertLessEqual(tmax, math.pi * 1.5, "Must turn at least 90 degrees left")
def test_obstacle_closer_on_left(self): sensors = Sensors({ 'LeftBumper': False, 'RightBumper': False, 'LeftSonar': 0.3, 'RightSonar': 0.5 }) ev = ObstacleDetected('LeftSonar', sensors, [0.0, 0.0, 0.0, 0.0, 0.0, 0.0]) (tmin, tmax) = event_to_obstruction_direction(ev) print "tmin = " + str(tmin) + ", tmax = " + str(tmax) self.assertLess(tmin, 0.0, "Must turn to right")
def test_obstacle_on_right(self): sensors = Sensors({ 'LeftBumper': False, 'RightBumper': False, 'LeftSonar': 2.5, 'RightSonar': 0.3 }) ev = ObstacleDetected('RightSonar', sensors, [0.0, 0.0, 0.0, 0.0, 0.0, 0.0]) (tmin, tmax) = event_to_obstruction_direction(ev) print "tmin = " + str(tmin) + ", tmax = " + str(tmax) self.assertGreater(tmin, 0.0, "Must turn to left")
def test_obstacle_dead_ahead(self): sensors = Sensors({ 'LeftBumper': False, 'RightBumper': False, 'LeftSonar': 0.3, 'RightSonar': 0.3 }) ev = ObstacleDetected('LeftSonar', sensors, [0.0, 0.0, 0.0, 0.0, 0.0, 0.0]) (tmin, tmax) = event_to_obstruction_direction(ev) print "tmin = " + str(tmin) + ", tmax = " + str(tmax) self.assertGreaterEqual(tmin, math.pi / 2, "Must turn at least 90 degrees right") self.assertLessEqual(tmax, math.pi * 1.5, "Must turn at least 90 degrees left")
def test_obstacle_closer_on_left(self): sensors = Sensors({"LeftBumper": False, "RightBumper": False, "LeftSonar": 0.3, "RightSonar": 0.5}) ev = ObstacleDetected("LeftSonar", sensors, [0.0, 0.0, 0.0, 0.0, 0.0, 0.0]) (tmin, tmax) = event_to_obstruction_direction(ev) print "tmin = " + str(tmin) + ", tmax = " + str(tmax) self.assertLess(tmin, 0.0, "Must turn to right")
def test_obstacle_on_right(self): sensors = Sensors({"LeftBumper": False, "RightBumper": False, "LeftSonar": 2.5, "RightSonar": 0.3}) ev = ObstacleDetected("RightSonar", sensors, [0.0, 0.0, 0.0, 0.0, 0.0, 0.0]) (tmin, tmax) = event_to_obstruction_direction(ev) print "tmin = " + str(tmin) + ", tmax = " + str(tmax) self.assertGreater(tmin, 0.0, "Must turn to left")