Finished beamforming_2d, calcDelay2d includes findDist

No debugging/testing yet