Added Angle Sensor class

Added an angle sensor class to allow the arduino to obtain the motor and mast angles easily.