78 lines
2.4 KiB
Python
78 lines
2.4 KiB
Python
import numpy as np
|
|
from modules.gamma import gamma_sensor
|
|
from modules.heartbeat import heartbeat_module
|
|
from modules.location import location_module
|
|
from modules.memory import memory_module
|
|
from time import sleep
|
|
from os import system
|
|
|
|
#debugg to rebuild the file every test
|
|
system('cp command_q test_q')
|
|
|
|
ONSAT_FILESTORE = "DATA"
|
|
DOWNLINK_FILESTORE = "../store/data"
|
|
|
|
class sat:
|
|
def __init__(self):
|
|
self.attitude = sc(0,0, unit='deg', frame='icrs')
|
|
self.battery = 100.00
|
|
self.maneuver_TTC = 0 #time to completion
|
|
self.gyro_saturation = 0
|
|
self.modules = {
|
|
"heartbeat" : heartbeat_module(),
|
|
"location" : location_module(),
|
|
#"power" : power_manager(),
|
|
#"attitude" : attitude_module(),
|
|
"memory" : memory_module(),
|
|
"gamma_sensor" : gamma_sensor()
|
|
}
|
|
|
|
def check_command_q(self):
|
|
cur_batch = []
|
|
with open("command_q","r") as q:
|
|
com_q = q.read().splitlines()
|
|
for com in com_q:
|
|
if int(com.split(":")[0]) == self.modules["heartbeat"].mod_get("MTE")[0]:
|
|
cur_batch.append(com)
|
|
return cur_batch
|
|
|
|
|
|
def spin(self):
|
|
while True:
|
|
MTE = self.modules["heartbeat"].mod_get("MTE")[0]
|
|
print(MTE)
|
|
batch = self.check_command_q()
|
|
|
|
for c in batch:
|
|
print(c)
|
|
com = c.split(":")
|
|
if com[1] == "GET" and len(com) == 4:
|
|
res = self.modules[com[2]].mod_get(com[3])
|
|
elif com[1] == "SET" and len(com) == 5:
|
|
res = self.modules[com[2]].mod_set(com[3],com[4])
|
|
elif com[1] == "EXE" and len(com) == 3:
|
|
res = self.modules[com[2]].mod_exe()
|
|
else:
|
|
res = (-1, "BAD COMMAND: " + c)
|
|
print(res)
|
|
|
|
for m in self.modules:
|
|
self.modules[m].mod_update()
|
|
|
|
if self.modules["heartbeat"].mod_get("kill")[0] == 1:
|
|
print("heading to bed")
|
|
return
|
|
|
|
with open("MTE", "r+") as statfile:
|
|
statfile.seek(0)
|
|
statfile.truncate()
|
|
statfile.write(str(MTE))
|
|
|
|
sleep(1)
|
|
|
|
|
|
if __name__ == "__main__":
|
|
BoSLOO = sat()
|
|
BoSLOO.spin()
|
|
|