Murata Type YD Wi-Fi driver
Dependents: easy-connect-type-yd
SNICInterface/SNIC/SNIC_UartMsgUtil.cpp@0:35a2186cf186, 2017-07-12 (annotated)
- Committer:
- MACRUM
- Date:
- Wed Jul 12 10:49:10 2017 +0000
- Revision:
- 0:35a2186cf186
Initial commit
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
MACRUM | 0:35a2186cf186 | 1 | /* Copyright (C) 2014 Murata Manufacturing Co.,Ltd., MIT License |
MACRUM | 0:35a2186cf186 | 2 | * muRata, SWITCH SCIENCE Wi-FI module TypeYD SNIC-UART. |
MACRUM | 0:35a2186cf186 | 3 | * |
MACRUM | 0:35a2186cf186 | 4 | * Permission is hereby granted, free of charge, to any person obtaining a copy of this software |
MACRUM | 0:35a2186cf186 | 5 | * and associated documentation files (the "Software"), to deal in the Software without restriction, |
MACRUM | 0:35a2186cf186 | 6 | * including without limitation the rights to use, copy, modify, merge, publish, distribute, |
MACRUM | 0:35a2186cf186 | 7 | * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is |
MACRUM | 0:35a2186cf186 | 8 | * furnished to do so, subject to the following conditions: |
MACRUM | 0:35a2186cf186 | 9 | * |
MACRUM | 0:35a2186cf186 | 10 | * The above copyright notice and this permission notice shall be included in all copies or |
MACRUM | 0:35a2186cf186 | 11 | * substantial portions of the Software. |
MACRUM | 0:35a2186cf186 | 12 | * |
MACRUM | 0:35a2186cf186 | 13 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING |
MACRUM | 0:35a2186cf186 | 14 | * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
MACRUM | 0:35a2186cf186 | 15 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, |
MACRUM | 0:35a2186cf186 | 16 | * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
MACRUM | 0:35a2186cf186 | 17 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. |
MACRUM | 0:35a2186cf186 | 18 | */ |
MACRUM | 0:35a2186cf186 | 19 | #include "SNICInterface/SNIC/SNIC_UartMsgUtil.h" |
MACRUM | 0:35a2186cf186 | 20 | |
MACRUM | 0:35a2186cf186 | 21 | C_SNIC_UartMsgUtil::C_SNIC_UartMsgUtil() |
MACRUM | 0:35a2186cf186 | 22 | { |
MACRUM | 0:35a2186cf186 | 23 | } |
MACRUM | 0:35a2186cf186 | 24 | |
MACRUM | 0:35a2186cf186 | 25 | C_SNIC_UartMsgUtil::~C_SNIC_UartMsgUtil() |
MACRUM | 0:35a2186cf186 | 26 | { |
MACRUM | 0:35a2186cf186 | 27 | } |
MACRUM | 0:35a2186cf186 | 28 | |
MACRUM | 0:35a2186cf186 | 29 | unsigned int C_SNIC_UartMsgUtil::makeRequest( unsigned char cmd_id,unsigned char *payload_p |
MACRUM | 0:35a2186cf186 | 30 | , unsigned short payload_len, unsigned char *uart_command_p ) |
MACRUM | 0:35a2186cf186 | 31 | { |
MACRUM | 0:35a2186cf186 | 32 | unsigned char check_sum = 0; // Check Sum |
MACRUM | 0:35a2186cf186 | 33 | unsigned int uart_cmd_len = 0; |
MACRUM | 0:35a2186cf186 | 34 | int i; |
MACRUM | 0:35a2186cf186 | 35 | |
MACRUM | 0:35a2186cf186 | 36 | // set SOM |
MACRUM | 0:35a2186cf186 | 37 | *uart_command_p = UART_CMD_SOM; |
MACRUM | 0:35a2186cf186 | 38 | uart_command_p++; |
MACRUM | 0:35a2186cf186 | 39 | uart_cmd_len++; |
MACRUM | 0:35a2186cf186 | 40 | |
MACRUM | 0:35a2186cf186 | 41 | // set payload length L0 |
MACRUM | 0:35a2186cf186 | 42 | *uart_command_p = (0x80 | (payload_len & 0x007f)); |
MACRUM | 0:35a2186cf186 | 43 | check_sum += *uart_command_p; |
MACRUM | 0:35a2186cf186 | 44 | uart_command_p++; |
MACRUM | 0:35a2186cf186 | 45 | uart_cmd_len++; |
MACRUM | 0:35a2186cf186 | 46 | |
MACRUM | 0:35a2186cf186 | 47 | // set payload length L1 |
MACRUM | 0:35a2186cf186 | 48 | *uart_command_p = (0x80 | ( (payload_len >> 7) & 0x003f)); |
MACRUM | 0:35a2186cf186 | 49 | check_sum += *uart_command_p; |
MACRUM | 0:35a2186cf186 | 50 | uart_command_p++; |
MACRUM | 0:35a2186cf186 | 51 | uart_cmd_len++; |
MACRUM | 0:35a2186cf186 | 52 | |
MACRUM | 0:35a2186cf186 | 53 | // set Command ID |
MACRUM | 0:35a2186cf186 | 54 | *uart_command_p = (0x80 | cmd_id); |
MACRUM | 0:35a2186cf186 | 55 | check_sum += *uart_command_p; |
MACRUM | 0:35a2186cf186 | 56 | uart_command_p++; |
MACRUM | 0:35a2186cf186 | 57 | uart_cmd_len++; |
MACRUM | 0:35a2186cf186 | 58 | |
MACRUM | 0:35a2186cf186 | 59 | // set Payload |
MACRUM | 0:35a2186cf186 | 60 | for( i = 0; i < payload_len; i++, uart_command_p++, uart_cmd_len++ ) |
MACRUM | 0:35a2186cf186 | 61 | { |
MACRUM | 0:35a2186cf186 | 62 | *uart_command_p = payload_p[i]; |
MACRUM | 0:35a2186cf186 | 63 | } |
MACRUM | 0:35a2186cf186 | 64 | |
MACRUM | 0:35a2186cf186 | 65 | // set Check sum |
MACRUM | 0:35a2186cf186 | 66 | *uart_command_p = (0x80 | check_sum); |
MACRUM | 0:35a2186cf186 | 67 | uart_command_p++; |
MACRUM | 0:35a2186cf186 | 68 | uart_cmd_len++; |
MACRUM | 0:35a2186cf186 | 69 | |
MACRUM | 0:35a2186cf186 | 70 | // set EOM |
MACRUM | 0:35a2186cf186 | 71 | *uart_command_p = UART_CMD_EOM; |
MACRUM | 0:35a2186cf186 | 72 | uart_cmd_len++; |
MACRUM | 0:35a2186cf186 | 73 | |
MACRUM | 0:35a2186cf186 | 74 | return uart_cmd_len; |
MACRUM | 0:35a2186cf186 | 75 | } |
MACRUM | 0:35a2186cf186 | 76 | |
MACRUM | 0:35a2186cf186 | 77 | unsigned int C_SNIC_UartMsgUtil::getResponsePayload( unsigned int recvdata_len, unsigned char *recvdata_p |
MACRUM | 0:35a2186cf186 | 78 | , unsigned char *command_id_p, unsigned char *payload_p ) |
MACRUM | 0:35a2186cf186 | 79 | { |
MACRUM | 0:35a2186cf186 | 80 | unsigned short payload_len = 0; |
MACRUM | 0:35a2186cf186 | 81 | unsigned char *buf_p = NULL; |
MACRUM | 0:35a2186cf186 | 82 | int i; |
MACRUM | 0:35a2186cf186 | 83 | |
MACRUM | 0:35a2186cf186 | 84 | // get payload length |
MACRUM | 0:35a2186cf186 | 85 | payload_len = ( ( (recvdata_p[1] & ~0x80) & 0xff) | ( ( (recvdata_p[2] & ~0xC0) << 7) & 0xff80) ); |
MACRUM | 0:35a2186cf186 | 86 | |
MACRUM | 0:35a2186cf186 | 87 | // get Command ID |
MACRUM | 0:35a2186cf186 | 88 | *command_id_p = (recvdata_p[3] & ~0x80); |
MACRUM | 0:35a2186cf186 | 89 | |
MACRUM | 0:35a2186cf186 | 90 | buf_p = &recvdata_p[4]; |
MACRUM | 0:35a2186cf186 | 91 | |
MACRUM | 0:35a2186cf186 | 92 | // get payload data |
MACRUM | 0:35a2186cf186 | 93 | for( i = 0; i < payload_len; i++, buf_p++ ) |
MACRUM | 0:35a2186cf186 | 94 | { |
MACRUM | 0:35a2186cf186 | 95 | *payload_p = *buf_p; |
MACRUM | 0:35a2186cf186 | 96 | payload_p++; |
MACRUM | 0:35a2186cf186 | 97 | } |
MACRUM | 0:35a2186cf186 | 98 | |
MACRUM | 0:35a2186cf186 | 99 | return payload_len; |
MACRUM | 0:35a2186cf186 | 100 | } |
MACRUM | 0:35a2186cf186 | 101 | |
MACRUM | 0:35a2186cf186 | 102 | int C_SNIC_UartMsgUtil::addrToInteger( const char *addr_p ) |
MACRUM | 0:35a2186cf186 | 103 | { |
MACRUM | 0:35a2186cf186 | 104 | if( addr_p == NULL ) |
MACRUM | 0:35a2186cf186 | 105 | { |
MACRUM | 0:35a2186cf186 | 106 | DEBUG_PRINT("addrToInteger parameter error\r\n"); |
MACRUM | 0:35a2186cf186 | 107 | return 0; |
MACRUM | 0:35a2186cf186 | 108 | } |
MACRUM | 0:35a2186cf186 | 109 | |
MACRUM | 0:35a2186cf186 | 110 | unsigned char ipadr[4]; |
MACRUM | 0:35a2186cf186 | 111 | unsigned char temp= 0; |
MACRUM | 0:35a2186cf186 | 112 | int i,j,k; |
MACRUM | 0:35a2186cf186 | 113 | |
MACRUM | 0:35a2186cf186 | 114 | /* convert to char[4] */ |
MACRUM | 0:35a2186cf186 | 115 | k=0; |
MACRUM | 0:35a2186cf186 | 116 | for(i=0; i<4; i ++) |
MACRUM | 0:35a2186cf186 | 117 | { |
MACRUM | 0:35a2186cf186 | 118 | for(j=0; j<4; j ++) |
MACRUM | 0:35a2186cf186 | 119 | { |
MACRUM | 0:35a2186cf186 | 120 | if((addr_p[k] > 0x2F)&&(addr_p[k] < 0x3A)) |
MACRUM | 0:35a2186cf186 | 121 | { |
MACRUM | 0:35a2186cf186 | 122 | temp = (temp * 10) + addr_p[k]-0x30; |
MACRUM | 0:35a2186cf186 | 123 | } |
MACRUM | 0:35a2186cf186 | 124 | else if((addr_p[k] == 0x20)&&(temp == 0)) |
MACRUM | 0:35a2186cf186 | 125 | { |
MACRUM | 0:35a2186cf186 | 126 | } |
MACRUM | 0:35a2186cf186 | 127 | else |
MACRUM | 0:35a2186cf186 | 128 | { |
MACRUM | 0:35a2186cf186 | 129 | ipadr[i]=temp; |
MACRUM | 0:35a2186cf186 | 130 | temp = 0; |
MACRUM | 0:35a2186cf186 | 131 | k++; |
MACRUM | 0:35a2186cf186 | 132 | break; |
MACRUM | 0:35a2186cf186 | 133 | } |
MACRUM | 0:35a2186cf186 | 134 | k++; |
MACRUM | 0:35a2186cf186 | 135 | } |
MACRUM | 0:35a2186cf186 | 136 | } |
MACRUM | 0:35a2186cf186 | 137 | |
MACRUM | 0:35a2186cf186 | 138 | int addr = ( (ipadr[0]<<24) | (ipadr[1]<<16) | (ipadr[2]<<8) | ipadr[3] ); |
MACRUM | 0:35a2186cf186 | 139 | |
MACRUM | 0:35a2186cf186 | 140 | return addr; |
MACRUM | 0:35a2186cf186 | 141 | } |
MACRUM | 0:35a2186cf186 | 142 | |
MACRUM | 0:35a2186cf186 | 143 | void C_SNIC_UartMsgUtil::convertIntToByteAdday( int addr, char *addr_array_p ) |
MACRUM | 0:35a2186cf186 | 144 | { |
MACRUM | 0:35a2186cf186 | 145 | addr_array_p[0] = ((addr & 0xFF000000) >> 24 ); |
MACRUM | 0:35a2186cf186 | 146 | addr_array_p[1] = ((addr & 0xFF0000) >> 16 ); |
MACRUM | 0:35a2186cf186 | 147 | addr_array_p[2] = ((addr & 0xFF00) >> 8 ); |
MACRUM | 0:35a2186cf186 | 148 | addr_array_p[3] = ( addr & 0xFF); |
MACRUM | 0:35a2186cf186 | 149 | } |
MACRUM | 0:35a2186cf186 | 150 |