Motor Encoders

Motor Encoder function written, cool things.