Re-enabling LiDAR reading.

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);