added z and theta axes to drivetest