Changed final image output to update with obstacles instead of with camera
merge in delayed raw image display
First pass at distance calculation function in dist.py