Implemented basic trilateration (currently only uses arbitrary locations and radius is different units to "grid")