GY-53-L1X激光測(cè)距Arduino源碼

ID:420753 · 發(fā)表于 2018-11-4 21:33

激光測(cè)距源碼，跟大家分享一下

/////////////////////
/*
GY53----MINI
VCC----VCC
GND----GND
1:GY53L1_TX---10
2:GY53L1_RX---11
*/
#include <SoftwareSerial.h>
SoftwareSerial mySerial(10, 11); // RX, TX
//////////////////
unsigned char re_Buf[11],counter=0;
unsigned char sign=0;
byte data_Buf[3]={0};
void setup() {
Serial.begin(9600);
mySerial.begin(9600);
mySerial.listen();
delay(1);
// mySerial.write(0XA5);
// mySerial.write(0X45); //初始化,連續(xù)輸出模式
//mySerial.write(0XEA); //初始化,連續(xù)輸出模式
}
void loop() {
unsigned char i=0,sum=0;
unsigned char RangeStatus=0,Time=0,Mode=0;
uint16_t distance=0;
while (mySerial.available()) {
re_Buf[counter]=(unsigned char)mySerial.read();
if(counter==0&&re_Buf[0]!=0x5A) return; // 檢查幀頭
counter++;
if(counter==8) //接收到數(shù)據(jù)
{
counter=0; //重新賦值，準(zhǔn)備下一幀數(shù)據(jù)的接收
sign=1;
}
}
if(sign)
{
sign=0;
for(i=0;i<7;i++)
sum+=re_Buf[i];
if(sum==re_Buf[i] ) //檢查幀頭，幀尾
{
data_Buf[0]=re_Buf[4];
data_Buf[1]=re_Buf[5];
data_Buf[2]=re_Buf[6];
distance=data_Buf[0]<<8|data_Buf[1];
RangeStatus=(data_Buf[2]>>4)&0x0f;
Time=(data_Buf[2]>>2)&0x03;
Mode=data_Buf[2]&0x03;
Serial.print("distance: ");
Serial.print( distance);
Serial.print(" mm,RangeStatus: ");
Serial.print( RangeStatus);
Serial.print(" ,Time: ");
Serial.print( Time);
Serial.print(",Mode: ");
Serial.println( Mode);
}
}
}
/*void serialEvent() {
while (Serial.available()) {
re_Buf[counter]=(unsigned char)Serial.read();
if(counter==0&&re_Buf[0]!=0x5A) return; // 檢查幀頭
counter++;
if(counter==8) //接收到數(shù)據(jù)
{
counter=0; //重新賦值，準(zhǔn)備下一幀數(shù)據(jù)的接收
sign=1;
}
}
}*/

復(fù)制代碼

全部資料51hei下載地址：

arduino.zip (1.83 KB, 下載次數(shù): 18)

ID:25481 · 發(fā)表于 2018-11-13 08:02

這個(gè)模塊輸出的距離單位是厘米還是毫米？

帳號(hào)		自動(dòng)登錄	找回密碼
密碼			立即注冊(cè)