Multi-sensor fusion MATLAB method