diff --git a/src/lidar_lite.cpp b/src/lidar_lite.cpp index d088e886897d31e74b44db884629d72155e8c355..d2898ceba831cf4baaf3b743676c98d375c6351a 100644 --- a/src/lidar_lite.cpp +++ b/src/lidar_lite.cpp @@ -211,10 +211,8 @@ CLidarLite::read(unsigned char addr, int len) addr); // See header file for a description of this functionality. // Read STATUS. Repeat until bit 0 (LSB) goes low. - // wait_busy(); - // NOTE: Commented because using this USB adapter the following write actions - // are slower than usual busy time. - + wait_busy(); + unsigned char data[len]; try { this->adapter_->write(DEVICE_ID, &addr, 1);