Q800_LS_CY/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);
}


/*
restoreDataFormatByHex
"313233"=>{0x31,0x32,0x33}
*/
unsigned char  restoreDataFormatByHex(unsigned char *src, unsigned short len)
{
  unsigned short i,j,k;
  unsigned char temp[2];
  if(0==src) return 1;
  j=0;
  for(i=0;i<len/2;i++){
  	temp[0]=src[2*i];
	temp[1]=src[2*i+1];
	for(k=0;k<2;k++){
	  if(temp[k]>='0' && temp[k]<='9') temp[k] -= 0x30;
	  else if(temp[k]>='a' && temp[k]<='f') temp[k] -= 0x57;
	  else if(temp[k]>='A' && temp[k]<='F') temp[k] -= 0x37;
	  else return 2;
	}
	temp[0] <<= 4;
	temp[0] &= 0xF0;
	src[j++] = temp[0] | temp[1];
  }
  return 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];
	}
}