Added a command that uses a PID controller that can be use to drive forward or backward.