Added the Optical Encoder functionality to the steering to determine angle
Fixed steering methods to use interupt functions