//检测逗号位置的函数,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;i<ilen;i++) //得到整数部分数据
{
ires+=NMEA_Pow(10,ilen-1-i)*(buf[i]-'0');
}
if(flen>5)flen=5; //最多取5位小数
*dx=flen; //小数点
串口接收数据转换成double型
最新推荐文章于 2023-02-06 09:02:13 发布