Drivetrain working with teleop and autonomous

Teleop tank drive. Autonomous with PID integrated (PID constants have
yet to be tuned)