Websocket_Sample for MurataTypeYD

Dependencies:   mbed picojson

Committer:
komoritan
Date:
Thu Mar 12 12:15:46 2015 +0000
Revision:
1:b5ac0f971f43
Parent:
0:14bd24b5a77f
Fixed

Who changed what in which revision?

UserRevisionLine numberNew 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 }