移植与电子模块通信相关代码
This commit is contained in:
andy
458
source/elec_det/base/utility.c
Normal file
458
source/elec_det/base/utility.c
Normal file
@@ -0,0 +1,458 @@
|
||||
|
||||
|
||||
#include "utility.h"
|
||||
float myatof(const char* str)
|
||||
{
|
||||
|
||||
uint32_t int_nu = 0;
|
||||
uint32_t flot_nu = 0;
|
||||
float val;
|
||||
float f_count = 1;
|
||||
while((*str != 0) && (*str != '.'))
|
||||
{
|
||||
if(*str > '9' && *str < '0')
|
||||
{
|
||||
str++;
|
||||
continue;
|
||||
}
|
||||
int_nu = int_nu*10+(*str - 48);
|
||||
str++;
|
||||
}
|
||||
|
||||
if(*str == 0)
|
||||
{
|
||||
val = int_nu;
|
||||
return val;
|
||||
}
|
||||
str++;
|
||||
while(*str != 0)
|
||||
{
|
||||
if(*str > '9' && *str < '0')
|
||||
{
|
||||
str++;
|
||||
continue;
|
||||
}
|
||||
flot_nu = flot_nu*10+(*str - 48);
|
||||
f_count *= 10;
|
||||
str++;
|
||||
}
|
||||
val = flot_nu;
|
||||
val = val / f_count + int_nu;
|
||||
return val;
|
||||
}
|
||||
|
||||
/**
|
||||
*@brief string to uint16_t
|
||||
*@param str:src string， base:
|
||||
*@return num:convert result
|
||||
*/
|
||||
uint16_t atoi16(const char* str,uint16_t base)
|
||||
{
|
||||
unsigned int num = 0;
|
||||
while (*str !=0)
|
||||
num = num * base + c2d(*str++);
|
||||
return num;
|
||||
}
|
||||
|
||||
/**
|
||||
*@brief string to uint32
|
||||
*@param str:src string， base:
|
||||
*@return num:convert result
|
||||
*/
|
||||
uint32_t atoi32(const char* str,uint16_t base)
|
||||
{
|
||||
uint32_t num = 0;
|
||||
while (*str !=0)
|
||||
num = num * base + c2d(*str++);
|
||||
return num;
|
||||
}
|
||||
|
||||
/**
|
||||
*@brief uint16 data to string
|
||||
*@param n:src num， str[5]:string buffer len：string size
|
||||
*@return void
|
||||
*/
|
||||
void itoa(uint16_t n,uint8_t str[5], uint8_t len)
|
||||
{
|
||||
|
||||
uint8_t i=len-1;
|
||||
|
||||
memset(str,0x20,len);
|
||||
do{
|
||||
str[i--]=n%10+'0';
|
||||
|
||||
}while((n/=10)>0);
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
|
||||
/**
|
||||
*@brief dec or hex string convert to uint32_t
|
||||
*@param str:src string， ret： the pointer of result
|
||||
*@return success = 1, fail = 0
|
||||
*/
|
||||
int validatoi(const char* str, int base,uint32_t* ret)
|
||||
{
|
||||
int c;
|
||||
const char* tstr = str;
|
||||
if(str == 0 || *str == '\0')
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
while(*tstr != '\0')
|
||||
{
|
||||
c = c2d(*tstr);
|
||||
if( (c >= 0) && (c < base))
|
||||
{
|
||||
tstr++;
|
||||
}
|
||||
else
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
*ret = atoi32(str,base);
|
||||
return 1;
|
||||
}
|
||||
|
||||
/**
|
||||
*@brief new char to replace the old char
|
||||
*@param str:src string，oldchar:dst char，newchar：src char
|
||||
*@return void
|
||||
*/
|
||||
void replacetochar(char * str, char oldchar,char newchar)
|
||||
{
|
||||
int x;
|
||||
for (x = 0; str[x]; x++)
|
||||
if (str[x] == oldchar) str[x] = newchar;
|
||||
}
|
||||
|
||||
/**
|
||||
*@brief char to num
|
||||
*@param c:src char
|
||||
*@return convert result
|
||||
*/
|
||||
char c2d(const uint8_t c)
|
||||
{
|
||||
if (c >= '0' && c <= '9')
|
||||
return c - '0';
|
||||
if (c >= 'a' && c <= 'f')
|
||||
return 10 + c -'a';
|
||||
if (c >= 'A' && c <= 'F')
|
||||
return 10 + c -'A';
|
||||
|
||||
return (char)0;
|
||||
}
|
||||
/**
|
||||
*@brief num to char
|
||||
*@param c:src num
|
||||
*@return convert result
|
||||
*/
|
||||
char d2c(const uint8_t c)
|
||||
{
|
||||
if ( c <= 9)
|
||||
{
|
||||
return c + '0';
|
||||
}
|
||||
if (c >= 0x0a && c <= 0x0f)
|
||||
{
|
||||
return c + 'a' - 10;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
/**
|
||||
*@brief 2bytes swap
|
||||
*@param i:src num
|
||||
*@return convert result
|
||||
*/
|
||||
uint16_t swaps(uint16_t i)
|
||||
{
|
||||
uint16_t ret=0;
|
||||
ret = (i & 0xFF) << 8;
|
||||
ret |= ((i >> 8)& 0xFF);
|
||||
return ret;
|
||||
}
|
||||
/**
|
||||
*@brief 4 bytes swap, bytes order 4 3 2 1 convert to 1 2 3 4
|
||||
*@param i:src num
|
||||
*@return convert result
|
||||
*/
|
||||
uint32_t swapl(uint32_t l)
|
||||
{
|
||||
uint32_t ret=0;
|
||||
ret = (l & 0xFF) << 24;
|
||||
ret |= ((l >> 8) & 0xFF) << 16;
|
||||
ret |= ((l >> 16) & 0xFF) << 8;
|
||||
ret |= ((l >> 24) & 0xFF);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/**
|
||||
*@brief get substring
|
||||
*@param src:src string s1: target begin s2: target end sub: result pointer
|
||||
*@return void
|
||||
*/
|
||||
void mid(const char* src, const char* s1, const char* s2, char* sub)
|
||||
{
|
||||
char* sub1;
|
||||
char* sub2;
|
||||
uint16_t n;
|
||||
|
||||
sub1=strstr(src,s1);
|
||||
sub1+=strlen(s1);
|
||||
sub2=strstr(sub1,s2);
|
||||
n=sub2-sub1;
|
||||
strncpy(sub,sub1,n);
|
||||
sub[n]=0;
|
||||
}
|
||||
/**
|
||||
*@brief bytes array conver to string
|
||||
*@param *data: ponit src bytes len: array length str: resuter string pointer
|
||||
*@return void
|
||||
*/
|
||||
|
||||
void bytes2hexString(const char* data, uint32_t len, char* str)
|
||||
{
|
||||
char c_temp;
|
||||
while(len > 0)
|
||||
{
|
||||
c_temp = ((*data) &0xF0) >> 4;
|
||||
if(c_temp < 10)
|
||||
{
|
||||
*str = c_temp + '0';
|
||||
}
|
||||
else
|
||||
{
|
||||
*str = (c_temp - 10) + 'A';
|
||||
}
|
||||
|
||||
c_temp = ((*data) &0x0F);
|
||||
str++;
|
||||
if(c_temp < 10)
|
||||
{
|
||||
*str = c_temp + '0';
|
||||
}
|
||||
else
|
||||
{
|
||||
*str = (c_temp - 10)+ 'A';
|
||||
}
|
||||
str++;
|
||||
data++;
|
||||
len--;
|
||||
}
|
||||
*(str++) = '\0';
|
||||
|
||||
}
|
||||
/*
|
||||
Hex Datas to Bytes
|
||||
*/
|
||||
uint8_t HexStrings2Byte(char**strs,uint16_t size,uint8_t* buf,uint16_t buf_size)
|
||||
{
|
||||
char* str;
|
||||
uint8_t data = 0;
|
||||
uint16_t count = 0;
|
||||
while((size > 0) && (count < buf_size))
|
||||
{
|
||||
str = strs[count++];
|
||||
size--;
|
||||
data = 0;
|
||||
while(*str != '\0')
|
||||
{
|
||||
|
||||
if(*str == '0')
|
||||
{
|
||||
if((*(str+1) == 'X') || (*(str+1) == 'x'))
|
||||
{
|
||||
str+=2;
|
||||
continue;
|
||||
}
|
||||
}
|
||||
data <<=4;
|
||||
data |=c2d(*str);
|
||||
str++;
|
||||
}
|
||||
*buf = data;
|
||||
buf++;
|
||||
}
|
||||
return count;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
Hex Datas to uint32_t
|
||||
*/
|
||||
uint32_t HexStrings2UInt(char*str)
|
||||
{
|
||||
|
||||
uint32_t data = 0;
|
||||
uint16_t count = 0;
|
||||
data = 0;
|
||||
while(*str != '\0' && count < 10)
|
||||
{
|
||||
|
||||
if(*str == '0')
|
||||
{
|
||||
if((*(str+1) == 'X') || (*(str+1) == 'x'))
|
||||
{
|
||||
str+=2;
|
||||
continue;
|
||||
}
|
||||
}
|
||||
data <<=4;
|
||||
data |=c2d(*str);
|
||||
str++;
|
||||
count++;
|
||||
}
|
||||
return data;
|
||||
}
|
||||
|
||||
//冒泡排序16位数据
|
||||
void Bubble_Sort_u16(uint16_t* buf,uint32_t len)
|
||||
{
|
||||
uint32_t ul_temp1 = 0;
|
||||
uint32_t ul_temp2 = 0;
|
||||
uint16_t us_temp;
|
||||
if(len < 2)
|
||||
return;
|
||||
for(ul_temp2 = 0; ul_temp2 < len-1; ul_temp2++)
|
||||
{
|
||||
for(ul_temp1 = 0; ul_temp1 < len-1-ul_temp2; ul_temp1++)
|
||||
{
|
||||
if(buf[ul_temp1] > buf[ul_temp1+1])
|
||||
{
|
||||
us_temp = buf[ul_temp1];
|
||||
buf[ul_temp1] = buf[ul_temp1 + 1];
|
||||
buf[ul_temp1 + 1] = us_temp;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
//数据左移
|
||||
void BufMoveLeft(uint8_t* srcbuf,uint16_t offset,uint16_t data_len)
|
||||
{
|
||||
uint8_t index = 0;
|
||||
while(data_len > 0)
|
||||
{
|
||||
srcbuf[index] = srcbuf[index+offset];
|
||||
data_len--;
|
||||
index++;
|
||||
}
|
||||
}
|
||||
//数据右移
|
||||
void BufMoveRight(uint8_t* srcbuf,uint16_t offset,uint16_t data_len)
|
||||
{
|
||||
while(data_len > 0)
|
||||
{
|
||||
data_len--;
|
||||
srcbuf[data_len+offset] = srcbuf[data_len] ;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
//@brief 计算数组的CRC8值
|
||||
//@param *srcbuf 数据源指针
|
||||
//@param len 数据源长度
|
||||
//@rtvl 返回计算结果
|
||||
uint8_t CheckXOR_8(uint8_t* srcbuf,uint16_t len)
|
||||
{
|
||||
uint8_t crc = 0x00;
|
||||
while(len--)
|
||||
{
|
||||
crc ^= *srcbuf++;
|
||||
}
|
||||
return crc;
|
||||
}
|
||||
|
||||
|
||||
//@brief 计算数组异或校验值
|
||||
//@param *Ptr 数据源
|
||||
//@param num 计算长度
|
||||
//@rtvl 返回计算结果
|
||||
uint8_t CheckCRC_8(uint8_t* Ptr,uint16_t num)
|
||||
{
|
||||
uint8_t crc = 0;
|
||||
uint16_t j,i;
|
||||
|
||||
for (j = 0; j < num; j++)
|
||||
{
|
||||
crc ^= *(Ptr+j);
|
||||
for ( i = 0; i < 8; i++)
|
||||
{
|
||||
if ((crc & 0x01) != 0)
|
||||
{
|
||||
crc >>= 1;
|
||||
crc ^= 0x8c;
|
||||
}
|
||||
else
|
||||
{
|
||||
crc >>= 1;
|
||||
}
|
||||
}
|
||||
}
|
||||
return crc;
|
||||
}
|
||||
//@brief 计算CRC32
|
||||
//@param *srcbuf 数据源
|
||||
//@param len 计算长度
|
||||
//@rtvl 返回计算结果
|
||||
uint32_t Crc32Calu(uint32_t* buf, uint32_t len)
|
||||
{
|
||||
uint32_t temp,crc = 0xFFFFFFFF;
|
||||
|
||||
uint32_t i,j;
|
||||
i = 0;
|
||||
if(((uint32_t)buf %4) != 0)
|
||||
{
|
||||
return 1;
|
||||
}
|
||||
while(i<len)
|
||||
{
|
||||
temp = *buf;
|
||||
i += 4;
|
||||
buf ++;
|
||||
for(j=0; j<32; j++)
|
||||
{
|
||||
if( (crc ^ temp) & 0x80000000 )
|
||||
{
|
||||
crc = 0x04C11DB7 ^(crc<<1);
|
||||
}
|
||||
else
|
||||
{
|
||||
crc <<=1;
|
||||
}
|
||||
temp<<=1;
|
||||
}
|
||||
crc&=0xFFFFFFFF;
|
||||
}
|
||||
return crc;
|
||||
}
|
||||
/*
|
||||
@brief 获取数组中的最大值和最小值
|
||||
@param *aus_buf 缓存数组
|
||||
@param us_size 数组长度
|
||||
@param *us_max 最大值
|
||||
@param *us_min 最小值
|
||||
*/
|
||||
|
||||
void GetMaxAndMinValue(uint16_t* aus_buf,uint16_t us_size,uint16_t* us_max,uint16_t* us_min)
|
||||
{
|
||||
*us_max = 0;
|
||||
*us_min = ~0;
|
||||
while(us_size > 0)
|
||||
{
|
||||
if(*us_max < *aus_buf)
|
||||
{
|
||||
*us_max = *aus_buf;
|
||||
}
|
||||
if(*us_min > *aus_buf)
|
||||
{
|
||||
*us_min = *aus_buf;
|
||||
}
|
||||
aus_buf++;
|
||||
us_size--;
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user