/****************************************************
一、字符串截取函數
****************************************************/
char* SplitLeft(char *dst,char *src, int n)
{
char *p = src;
char *q = dst;
int len = strlen(src);
if(n>len)
n = len;
while(n--)
*(q++) = *(p++);
*(q++)='\0';
return dst;
}
char* SplitMid(char *dst,char *src, int n,int m)
{
char *p = src;
char *q = dst;
int len = strlen(src);
if(n>len)
n = len-m;
if(m<0)
m=0;
if(m>len)
return NULL;
p += m;
while(n--)
*(q++) = *(p++);
*(q++)='\0';
return dst;
}
char* SplitRight(char *dst,char *src, int n)
{
char *p = src;
char *q = dst;
int len = strlen(src);
if(n>len)
n = len;
p += (len-n);
while(*(q++) = *(p++));
return dst;
}
int SplitSize(char x,char * str)
{
int i=0;
int ret = 0;
for(;i<strlen(str);i++)
{
if(str[i] == x)
ret ++;
}
return ret;
}
/****************************************************
二、轉換函數
****************************************************/
const char HEXCH[] = "0123456789ABCDEF";
unsigned char CharToHex(char chFrom)
{
if (chFrom>='0' && chFrom<='9')
{
return chFrom - '0';
}
else if (chFrom>='A' && chFrom<='Z')
{
return 0x0A + chFrom - 'A';
}
else if (chFrom>='a' && chFrom<='z')
{
return 0x0A + chFrom - 'a';
}
else
{
return 0;
}
}
static unsigned parse_hex4(const char *str)
{
unsigned h = 0;
if ((*str >= '0') && (*str <= '9'))
{
h += (*str) - '0';
}
else if ((*str >= 'A') && (*str <= 'F'))
{
h += 10 + (*str) - 'A';
}
else if ((*str >= 'a') && (*str <= 'f'))
{
h += 10 + (*str) - 'a';
}
else
{
return 0;
}
h = h << 4;
str++;
if ((*str >= '0') && (*str <= '9'))
{
h += (*str) - '0';
}
else if ((*str >= 'A') && (*str <= 'F'))
{
h += 10 + (*str) - 'A';
}
else if ((*str >= 'a') && (*str <= 'f'))
{
h += 10 + (*str) - 'a';
}
else
{
return 0;
}
h = h << 4;
str++;
if ((*str >= '0') && (*str <= '9'))
{
h += (*str) - '0';
}
else if ((*str >= 'A') && (*str <= 'F'))
{
h += 10 + (*str) - 'A';
}
else if ((*str >= 'a') && (*str <= 'f'))
{
h += 10 + (*str) - 'a';
}
else
{
return 0;
}
h = h << 4;
str++;
if ((*str >= '0') && (*str <= '9'))
{
h += (*str) - '0';
}
else if ((*str >= 'A') && (*str <= 'F'))
{
h += 10 + (*str) - 'A';
}
else if ((*str >= 'a') && (*str <= 'f'))
{
h += 10 + (*str) - 'a';
}
else
{
return 0;
}
return h;
}
unsigned short int Str2HexByOneByte(char *pFrom)
{
unsigned short int nuint8Return = 0;
unsigned short int k = 0;
for (int i=7; i<0; i--)
{
k = CharToHex(pFrom[i]);
k <<= i;
nuint8Return += k;
}
return nuint8Return;
}
unsigned char BcdToHex(unsigned char nBcdData)
{
unsigned char temp;
temp=(nBcdData/16*10 + nBcdData%16);
return temp;
}
unsigned int HexToBcd(unsigned char nHexData)
{
unsigned char temp;
temp=(nHexData/10*16 + nHexData%10);
return temp;
}
void BcdToStr(char * dest,char * bcd,int bcdlength)
{
int i;
for(i=0;i<bcdlength;i++)
{
sprintf(dest+i*2,"%02X",(unsigned char)bcd[i]);
}
}
void HexToStr(char *pbDest, char *pbSrc, int nLen)
{
char ddl,ddh;
for (int i=0; i<nLen; i++)
{
ddh = 48 + pbSrc[i] / 16;
ddl = 48 + pbSrc[i] % 16;
if (ddh > 57)
ddh = ddh + 7;
if (ddl > 57)
ddl = ddl + 7;
pbDest[i*2] = ddh;
pbDest[i*2+1] = ddl;
}
pbDest[nLen*2] = '\0';
}
int StrToHex(char *pFrom, unsigned char *pTo)
{
int i;
char *p;
i = 0;
p = pFrom;
while (1)
{
if (*p==0 || *(p+1)==0)
{
break;
}
*pTo = (CHAR2HEX(*p)<<4)|(CHAR2HEX(*(p+1)));
++pTo;
++p;
++p;
++i;
}
*pTo++ = 0;
return i;
}
int StrToHex2(char *lpszIn, int nLen)
{
int nRet = 0;
for(int i = 1; i <= nLen; i++)
{
if( *lpszIn >= 'A' && *lpszIn < 'Z')
{
nRet += (*lpszIn - '0' - 7) * ( pow(16, (nLen-i)) );
}
else if( *lpszIn >= 'a' && *lpszIn < 'z')
{
nRet += (*lpszIn - '0' - 39) * ( pow(16, (nLen-i)) );
}
else
{
nRet += (*lpszIn - '0') * ( pow(16, (nLen-i)) );
}
lpszIn++;
}
return nRet;
}
int AsciiToBcd( char *pDst, char *pSrc)
{
int nLen = (strlen(pSrc)+1)/2;
for (int i=strlen(pSrc)-1; i>0; i-=2)
{
int n1 = pSrc[i] - '0';
int n2 = pSrc[i-1] - '0';
pDst[i/2] = (n1&0xFF)|(n2<<4);
}
if (strlen(pSrc)%2 != 0)
{
pDst[0] = pSrc[0] - '0';
}
return nLen;
}
void EndianLocal2Big32(unsigned int nLocalData, unsigned char *pTo)
{
pTo[0] = (nLocalData >> 24) & 0xff;
pTo[1] = (nLocalData >> 16) & 0xff;
pTo[2] = (nLocalData >> 8) & 0xff;
pTo[3] = nLocalData & 0xff;
}
void EndianLocal2Big16(unsigned short int nLocalData, unsigned char *pTo)
{
pTo[0] = (nLocalData >> 8) & 0xff;
pTo[1] = nLocalData & 0xff;
}
unsigned int EndianBig2Local32(unsigned char *pFrom)
{
unsigned long ret;
ret = pFrom[0];
ret <<= 8;
ret |= pFrom[1];
ret <<= 8;
ret |= pFrom[2];
ret <<= 8;
ret |= pFrom[3];
return ret;
}
unsigned short int EndianBig2Local16(unsigned char *pFrom)
{
unsigned short ret;
ret = pFrom[0];
ret <<= 8;
ret |= pFrom[1];
return ret;
}
unsigned short int EndianLittle2Local16(unsigned char *pFrom)
{
unsigned short ret;
ret = pFrom[1];
ret <<= 8;
ret |= pFrom[0];
return ret;
}
void EndianLocal2Little16(unsigned short int nLocalData, unsigned char *pTo)
{
pTo[0] = nLocalData & 0xff;
pTo[1] = (nLocalData >> 8) & 0xff;
}
long DectoBCD(long Dec, unsigned char *Bcd, int length)
{
int i;
int temp;
for(i=length-1; i>=0; i--)
{
temp = Dec%100;
Bcd[i] = ((temp/10)<<4) + ((temp%10) & 0x0F);
Dec /= 100;
}
return 0;
}
unsigned long BCDtoDec(const unsigned char *bcd, int length)
{
int i, tmp;
unsigned long dec = 0;
for(i=0; i<length; i++)
{
tmp = ((bcd[i]>>4)&0x0F)*10 + (bcd[i]&0x0F);
dec += tmp * pow(100, length-1-i);
}
return dec;
}
int AsciiToBcd( char *pDst, char *pSrc)
{
int nLen = (strlen(pSrc)+1)/2;
int i=strlen(pSrc)-1;
for (; i>0; i-=2)
{
int n1 = pSrc[i] - '0';
int n2 = pSrc[i-1] - '0';
pDst[i/2] = (n1&0xFF)|(n2<<4);
}
if (strlen(pSrc)%2 != 0)
{
pDst[0] = pSrc[0] - '0';
}
return nLen;
}