Delay between lidar point cloud and annotation

[xavhl]

It seems there's delay between the sensor data and bounding box annotations from yaml files

[xavhl]

After modifying def save_lidar_points() #208 , the sensor data and annotations are now consistent