Added tank drive.

Merge tank drive code from ImageTesting into sixRobot.