Added Code to Display Encoder Values on Robot

Code to Debug Encoders