'''
roslaunch elevation_mapping_demos rs_elevation_map.launch #launches everything except the map visualization
rosrun elevation_mapping main_sub.py
'''
1642480910767342567.yaml corresponds to screenshot
Current problems:
- the object contour gets buried in the background