WS_UART.cpp 1.4 KB

12345678910111213141516171819202122232425262728293031323334353637383940
  1. #include "WS_UART.h"
  2. #include <algorithm>
  3. HardwareSerial lidarSerial2(2); // Using serial port 1
  4. HardwareSerial lidarSerial3(0); // Using serial port 1
  5. uint8_t buf2[20] = {0}; // Data storage area
  6. uint8_t buf3[20] = {0}; // Data storage area
  7. void SetData2(uint8_t* data, size_t length) {
  8. lidarSerial2.write(data, length); // Send data from the RS485
  9. }
  10. void SetData3(uint8_t* data, size_t length) {
  11. lidarSerial3.write(data, length); // Send data from the RS485
  12. }
  13. void Extension_Init()
  14. {
  15. // Serial.begin(115200); // Initializing serial port
  16. lidarSerial2.begin(115200, SERIAL_8N1, RXD2, TXD2); // Initializing serial port
  17. lidarSerial3.begin(115200, SERIAL_8N1, RXD3, TXD3); // Initializing serial port
  18. }
  19. void Extension_Loop()
  20. {
  21. uint8_t Receive_Flag2 = 0,Receive_Flag3 = 0; // Receiving mark
  22. Receive_Flag2 = lidarSerial2.available();
  23. Receive_Flag3 = lidarSerial3.available();
  24. if (Receive_Flag2 > 0) {
  25. lidarSerial2.readBytes(buf2, Receive_Flag2); // The Receive_Flag length is read
  26. printf("Channel 0: %s\r\n",buf2);
  27. Receive_Flag2=0;
  28. memset(buf2,0, sizeof(buf2));
  29. }
  30. if (Receive_Flag3 > 0) {
  31. lidarSerial3.readBytes(buf3, Receive_Flag3); // The Receive_Flag length is read
  32. printf("Channel 1: %s\r\n",buf3);
  33. Receive_Flag3=0;
  34. memset(buf3,0, sizeof(buf3));
  35. }
  36. }