amiro-os / os / core / src / main.c @ 42f1b573
History | View | Annotate | Download (13.014 KB)
1 |
/*
|
---|---|
2 |
AMiRo-OS is an operating system designed for the Autonomous Mini Robot (AMiRo) platform.
|
3 |
Copyright (C) 2016..2018 Thomas Schöpping et al.
|
4 |
|
5 |
This program is free software: you can redistribute it and/or modify
|
6 |
it under the terms of the GNU General Public License as published by
|
7 |
the Free Software Foundation, either version 3 of the License, or
|
8 |
(at your option) any later version.
|
9 |
|
10 |
This program is distributed in the hope that it will be useful,
|
11 |
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
12 |
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
13 |
GNU General Public License for more details.
|
14 |
|
15 |
You should have received a copy of the GNU General Public License
|
16 |
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
17 |
*/
|
18 |
|
19 |
#include <hal.h> |
20 |
#include <ch.h> |
21 |
#include <amiroos.h> |
22 |
|
23 |
/**
|
24 |
* @brief Event mask to identify I/O events.
|
25 |
*/
|
26 |
#define IOEVENT_MASK EVENT_MASK(0) |
27 |
|
28 |
/**
|
29 |
* @brief Event mask to identify OS events.
|
30 |
*/
|
31 |
#define OSEVENT_MASK EVENT_MASK(1) |
32 |
|
33 |
/**
|
34 |
* @brief Listener object for I/O events.
|
35 |
*/
|
36 |
static event_listener_t _eventListenerIO;
|
37 |
|
38 |
/**
|
39 |
* @brief Listener object for OS events.
|
40 |
*/
|
41 |
static event_listener_t _eventListenerOS;
|
42 |
|
43 |
#if defined(MODULE_HAL_PROGIF) || defined(__DOXYGEN__)
|
44 |
/**
|
45 |
* @brief I/O channel for the programmer interface.
|
46 |
*/
|
47 |
static AosIOChannel _stdiochannel;
|
48 |
|
49 |
/**
|
50 |
* @brief I/O shell channel for the programmer interface.
|
51 |
*/
|
52 |
static AosShellChannel _stdshellchannel;
|
53 |
#endif
|
54 |
|
55 |
/**
|
56 |
* @brief Prints an error message about an unexpected event.
|
57 |
*
|
58 |
* @param[in] mask The event mask.
|
59 |
* @param[in] flags The event flags.
|
60 |
*/
|
61 |
static inline void _unexpectedEventError(eventmask_t mask, eventflags_t flags) |
62 |
{ |
63 |
aosprintf("unexpected/unknown event recieved. mask: 0x%08X; flags: 0x%08X\n", mask, flags);
|
64 |
return;
|
65 |
} |
66 |
|
67 |
/**
|
68 |
* @brief Application entry point.
|
69 |
*/
|
70 |
int main(void) |
71 |
{ |
72 |
// local variables
|
73 |
eventmask_t eventmask = 0;
|
74 |
eventflags_t eventflags = 0;
|
75 |
aos_shutdown_t shutdown = AOS_SHUTDOWN_NONE; |
76 |
#if defined(AMIROOS_CFG_MAIN_EXTRA_VARIABLES)
|
77 |
AMIROOS_CFG_MAIN_EXTRA_VARIABLES |
78 |
#endif
|
79 |
|
80 |
/*
|
81 |
* ##########################################################################
|
82 |
* # system initialization #
|
83 |
* ##########################################################################
|
84 |
*/
|
85 |
|
86 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_0)
|
87 |
AMIROOS_CFG_MAIN_INIT_HOOK_0(); |
88 |
#endif
|
89 |
|
90 |
/* hardware, kernel, and operating system initialization */
|
91 |
// ChibiOS/HAL and custom hal additions (if any)
|
92 |
halInit(); |
93 |
#ifdef MODULE_INIT_HAL_EXTRA
|
94 |
MODULE_INIT_HAL_EXTRA(); |
95 |
#endif
|
96 |
|
97 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_1)
|
98 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_1_ARGS)
|
99 |
AMIROOS_CFG_MAIN_INIT_HOOK_1(AMIROOS_CFG_MAIN_INIT_HOOK_1_ARGS); |
100 |
#else
|
101 |
AMIROOS_CFG_MAIN_INIT_HOOK_1(); |
102 |
#endif
|
103 |
#endif
|
104 |
|
105 |
// ChibiOS/RT kernel and custom kernel additions (if any)
|
106 |
chSysInit(); |
107 |
#ifdef MODULE_INIT_KERNEL_EXTRA
|
108 |
MODULE_INIT_KERNEL_EXTRA(); |
109 |
#endif
|
110 |
|
111 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_2)
|
112 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_2_ARGS)
|
113 |
AMIROOS_CFG_MAIN_INIT_HOOK_2(AMIROOS_CFG_MAIN_INIT_HOOK_2_ARGS); |
114 |
#else
|
115 |
AMIROOS_CFG_MAIN_INIT_HOOK_2(); |
116 |
#endif
|
117 |
#endif
|
118 |
|
119 |
// AMiRo-OS and custom OS additions (if any)
|
120 |
aosSysInit(&MODULE_HAL_EXT, |
121 |
&moduleHalExtConfig, |
122 |
&moduleSsspPd, |
123 |
&moduleSsspSync, |
124 |
MODULE_OS_IOEVENTFLAGS_SYSPD, |
125 |
MODULE_OS_IOEVENTFLAGS_SYSSYNC, |
126 |
moduleShellPrompt); |
127 |
#ifdef MODULE_INIT_OS_EXTRA
|
128 |
MODULE_INIT_OS_EXTRA(); |
129 |
#endif
|
130 |
|
131 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_3)
|
132 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_3_ARGS)
|
133 |
AMIROOS_CFG_MAIN_INIT_HOOK_3(AMIROOS_CFG_MAIN_INIT_HOOK_3_ARGS); |
134 |
#else
|
135 |
AMIROOS_CFG_MAIN_INIT_HOOK_3(); |
136 |
#endif
|
137 |
#endif
|
138 |
|
139 |
#if (AMIROOS_CFG_TESTS_ENABLE == true) |
140 |
#if defined(MODULE_INIT_TESTS)
|
141 |
MODULE_INIT_TESTS(); |
142 |
#else
|
143 |
#warning "MODULE_INIT_TESTS not defined" |
144 |
#endif
|
145 |
#endif
|
146 |
|
147 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_4)
|
148 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_4_ARGS)
|
149 |
AMIROOS_CFG_MAIN_INIT_HOOK_4(AMIROOS_CFG_MAIN_INIT_HOOK_4_ARGS); |
150 |
#else
|
151 |
AMIROOS_CFG_MAIN_INIT_HOOK_4(); |
152 |
#endif
|
153 |
#endif
|
154 |
|
155 |
/* event associations */
|
156 |
chEvtRegisterMask(&aos.events.io.source, &_eventListenerIO, IOEVENT_MASK); |
157 |
chEvtRegisterMask(&aos.events.os.source, &_eventListenerOS, OSEVENT_MASK); |
158 |
|
159 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_5)
|
160 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_5_ARGS)
|
161 |
AMIROOS_CFG_MAIN_INIT_HOOK_5(AMIROOS_CFG_MAIN_INIT_HOOK_5_ARGS); |
162 |
#else
|
163 |
AMIROOS_CFG_MAIN_INIT_HOOK_5(); |
164 |
#endif
|
165 |
#endif
|
166 |
|
167 |
/* periphery communication initialization */
|
168 |
// CAN (mandatory)
|
169 |
canStart(&MODULE_HAL_CAN, &moduleHalCanConfig); |
170 |
// module specific initialization (if any)
|
171 |
#ifdef MODULE_INIT_PERIPHERY_COMM
|
172 |
MODULE_INIT_PERIPHERY_COMM(); |
173 |
#endif
|
174 |
// user interface (if any)
|
175 |
#ifdef MODULE_HAL_PROGIF
|
176 |
aosIOChannelInit(&_stdiochannel, (BaseAsynchronousChannel*)&MODULE_HAL_PROGIF); |
177 |
aosIOChannelOutputEnable(&_stdiochannel); |
178 |
aosIOStreamAddChannel(&aos.iostream, &_stdiochannel); |
179 |
#if (AMIROOS_CFG_SHELL_ENABLE == true) |
180 |
aosShellChannelInit(&_stdshellchannel, &_stdiochannel); |
181 |
aosShellChannelInputEnable(&_stdshellchannel); |
182 |
aosShellChannelOutputEnable(&_stdshellchannel); |
183 |
aosShellStreamAddChannel(&aos.shell->stream, &_stdshellchannel); |
184 |
#endif
|
185 |
#endif
|
186 |
|
187 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_6)
|
188 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_6_ARGS)
|
189 |
AMIROOS_CFG_MAIN_INIT_HOOK_6(AMIROOS_CFG_MAIN_INIT_HOOK_6_ARGS); |
190 |
#else
|
191 |
AMIROOS_CFG_MAIN_INIT_HOOK_6(); |
192 |
#endif
|
193 |
#endif
|
194 |
|
195 |
/* module is ready -> print welcome prompt */
|
196 |
aosprintf("\n");
|
197 |
aosprintf("######################################################################\n");
|
198 |
aosprintf("# AMiRo-OS is an operating system designed for the Autonomous Mini #\n");
|
199 |
aosprintf("# Robot (AMiRo) platform. #\n");
|
200 |
aosprintf("# Copyright (C) 2016..2018 Thomas Schöpping et al. #\n");
|
201 |
aosprintf("# #\n");
|
202 |
aosprintf("# This is free software; see the source for copying conditions. #\n");
|
203 |
aosprintf("# There is NO warranty; not even for MERCHANTABILITY or FITNESS FOR #\n");
|
204 |
aosprintf("# A PARTICULAR PURPOSE. #\n");
|
205 |
aosprintf("# The development of this software was supported by the Excellence #\n");
|
206 |
aosprintf("# Cluster EXC 227 Cognitive Interaction Technology. The Excellence #\n");
|
207 |
aosprintf("# Cluster EXC 227 is a grant of the Deutsche Forschungsgemeinschaft #\n");
|
208 |
aosprintf("# (DFG) in the context of the German Excellence Initiative. #\n");
|
209 |
aosprintf("######################################################################\n");
|
210 |
aosprintf("\n");
|
211 |
|
212 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_7)
|
213 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_7_ARGS)
|
214 |
AMIROOS_CFG_MAIN_INIT_HOOK_7(AMIROOS_CFG_MAIN_INIT_HOOK_7_ARGS); |
215 |
#else
|
216 |
AMIROOS_CFG_MAIN_INIT_HOOK_7(); |
217 |
#endif
|
218 |
#endif
|
219 |
|
220 |
/* SSSP startup outro (end of startup stage 2) synchronization */
|
221 |
while ((eventmask = aosSysSsspStartupOsInitSyncCheck(&_eventListenerIO)) != 0) { |
222 |
/*
|
223 |
* This code is executed if the received event was not about the SYS_SYNC control signal.
|
224 |
* The returned event could be caused by any listener (not only the argument).
|
225 |
*/
|
226 |
// unexpected IO events
|
227 |
if (eventmask & _eventListenerIO.events) {
|
228 |
eventflags = chEvtGetAndClearFlags(&_eventListenerIO); |
229 |
#ifdef MODULE_SSP_STARTUP_OUTRO_IO_EVENT
|
230 |
MODULE_SSP_STARTUP_OUTRO_IO_EVENT(eventmask, eventflags); |
231 |
#else
|
232 |
_unexpectedEventError(eventmask, eventflags); |
233 |
#endif
|
234 |
} |
235 |
// unexpected OS event
|
236 |
else if (eventmask & _eventListenerOS.events) { |
237 |
eventflags = chEvtGetAndClearFlags(&_eventListenerOS); |
238 |
_unexpectedEventError(eventmask, eventflags); |
239 |
} |
240 |
#if (AMIROOS_CFG_DBG == true) |
241 |
// unknown event (must never occur, thus disabled for release builds)
|
242 |
else {
|
243 |
eventflags = 0;
|
244 |
_unexpectedEventError(eventmask, eventflags); |
245 |
} |
246 |
#endif
|
247 |
} |
248 |
|
249 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_8)
|
250 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_8_ARGS)
|
251 |
AMIROOS_CFG_MAIN_INIT_HOOK_8(AMIROOS_CFG_MAIN_INIT_HOOK_8_ARGS); |
252 |
#else
|
253 |
AMIROOS_CFG_MAIN_INIT_HOOK_8(); |
254 |
#endif
|
255 |
#endif
|
256 |
|
257 |
/* completely start AMiRo-OS */
|
258 |
aosSysStart(); |
259 |
|
260 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_9)
|
261 |
#if defined(AMIROOS_CFG_MAIN_INIT_HOOK_9_ARGS)
|
262 |
AMIROOS_CFG_MAIN_INIT_HOOK_9(AMIROOS_CFG_MAIN_INIT_HOOK_9_ARGS); |
263 |
#else
|
264 |
AMIROOS_CFG_MAIN_INIT_HOOK_9(); |
265 |
#endif
|
266 |
#endif
|
267 |
|
268 |
/*
|
269 |
* ##########################################################################
|
270 |
* # infinite loop #
|
271 |
* ##########################################################################
|
272 |
*/
|
273 |
|
274 |
// sleep until a shutdown event is received
|
275 |
while (shutdown == AOS_SHUTDOWN_NONE) {
|
276 |
// wait for an event
|
277 |
#if (AMIROOS_CFG_MAIN_LOOP_TIMEOUT != 0) |
278 |
eventmask = chEvtWaitOneTimeout(ALL_EVENTS, US2ST_LLD(AMIROOS_CFG_MAIN_LOOP_TIMEOUT)); |
279 |
#else
|
280 |
eventmask = chEvtWaitOne(ALL_EVENTS); |
281 |
#endif
|
282 |
|
283 |
#if defined(AMIROOS_CFG_MAIN_LOOP_HOOK_0)
|
284 |
#if defined(AMIROOS_CFG_MAIN_LOOP_HOOK_0_ARGS)
|
285 |
AMIROOS_CFG_MAIN_LOOP_HOOK_0(AMIROOS_CFG_MAIN_LOOP_HOOK_0_ARGS); |
286 |
#else
|
287 |
AMIROOS_CFG_MAIN_LOOP_HOOK_0(); |
288 |
#endif
|
289 |
#endif
|
290 |
|
291 |
switch (eventmask) {
|
292 |
// if this was an I/O event
|
293 |
case IOEVENT_MASK:
|
294 |
// evaluate flags
|
295 |
eventflags = chEvtGetAndClearFlags(&_eventListenerIO); |
296 |
// PD event
|
297 |
if (eventflags & MODULE_OS_IOEVENTFLAGS_SYSPD) {
|
298 |
shutdown = AOS_SHUTDOWN_PASSIVE; |
299 |
} |
300 |
// all other events
|
301 |
#ifdef MODULE_MAIN_LOOP_IO_EVENT
|
302 |
else {
|
303 |
MODULE_MAIN_LOOP_IO_EVENT(eventmask, eventflags); |
304 |
} |
305 |
#endif
|
306 |
break;
|
307 |
|
308 |
// if this was an OS event
|
309 |
case OSEVENT_MASK:
|
310 |
// evaluate flags
|
311 |
eventflags = chEvtGetAndClearFlags(&_eventListenerOS); |
312 |
switch (eventflags) {
|
313 |
case AOS_SYSTEM_EVENTFLAGS_HIBERNATE:
|
314 |
shutdown = AOS_SHUTDOWN_HIBERNATE; |
315 |
break;
|
316 |
case AOS_SYSTEM_EVENTFLAGS_DEEPSLEEP:
|
317 |
shutdown = AOS_SHUTDOWN_DEEPSLEEP; |
318 |
break;
|
319 |
case AOS_SYSTEM_EVENTFLAGS_TRANSPORTATION:
|
320 |
shutdown = AOS_SHUTDOWN_TRANSPORTATION; |
321 |
break;
|
322 |
case AOS_SYSTEM_EVENTFLAGS_RESTART:
|
323 |
shutdown = AOS_SHUTDOWN_RESTART; |
324 |
break;
|
325 |
default:
|
326 |
_unexpectedEventError(eventmask, eventflags); |
327 |
break;
|
328 |
} |
329 |
break;
|
330 |
|
331 |
// if this was any other event (should be impossible to occur)
|
332 |
default:
|
333 |
eventflags = 0;
|
334 |
_unexpectedEventError(eventmask, eventflags); |
335 |
break;
|
336 |
} |
337 |
|
338 |
#if defined(AMIROOS_CFG_MAIN_LOOP_HOOK_1)
|
339 |
#if defined(AMIROOS_CFG_MAIN_LOOP_HOOK_1_ARGS)
|
340 |
AMIROOS_CFG_MAIN_LOOP_HOOK_1(AMIROOS_CFG_MAIN_LOOP_HOOK_1_ARGS); |
341 |
#else
|
342 |
AMIROOS_CFG_MAIN_LOOP_HOOK_1(); |
343 |
#endif
|
344 |
#endif
|
345 |
} |
346 |
|
347 |
/*
|
348 |
* ##########################################################################
|
349 |
* # system shutdown #
|
350 |
* ##########################################################################
|
351 |
*/
|
352 |
|
353 |
#if defined(AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_0)
|
354 |
#if defined(AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_0_ARGS)
|
355 |
AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_0(AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_0_ARGS); |
356 |
#else
|
357 |
AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_0(); |
358 |
#endif
|
359 |
#endif
|
360 |
|
361 |
// initialize/acknowledge shutdown
|
362 |
aosSysShutdownInit(shutdown); |
363 |
|
364 |
#if defined(AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_1)
|
365 |
#if defined(AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_1_ARGS)
|
366 |
AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_1(AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_1_ARGS); |
367 |
#else
|
368 |
AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_1(); |
369 |
#endif
|
370 |
#endif
|
371 |
|
372 |
// stop system threads
|
373 |
aosSysStop(); |
374 |
|
375 |
#if defined(AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_2)
|
376 |
#if defined(AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_2_ARGS)
|
377 |
AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_2(AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_2_ARGS); |
378 |
#else
|
379 |
AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_2(); |
380 |
#endif
|
381 |
#endif
|
382 |
|
383 |
// deinitialize system
|
384 |
aosSysDeinit(); |
385 |
|
386 |
#if defined(AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_3)
|
387 |
#if defined(AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_3_ARGS)
|
388 |
AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_3(AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_3_ARGS); |
389 |
#else
|
390 |
AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_3(); |
391 |
#endif
|
392 |
#endif
|
393 |
|
394 |
/* stop all periphery communication */
|
395 |
// CAN (mandatory)
|
396 |
canStop(&MODULE_HAL_CAN); |
397 |
#ifdef MODULE_SHUTDOWN_PERIPHERY_COMM
|
398 |
MODULE_SHUTDOWN_PERIPHERY_COMM(); |
399 |
#endif
|
400 |
|
401 |
#if defined(AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_4)
|
402 |
#if defined(AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_4_ARGS)
|
403 |
AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_4(AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_4_ARGS); |
404 |
#else
|
405 |
AMIROOS_CFG_MAIN_SHUTDOWN_HOOK_4(); |
406 |
#endif
|
407 |
#endif
|
408 |
|
409 |
// finally hand over to bootloader
|
410 |
aosSysShutdownFinal(&MODULE_HAL_EXT, shutdown); |
411 |
|
412 |
/*
|
413 |
* ##########################################################################
|
414 |
* # after shutdown/restart #
|
415 |
* ##########################################################################
|
416 |
*
|
417 |
* NOTE: This code will not be executed, since the bootloader callbacks will stop/restart the MCU.
|
418 |
* It is included nevertheless for the sake of completeness and to explicitely indicate,
|
419 |
* which subsystems should NOT be shut down.
|
420 |
*/
|
421 |
|
422 |
// return an error, since this code should not be executed
|
423 |
return -1; |
424 |
} |