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