Nurbol Nurdaulet
/
2sensors_2servo_17_11_11
Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
cmd_io.cpp@0:d33360d14a57, 2011-11-17 (annotated)
- Committer:
- Nurbol
- Date:
- Thu Nov 17 17:03:22 2011 +0000
- Revision:
- 0:d33360d14a57
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| Nurbol | 0:d33360d14a57 | 1 | // |
| Nurbol | 0:d33360d14a57 | 2 | // cmd_io.cpp : library of routines to communicate with virtual COM port |
| Nurbol | 0:d33360d14a57 | 3 | // ========== |
| Nurbol | 0:d33360d14a57 | 4 | // |
| Nurbol | 0:d33360d14a57 | 5 | #include "mbed.h" |
| Nurbol | 0:d33360d14a57 | 6 | #include "cmd_io.h" |
| Nurbol | 0:d33360d14a57 | 7 | #include "globals.h" |
| Nurbol | 0:d33360d14a57 | 8 | |
| Nurbol | 0:d33360d14a57 | 9 | //************************************************************************ |
| Nurbol | 0:d33360d14a57 | 10 | // |
| Nurbol | 0:d33360d14a57 | 11 | // get_cmd - read a command string from the serial port |
| Nurbol | 0:d33360d14a57 | 12 | // ======= |
| Nurbol | 0:d33360d14a57 | 13 | // |
| Nurbol | 0:d33360d14a57 | 14 | // Method |
| Nurbol | 0:d33360d14a57 | 15 | // 1. Read string of data until a Newline character |
| Nurbol | 0:d33360d14a57 | 16 | // string is passed as the parameter |
| Nurbol | 0:d33360d14a57 | 17 | // 2. return a sting through the pointer and a count of the number of characters |
| Nurbol | 0:d33360d14a57 | 18 | // |
| Nurbol | 0:d33360d14a57 | 19 | // Notes |
| Nurbol | 0:d33360d14a57 | 20 | // |
| Nurbol | 0:d33360d14a57 | 21 | uint32_t get_cmd(CMD_STRUCT *command) |
| Nurbol | 0:d33360d14a57 | 22 | { |
| Nurbol | 0:d33360d14a57 | 23 | char ch; |
| Nurbol | 0:d33360d14a57 | 24 | uint8_t i; |
| Nurbol | 0:d33360d14a57 | 25 | // |
| Nurbol | 0:d33360d14a57 | 26 | // read string and use newline as terminator |
| Nurbol | 0:d33360d14a57 | 27 | // |
| Nurbol | 0:d33360d14a57 | 28 | for (i= 0 ; i < CMD_STR_BUFFER_SZ ; i++) { |
| Nurbol | 0:d33360d14a57 | 29 | ch = pc.getc(); |
| Nurbol | 0:d33360d14a57 | 30 | if (ch == '\r') { |
| Nurbol | 0:d33360d14a57 | 31 | continue; |
| Nurbol | 0:d33360d14a57 | 32 | } |
| Nurbol | 0:d33360d14a57 | 33 | command->cmd_str[i] = ch; |
| Nurbol | 0:d33360d14a57 | 34 | if (ch == '\n') { |
| Nurbol | 0:d33360d14a57 | 35 | command->cmd_str[i] = '\0'; |
| Nurbol | 0:d33360d14a57 | 36 | break; |
| Nurbol | 0:d33360d14a57 | 37 | } |
| Nurbol | 0:d33360d14a57 | 38 | } |
| Nurbol | 0:d33360d14a57 | 39 | command->char_cnt = i; // record character count |
| Nurbol | 0:d33360d14a57 | 40 | command->result_status = OK; |
| Nurbol | 0:d33360d14a57 | 41 | return 0; |
| Nurbol | 0:d33360d14a57 | 42 | } |
| Nurbol | 0:d33360d14a57 | 43 | |
| Nurbol | 0:d33360d14a57 | 44 | //************************************************************************ |
| Nurbol | 0:d33360d14a57 | 45 | // |
| Nurbol | 0:d33360d14a57 | 46 | // parse_cmd - split command into its component parts |
| Nurbol | 0:d33360d14a57 | 47 | // ========= |
| Nurbol | 0:d33360d14a57 | 48 | // |
| Nurbol | 0:d33360d14a57 | 49 | // Method |
| Nurbol | 0:d33360d14a57 | 50 | // 1. first character is the command code |
| Nurbol | 0:d33360d14a57 | 51 | // 2. subsequent character define a set of parameters |
| Nurbol | 0:d33360d14a57 | 52 | // |
| Nurbol | 0:d33360d14a57 | 53 | // String is located in the CMD_STRUCT and the resulting |
| Nurbol | 0:d33360d14a57 | 54 | // data is returned to the same structure. |
| Nurbol | 0:d33360d14a57 | 55 | // |
| Nurbol | 0:d33360d14a57 | 56 | // Notes |
| Nurbol | 0:d33360d14a57 | 57 | // |
| Nurbol | 0:d33360d14a57 | 58 | uint32_t parse_cmd(CMD_STRUCT *command) |
| Nurbol | 0:d33360d14a57 | 59 | { |
| Nurbol | 0:d33360d14a57 | 60 | uint8_t param_cnt, i, state; |
| Nurbol | 0:d33360d14a57 | 61 | uint16_t tmp; |
| Nurbol | 0:d33360d14a57 | 62 | |
| Nurbol | 0:d33360d14a57 | 63 | command->cmd_code = command->cmd_str[0]; |
| Nurbol | 0:d33360d14a57 | 64 | param_cnt = 0; |
| Nurbol | 0:d33360d14a57 | 65 | tmp = 0; |
| Nurbol | 0:d33360d14a57 | 66 | state = 0; |
| Nurbol | 0:d33360d14a57 | 67 | for (i=1 ; i < CMD_STR_BUFFER_SZ ; i++) { // step through characters |
| Nurbol | 0:d33360d14a57 | 68 | if (command->cmd_str[i] == '\0') { |
| Nurbol | 0:d33360d14a57 | 69 | if (state == 1) { // count paramter that is terminated by NEWLINE |
| Nurbol | 0:d33360d14a57 | 70 | command->param[param_cnt] = tmp; |
| Nurbol | 0:d33360d14a57 | 71 | param_cnt++; |
| Nurbol | 0:d33360d14a57 | 72 | } |
| Nurbol | 0:d33360d14a57 | 73 | command->nos_params = param_cnt; |
| Nurbol | 0:d33360d14a57 | 74 | return OK; |
| Nurbol | 0:d33360d14a57 | 75 | } |
| Nurbol | 0:d33360d14a57 | 76 | if ((command->cmd_str[i] == ' ') && (state == 0)) { // skip spaces |
| Nurbol | 0:d33360d14a57 | 77 | continue; |
| Nurbol | 0:d33360d14a57 | 78 | } |
| Nurbol | 0:d33360d14a57 | 79 | if ((command->cmd_str[i] == ' ') && (state == 1)) { // skip spaces |
| Nurbol | 0:d33360d14a57 | 80 | state = 0; |
| Nurbol | 0:d33360d14a57 | 81 | command->param[param_cnt] = tmp; |
| Nurbol | 0:d33360d14a57 | 82 | param_cnt++; |
| Nurbol | 0:d33360d14a57 | 83 | tmp = 0; |
| Nurbol | 0:d33360d14a57 | 84 | continue; |
| Nurbol | 0:d33360d14a57 | 85 | } |
| Nurbol | 0:d33360d14a57 | 86 | state = 1; |
| Nurbol | 0:d33360d14a57 | 87 | if ((command->cmd_str[i] >= '0') && (command->cmd_str[i] <= '9')) { |
| Nurbol | 0:d33360d14a57 | 88 | tmp = (tmp * 10) + (command->cmd_str[i] - '0'); |
| Nurbol | 0:d33360d14a57 | 89 | } else { |
| Nurbol | 0:d33360d14a57 | 90 | command->param[param_cnt] = tmp; |
| Nurbol | 0:d33360d14a57 | 91 | return CMD_BAD_CHARACTER; |
| Nurbol | 0:d33360d14a57 | 92 | } |
| Nurbol | 0:d33360d14a57 | 93 | } |
| Nurbol | 0:d33360d14a57 | 94 | return CMD_NO_TERMINATOR; |
| Nurbol | 0:d33360d14a57 | 95 | } |
| Nurbol | 0:d33360d14a57 | 96 | |
| Nurbol | 0:d33360d14a57 | 97 | //************************************************************************ |
| Nurbol | 0:d33360d14a57 | 98 | // |
| Nurbol | 0:d33360d14a57 | 99 | // reply_to_cmd - return data and status info |
| Nurbol | 0:d33360d14a57 | 100 | // ============ |
| Nurbol | 0:d33360d14a57 | 101 | // |
| Nurbol | 0:d33360d14a57 | 102 | // Method |
| Nurbol | 0:d33360d14a57 | 103 | // |
| Nurbol | 0:d33360d14a57 | 104 | // Notes |
| Nurbol | 0:d33360d14a57 | 105 | // |
| Nurbol | 0:d33360d14a57 | 106 | void reply_to_cmd(CMD_STRUCT *command) |
| Nurbol | 0:d33360d14a57 | 107 | { |
| Nurbol | 0:d33360d14a57 | 108 | send_status(command->result_status); |
| Nurbol | 0:d33360d14a57 | 109 | if ((command->result_status == OK) && (command->nos_data > 0)) { |
| Nurbol | 0:d33360d14a57 | 110 | send_data(command); |
| Nurbol | 0:d33360d14a57 | 111 | } |
| Nurbol | 0:d33360d14a57 | 112 | } |
| Nurbol | 0:d33360d14a57 | 113 | |
| Nurbol | 0:d33360d14a57 | 114 | //************************************************************************ |
| Nurbol | 0:d33360d14a57 | 115 | // |
| Nurbol | 0:d33360d14a57 | 116 | // send_status - command status |
| Nurbol | 0:d33360d14a57 | 117 | // =========== |
| Nurbol | 0:d33360d14a57 | 118 | // |
| Nurbol | 0:d33360d14a57 | 119 | // Notes |
| Nurbol | 0:d33360d14a57 | 120 | // return status value as a positive interger in a string format |
| Nurbol | 0:d33360d14a57 | 121 | // with a terminating newline character. |
| Nurbol | 0:d33360d14a57 | 122 | // |
| Nurbol | 0:d33360d14a57 | 123 | void send_status(uint32_t value) |
| Nurbol | 0:d33360d14a57 | 124 | { |
| Nurbol | 0:d33360d14a57 | 125 | pc.printf("%d\n", value); |
| Nurbol | 0:d33360d14a57 | 126 | return; |
| Nurbol | 0:d33360d14a57 | 127 | } |
| Nurbol | 0:d33360d14a57 | 128 | |
| Nurbol | 0:d33360d14a57 | 129 | //************************************************************************ |
| Nurbol | 0:d33360d14a57 | 130 | // |
| Nurbol | 0:d33360d14a57 | 131 | // send_data - send data appropriate to the command |
| Nurbol | 0:d33360d14a57 | 132 | // ========= |
| Nurbol | 0:d33360d14a57 | 133 | // |
| Nurbol | 0:d33360d14a57 | 134 | // Method |
| Nurbol | 0:d33360d14a57 | 135 | // |
| Nurbol | 0:d33360d14a57 | 136 | // Notes |
| Nurbol | 0:d33360d14a57 | 137 | // |
| Nurbol | 0:d33360d14a57 | 138 | void send_data(CMD_STRUCT *command) |
| Nurbol | 0:d33360d14a57 | 139 | { |
| Nurbol | 0:d33360d14a57 | 140 | char buffer[80]; |
| Nurbol | 0:d33360d14a57 | 141 | uint8_t i; |
| Nurbol | 0:d33360d14a57 | 142 | // |
| Nurbol | 0:d33360d14a57 | 143 | // create data string |
| Nurbol | 0:d33360d14a57 | 144 | // |
| Nurbol | 0:d33360d14a57 | 145 | if (command->nos_data == 1) { |
| Nurbol | 0:d33360d14a57 | 146 | sprintf(buffer, "%u\n", (int)command->result_data[0]); |
| Nurbol | 0:d33360d14a57 | 147 | } |
| Nurbol | 0:d33360d14a57 | 148 | if (command->nos_data == 2) { |
| Nurbol | 0:d33360d14a57 | 149 | sprintf(buffer, "%u %u\n", (int)command->result_data[0], (int)command->result_data[1]); |
| Nurbol | 0:d33360d14a57 | 150 | } |
| Nurbol | 0:d33360d14a57 | 151 | // |
| Nurbol | 0:d33360d14a57 | 152 | // send string |
| Nurbol | 0:d33360d14a57 | 153 | // |
| Nurbol | 0:d33360d14a57 | 154 | for (i = 0 ; i < 40 ; i++) { |
| Nurbol | 0:d33360d14a57 | 155 | if (buffer[i] == '\0') { // do not send NULL character |
| Nurbol | 0:d33360d14a57 | 156 | return; |
| Nurbol | 0:d33360d14a57 | 157 | } |
| Nurbol | 0:d33360d14a57 | 158 | pc.putc(buffer[i]); |
| Nurbol | 0:d33360d14a57 | 159 | } |
| Nurbol | 0:d33360d14a57 | 160 | return; |
| Nurbol | 0:d33360d14a57 | 161 | } |