Tons of changes.

Additions:
- Enable and Disable encoder commands.
- Command to change drive PID.