Added SwerveDrive.cpp along with offset code.