def test_go_straight():
o_pilot = pilot_i.Pilot()
o_pilot.forward_speed(60)
for i in range(100):
time.sleep(0.1)
o_pilot.go_straight()
o_pilot.stop()
def test_auto_pilot_2():
global auto_pilot
auto_pilot = auto_pilot_i.Auto_Pilot(pilot_i.Pilot(),
ultrasound_i.Ultrasound())
while (1):
auto_pilot.start()
time.sleep(2)
def test_kill_multi_process():
global auto_pilot
auto_pilot = auto_pilot_i.Auto_Pilot(pilot_i.Pilot())
threading.Thread(target=auto_pilot.scenario_move_and_avoid).start()
time.sleep(5)
auto_pilot.reset()
log.debug("reset sent")
def test_bug():
global auto_pilot
auto_pilot = auto_pilot_i.Auto_Pilot(pilot_i.Pilot(),
ultrasound_i.Ultrasound())
while (1):
auto_pilot.pilot.turn_left()
auto_pilot.pilot.turn_right()
time.sleep(0.01)
def test_gps_to_pos():
global auto_pilot
auto_pilot = auto_pilot_i.Auto_Pilot(pilot_i.Pilot())
t = threading.Thread(target=auto_pilot.scenario_go_to_GPS_pos,
args=[
(4333.66814, 00127.95310),
])
t.start()
t.join()
def test_scenar_go_straight():
global auto_pilot
auto_pilot = auto_pilot_i.Auto_Pilot(pilot_i.Pilot())
t = threading.Thread(target=auto_pilot.scenario_straight_line_time,
args=[
6,
])
t.start()
t.join()
def test_find_color(color):
global auto_pilot
auto_pilot = auto_pilot_i.Auto_Pilot(pilot_i.Pilot())
t = threading.Thread(target=auto_pilot.scenario_find_color, args=[
color,
])
t.start()
t.join()
log.debug("end of test")
def test_pilot_angle():
global pilot
pilot = pilot_i.Pilot()
pilot.turn(100)
time.sleep(1)
pilot.turn(170)
time.sleep(1)
pilot.turn(200)
time.sleep(1)
pilot.turn(110)
time.sleep(1)
def test_direction():
global auto_pilot
auto_pilot = auto_pilot_i.Auto_Pilot(pilot_i.Pilot(),
ultrasound_i.Ultrasound())
pilot = auto_pilot.pilot
while (1):
val = input("f,t, h, s to stop\n")
if val == "f":
pilot.forward_speed(80)
elif val == "t":
val = int(input("give angle:\n"))
pilot.turn(val)
elif val == "s":
pilot.reset()
return
elif val == "h":
auto_pilot.half_turn()
def test_auto_pilot():
global auto_pilot
auto_pilot = auto_pilot_i.Auto_Pilot(pilot_i.Pilot(),
ultrasound_i.Ultrasound())
auto_pilot_i.test_auto_pilot(auto_pilot)
def test_gps_only():
global auto_pilot
auto_pilot = auto_pilot_i.Auto_Pilot(pilot_i.Pilot())
t = threading.Thread(target=auto_pilot.sceanario_gps_only)
t.start()
t.join()
def test_scenario_read_roadmap():
global auto_pilot
auto_pilot = auto_pilot_i.Auto_Pilot(pilot_i.Pilot(),
ultrasound_i.Ultrasound())
auto_pilot.scenario_read_roadmap("simple_roadmap.txt")
def test_avoid_obstacle():
global auto_pilot
auto_pilot = auto_pilot_i.Auto_Pilot(pilot_i.Pilot(),
ultrasound_i.Ultrasound())
auto_pilot.scenario_move_and_avoid()
def main():
obj_pilot = pilot.Pilot()
obj_pilot.stop()
obj_pilot.go_straight()