![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
TRR2018 omar
Fork of biniou by
main.cpp@52:228703200e35, 2018-09-21 (annotated)
- Committer:
- ohlimi2
- Date:
- Fri Sep 21 17:29:30 2018 +0000
- Revision:
- 52:228703200e35
- Parent:
- 39:de3638276b7e
version bof
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
GaspardD | 8:1d8c3ca5e508 | 1 | #include "stateMachines.h" |
GaspardD | 33:88d8f254c0b7 | 2 | |
GaspardD | 23:04d393220daa | 3 | Timer timerLoop; |
GaspardD | 29:fc984fe08ca7 | 4 | #if DEBUG >= -1 |
GaspardD | 29:fc984fe08ca7 | 5 | InterruptIn dump_button(USER_BUTTON); |
GaspardD | 29:fc984fe08ca7 | 6 | #endif |
GaspardD | 29:fc984fe08ca7 | 7 | |
ohlimi2 | 1:abed67ad1d03 | 8 | int main() |
ohlimi2 | 1:abed67ad1d03 | 9 | { |
GaspardD | 29:fc984fe08ca7 | 10 | #if DEBUG >= -1 |
GaspardD | 29:fc984fe08ca7 | 11 | dump_button.fall(&pressed); |
GaspardD | 29:fc984fe08ca7 | 12 | initSamples(); |
GaspardD | 29:fc984fe08ca7 | 13 | #endif |
GaspardD | 29:fc984fe08ca7 | 14 | initIntegrationTable(); |
GaspardD | 23:04d393220daa | 15 | mursInit(); |
GaspardD | 11:bc24b3ba51a9 | 16 | #ifdef DLVV |
GaspardD | 23:04d393220daa | 17 | obstacleInit(); |
GaspardD | 23:04d393220daa | 18 | #endif |
GaspardD | 23:04d393220daa | 19 | sectionInit(); |
GaspardD | 23:04d393220daa | 20 | maxSpeedInit(); |
GaspardD | 23:04d393220daa | 21 | throttleInit(); |
GaspardD | 23:04d393220daa | 22 | timerLoop.start(); |
GaspardD | 23:04d393220daa | 23 | while (1) { |
ohlimi2 | 37:810cdbcbbf3f | 24 | if(timerLoop.read_us()>20000) { // output every 20 ms |
GaspardD | 23:04d393220daa | 25 | timerLoop.reset(); |
GaspardD | 23:04d393220daa | 26 | timerLoop.start(); |
GaspardD | 23:04d393220daa | 27 | mursUpdate(); |
GaspardD | 23:04d393220daa | 28 | #ifdef DLVV |
GaspardD | 23:04d393220daa | 29 | obstacleUpdate(); |
GaspardD | 23:04d393220daa | 30 | #endif |
GaspardD | 27:f8c3f1524a64 | 31 | |
GaspardD | 27:f8c3f1524a64 | 32 | sectionUpdate(); |
GaspardD | 27:f8c3f1524a64 | 33 | maxSpeedUpdate(); |
GaspardD | 27:f8c3f1524a64 | 34 | throttleUpdate(); |
GaspardD | 11:bc24b3ba51a9 | 35 | |
ohlimi2 | 1:abed67ad1d03 | 36 | |
GaspardD | 27:f8c3f1524a64 | 37 | mursOutput(); |
GaspardD | 23:04d393220daa | 38 | #ifdef DLVV |
GaspardD | 27:f8c3f1524a64 | 39 | obstacleOutput(); |
GaspardD | 23:04d393220daa | 40 | #endif |
GaspardD | 27:f8c3f1524a64 | 41 | sectionOutput(); |
GaspardD | 27:f8c3f1524a64 | 42 | maxSpeedOutput(); |
GaspardD | 27:f8c3f1524a64 | 43 | throttleOutput(); |
GaspardD | 27:f8c3f1524a64 | 44 | } |
GaspardD | 23:04d393220daa | 45 | #ifdef SAMPLING |
GaspardD | 27:f8c3f1524a64 | 46 | sampleLog(); |
GaspardD | 23:04d393220daa | 47 | #endif |
GaspardD | 23:04d393220daa | 48 | |
ohlimi2 | 1:abed67ad1d03 | 49 | } |
GaspardD | 29:fc984fe08ca7 | 50 | } |