-
-
Notifications
You must be signed in to change notification settings - Fork 593
/
manual_control.py
executable file
·139 lines (119 loc) · 3.67 KB
/
manual_control.py
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
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
#!/usr/bin/env python3
from __future__ import annotations
import gymnasium as gym
import pygame
from gymnasium import Env
from minigrid.core.actions import Actions
from minigrid.minigrid_env import MiniGridEnv
from minigrid.wrappers import ImgObsWrapper, RGBImgPartialObsWrapper
class ManualControl:
def __init__(
self,
env: Env,
seed=None,
) -> None:
self.env = env
self.seed = seed
self.closed = False
def start(self):
"""Start the window display with blocking event loop"""
self.reset(self.seed)
while not self.closed:
for event in pygame.event.get():
if event.type == pygame.QUIT:
self.env.close()
break
if event.type == pygame.KEYDOWN:
event.key = pygame.key.name(int(event.key))
self.key_handler(event)
def step(self, action: Actions):
_, reward, terminated, truncated, _ = self.env.step(action)
print(f"step={self.env.step_count}, reward={reward:.2f}")
if terminated:
print("terminated!")
self.reset(self.seed)
elif truncated:
print("truncated!")
self.reset(self.seed)
else:
self.env.render()
def reset(self, seed=None):
self.env.reset(seed=seed)
self.env.render()
def key_handler(self, event):
key: str = event.key
print("pressed", key)
if key == "escape":
self.env.close()
return
if key == "backspace":
self.reset()
return
key_to_action = {
"left": Actions.left,
"right": Actions.right,
"up": Actions.forward,
"space": Actions.toggle,
"pageup": Actions.pickup,
"pagedown": Actions.drop,
"tab": Actions.pickup,
"left shift": Actions.drop,
"enter": Actions.done,
}
if key in key_to_action.keys():
action = key_to_action[key]
self.step(action)
else:
print(key)
if __name__ == "__main__":
import argparse
parser = argparse.ArgumentParser()
parser.add_argument(
"--env-id",
type=str,
help="gym environment to load",
choices=gym.envs.registry.keys(),
default="MiniGrid-MultiRoom-N6-v0",
)
parser.add_argument(
"--seed",
type=int,
help="random seed to generate the environment with",
default=None,
)
parser.add_argument(
"--tile-size", type=int, help="size at which to render tiles", default=32
)
parser.add_argument(
"--agent-view",
action="store_true",
help="draw the agent sees (partially observable view)",
)
parser.add_argument(
"--agent-view-size",
type=int,
default=7,
help="set the number of grid spaces visible in agent-view ",
)
parser.add_argument(
"--screen-size",
type=int,
default="640",
help="set the resolution for pygame rendering (width and height)",
)
args = parser.parse_args()
env: MiniGridEnv = gym.make(
args.env_id,
tile_size=args.tile_size,
render_mode="human",
agent_pov=args.agent_view,
agent_view_size=args.agent_view_size,
screen_size=args.screen_size,
)
# TODO: check if this can be removed
if args.agent_view:
print("Using agent view")
env = RGBImgPartialObsWrapper(env, args.tile_size)
env = ImgObsWrapper(env)
manual_control = ManualControl(env, seed=args.seed)
manual_control.start()