Toyomasa Watarai / type-yd-driver

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?

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