adding calibration script
fixed imshow issues
occupancy grid done, still need to tweak numbers