Changed drive.cpp to work with tank drive