byte inbyte[19];
int h[13];
void setup()
{
Serial.begin(115200); //设置串口波特率
}
void loop()
{
while (Serial.available() > 0) { //判断是否获取到数据
for(int b=0;b<19;b++){ //19个字节为一组
inbyte[b]=Serial.read(); //获取数据
// delay(10);
if(inbyte[b]==170&&inbyte[b+1]==48) //识别标识位(手册可查)
{for(int a=b+4;a<b+12;a+=2){
h[a] = (inbyte[a]/16)*16*16*16+(inbyte[a]%16)*16*16+inbyte[a+1]; //根据规则计算出实际测量距离
Serial.print(h[a]); //输出
Serial.print(",");
Serial.write(16);
}
}
}
Serial.println();
while(Serial.read() >= 0){}
}
delay(2);
}
arduino读取处理UWB(匿名科技的)数据集
最新推荐文章于 2022-12-09 09:24:42 发布