added more infrastructure for localizing with 3 points