Serial debug in example

kaiaai · May 11, 2024 · aac74e6 · aac74e6
1 parent e7b632d
commit aac74e6
Showing 1 changed file with 18 additions and 2 deletions.
diff --git a/examples/lds_basic_esp32/lds_basic_esp32.ino b/examples/lds_basic_esp32/lds_basic_esp32.ino
@@ -66,7 +66,23 @@ void setup() {
 }
 
 int lidar_serial_read_callback() {
-  return LidarSerial.read();
+  int c = LidarSerial.read();
+// Uncomment below for debug
+/*
+  if (c < 0)
+    return c;
+
+  if (c < 16)
+    Serial.print('0');
+  Serial.print(c, HEX);
+
+  static int i=0;
+  if (i++ % 16 == 0)
+    Serial.println();
+  else
+    Serial.print(' ');
+*/
+  return c;
 }
 
 size_t lidar_serial_write_callback(const uint8_t * buffer, size_t length) {
@@ -132,4 +148,4 @@ void lidar_packet_callback(uint8_t * packet, uint16_t length, bool scan_complete
 
 void loop() {
   lidar.loop();
-}
+}