Make VL53L0X work

include/rideheight_sensing/rideheight_sensing.h

@@ -2,12 +2,12 @@
 
 #include <ros/ros.h>
 
+#include "vl53l0x_def.h"
+#include "vl53l0x_platform.h"
 #include "vl6180x_platform.h"
 
-namespace rh_sensing
-{
-class RideheightSensing
-{
+namespace rh_sensing {
+class RideheightSensing {
 public:
   RideheightSensing(ros::NodeHandle nh, ros::NodeHandle nh_private);
 
@@ -22,6 +22,15 @@ private:
 
   VL6180xDev_t vl6180x_dev;
   VL6180x_RangeData_t vl6180x_range;
+
+  VL53L0X_Dev_t vl53l0x_dev;
+  VL53L0X_RangingMeasurementData_t vl53l0x_range;
+
+  void init_6180(const char *i2c_dev_path);
+  void init_53l0(const char *i2c_dev_path);
+  void config_53l0(bool long_range);
+
+  bool vl53l0x_long_range;
 };
 
-}  // namespace rh_sensing
+} // namespace rh_sensing