-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathsim.py
More file actions
79 lines (62 loc) · 2.75 KB
/
Copy pathsim.py
File metadata and controls
79 lines (62 loc) · 2.75 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
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
import gpio_device, locomotion_device
from time import sleep
class Simulation:
def __init__(self):
# variable_name: value
self.simulation_variables = {}
# variable_name: (id, function, device instance, parameter)
# Function takes 1 variable: new value of variable
self.listeners = {}
# variable_name: (id, function, device_instance)
# Function returns 1 variable: value of of the variable
self.updaters = {}
self.next_id = 1
def get_variable(self, variable_name):
return self.simulation_variables[variable_name]
def register_variable(self, variable_name):
if variable_name not in self.simulation_variables:
self.simulation_variables[variable_name] = 0
self.listeners[variable_name] = []
self.updaters[variable_name] = []
def register_listener(self, variable_name, function, device_instance, parameter):
if variable_name in self.simulation_variables:
self.listeners[variable_name].append((self.next_id, function, device_instance, parameter))
self.next_id += 1
return self.next_id - 1
return 0
def register_updater(self, variable_name, function, device_instance, parameter):
if variable_name in self.simulation_variables:
self.updaters[variable_name].append((self.next_id, function, device_instance, parameter))
self.next_id += 1
return self.next_id - 1
return 0
def delete_registration(self, registration_id):
for key in self.listeners.keys():
for j in range(len(self.listeners[key])):
function_id, _, _, _ = self.listeners[key][j]
if function_id == registration_id:
del self.listeners[key][j]
for key in self.updaters.keys():
for j in range(len(self.updaters[key])):
function_id, _, _, _ = self.updaters[key][j]
if function_id == registration_id:
del self.updaters[key][j]
def main():
sim = Simulation()
###### Load Devices #######
pi = gpio_device.GpioDevice(sim)
bot = locomotion_device.LocomotionDevice(sim)
#### End Load Devices #####
while True:
for var, val in sim.simulation_variables.items():
updated = False
for _, function, device_instance, parameter in sim.updaters[var]:
new_val = function(parameter)
if new_val != val:
sim.simulation_variables[var] = new_val
updated = True
break
for _, function, device_instance, parameter in sim.listeners[var]:
function(parameter)
if __name__ == '__main__':
main()