LC_D29V_ZZD/app/common.c

#include "common.h"
#include "ohpoc.h"

MY_CLOCK My_Clock;

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];
	}
}


void RTC_Init(void)
{
	My_Clock.year=2000;
	My_Clock.month=1;
	My_Clock.day=1,
	My_Clock.hour=0;
	My_Clock.min=0;
	My_Clock.sec=0;
}

void RTC_Update(void)
{
	if(++My_Clock.sec>=60){
		My_Clock.sec=0;
		if(++My_Clock.min>=60){
			My_Clock.min=0;
			if(++My_Clock.hour>=24){
				My_Clock.hour=0;
			}
		}
	}
}

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;
}