Create Encoder Testbench

Should work to test encoders.  Ramps up speed to both wheels then takes samples of encoder data and saves to SD card as well as serial print.  Flip toggle switch to close the file.