This is a simple localisation algorithm.
It incorporates time of arrival estimates to locate the target location.
This code is based on my understanding from the following paper.
Performance Comparison of Localization Techniques For Sequential WSN Discovery