This repository has been archived by the owner on Nov 1, 2022. It is now read-only.
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathSensorik_fake.py
329 lines (265 loc) · 11.4 KB
/
Sensorik_fake.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
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
#!/usr/bin/env python3
# Fake Modul, das auch auf anderen Geraeten ausser dem Raspberry Pi lauffaehig ist.
# Statt echter Sensordaten gibt es irgendwelche Phantasiewerte zurueck, die nur zu Testzwecken geeignet sind.
import time
import sys
import subprocess
import asyncio
from concurrent.futures import ThreadPoolExecutor
executor = ThreadPoolExecutor(max_workers = 5)
import Steuerung
DEBUG = True if "-d" in sys.argv else False
# ---------------------------
## --- globale Funktionen ---
# ---------------------------
def init(_loop):
global loop, Sensoren, SensorenList, pi, cb1, shutdown
shutdown = False
loop = _loop
# Ein Dictionary, das den Namen aller Subklassen von "Sensor" als Key enthaelt und die jeweilige Klasse als Wert:
Sensoren = {}
# Alle Subklassen und das jeweils zugehoerige Klassenatrribut "NAME" werden automatisch in das obige Dictionary eingetragen:
for subcl in Sensor.__subclasses__():
Sensoren[subcl.NAME] = subcl
# Zusaetzlich eine SensorListe erstellen, ueber die iteriert werden kann:
SensorenList = list(Sensoren.values())
for Sen in Sensoren:
# Start Refresh-Tasks:
Sensoren[Sen]._AutoRefresh()
# Print all Alerts to StdOut:
Sensoren[Sen].SubscribeAlerts(PrintAlerts)
Steuerung.light.change_mode(mode = 0)
def close():
global shutdown
shutdown = True
print("Closing sensor module")
def PrintSensorData(Sensor, Data, Unit):
print(str(Sensor), ":", str(Data) + " " + str(Unit))
def PrintAlerts(Type, Msg):
print("! Alert from Sensor {} received: {} !".format(Type, Msg))
# --------------------------
## --- Sensor-Metaklasse ---
# --------------------------
# Quelle: https://stackoverflow.com/questions/46237639/inheritance-of-class-variables-in-python
class SensorMeta(type):
def __new__(cls, name, bases, attrs):
if DEBUG: print("creating Class {}".format(name))
new_class = super(SensorMeta, cls).__new__(cls, name, bases, attrs)
# Initialisierungen (sollten nicht ueberschrieben werden):
# In dieser Static Variable werden die zuletzt ausgelesenen Sensor-Daten gespeichert. Solange keine ausgelesen wurden: None
new_class.SensorData = None
# In dieser Static Variable werden Alert-Nachrichten als String gespeichert. Solange kein Alert vorliegt: None
new_class.AlertMsg = None
# In dieser Liste werden die Funktionen hinterlegt. die bei einem Alert aufgerufen werden.
new_class.AlertSubscriber = []
return new_class
# -------------------------------------
## --- abstrakte Sensor-Basisklasse ---
# -------------------------------------
class Sensor(metaclass=SensorMeta):
"""
Abstrakte Basisklasse, die alle Methoden in Bezug zu den Sensoren implementiert. Fuer jeden Sensor sollte eine Klasse
von dieser Klasse geerbt werden, die zumindest festlegt, welche Funktion zum Auslesen der Sensordaten aufgerufen werden muss.
Bei jeder konkreter Sensorklasse muss der Name als Klassenattribut angegeben werden, unter welchem der Sensor angesprochen werden soll!
"""
# ----------------------
## --Klassenattribute --
# ----------------------
# Diese Klassenatribute muessen auf konkreter Ebene ueberschrieben werden:
NAME = "AbstrakteSensorklasse" # Gibt den Namen des Sensors an. Dieser wird als Key im Dict 'Sensoren' abgelegt
REFRESH_TIME = False # Nach dieser Zeit in Sekunden weden die Sensordaten erneut vom Sensor aktualisiert, wenn False nur einmal beim Start
UNIT = "Einheit" # Einheit der Sensordaten
# ----------------------
## -- Klassenmethoden --
# ----------------------
@classmethod
def ReadSensorData(cls):
"""
muss in den erbenden Sensor-Klassen implementiert werden.
Die Funktion muss die Sensordaten vom Sensor einlesen und als Reuckgabewert liefern
"""
return False
@classmethod
def CheckAlerts(cls):
"""
muss in den erbenden Sensor-Klassen implementiert werden.
Die Funktion wird bei jedem Aktualisieren der Sensordaten aufgerufen.
Sie muss die Sensordaten aus cls.SensorData auslesen und je nach gegebenen
Bedingungen eine Alert-Nachricht oder False (kein Alert) zurückliefern.
"""
return False
@classmethod
def Refresh(cls):
if DEBUG: print("Reading Data from Sensor {}".format(cls.NAME))
try:
cls.SensorData = cls.ReadSensorData()
except Exception as e: #TODO: Exception-Handling verbessern
print("ERROR while reading Data from Sensor {}: {}!".format(cls.NAME, e))
cls.NewAlertMsg = "Error while reading Data from Sensor {}: {}!".format(cls.NAME, e)
else:
cls.NewAlertMsg = cls.CheckAlerts()
if cls.NewAlertMsg != cls.AlertMsg: # nur neue Alerts
# Bei jedem Refresh werden, falls vorhanden, neue Alert-Nachrichten verschickt
cls.AlertMsg = cls.NewAlertMsg
if cls.AlertMsg: cls.Alert()
@classmethod
def SubscribeAlerts(cls, AlertOutput):
cls.AlertSubscriber.append(AlertOutput)
@classmethod
def DesubscribeAlerts(cls, AlertOutput):
cls.AlertSubscriber.remove(AlertOutput)
@classmethod
def Alert(cls):
for Output in cls.AlertSubscriber:
if DEBUG: print("Sending Alert {} to {}".format(cls.AlertMsg, Output))
Output(cls.NAME, cls.GetAlert())
@classmethod
def GetAlert(cls):
return cls.AlertMsg
@classmethod
def _AutoRefresh(cls):
if not shutdown:
cls.RefreshTask = loop.run_in_executor(executor, cls.Refresh)
if cls.REFRESH_TIME:
# schedule next Refresh if REFRESH_TIME is not False:
cls.NextRefresh = loop.call_later(cls.REFRESH_TIME, cls._AutoRefresh)
# ---------------------
## -- Objektmethoden --
# ---------------------
def __init__(self):
self._sub = False
self.lastPubValue = None
def subscribe(self, Output, OnlyNew = True, time = False):
"""
Die uebergebene Funktion "Output" muss drei Parameter annehmen: Type, Message, und Unit
Es macht keinen Sinn, das Intervall "time" der Veroeffentlichungen kleiner zu waehlen
als das Intervall, in dem die jeweiligen Sensordaten aktualisiert werden.
Wenn OnlyNew True ist (Standard) werden nur neue Werte veroeffentlicht.
"""
if not time:
if type(self).REFRESH_TIME:
# Wenn keine Zeit angegeben ist standardmaesig REFRESH-TIME als Intervall nehmen
time = type(self).REFRESH_TIME
else:
# Wenn AutoRefresh deaktiviert ist (REFRESH-TIME = False)
# und keine Zeit angegeben ist, Sensordaten nur einmal veroeffentlichen:
Output(str(type(self).NAME), self.getSensorData(), str(type(self).UNIT))
return
t = float(time)
if t < type(self).REFRESH_TIME:
if DEBUG: print("Time lower than refresh rate! Taking refresh rate instead.")
t = type(self).REFRESH_TIME
self._sub = True
self._SendSensorData(Output, OnlyNew, t)
def desubscribe(self):
self._sub = False
def getSensorData(self, OnlyNew = False, Refresh = False):
"""
Liefert den zuletzt ausgelesenen Wert des Sensors zurück.
Parameter: (OnlyNew = False, Refresh = False)
| |
| -> Wenn True: Die Sensordaten werden zuvor neu vom Sensor aktualisiert
| Standard False: Die als Klassenattribut seit dem letzten Aufruf der Klassenfunktion
| "Refresh()" zwischengespeicherten Sensordaten werden ausgegeben
|
-> Wenn True: Es wird nur ein Rueckgabewert gegeben, falls die Sensordaten sich seit dem letzten Aufruf
der Methode verändert haben, andernfalls: None.
"""
if Refresh: type(self).Refresh() # Falls Refresh == True: Sensordaten vor der Rueckgabe aktualisieren
Value = type(self).SensorData # Das Klassen-Attribut "SensorData" in die lokale Variable "value" zwischenspeichern
if (Value == self.lastPubValue and OnlyNew == True):
return None
else:
self.lastPubValue = Value
return Value
def _SendSensorData(self, Output, OnlyNew, t):
"""
Veroeffentlicht die Sensordaten wiederholt an die uebergebene 'Output(Name, SensorDaten, Einheit)'- Fkt
time gibt die Zeit in Sekunden zwischend den Veroeffentlichungen an
BEACHTEN: Es macht keinen Sinn, das Intervall der Veroeffentlichungen kleiner zu waehlen
als das Intervall, in dem die jeweiligen Sensordaten aktualisiert werden (REFRESH_TIME)!
"""
Data = self.getSensorData(OnlyNew)
if Data is not None:
if DEBUG: print("Sending Sensor Data: {}".format(Data))
Output(str(type(self).NAME), str(Data), str(type(self).UNIT))
if self._sub and not shutdown:
self.NextSendTask = loop.call_later(t, self._SendSensorData, Output, OnlyNew, t)
# --------------------------------
## --- konkrete Sensor-Klassen ---
# --------------------------------
class Sensor1(Sensor):
NAME = "1"
REFRESH_TIME = 10
UNIT = "?"
@classmethod
def ReadSensorData(cls):
return "xyz"
class Sensor3(Sensor):
NAME = "3"
REFRESH_TIME = 10
UNIT = "blub"
@classmethod
def ReadSensorData(cls):
return "abc"
class IP_Addr(Sensor):
NAME = "IP-Address"
REFRESH_TIME = False
UNIT = ""
@classmethod
def ReadSensorData(cls):
cmdIP = "ip addr show wlan0 | grep inet | awk '{print $2}' | cut -d/ -f1"
com = subprocess.Popen(cmdIP, shell=True, stdout=subprocess.PIPE)
shellOutput = com.communicate()
strIP = shellOutput[0].decode()
IP = strIP.split('\n')[0]
return IP
class Mtr_Speed(Sensor):
NAME = "Motor-Speed"
UNIT = "%"
REFRESH_TIME = 0.5
@classmethod
def ReadSensorData(cls):
return Steuerung.get_speed()
class Lnk_Pos(Sensor):
NAME = "Lenk-Position"
UNIT = ""
REFRESH_TIME = 0.5
@classmethod
def ReadSensorData(cls):
return int(Steuerung.get_pos())
class Batt_Mon_Current(Sensor):
NAME = "Batt.-Current"
UNIT = "A"
REFRESH_TIME = 1
X = 2
@classmethod
def ReadSensorData(cls):
#cls.X = (cls.X + 0.1) % 2
return cls.X - 1
class Batt_Mon_Charge(Sensor):
NAME = "Batt.-Charge"
UNIT = "mAh"
REFRESH_TIME = 1
X = 4000
MAX_CHARGE = 4000 # mAh
@classmethod
def ReadSensorData(cls):
cls.X = (cls.X -100) % (cls.MAX_CHARGE + 100)
return cls.X
# Hier weitere konkrete Sensoren nach obigen Beispielen einfuegen...
# -------------
## --- Main ---
# -------------
if __name__ == "__main__":
# Hier ergaenzen, was das Modul machen soll, wenn es direkt als Skript gestartet wird
loop = asyncio.get_event_loop()
init(loop)
for Sen in Sensoren:
S = Sensoren[Sen]()
S.subscribe(PrintSensorData, False) # subscribe all Sensors with default refresh time
try:
loop.run_forever()
finally:
print("Cleaning up...")
close()