Angle Finde

Improved from https://github.com/RepRapLtd/Angle-gauge, enjoy