diff --git a/quad/src/quad_app/sensor.c b/quad/src/quad_app/sensor.c
index 6fcf5277a2fdbc81d5e8fa8eda1b2ee0b0c1fdb4..cbb31e1cad9474c991dc5a45bfa481e8a93efa78 100644
--- a/quad/src/quad_app/sensor.c
+++ b/quad/src/quad_app/sensor.c
@@ -49,11 +49,11 @@ int get_sensors(hardware_t *hardware_struct, log_t* log_struct, user_input_t* us
   status = imu->read(imu, &raw_sensor_struct->gam);
   updateError(&(raw_sensor_struct->gam.error), status);
 
-  //status = lidar->read(lidar, &lidar_val);
-  //updateError(&(raw_sensor_struct->lidar.error), status);
-  //if (status == 0) {
-	//	raw_sensor_struct->lidar_distance_m = lidar_val.distance_m;
-  //}
+  status = lidar->read(lidar, &lidar_val);
+  updateError(&(raw_sensor_struct->lidar.error), status);
+  if (status == 0) {
+		raw_sensor_struct->lidar_distance_m = lidar_val.distance_m;
+  }
   
   status = of->read(of, &raw_sensor_struct->optical_flow);
   updateError(&(raw_sensor_struct->optical_flow.error), status);