Working Algo for TDOA

Solution is wrong. But solution converging to global minima