3D Sonar with Arduino\MATLAB and Point Cloud Filtering