Added VEHICLE_STATE, VEHICLE_STATUS_MSG, CMD_ARM, CMD_DISARM and CMD_SHUDOWN
Removed unused code