Position and Angle detection

In progress, few things that I have not considered.