Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <SoftwareSerial.h>
- SoftwareSerial mySerial(11, 10); // RX, TX
- unsigned char data[4] = {};
- float distance;
- void setup()
- {
- Serial.begin(57600);
- mySerial.begin(9600);
- }
- void loop()
- {
- do {
- for (int i = 0; i < 4; i++)
- {
- data[i] = mySerial.read();
- }
- } while (mySerial.read() == 0xff);
- mySerial.flush();
- if (data[0] == 0xff)
- {
- int sum;
- sum = (data[0] + data[1] + data[2]) & 0x00FF;
- if (sum == data[3])
- {
- distance = (data[1] << 8) + data[2];
- if (distance > 280)
- {
- Serial.print("distance=");
- Serial.print(distance / 10);
- Serial.println("cm");
- } else
- {
- Serial.println("Below the lower limit");
- }
- } else Serial.println("ERROR");
- }
- delay(150);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement