X2-LS-GWSD/app/common.c

#include "common.h"

int GetParaFromStr(char *Str,char *Para,char *Value){
	int ValueLen=0,ParaLen=0;
	char ParaTemp[22];
	char *p;
	char d;
	int i=0;

	if(0==*Str || 0==*Para)return 0;

	while(0!=(d=*Para) && ParaLen<20){
		ParaTemp[i++]=d;
		if(d=='=' || d==';')return 0;
		Para++;
		ParaLen++;
	}
	ParaTemp[ParaLen++]='=';
	ParaTemp[ParaLen]=0;
	p=strstr(Str,ParaTemp);
	p+=ParaLen;
	//--
	while(*p>0x20 && ';'!=*p && ValueLen<=80){
		*Value=*p;
		p++;
		Value++;
		ValueLen++;	
	}
	*Value=0;
	return ValueLen;
}

char msgCmp(char *msg, char *target){
	char *p1=target, *p2=msg;

	while(*p1 != 0){
		if(*p1 != *p2) return 0;
		p1++;p2++;
	}
	return 1;
}

// '56'->0X56
unsigned char charStrToHex(char d1, char d2){
	unsigned char p1=d1;
	unsigned char p2=d2;
	if(p1>='0' && p1 <='9') p1 -= 0x30;
	else if(p1>='a' && p1 <='f') p1 -= 0x57;
	else if(p1>='A' && p1 <='F') p1 -= 0x37;
	else return 0;
	p1<<=4;p1&=0xF0;
	
	if(p2>='0' && p2 <='9') p2 -= 0x30;
	else if(p2>='a' && p2 <='f') p2 -= 0x57;
	else if(p2>='A' && p2 <='F') p2 -= 0x37;
	else return 0;
	return (p1|p2);
}


unsigned char AscToHex(unsigned char aHex)
{    
	if((aHex>=0)&&(aHex<=9))        
	aHex += 0x30;    
	else if((aHex>=10)&&(aHex<=15))//A-F        
	//aHex += 0x37;    
	aHex += 0x57;  
	else aHex = 0xff;    
	return aHex;
}
void AscStrTurnHexStr(char *AscStr, char *HexStr)
{
	char *pAscStr=AscStr;
	unsigned char d,h,l;
	while(0!=(d=(unsigned char)*pAscStr++)){
		l=d&0x0f;
		h=d>>4;
		*HexStr++=AscToHex(h);
		*HexStr++=AscToHex(l);
	}
	*HexStr=0;
}

void LwEndingToBiEndingStr(char *data, int len){
	char tt[2];
	int i;
	for(i=0;i<len/4;i++){
		tt[0]=data[4*i];
		tt[1]=data[4*i+1];
		data[4*i]=data[4*i+2];
		data[4*i+1]=data[4*i+3];
		data[4*i+2]=tt[0];
		data[4*i+3]=tt[1];
	}
}