Got the ultrasound transferred to MATLAB. Made a matlab_reset. Please remember to remove it while doing the actual flight testing