Add drive motor kill code to drive.h