New method to calculate beacons. Started to refine the robot logic.