Encoder sensors are currently read directly from motor

[henryscheible]

While this works, it would probably make the code cleaner if they were read through the drive chain object, and this would also make testing simpler.