Implemented the driveDirect command. Robot is now controllable.