test public
Dependencies: HttpServer_snapshot_mbed-os
i2c_setting.cpp@0:e9fd5575b10e, 2019-10-18 (annotated)
- Committer:
- anhtran
- Date:
- Fri Oct 18 03:09:43 2019 +0000
- Revision:
- 0:e9fd5575b10e
abc
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
anhtran | 0:e9fd5575b10e | 1 | /* |
anhtran | 0:e9fd5575b10e | 2 | Permission is hereby granted, free of charge, to any person obtaining a copy |
anhtran | 0:e9fd5575b10e | 3 | of this software and associated documentation files (the "Software"), to deal |
anhtran | 0:e9fd5575b10e | 4 | in the Software without restriction, including without limitation the rights |
anhtran | 0:e9fd5575b10e | 5 | to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
anhtran | 0:e9fd5575b10e | 6 | copies of the Software, and to permit persons to whom the Software is |
anhtran | 0:e9fd5575b10e | 7 | furnished to do so, subject to the following conditions: |
anhtran | 0:e9fd5575b10e | 8 | |
anhtran | 0:e9fd5575b10e | 9 | The above copyright notice and this permission notice shall be included in |
anhtran | 0:e9fd5575b10e | 10 | all copies or substantial portions of the Software. |
anhtran | 0:e9fd5575b10e | 11 | |
anhtran | 0:e9fd5575b10e | 12 | THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
anhtran | 0:e9fd5575b10e | 13 | IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
anhtran | 0:e9fd5575b10e | 14 | FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
anhtran | 0:e9fd5575b10e | 15 | AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
anhtran | 0:e9fd5575b10e | 16 | LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
anhtran | 0:e9fd5575b10e | 17 | OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
anhtran | 0:e9fd5575b10e | 18 | THE SOFTWARE. |
anhtran | 0:e9fd5575b10e | 19 | */ |
anhtran | 0:e9fd5575b10e | 20 | |
anhtran | 0:e9fd5575b10e | 21 | #include "mbed.h" |
anhtran | 0:e9fd5575b10e | 22 | #include "i2c_setting.h" |
anhtran | 0:e9fd5575b10e | 23 | |
anhtran | 0:e9fd5575b10e | 24 | #define REG_REQ_BUF_SIZE (7) |
anhtran | 0:e9fd5575b10e | 25 | #define DATA_MAX_SIZE (32) |
anhtran | 0:e9fd5575b10e | 26 | #define ARG_MAX_NUM (DATA_MAX_SIZE + 3) // Reqest, I2C addr, len, data1, data2, data3, ... |
anhtran | 0:e9fd5575b10e | 27 | #define ARG_MAX_SIZE (2) // upper bit + lower bit |
anhtran | 0:e9fd5575b10e | 28 | #define NULL_SIZE (1) |
anhtran | 0:e9fd5575b10e | 29 | #define CODE_NULL (0x00) |
anhtran | 0:e9fd5575b10e | 30 | #define NUM_STR_TO_HEX (0x30) |
anhtran | 0:e9fd5575b10e | 31 | #define BIG_STR_TO_HEX (0x37) |
anhtran | 0:e9fd5575b10e | 32 | #define SMA_STR_TO_HEX (0x57) |
anhtran | 0:e9fd5575b10e | 33 | #define MASK_HEX10 (0x10) |
anhtran | 0:e9fd5575b10e | 34 | |
anhtran | 0:e9fd5575b10e | 35 | #define OFS_REQ (0) |
anhtran | 0:e9fd5575b10e | 36 | #define OFS_I2C_ADDR (1) |
anhtran | 0:e9fd5575b10e | 37 | #define OFS_DATA_SIZE (2) |
anhtran | 0:e9fd5575b10e | 38 | #define OFS_DATA (3) |
anhtran | 0:e9fd5575b10e | 39 | |
anhtran | 0:e9fd5575b10e | 40 | #define STR_WR "Wr:" |
anhtran | 0:e9fd5575b10e | 41 | #define STR_RD "Rd:" |
anhtran | 0:e9fd5575b10e | 42 | #define STR_WR_NO_P "WrNoP:" |
anhtran | 0:e9fd5575b10e | 43 | #define STR_RD_NO_P "RdNoP:" |
anhtran | 0:e9fd5575b10e | 44 | |
anhtran | 0:e9fd5575b10e | 45 | #define REQ_NONE (0) |
anhtran | 0:e9fd5575b10e | 46 | #define REQ_WR (1) |
anhtran | 0:e9fd5575b10e | 47 | #define REQ_RD (2) |
anhtran | 0:e9fd5575b10e | 48 | #define REQ_WR_NO_P (3) |
anhtran | 0:e9fd5575b10e | 49 | #define REQ_RD_NO_P (4) |
anhtran | 0:e9fd5575b10e | 50 | |
anhtran | 0:e9fd5575b10e | 51 | I2C i2c(I2C_SDA, I2C_SCL); |
anhtran | 0:e9fd5575b10e | 52 | |
anhtran | 0:e9fd5575b10e | 53 | static char hex_to_char_tbl[] = { |
anhtran | 0:e9fd5575b10e | 54 | '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', |
anhtran | 0:e9fd5575b10e | 55 | 'A', 'B', 'C', 'D', 'E', 'F' |
anhtran | 0:e9fd5575b10e | 56 | }; |
anhtran | 0:e9fd5575b10e | 57 | |
anhtran | 0:e9fd5575b10e | 58 | static int str_to_hex(char * psrcbuf, char * pdestbuf, int cnt) { |
anhtran | 0:e9fd5575b10e | 59 | int retval = false; |
anhtran | 0:e9fd5575b10e | 60 | int32_t tmp_hex; |
anhtran | 0:e9fd5575b10e | 61 | |
anhtran | 0:e9fd5575b10e | 62 | if ((psrcbuf != NULL) && (pdestbuf != NULL)) { |
anhtran | 0:e9fd5575b10e | 63 | retval = true; |
anhtran | 0:e9fd5575b10e | 64 | if ((((int32_t)*psrcbuf) >= '0') && (((int32_t)*psrcbuf) <= '9')) { |
anhtran | 0:e9fd5575b10e | 65 | tmp_hex = NUM_STR_TO_HEX; |
anhtran | 0:e9fd5575b10e | 66 | } else if ((((int32_t)*psrcbuf) >= 'A') && (((int32_t)*psrcbuf) <= 'F')) { |
anhtran | 0:e9fd5575b10e | 67 | tmp_hex = BIG_STR_TO_HEX; |
anhtran | 0:e9fd5575b10e | 68 | } else if ((((int32_t)*psrcbuf) >= 'a') && (((int32_t)*psrcbuf) <= 'f')) { |
anhtran | 0:e9fd5575b10e | 69 | tmp_hex = SMA_STR_TO_HEX; |
anhtran | 0:e9fd5575b10e | 70 | } else { |
anhtran | 0:e9fd5575b10e | 71 | retval = false; |
anhtran | 0:e9fd5575b10e | 72 | } |
anhtran | 0:e9fd5575b10e | 73 | if (retval == true) { |
anhtran | 0:e9fd5575b10e | 74 | *pdestbuf += ((int32_t)*psrcbuf) - tmp_hex; |
anhtran | 0:e9fd5575b10e | 75 | if (cnt == 0) { |
anhtran | 0:e9fd5575b10e | 76 | *pdestbuf *= MASK_HEX10; |
anhtran | 0:e9fd5575b10e | 77 | } |
anhtran | 0:e9fd5575b10e | 78 | } |
anhtran | 0:e9fd5575b10e | 79 | } |
anhtran | 0:e9fd5575b10e | 80 | |
anhtran | 0:e9fd5575b10e | 81 | return retval; |
anhtran | 0:e9fd5575b10e | 82 | } |
anhtran | 0:e9fd5575b10e | 83 | |
anhtran | 0:e9fd5575b10e | 84 | static void char_to_16char(char * pdestbuf, char * psrcbuf, int length) { |
anhtran | 0:e9fd5575b10e | 85 | if ((pdestbuf != NULL) && (psrcbuf != NULL)) { |
anhtran | 0:e9fd5575b10e | 86 | while (1) { |
anhtran | 0:e9fd5575b10e | 87 | *pdestbuf = hex_to_char_tbl[((int32_t)*psrcbuf) / MASK_HEX10]; |
anhtran | 0:e9fd5575b10e | 88 | pdestbuf++; |
anhtran | 0:e9fd5575b10e | 89 | *pdestbuf = hex_to_char_tbl[((int32_t)*psrcbuf) % MASK_HEX10]; |
anhtran | 0:e9fd5575b10e | 90 | pdestbuf++; |
anhtran | 0:e9fd5575b10e | 91 | |
anhtran | 0:e9fd5575b10e | 92 | psrcbuf++; |
anhtran | 0:e9fd5575b10e | 93 | length--; |
anhtran | 0:e9fd5575b10e | 94 | if (length != 0) { |
anhtran | 0:e9fd5575b10e | 95 | *pdestbuf = ','; |
anhtran | 0:e9fd5575b10e | 96 | pdestbuf++; |
anhtran | 0:e9fd5575b10e | 97 | } else { |
anhtran | 0:e9fd5575b10e | 98 | break; |
anhtran | 0:e9fd5575b10e | 99 | } |
anhtran | 0:e9fd5575b10e | 100 | } |
anhtran | 0:e9fd5575b10e | 101 | *pdestbuf = CODE_NULL; |
anhtran | 0:e9fd5575b10e | 102 | } |
anhtran | 0:e9fd5575b10e | 103 | } |
anhtran | 0:e9fd5575b10e | 104 | |
anhtran | 0:e9fd5575b10e | 105 | static int analysis_cmd(char * buf, char * p_reg_arg_buf) { |
anhtran | 0:e9fd5575b10e | 106 | int arg_cnt = 0; |
anhtran | 0:e9fd5575b10e | 107 | int byte_cnt = 0; |
anhtran | 0:e9fd5575b10e | 108 | int retval; |
anhtran | 0:e9fd5575b10e | 109 | char * psrcbuf = buf; |
anhtran | 0:e9fd5575b10e | 110 | int ret; |
anhtran | 0:e9fd5575b10e | 111 | |
anhtran | 0:e9fd5575b10e | 112 | if (strncmp(psrcbuf, STR_WR, sizeof(STR_WR) - 1) == 0) { |
anhtran | 0:e9fd5575b10e | 113 | ret = REQ_WR; |
anhtran | 0:e9fd5575b10e | 114 | psrcbuf += sizeof(STR_WR) - 1; |
anhtran | 0:e9fd5575b10e | 115 | } else if (strncmp(psrcbuf, STR_RD, sizeof(STR_RD) - 1) == 0) { |
anhtran | 0:e9fd5575b10e | 116 | ret = REQ_RD; |
anhtran | 0:e9fd5575b10e | 117 | psrcbuf += sizeof(STR_RD) - 1; |
anhtran | 0:e9fd5575b10e | 118 | } else if (strncmp(psrcbuf, STR_WR_NO_P, sizeof(STR_WR_NO_P) - 1) == 0) { |
anhtran | 0:e9fd5575b10e | 119 | ret = REQ_WR_NO_P; |
anhtran | 0:e9fd5575b10e | 120 | psrcbuf += sizeof(STR_WR_NO_P) - 1; |
anhtran | 0:e9fd5575b10e | 121 | } else if (strncmp(psrcbuf, STR_RD_NO_P, sizeof(STR_RD_NO_P) - 1) == 0) { |
anhtran | 0:e9fd5575b10e | 122 | ret = REQ_RD_NO_P; |
anhtran | 0:e9fd5575b10e | 123 | psrcbuf += sizeof(STR_RD_NO_P) - 1; |
anhtran | 0:e9fd5575b10e | 124 | } else { |
anhtran | 0:e9fd5575b10e | 125 | ret = REQ_NONE; |
anhtran | 0:e9fd5575b10e | 126 | } |
anhtran | 0:e9fd5575b10e | 127 | |
anhtran | 0:e9fd5575b10e | 128 | if (ret != REQ_NONE) { |
anhtran | 0:e9fd5575b10e | 129 | /* get argument(Reqest, I2C addr, len, data1, data2, data3, ...) */ |
anhtran | 0:e9fd5575b10e | 130 | p_reg_arg_buf[arg_cnt] = ret; |
anhtran | 0:e9fd5575b10e | 131 | arg_cnt++; |
anhtran | 0:e9fd5575b10e | 132 | byte_cnt = 0; |
anhtran | 0:e9fd5575b10e | 133 | while (((int32_t)*psrcbuf) != CODE_NULL) { |
anhtran | 0:e9fd5575b10e | 134 | retval = str_to_hex(psrcbuf, &p_reg_arg_buf[arg_cnt], byte_cnt); |
anhtran | 0:e9fd5575b10e | 135 | if (retval != false) { |
anhtran | 0:e9fd5575b10e | 136 | byte_cnt++; |
anhtran | 0:e9fd5575b10e | 137 | if (byte_cnt >= ARG_MAX_SIZE) { |
anhtran | 0:e9fd5575b10e | 138 | if ((arg_cnt + 1) >= ARG_MAX_NUM) { |
anhtran | 0:e9fd5575b10e | 139 | ret = REQ_NONE; |
anhtran | 0:e9fd5575b10e | 140 | break; |
anhtran | 0:e9fd5575b10e | 141 | } else { |
anhtran | 0:e9fd5575b10e | 142 | arg_cnt++; |
anhtran | 0:e9fd5575b10e | 143 | byte_cnt = 0; |
anhtran | 0:e9fd5575b10e | 144 | } |
anhtran | 0:e9fd5575b10e | 145 | } |
anhtran | 0:e9fd5575b10e | 146 | } |
anhtran | 0:e9fd5575b10e | 147 | psrcbuf++; |
anhtran | 0:e9fd5575b10e | 148 | } |
anhtran | 0:e9fd5575b10e | 149 | } |
anhtran | 0:e9fd5575b10e | 150 | |
anhtran | 0:e9fd5575b10e | 151 | return ret; |
anhtran | 0:e9fd5575b10e | 152 | } |
anhtran | 0:e9fd5575b10e | 153 | |
anhtran | 0:e9fd5575b10e | 154 | static void execute_cmd(char * buf, char * p_reg_arg_buf) { |
anhtran | 0:e9fd5575b10e | 155 | int ret; |
anhtran | 0:e9fd5575b10e | 156 | size_t len; |
anhtran | 0:e9fd5575b10e | 157 | int stop = 0; |
anhtran | 0:e9fd5575b10e | 158 | |
anhtran | 0:e9fd5575b10e | 159 | /* check request */ |
anhtran | 0:e9fd5575b10e | 160 | if ((p_reg_arg_buf[OFS_REQ] == REQ_WR_NO_P) || (p_reg_arg_buf[OFS_REQ] == REQ_RD_NO_P)) { |
anhtran | 0:e9fd5575b10e | 161 | stop = 1; |
anhtran | 0:e9fd5575b10e | 162 | } |
anhtran | 0:e9fd5575b10e | 163 | |
anhtran | 0:e9fd5575b10e | 164 | switch (p_reg_arg_buf[OFS_REQ]) { |
anhtran | 0:e9fd5575b10e | 165 | case REQ_WR: |
anhtran | 0:e9fd5575b10e | 166 | case REQ_WR_NO_P: |
anhtran | 0:e9fd5575b10e | 167 | ret = i2c.write(p_reg_arg_buf[OFS_I2C_ADDR], &p_reg_arg_buf[OFS_DATA], p_reg_arg_buf[OFS_DATA_SIZE], stop); |
anhtran | 0:e9fd5575b10e | 168 | if (ret == 0) { |
anhtran | 0:e9fd5575b10e | 169 | sprintf(buf, "OK"); |
anhtran | 0:e9fd5575b10e | 170 | } |
anhtran | 0:e9fd5575b10e | 171 | break; |
anhtran | 0:e9fd5575b10e | 172 | case REQ_RD: |
anhtran | 0:e9fd5575b10e | 173 | case REQ_RD_NO_P: |
anhtran | 0:e9fd5575b10e | 174 | ret = i2c.read(p_reg_arg_buf[OFS_I2C_ADDR], &p_reg_arg_buf[OFS_DATA], p_reg_arg_buf[OFS_DATA_SIZE], stop); |
anhtran | 0:e9fd5575b10e | 175 | if (ret == 0) { |
anhtran | 0:e9fd5575b10e | 176 | sprintf(buf, "OK "); |
anhtran | 0:e9fd5575b10e | 177 | len = strlen(buf); |
anhtran | 0:e9fd5575b10e | 178 | char_to_16char(&buf[len], &p_reg_arg_buf[OFS_DATA], p_reg_arg_buf[OFS_DATA_SIZE]); |
anhtran | 0:e9fd5575b10e | 179 | } |
anhtran | 0:e9fd5575b10e | 180 | break; |
anhtran | 0:e9fd5575b10e | 181 | default: |
anhtran | 0:e9fd5575b10e | 182 | case REQ_NONE: |
anhtran | 0:e9fd5575b10e | 183 | ret = -1; |
anhtran | 0:e9fd5575b10e | 184 | break; |
anhtran | 0:e9fd5575b10e | 185 | } |
anhtran | 0:e9fd5575b10e | 186 | if (ret != 0) { |
anhtran | 0:e9fd5575b10e | 187 | sprintf(buf, "NG"); |
anhtran | 0:e9fd5575b10e | 188 | } |
anhtran | 0:e9fd5575b10e | 189 | } |
anhtran | 0:e9fd5575b10e | 190 | |
anhtran | 0:e9fd5575b10e | 191 | bool i2c_setting_exe(char * buf) { |
anhtran | 0:e9fd5575b10e | 192 | int reg_arg_cnt; |
anhtran | 0:e9fd5575b10e | 193 | char reg_arg_buf[ARG_MAX_NUM] = {0}; |
anhtran | 0:e9fd5575b10e | 194 | |
anhtran | 0:e9fd5575b10e | 195 | /* analysis command */ |
anhtran | 0:e9fd5575b10e | 196 | reg_arg_cnt = analysis_cmd(buf, reg_arg_buf); |
anhtran | 0:e9fd5575b10e | 197 | if (reg_arg_cnt != REQ_NONE) { |
anhtran | 0:e9fd5575b10e | 198 | /* check length */ |
anhtran | 0:e9fd5575b10e | 199 | if (reg_arg_buf[OFS_DATA_SIZE] >= DATA_MAX_SIZE) { |
anhtran | 0:e9fd5575b10e | 200 | reg_arg_buf[OFS_DATA_SIZE] = DATA_MAX_SIZE; |
anhtran | 0:e9fd5575b10e | 201 | } |
anhtran | 0:e9fd5575b10e | 202 | /* execute command */ |
anhtran | 0:e9fd5575b10e | 203 | execute_cmd(buf, reg_arg_buf); |
anhtran | 0:e9fd5575b10e | 204 | return true; |
anhtran | 0:e9fd5575b10e | 205 | } |
anhtran | 0:e9fd5575b10e | 206 | |
anhtran | 0:e9fd5575b10e | 207 | return false; |
anhtran | 0:e9fd5575b10e | 208 | } |
anhtran | 0:e9fd5575b10e | 209 | |
anhtran | 0:e9fd5575b10e | 210 | #if(0) /* Please enable this line when performing the setting from the Terminal side. */ |
anhtran | 0:e9fd5575b10e | 211 | Serial terminal(USBTX, USBRX); |
anhtran | 0:e9fd5575b10e | 212 | static char recv_term_buffer[I2C_SETTING_STR_BUF_SIZE]; |
anhtran | 0:e9fd5575b10e | 213 | |
anhtran | 0:e9fd5575b10e | 214 | void SetI2CfromTerm(void const *argument) { |
anhtran | 0:e9fd5575b10e | 215 | int32_t term_buf_offset = 0; |
anhtran | 0:e9fd5575b10e | 216 | char recv_data; |
anhtran | 0:e9fd5575b10e | 217 | |
anhtran | 0:e9fd5575b10e | 218 | while (1) { |
anhtran | 0:e9fd5575b10e | 219 | recv_data = terminal.getc(); |
anhtran | 0:e9fd5575b10e | 220 | /* echo back */ |
anhtran | 0:e9fd5575b10e | 221 | printf("%c", recv_data); |
anhtran | 0:e9fd5575b10e | 222 | switch ((int32_t)recv_data) { |
anhtran | 0:e9fd5575b10e | 223 | case 0x0A : |
anhtran | 0:e9fd5575b10e | 224 | recv_term_buffer[term_buf_offset] = CODE_NULL; |
anhtran | 0:e9fd5575b10e | 225 | term_buf_offset = 0; |
anhtran | 0:e9fd5575b10e | 226 | /* command analysis and execute */ |
anhtran | 0:e9fd5575b10e | 227 | if (i2c_setting_exe(recv_term_buffer) != false) { |
anhtran | 0:e9fd5575b10e | 228 | terminal.puts(recv_term_buffer); |
anhtran | 0:e9fd5575b10e | 229 | } |
anhtran | 0:e9fd5575b10e | 230 | break; |
anhtran | 0:e9fd5575b10e | 231 | case 0x0D : |
anhtran | 0:e9fd5575b10e | 232 | /* Do Nothing */ |
anhtran | 0:e9fd5575b10e | 233 | break; |
anhtran | 0:e9fd5575b10e | 234 | default : |
anhtran | 0:e9fd5575b10e | 235 | /* check data_buffer size */ |
anhtran | 0:e9fd5575b10e | 236 | if (term_buf_offset < I2C_SETTING_STR_BUF_SIZE) { |
anhtran | 0:e9fd5575b10e | 237 | recv_term_buffer[term_buf_offset] = recv_data; |
anhtran | 0:e9fd5575b10e | 238 | term_buf_offset++; |
anhtran | 0:e9fd5575b10e | 239 | } |
anhtran | 0:e9fd5575b10e | 240 | break; |
anhtran | 0:e9fd5575b10e | 241 | } |
anhtran | 0:e9fd5575b10e | 242 | } |
anhtran | 0:e9fd5575b10e | 243 | } |
anhtran | 0:e9fd5575b10e | 244 | #endif |
anhtran | 0:e9fd5575b10e | 245 |