Network-Modules/Drivers/Utils/Common_Util.c

#include <stdarg.h>
#include <string.h>
#include <stdio.h>

#include "Common_Util.h"



/**
* 整形字符串转整形数字
*/
int my_atoi(char *str)
{
    int n = 0;
    int flag = 0;
    if(*str == '-')
    {
        flag = 1;
        str++;
    }
    while(*str >= '0' && *str <= '9')
    {
        n = n*10 + (*str - '0');
        str++;
    }
    if(flag == 1)
    {
        n = -n;
    }
    return n;
}

/**
* 整形转字符串
* num:待转的数据,str:目标地址,radix:进制2,8,10,16
*/
char* my_itoa(int num,char* str,int radix)
{
    char index[]="0123456789ABCDEFGHIJKLMNOPQRSTUVWXYZ";//索引表
    unsigned unum;//存放要转换的整数的绝对值,转换的整数可能是负数
    int i=0,j,k;//i用来指示设置字符串相应位，转换之后i其实就是字符串的长度；转换后顺序是逆序的，有正负的情况，k用来指示调整顺序的开始位置;j用来指示调整顺序时的交换。
 
    //获取要转换的整数的绝对值
    if(radix==10&&num<0)//要转换成十进制数并且是负数
    {
        unum=(unsigned)-num;//将num的绝对值赋给unum
        str[i++]='-';//在字符串最前面设置为'-'号，并且索引加1
    }
    else unum=(unsigned)num;//若是num为正，直接赋值给unum
 
    //转换部分，注意转换后是逆序的
    do
    {
        str[i++]=index[unum%(unsigned)radix];//取unum的最后一位，并设置为str对应位，指示索引加1
        unum/=radix;//unum去掉最后一位
 
    }while(unum);//直至unum为0退出循环
 
    str[i]='\0';//在字符串最后添加'\0'字符，c语言字符串以'\0'结束。
 
    //将顺序调整过来
    if(str[0]=='-') k=1;//如果是负数，符号不用调整，从符号后面开始调整
    else k=0;//不是负数，全部都要调整
 
    char temp;//临时变量，交换两个值时用到
    for(j=k;j<=(i-1)/2;j++)//头尾一一对称交换，i其实就是字符串的长度，索引最大值比长度少1
    {
        temp=str[j];//头部赋值给临时变量
        str[j]=str[i-1+k-j];//尾部赋值给头部
        str[i-1+k-j]=temp;//将临时变量的值(其实就是之前的头部值)赋给尾部
    }
 
    return str;//返回转换后的字符串
 
}


//字节流转HEX字符串
void byteToHexStr(const unsigned char* source, char* dest, int sourceLen)
{  
    short i;  
    unsigned char highByte, lowByte;  
  
    for (i = 0; i < sourceLen; i++)  
    {  
        highByte = source[i] >> 4;  
        lowByte = source[i] & 0x0f ;  
  
        highByte += 0x30;  
  
        if (highByte > 0x39)  
                dest[i * 2] = highByte + 0x07;  
        else  
                dest[i * 2] = highByte;  
  
        lowByte += 0x30;  
        if (lowByte > 0x39)  
            dest[i * 2 + 1] = lowByte + 0x07;  
        else  
            dest[i * 2 + 1] = lowByte;  
    }  
    return ;  
}

void bytesToHex(char * dest, uint8_t * source, uint16_t source_length)
{
	int i = 0;
	for(; i < source_length; i++)
	{
		sprintf(dest + 2 * i, "%02X", source[i]);
	}
//	*(dest + 2 * i + 1) = 0;
}



uint8_t memmem(uint8_t * result,uint16_t result_length, uint8_t *rdystring,uint8_t rdylen)
{
	uint8_t res = 0;
	for(int i = 0; i < result_length - rdylen; i++)
	{
		for(int j = 0; j < rdylen; j++)
		{
			if(result[i+j] == rdystring[j])
			{
				res = 1;
			}
			else
			{
				res = 0;
				break;
			}
		}
		if(res == 1)
		{
			break;
		}
	 }
	return res;
}

//uint8_t memmem(uint8_t * result,uint16_t result_length, uint8_t *rdystring,uint8_t rdylen)
//{
//   for(int i=0;i<result_length-rdylen;i++){
//		 if(strstr((char * )result+i,(char *)rdystring) != NULL)
//		 {
//			 return 1;
//		 }
//	 }
//	return 0;
//}