Made necessary changes to RobotTemplate to support MechanumDrive.