Added basic test for reading encoder on one wheel