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