forked from proveskit/CircuitPython_RP2350_v5b
-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathmain.py
More file actions
151 lines (126 loc) · 4.38 KB
/
main.py
File metadata and controls
151 lines (126 loc) · 4.38 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
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
import os
import time
import board
import digitalio
import microcontroller
from lib.proveskit_rp2350_v5b.register import Register
from lib.pysquared.beacon import Beacon
from lib.pysquared.cdh import CommandDataHandler
from lib.pysquared.config.config import Config
from lib.pysquared.hardware.busio import _spi_init, initialize_i2c_bus
from lib.pysquared.hardware.digitalio import initialize_pin
from lib.pysquared.hardware.imu.manager.lsm6dsox import LSM6DSOXManager
from lib.pysquared.hardware.magnetometer.manager.lis2mdl import LIS2MDLManager
from lib.pysquared.hardware.radio.manager.rfm9x import RFM9xManager
from lib.pysquared.hardware.radio.manager.sx1280 import SX1280Manager
from lib.pysquared.hardware.radio.packetizer.packet_manager import PacketManager
from lib.pysquared.logger import Logger
from lib.pysquared.nvm.counter import Counter
from lib.pysquared.rtc.manager.microcontroller import MicrocontrollerManager
from lib.pysquared.sleep_helper import SleepHelper
from lib.pysquared.watchdog import Watchdog
from utils import listener_nominal_power_loop
from version import __version__
boot_time: float = time.time()
# Satellite configuration constants
CUBE_IDS = ["Listener1", "Listener2", "Listener3"]
MY_CUBESAT_ID = "Listener1"
rtc = MicrocontrollerManager()
(boot_count := Counter(index=Register.boot_count)).increment()
error_count: Counter = Counter(index=Register.error_count)
logger: Logger = Logger(
error_counter=error_count,
colorized=False,
)
logger.info(
"Booting",
hardware_version=os.uname().version, # type: ignore[attr-defined]
software_version=__version__,
)
loiter_time: int = 5
for i in range(loiter_time):
logger.info(f"Code Starting in {loiter_time-i} seconds")
time.sleep(1)
try:
watchdog = Watchdog(logger, board.WDT_WDI)
watchdog.pet()
logger.debug("Initializing Config")
config: Config = Config("config.json")
mux_reset = initialize_pin(
logger, board.MUX_RESET, digitalio.Direction.OUTPUT, False
)
# TODO(nateinaction): fix spi init
spi0 = _spi_init(
logger,
board.SPI0_SCK,
board.SPI0_MOSI,
board.SPI0_MISO,
)
spi1 = _spi_init(
logger,
board.SPI1_SCK,
board.SPI1_MOSI,
board.SPI1_MISO,
)
sband_radio = SX1280Manager(
logger,
config.radio,
spi1,
initialize_pin(logger, board.SPI1_CS0, digitalio.Direction.OUTPUT, True),
initialize_pin(logger, board.RF2_RST, digitalio.Direction.OUTPUT, True),
initialize_pin(logger, board.RF2_IO0, digitalio.Direction.OUTPUT, True),
2.4,
initialize_pin(logger, board.RF2_TX_EN, digitalio.Direction.OUTPUT, False),
initialize_pin(logger, board.RF2_RX_EN, digitalio.Direction.OUTPUT, False),
)
i2c1 = initialize_i2c_bus(
logger,
board.SCL1,
board.SDA1,
100000,
)
sleep_helper = SleepHelper(logger, config, watchdog)
uhf_radio = RFM9xManager(
logger,
config.radio,
spi0,
initialize_pin(logger, board.SPI0_CS0, digitalio.Direction.OUTPUT, True),
initialize_pin(logger, board.RF1_RST, digitalio.Direction.OUTPUT, True),
)
magnetometer = LIS2MDLManager(logger, i2c1)
imu = LSM6DSOXManager(logger, i2c1, 0x6B)
uhf_packet_manager = PacketManager(
logger,
uhf_radio,
config.radio.license,
Counter(Register.message_count),
0.2,
)
cdh = CommandDataHandler(logger, config, uhf_packet_manager)
beacon = Beacon(
logger,
config.cubesat_name,
uhf_packet_manager,
boot_time,
imu,
magnetometer,
uhf_radio,
sband_radio,
error_count,
boot_count,
)
try:
logger.info("Entering main loop")
while True:
# TODO(nateinaction): Modify behavior based on power state
listener_nominal_power_loop(logger, uhf_packet_manager, sleep_helper)
# nominal_power_loop(logger, uhf_packet_manager, sleep_helper, cube_ids=["Listener1", "Listener2", "Listener3"])
except Exception as e:
logger.critical("Critical in Main Loop", e)
time.sleep(10)
microcontroller.on_next_reset(microcontroller.RunMode.NORMAL)
microcontroller.reset()
finally:
logger.info("Going Neutral!")
except Exception as e:
logger.critical("An exception occured within main.py", e)