Encoders and RPM

added left and right drive encoders, created function to return RPM
(untested)