car chassis
Dependencies: Servo mbed-rtos mbed
diag.cpp@4:7fa7f78cbb92, 2015-10-13 (annotated)
- Committer:
- mariob
- Date:
- Tue Oct 13 14:08:44 2015 +0000
- Revision:
- 4:7fa7f78cbb92
- Parent:
- 3:bfc20ec72b15
delete unused library
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
mariob | 1:79b1ee0f97ef | 1 | #include "car_config.hpp" |
mariob | 2:7dfc8dd6aab3 | 2 | #include "can.hpp" |
mariob | 2:7dfc8dd6aab3 | 3 | #include "net.hpp" |
mariob | 1:79b1ee0f97ef | 4 | #include "mbed.h" |
mariob | 1:79b1ee0f97ef | 5 | #include "rtos.h" |
mariob | 1:79b1ee0f97ef | 6 | |
mariob | 3:bfc20ec72b15 | 7 | void init_diag () { |
mariob | 1:79b1ee0f97ef | 8 | } |
mariob | 1:79b1ee0f97ef | 9 | |
mariob | 3:bfc20ec72b15 | 10 | void thread_diag (void const *args) { |
mariob | 2:7dfc8dd6aab3 | 11 | while(1) { |
mariob | 3:bfc20ec72b15 | 12 | if (can_cmd_diag.flag == CAN_FLAG_RECEIVED) { |
mariob | 3:bfc20ec72b15 | 13 | uint16 cmd = can_cmd_diag.payload.msg.cmd; |
mariob | 3:bfc20ec72b15 | 14 | uint32 data = can_cmd_diag.payload.msg.data; |
mariob | 2:7dfc8dd6aab3 | 15 | switch(cmd) { |
mariob | 2:7dfc8dd6aab3 | 16 | case CMD_ECHO: |
mariob | 3:bfc20ec72b15 | 17 | can_sts_diag.payload.msg.data = data; |
mariob | 3:bfc20ec72b15 | 18 | can_sts_diag.flag = CAN_FLAG_SEND; |
mariob | 2:7dfc8dd6aab3 | 19 | break; |
mariob | 2:7dfc8dd6aab3 | 20 | default: |
mariob | 2:7dfc8dd6aab3 | 21 | //ignore it |
mariob | 2:7dfc8dd6aab3 | 22 | break; |
mariob | 2:7dfc8dd6aab3 | 23 | } |
mariob | 3:bfc20ec72b15 | 24 | can_cmd_diag.flag = CAN_FLAG_EMPTY; |
mariob | 1:79b1ee0f97ef | 25 | } |
mariob | 3:bfc20ec72b15 | 26 | Thread::wait(DIAG_THREAD_PERIOD); |
mariob | 2:7dfc8dd6aab3 | 27 | } |
mariob | 1:79b1ee0f97ef | 28 | } |