535 lines
12 KiB
C
535 lines
12 KiB
C
/**************************************************************************
|
|
* File Name : utils.c
|
|
* Author :
|
|
* Version : 1.0
|
|
* Date :
|
|
* Description :
|
|
*
|
|
* Copyright (c) 2014 Winner Microelectronics Co., Ltd.
|
|
* All rights reserved.
|
|
*
|
|
***************************************************************************/
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <stdarg.h>
|
|
|
|
#include "wm_mem.h"
|
|
#include "tls_common.h"
|
|
#include "wm_debug.h"
|
|
#include "wm_sockets.h"
|
|
#include "utils.h"
|
|
|
|
|
|
static const u8 crc8_tbl[256] = {
|
|
0x00,0x91,0xe3,0x72,0x07,0x96,0xe4,0x75,
|
|
0x0e,0x9f,0xed,0x7c,0x09,0x98,0xea,0x7b,
|
|
0x1c,0x8d,0xff,0x6e,0x1b,0x8a,0xf8,0x69,
|
|
0x12,0x83,0xf1,0x60,0x15,0x84,0xf6,0x67,
|
|
0x38,0xa9,0xdb,0x4a,0x3f,0xae,0xdc,0x4d,
|
|
0x36,0xa7,0xd5,0x44,0x31,0xa0,0xd2,0x43,
|
|
0x24,0xb5,0xc7,0x56,0x23,0xb2,0xc0,0x51,
|
|
0x2a,0xbb,0xc9,0x58,0x2d,0xbc,0xce,0x5f,
|
|
0x70,0xe1,0x93,0x02,0x77,0xe6,0x94,0x05,
|
|
0x7e,0xef,0x9d,0x0c,0x79,0xe8,0x9a,0x0b,
|
|
0x6c,0xfd,0x8f,0x1e,0x6b,0xfa,0x88,0x19,
|
|
0x62,0xf3,0x81,0x10,0x65,0xf4,0x86,0x17,
|
|
0x48,0xd9,0xab,0x3a,0x4f,0xde,0xac,0x3d,
|
|
0x46,0xd7,0xa5,0x34,0x41,0xd0,0xa2,0x33,
|
|
0x54,0xc5,0xb7,0x26,0x53,0xc2,0xb0,0x21,
|
|
0x5a,0xcb,0xb9,0x28,0x5d,0xcc,0xbe,0x2f,
|
|
0xe0,0x71,0x03,0x92,0xe7,0x76,0x04,0x95,
|
|
0xee,0x7f,0x0d,0x9c,0xe9,0x78,0x0a,0x9b,
|
|
0xfc,0x6d,0x1f,0x8e,0xfb,0x6a,0x18,0x89,
|
|
0xf2,0x63,0x11,0x80,0xf5,0x64,0x16,0x87,
|
|
0xd8,0x49,0x3b,0xaa,0xdf,0x4e,0x3c,0xad,
|
|
0xd6,0x47,0x35,0xa4,0xd1,0x40,0x32,0xa3,
|
|
0xc4,0x55,0x27,0xb6,0xc3,0x52,0x20,0xb1,
|
|
0xca,0x5b,0x29,0xb8,0xcd,0x5c,0x2e,0xbf,
|
|
0x90,0x01,0x73,0xe2,0x97,0x06,0x74,0xe5,
|
|
0x9e,0x0f,0x7d,0xec,0x99,0x08,0x7a,0xeb,
|
|
0x8c,0x1d,0x6f,0xfe,0x8b,0x1a,0x68,0xf9,
|
|
0x82,0x13,0x61,0xf0,0x85,0x14,0x66,0xf7,
|
|
0xa8,0x39,0x4b,0xda,0xaf,0x3e,0x4c,0xdd,
|
|
0xa6,0x37,0x45,0xd4,0xa1,0x30,0x42,0xd3,
|
|
0xb4,0x25,0x57,0xc6,0xb3,0x22,0x50,0xc1,
|
|
0xba,0x2b,0x59,0xc8,0xbd,0x2c,0x5e,0xcf
|
|
};
|
|
|
|
#ifndef isdigit
|
|
#define in_range(c, lo, up) ((u8)c >= lo && (u8)c <= up)
|
|
#define isdigit(c) in_range(c, '0', '9')
|
|
#endif
|
|
int chk_crc8(u8 *ptr, u32 len)
|
|
{
|
|
u8 crc8;
|
|
u8 data;
|
|
|
|
crc8=0;
|
|
while (len--!=0) {
|
|
data = *ptr++;
|
|
crc8 = crc8_tbl[crc8^data];
|
|
}
|
|
|
|
if(crc8==0x00) {return 0;}
|
|
else {return -1;}
|
|
}
|
|
|
|
//#ifndef TLS_CONFIG_FPGA
|
|
u8 get_crc8(u8 *ptr, u32 len)
|
|
{
|
|
u8 crc8;
|
|
u8 data;
|
|
|
|
crc8=0;
|
|
while (len--!=0) {
|
|
data = *ptr++;
|
|
crc8 = crc8_tbl[crc8^data];
|
|
}
|
|
|
|
return crc8;
|
|
}
|
|
//#endif
|
|
|
|
u8 calculate_crc8(u8 crc8, u8 *ptr, u32 len)
|
|
{
|
|
u8 data;
|
|
|
|
while (len--!=0) {
|
|
data = *ptr++;
|
|
crc8 = crc8_tbl[crc8^data];
|
|
}
|
|
|
|
return crc8;
|
|
}
|
|
|
|
static u32 _cal_crc32(u32 crc_result, u8 data_8)
|
|
{
|
|
u8 crc_out[32];
|
|
u8 crc_buf[32];
|
|
u8 in_data_buf[8];
|
|
u32 i;
|
|
u32 flag;
|
|
|
|
flag = 0x01;
|
|
|
|
for (i = 0; i < 32; i++) {
|
|
crc_out[i] = 0;
|
|
}
|
|
|
|
|
|
for (i = 0; i < 8; i++) {
|
|
in_data_buf[i] = (data_8 >> i) & flag;
|
|
}
|
|
|
|
for (i = 0; i < 32; i++) {
|
|
crc_buf[i] = (unsigned char)(crc_result >> i) & flag;
|
|
}
|
|
|
|
crc_out[0] = in_data_buf[1]^in_data_buf[7]^crc_buf[30]^crc_buf[24];
|
|
crc_out[1] = in_data_buf[0]^in_data_buf[1]^in_data_buf[6]^in_data_buf[7]^crc_buf[31]^crc_buf[30]^crc_buf[25]^crc_buf[24];
|
|
crc_out[2] = in_data_buf[0]^in_data_buf[1]^in_data_buf[5]^in_data_buf[6]^in_data_buf[7]^crc_buf[31]^crc_buf[30]^crc_buf[26]^crc_buf[25]^crc_buf[24];
|
|
crc_out[3] = in_data_buf[0]^in_data_buf[4]^in_data_buf[5]^in_data_buf[6]^crc_buf[31]^crc_buf[27]^crc_buf[26]^crc_buf[25];
|
|
crc_out[4] = in_data_buf[1]^in_data_buf[3]^in_data_buf[4]^in_data_buf[5]^in_data_buf[7]^crc_buf[30]^crc_buf[28]^crc_buf[27]^crc_buf[26]^crc_buf[24];
|
|
crc_out[5] = in_data_buf[0]^in_data_buf[1]^in_data_buf[2]^in_data_buf[3]^in_data_buf[4]^in_data_buf[6]^in_data_buf[7]^
|
|
crc_buf[31]^crc_buf[30]^crc_buf[29]^crc_buf[28]^crc_buf[27]^crc_buf[25]^crc_buf[24];
|
|
crc_out[6] = in_data_buf[0]^in_data_buf[1]^in_data_buf[2]^in_data_buf[3]^in_data_buf[5]^in_data_buf[6]^
|
|
crc_buf[31]^crc_buf[30]^crc_buf[29]^crc_buf[28]^crc_buf[26]^crc_buf[25];
|
|
crc_out[7] = in_data_buf[0]^in_data_buf[2]^in_data_buf[4]^in_data_buf[5]^in_data_buf[7]^crc_buf[31]^crc_buf[29]^crc_buf[27]^crc_buf[26]^crc_buf[24];
|
|
crc_out[8] = in_data_buf[3]^in_data_buf[4]^in_data_buf[6]^in_data_buf[7]^crc_buf[28]^crc_buf[27]^crc_buf[25]^crc_buf[24]^crc_buf[0];
|
|
crc_out[9] = in_data_buf[2]^in_data_buf[3]^in_data_buf[5]^in_data_buf[6]^crc_buf[29]^crc_buf[28]^crc_buf[26]^crc_buf[25]^crc_buf[1];
|
|
crc_out[10] = in_data_buf[2]^in_data_buf[4]^in_data_buf[5]^in_data_buf[7]^crc_buf[29]^crc_buf[27]^crc_buf[26]^crc_buf[24]^crc_buf[2];
|
|
crc_out[11] = in_data_buf[3]^in_data_buf[4]^in_data_buf[6]^in_data_buf[7]^crc_buf[28]^crc_buf[27]^crc_buf[25]^crc_buf[24]^crc_buf[3];
|
|
|
|
crc_out[12] = in_data_buf[1]^in_data_buf[2]^in_data_buf[3]^in_data_buf[5]^in_data_buf[6]^in_data_buf[7]^
|
|
crc_buf[30]^crc_buf[29]^crc_buf[28]^crc_buf[26]^crc_buf[25]^crc_buf[24]^crc_buf[4];
|
|
crc_out[13] = in_data_buf[0]^in_data_buf[1]^in_data_buf[2]^in_data_buf[4]^in_data_buf[5]^in_data_buf[6]^
|
|
crc_buf[31]^crc_buf[30]^crc_buf[29]^crc_buf[27]^crc_buf[26]^crc_buf[25]^crc_buf[5];
|
|
crc_out[14] = in_data_buf[0]^in_data_buf[1]^in_data_buf[3]^in_data_buf[4]^in_data_buf[5]^crc_buf[31]^crc_buf[30]^crc_buf[28]^crc_buf[27]^crc_buf[26]^crc_buf[6];
|
|
crc_out[15] = in_data_buf[0]^in_data_buf[2]^in_data_buf[3]^in_data_buf[4]^crc_buf[31]^crc_buf[29]^crc_buf[28]^crc_buf[27]^crc_buf[7];
|
|
crc_out[16] = in_data_buf[2]^in_data_buf[3]^in_data_buf[7]^crc_buf[29]^crc_buf[28]^crc_buf[24]^crc_buf[8];
|
|
crc_out[17] = in_data_buf[1]^in_data_buf[2]^in_data_buf[6]^crc_buf[30]^crc_buf[29]^crc_buf[25]^crc_buf[9];
|
|
crc_out[18] = in_data_buf[0]^in_data_buf[1]^in_data_buf[5]^crc_buf[31]^crc_buf[30]^crc_buf[26]^crc_buf[10];
|
|
crc_out[19] = in_data_buf[0]^in_data_buf[4]^crc_buf[31]^crc_buf[27]^crc_buf[11];
|
|
crc_out[20] = in_data_buf[3]^crc_buf[28]^crc_buf[12];
|
|
crc_out[21] = in_data_buf[2]^crc_buf[29]^crc_buf[13];
|
|
crc_out[22] = in_data_buf[7]^crc_buf[24]^crc_buf[14];
|
|
crc_out[23] = in_data_buf[1]^in_data_buf[6]^in_data_buf[7]^crc_buf[30]^crc_buf[25]^crc_buf[24]^crc_buf[15];
|
|
crc_out[24] = in_data_buf[0]^in_data_buf[5]^in_data_buf[6]^crc_buf[31]^crc_buf[26]^crc_buf[25]^crc_buf[16];
|
|
crc_out[25] = in_data_buf[4]^in_data_buf[5]^crc_buf[27]^crc_buf[26]^crc_buf[17];
|
|
crc_out[26] = in_data_buf[1]^in_data_buf[3]^in_data_buf[4]^in_data_buf[7]^crc_buf[30]^crc_buf[28]^crc_buf[27]^crc_buf[24]^crc_buf[18];
|
|
crc_out[27] = in_data_buf[0]^in_data_buf[2]^in_data_buf[3]^in_data_buf[6]^crc_buf[31]^crc_buf[29]^crc_buf[28]^crc_buf[25]^crc_buf[19];
|
|
crc_out[28] = in_data_buf[1]^in_data_buf[2]^in_data_buf[5]^crc_buf[30]^crc_buf[29]^crc_buf[26]^crc_buf[20];
|
|
crc_out[29] = in_data_buf[0]^in_data_buf[1]^in_data_buf[4]^crc_buf[31]^crc_buf[30]^crc_buf[27]^crc_buf[21];
|
|
crc_out[30] = in_data_buf[0]^in_data_buf[3]^crc_buf[31]^crc_buf[28]^crc_buf[22];
|
|
crc_out[31] = in_data_buf[2]^crc_buf[23]^crc_buf[29];
|
|
|
|
crc_result = 0;
|
|
for (i = 0; i < 32; i++) {
|
|
if (crc_out[i]) {crc_result |= (1<<i);}
|
|
}
|
|
|
|
return crc_result;
|
|
}
|
|
|
|
//#ifndef TLS_CONFIG_FPGA
|
|
u32 get_crc32(u8 *data, u32 data_size)
|
|
{
|
|
u32 i;
|
|
u32 val;
|
|
int crc_result = 0xffffffff;
|
|
|
|
for (i = 0; i < data_size; i++) {
|
|
crc_result = _cal_crc32(crc_result, data[i]);
|
|
}
|
|
|
|
val = 0;
|
|
for (i = 0; i < 32; i++) {
|
|
if ((crc_result>>i) & 0x1) {val |= (1<<(31-i));}
|
|
}
|
|
|
|
TLS_DBGPRT_INFO("calculate crc -0x%x .\n", ~val);
|
|
return ~val;
|
|
}
|
|
//#endif
|
|
|
|
u32 checksum(u32 *data, u32 length, u32 init)
|
|
{
|
|
static long long sum = 0;
|
|
u32 checksum;
|
|
u32 i;
|
|
|
|
/*
|
|
Calculate the checksum.
|
|
*/
|
|
if (!init) {sum = 0;}
|
|
|
|
for (i = 0; i < length; i++) {sum+=*(data + i);}
|
|
checksum = ~((u32)(sum>>32)+(u32)sum);
|
|
|
|
return checksum;
|
|
}
|
|
|
|
int atodec(char ch)
|
|
{
|
|
int dec = -1;
|
|
|
|
if ((ch >= '0') && (ch <= '9')) {dec = ch - '0';}
|
|
|
|
return dec;
|
|
}
|
|
|
|
int strtodec(int *dec, char *str)
|
|
{
|
|
int i;
|
|
int dd;
|
|
int sign;
|
|
|
|
i = -1;
|
|
dd = 0;
|
|
sign = 1;
|
|
|
|
if (*str == '-') {
|
|
str++;
|
|
sign = -1;
|
|
}
|
|
|
|
while (*str) {
|
|
i = atodec(*str++);
|
|
if (i < 0) {return -1;}
|
|
dd = dd*10 + i;
|
|
}
|
|
|
|
*dec = dd*sign;
|
|
|
|
return ((i < 0) ? -1 : 0);
|
|
}
|
|
|
|
int atohex(char ch)
|
|
{
|
|
int hex;
|
|
|
|
hex = -1;
|
|
|
|
if ((ch >= '0') && (ch <= '9')) {hex = ch - '0';}
|
|
else if ((ch >= 'a') && (ch <= 'f')) {hex = ch - 'a' + 0xa;}
|
|
else if ((ch >= 'A') && (ch <= 'F')) {hex = ch - 'A' + 0xa;}
|
|
|
|
return hex;
|
|
}
|
|
|
|
int strtohex(u32 *hex, char *str)
|
|
{
|
|
int n;
|
|
int i;
|
|
u32 dd;
|
|
|
|
n = -1;
|
|
i = 0;
|
|
dd = 0;
|
|
|
|
while(*str){
|
|
n = atohex(*str++);
|
|
if (n < 0) {return -1;}
|
|
dd = (dd<<4) + n;
|
|
if (++i > 8){return -1;}
|
|
}
|
|
|
|
*hex = dd;
|
|
|
|
return (n<0?-1:0);
|
|
}
|
|
|
|
int strtohexarray(u8 array[], int cnt, char *str)
|
|
{
|
|
int hex;
|
|
u8 tmp;
|
|
u8 *des;
|
|
|
|
des = array;
|
|
|
|
while (cnt-- > 0) {
|
|
hex = atohex(*str++);
|
|
if (hex < 0) {return -1;}
|
|
else {tmp = (hex << 4) & 0xf0;}
|
|
|
|
hex = atohex(*str++);
|
|
if (hex < 0) {return -1;}
|
|
else {tmp = tmp | (hex & 0x0f);}
|
|
|
|
*des++ = (u8) tmp;
|
|
}
|
|
|
|
return ((*str==0) ? 0 : -1);
|
|
}
|
|
|
|
int strtoip(u32 *ipadr, char * str)
|
|
{
|
|
int n;
|
|
u32 i;
|
|
u32 ip;
|
|
char *head;
|
|
char *tail;
|
|
|
|
ip = 0;
|
|
head = str;
|
|
tail = str;
|
|
|
|
for (i = 0; i < 3; ) {
|
|
if (*tail == '.') {
|
|
i++;
|
|
*tail = 0;
|
|
ip <<= 8;
|
|
if (strtodec(&n, head) < 0) {return -1;}
|
|
if ((n < 0) || (n > 255)) {return -1;}
|
|
ip += n;
|
|
*tail = '.';
|
|
head = tail + 1;
|
|
}
|
|
tail++;
|
|
}
|
|
|
|
if (i < 3) {return -1;}
|
|
|
|
ip <<= 8;
|
|
if (strtodec(&n, head) < 0) {return -1;}
|
|
if ((n < 0) || (n > 255)) {return -1;}
|
|
ip += n;
|
|
|
|
*ipadr = ip;
|
|
|
|
return ((ip == 0) ? -1 : 0);
|
|
}
|
|
|
|
void iptostr(u32 ip, char *str)
|
|
{
|
|
sprintf(str, "%d.%d.%d.%d",
|
|
((ip >> 24) & 0xff),((ip >> 16) & 0xff),\
|
|
((ip >> 8) & 0xff), ((ip >> 0) & 0xff));
|
|
}
|
|
|
|
|
|
void mactostr(u8 mac[], char *str)
|
|
{
|
|
sprintf(str, "%02x%02x%02x%02x%02x%02x",
|
|
mac[0],mac[1],mac[2],mac[3],mac[4],mac[5]);
|
|
}
|
|
|
|
|
|
int hex_to_digit(int c)
|
|
{
|
|
if( '0' <= c && c <= '9' )
|
|
return c - '0';
|
|
if( 'A' <= c && c <= 'F' )
|
|
return c - ('A' - 10);
|
|
if( 'a' <= c && c <= 'f' )
|
|
return c - ('a' - 10);
|
|
return -1;
|
|
}
|
|
|
|
int digit_to_hex(int c)
|
|
{
|
|
if( 0 <= c && c <= 9 )
|
|
return c + '0';
|
|
if( 0xA <= c && c <= 0xF )
|
|
return c - 0xA + 'A' ;
|
|
return -1;
|
|
}
|
|
|
|
int hexstr_to_unit(char *buf, u32 *d)
|
|
{
|
|
int i;
|
|
int len = strlen(buf);
|
|
int c;
|
|
*d = 0;
|
|
|
|
if (len > 8)
|
|
return -1;
|
|
for (i=0; i<len; i++) {
|
|
c = hex_to_digit(buf[i]);
|
|
if (c < 0)
|
|
return -1;
|
|
*d = (u8)c | (*d << 4);
|
|
}
|
|
return 0;
|
|
}
|
|
int string_to_uint(char *buf, u32 *d)
|
|
{
|
|
int i;
|
|
int len = strlen(buf);
|
|
|
|
if (len > 11 || len == 0)
|
|
return -1;
|
|
for(i=0; i<len; i++) {
|
|
if (!isdigit(buf[i]))
|
|
return -1;
|
|
}
|
|
*d = atoi(buf);
|
|
return 0;
|
|
}
|
|
|
|
int string_to_ipaddr(const char *buf, u8 *addr)
|
|
{
|
|
int count = 0, rc = 0;
|
|
int in[4];
|
|
char c;
|
|
|
|
rc = sscanf(buf, "%u.%u.%u.%u%c",
|
|
&in[0], &in[1], &in[2], &in[3], &c);
|
|
if (rc != 4 && (rc != 5 || c != '\n'))
|
|
return -1;
|
|
for (count = 0; count < 4; count++) {
|
|
if (in[count] > 255)
|
|
return -1;
|
|
addr[count] = in[count];
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
|
|
char * strdup(const char *s)
|
|
{
|
|
char * ret;
|
|
int len;
|
|
//if(s == NULL)
|
|
// return NULL;
|
|
len = strlen(s) + 1;
|
|
ret = tls_mem_alloc(len);
|
|
if(ret == NULL)
|
|
return NULL;
|
|
memset(ret, 0, len);
|
|
memcpy(ret, s, len-1);
|
|
return ret;
|
|
}
|
|
|
|
char * strndup(const char *s, size_t len)
|
|
{
|
|
char * ret;
|
|
//if(s == NULL)
|
|
// return NULL;
|
|
ret = tls_mem_alloc(len + 1);
|
|
if(ret == NULL)
|
|
return NULL;
|
|
memset(ret, 0, len + 1);
|
|
memcpy(ret, s, len);
|
|
return ret;
|
|
}
|
|
#if 1
|
|
int gettimeofday(struct timeval *tv, struct timezone *tz)
|
|
{
|
|
int ret = 0;
|
|
u32 current_tick;
|
|
|
|
current_tick = tls_os_get_time();//OSTimeGet();
|
|
tv->tv_sec = (current_tick) / 100;
|
|
tv->tv_usec = 10000 * (current_tick % 100);
|
|
return ret;
|
|
}
|
|
#endif
|
|
|
|
void delay_cnt(int count)
|
|
{
|
|
#ifdef TLS_CONFIG_CPU_XT804
|
|
volatile int delay = count;
|
|
#else
|
|
int delay = count;
|
|
#endif
|
|
|
|
while(delay--)
|
|
;
|
|
}
|
|
|
|
void dumpBuffer(char *name, char* buffer, int len)
|
|
{
|
|
#if 1
|
|
int i = 0;
|
|
printf("%s:\n", name);
|
|
for(; i < len; i++)
|
|
{
|
|
printf("%02X, ", buffer[i]);
|
|
if((i + 1) % 16 == 0)
|
|
{
|
|
printf("\n");
|
|
}
|
|
}
|
|
printf("\n");
|
|
#endif
|
|
}
|
|
void dumpUint32(char *name, uint32_t* buffer, int len)
|
|
{
|
|
int i = 0;
|
|
printf("%s:\n", name);
|
|
for(; i < len; i++)
|
|
{
|
|
printf("%08x ", buffer[i]);
|
|
if((i + 1) % 8 == 0)
|
|
{
|
|
printf("\n");
|
|
}
|
|
}
|
|
printf("\n");
|
|
}
|
|
|
|
int strcasecmp(const char *s1, const char *s2)
|
|
{
|
|
char a, b;
|
|
while (*s1 && *s2) {
|
|
a = *s1++;
|
|
b = *s2++;
|
|
|
|
if (a == b)
|
|
continue;
|
|
|
|
if (a >= 'a' && a <= 'z')
|
|
a -= 'a' - 'A';
|
|
if (b >= 'a' && b <= 'z')
|
|
b -= 'a' - 'A';
|
|
|
|
if (a != b)
|
|
return 1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|