串口接收数据转换成double型

//检测逗号位置的函数,buf是需要检测的字符串,cx是要检测第几个逗号
u8 NMEA_Comma_Pos(u8 *buf,u8 cx)
{	 		    
	u8 *p=buf;
	while(cx)
	{		 
		
	  if(*buf==',')cx--;
		  buf++;
		if(*buf=='*'||*buf<' '||*buf>'z')return 0XFF;//遇到‘*’,和非法字符就返回0xff
	}
	return buf-p;	 
}

//m^n函数
//返回值:m^n
u32 NMEA_Pow(u8 m,u8 n)
{
	u32 result=1;	 
	while(n--)result*=m;    
	return result;
}


//str转换位数字,以‘,’或者‘*’结束
//buf:str存储区
//dx:小数点位数,返回给调用函数
//返回值:转换位长整形
int NMEA_Str2num(u8 *buf,u8*dx)
{
	u8 *p=buf;
	u32 ires=0,fres=0;
	u8 ilen=0,flen=0,i;
	u8 mask=0;
	int res;
	while(1) //得到整数和小数的长度
	{
		if(*p=='-'){mask|=0X02;p++;}//是负数
		if(*p==','||(*p=='*'))break;//遇到‘,’或者‘*’结束
		if(*p=='.'){mask|=0X01;p++;}//遇到小数点
		else if(*p>'9'||(*p<'0'))	//有非法字符
		{	
			ilen=0;
			flen=0;
			break;
		}	
		if(mask&0X01)flen++;
		else ilen++;
		p++;
	}
	if(mask&0X02)buf++;	//去掉负号
	for(i=0;i5)flen=5;	//最多取5位小数
	*dx=flen;	 		//小数点位数
	for(i=0;i

举例:*buf = {“ZCPOS,123.56,789.23,546.72,”}

得到:GPS_lat = 123.56   GPS_long = 789.23  GPS_direction=564.72

你可能感兴趣的:(C语言,算法)