-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathmain.py
More file actions
45 lines (33 loc) · 1.47 KB
/
main.py
File metadata and controls
45 lines (33 loc) · 1.47 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
import argparse
import random
from grid import Grid
from rover import Rover
from visualizer import animate
def parse_args():
parser = argparse.ArgumentParser(description="Autonomous Rover Navigator")
parser.add_argument("--width", type=int, default=20)
parser.add_argument("--height", type=int, default=20)
parser.add_argument("--obstacles", type=float, default=0.25)
parser.add_argument("--seed", type=int, default=None)
parser.add_argument("--sensor-radius", type=int, default=4)
parser.add_argument("--interval", type=int, default=120)
return parser.parse_args()
def main():
args = parse_args()
if args.seed is not None:
random.seed(args.seed)
grid = Grid(args.width, args.height, args.obstacles)
start = (0, 0)
goal = (args.width - 1, args.height - 1)
print(f"Grid: {args.width}x{args.height} Obstacles: {args.obstacles*100:.0f}% Sensor radius: {args.sensor_radius}")
rover = Rover(grid, start, goal, sensor_radius=args.sensor_radius)
result = rover.run()
messages = {
'success': f"Goal reached! Steps: {len(rover.history)} Replans: {rover.replans}",
'unreachable': "Goal is unreachable on this map. Try a different --seed.",
'stuck': f"Rover got stuck. Steps: {len(rover.history)} Replans: {rover.replans}",
}
print(messages[result])
animate(grid, rover, interval=args.interval)
if __name__ == "__main__":
main()