Changed localisation algorithm to using angles and distances instead of circle intersections, which should work, but testing is a real pain in the ass. Was not able to test it with the robot, as I only have two beacons which is not enough.