Added elements of Asa's C-code to our PIC code for debugging. Updated Python to include distance conversion. Updated MatLab code to create 3D plot of data