we can now locate the three localization points. TODO is to check if the points is rotated, if so rotate back