Implement expanded command set

Additionally, prepare the firmware for use with the DRV8833 motor driver (which will happen eventually).