/* ISAKMP VendorID
 * Copyright (C) 2002-2005 Mathieu Lafon - Arkoon Network Security
 * Copyright (C) 2009 Andreas Steffen - Hochschule fuer Technik Rapperswil
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License as published by the
 * Free Software Foundation; either version 2 of the License, or (at your
 * option) any later version.  See <http://www.fsf.org/copyleft/gpl.txt>.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
 * or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
 * for more details.
 */

#include <stdlib.h>
#include <string.h>
#include <ctype.h>
#include <sys/queue.h>
#include <freeswan.h>

#include <library.h>
#include <crypto/hashers/hasher.h>

#include "constants.h"
#include "defs.h"
#include "log.h"
#include "connections.h"
#include "packet.h"
#include "demux.h"
#include "whack.h"
#include "vendor.h"
#include "kernel.h"
#include "nat_traversal.h"

/**
 * Unknown/Special VID:
 *
 * SafeNet SoftRemote 8.0.0:
 *  47bbe7c993f1fc13b4e6d0db565c68e5010201010201010310382e302e3020284275696c6420313029000000
 *  >> 382e302e3020284275696c6420313029 = '8.0.0 (Build 10)'
 *  da8e937880010000
 *
 * SafeNet SoftRemote 9.0.1
 *  47bbe7c993f1fc13b4e6d0db565c68e5010201010201010310392e302e3120284275696c6420313229000000
 *  >> 392e302e3120284275696c6420313229 = '9.0.1 (Build 12)'
 *  da8e937880010000
 *
 * Netscreen:
 *  d6b45f82f24bacb288af59a978830ab7
 *  cf49908791073fb46439790fdeb6aeed981101ab0000000500000300
 *
 * Cisco:
 *  1f07f70eaa6514d3b0fa96542a500300 (VPN 3000 version 3.0.0)
 *  1f07f70eaa6514d3b0fa96542a500301 (VPN 3000 version 3.0.1)
 *  1f07f70eaa6514d3b0fa96542a500305 (VPN 3000 version 3.0.5)
 *  1f07f70eaa6514d3b0fa96542a500407 (VPN 3000 version 4.0.7)
 *  (Can you see the pattern?)
 *  afcad71368a1f1c96b8696fc77570100 (Non-RFC Dead Peer Detection ?)
 *  c32364b3b4f447eb17c488ab2a480a57
 *  6d761ddc26aceca1b0ed11fabbb860c4
 *  5946c258f99a1a57b03eb9d1759e0f24 (From a Cisco VPN 3k)
 *  ebbc5b00141d0c895e11bd395902d690 (From a Cisco VPN 3k)
 *
 * Microsoft L2TP (???):
 *  47bbe7c993f1fc13b4e6d0db565c68e5010201010201010310382e312e3020284275696c6420313029000000
 *  >> 382e312e3020284275696c6420313029 = '8.1.0 (Build 10)'
 *  3025dbd21062b9e53dc441c6aab5293600000000
 *  da8e937880010000
 *
 * 3COM-superstack
 *    da8e937880010000
 *    404bf439522ca3f6
 *

 * If someone know what they mean, mail me.
 */

#define MAX_LOG_VID_LEN    32

#define VID_KEEP                   0x0000
#define VID_MD5HASH                0x0001
#define VID_STRING                 0x0002
#define VID_FSWAN_HASH             0x0004

#define VID_SUBSTRING_DUMPHEXA     0x0100
#define VID_SUBSTRING_DUMPASCII    0x0200
#define VID_SUBSTRING_MATCH        0x0400
#define VID_SUBSTRING  (VID_SUBSTRING_DUMPHEXA | VID_SUBSTRING_DUMPASCII | VID_SUBSTRING_MATCH)

struct vid_struct {
		enum known_vendorid id;
		unsigned short flags;
		const char *data;
		const char *descr;
		chunk_t vid;
};

#define DEC_MD5_VID_D(id,str,descr) \
		{ VID_##id, VID_MD5HASH, str, descr, { NULL, 0 } },
#define DEC_MD5_VID(id,str) \
		{ VID_##id, VID_MD5HASH, str, NULL, { NULL, 0 } },

static struct vid_struct _vid_tab[] = {

		/* Implementation names */

		{ VID_OPENPGP, VID_STRING, "OpenPGP10171", "OpenPGP", { NULL, 0 } },

		DEC_MD5_VID(KAME_RACOON, "KAME/racoon")

		{ VID_MS_NT5, VID_MD5HASH | VID_SUBSTRING_DUMPHEXA,
				"MS NT5 ISAKMPOAKLEY", NULL, { NULL, 0 } },

		DEC_MD5_VID(SSH_SENTINEL, "SSH Sentinel")
		DEC_MD5_VID(SSH_SENTINEL_1_1, "SSH Sentinel 1.1")
		DEC_MD5_VID(SSH_SENTINEL_1_2, "SSH Sentinel 1.2")
		DEC_MD5_VID(SSH_SENTINEL_1_3, "SSH Sentinel 1.3")
		DEC_MD5_VID(SSH_SENTINEL_1_4, "SSH Sentinel 1.4")
		DEC_MD5_VID(SSH_SENTINEL_1_4_1, "SSH Sentinel 1.4.1")

		/* These ones come from SSH vendors.txt */
		DEC_MD5_VID(SSH_IPSEC_1_1_0,
				"Ssh Communications Security IPSEC Express version 1.1.0")
		DEC_MD5_VID(SSH_IPSEC_1_1_1,
				"Ssh Communications Security IPSEC Express version 1.1.1")
		DEC_MD5_VID(SSH_IPSEC_1_1_2,
				"Ssh Communications Security IPSEC Express version 1.1.2")
		DEC_MD5_VID(SSH_IPSEC_1_2_1,
				"Ssh Communications Security IPSEC Express version 1.2.1")
		DEC_MD5_VID(SSH_IPSEC_1_2_2,
				"Ssh Communications Security IPSEC Express version 1.2.2")
		DEC_MD5_VID(SSH_IPSEC_2_0_0,
				"SSH Communications Security IPSEC Express version 2.0.0")
		DEC_MD5_VID(SSH_IPSEC_2_1_0,
				"SSH Communications Security IPSEC Express version 2.1.0")
		DEC_MD5_VID(SSH_IPSEC_2_1_1,
				"SSH Communications Security IPSEC Express version 2.1.1")
		DEC_MD5_VID(SSH_IPSEC_2_1_2,
				"SSH Communications Security IPSEC Express version 2.1.2")
		DEC_MD5_VID(SSH_IPSEC_3_0_0,
				"SSH Communications Security IPSEC Express version 3.0.0")
		DEC_MD5_VID(SSH_IPSEC_3_0_1,
				"SSH Communications Security IPSEC Express version 3.0.1")
		DEC_MD5_VID(SSH_IPSEC_4_0_0,
				"SSH Communications Security IPSEC Express version 4.0.0")
		DEC_MD5_VID(SSH_IPSEC_4_0_1,
				"SSH Communications Security IPSEC Express version 4.0.1")
		DEC_MD5_VID(SSH_IPSEC_4_1_0,
				"SSH Communications Security IPSEC Express version 4.1.0")
		DEC_MD5_VID(SSH_IPSEC_4_2_0,
				"SSH Communications Security IPSEC Express version 4.2.0")

		/* note: md5('CISCO-UNITY') = 12f5f28c457168a9702d9fe274cc02d4 */
		{ VID_CISCO_UNITY, VID_KEEP, NULL, "Cisco-Unity",
		  { "\x12\xf5\xf2\x8c\x45\x71\x68\xa9\x70\x2d\x9f\xe2\x74\xcc\x01\x00", 16 } },

		{ VID_CISCO3K, VID_KEEP | VID_SUBSTRING_MATCH, NULL, "Cisco VPN 3000 Series" ,
		  { "\x1f\x07\xf7\x0e\xaa\x65\x14\xd3\xb0\xfa\x96\x54\x2a\x50", 14 } },

		{ VID_CISCO_IOS, VID_KEEP | VID_SUBSTRING_MATCH,
		  NULL, "Cisco IOS Device", { "\x3e\x98\x40\x48", 4 } },

		/*
		 * Timestep VID seen:
		 *   - 54494d455354455020312053475720313532302033313520322e303145303133
		 *     = 'TIMESTEP 1 SGW 1520 315 2.01E013'
		 */
		{ VID_TIMESTEP, VID_STRING | VID_SUBSTRING_DUMPASCII, "TIMESTEP",
				NULL, { NULL, 0 } },

		/*
		 * Netscreen:
		 * 4865617274426561745f4e6f74696679386b0100  (HeartBeat_Notify + 386b0100)
		 */
		{ VID_MISC_HEARTBEAT_NOTIFY, VID_STRING | VID_SUBSTRING_DUMPHEXA,
				"HeartBeat_Notify", "HeartBeat Notify", { NULL, 0 } },
		/*
		 * MacOS X
		 */
		{ VID_MACOSX, VID_STRING|VID_SUBSTRING_DUMPHEXA, "Mac OSX 10.x",
		  "\x4d\xf3\x79\x28\xe9\xfc\x4f\xd1\xb3\x26\x21\x70\xd5\x15\xc6\x62", { NULL, 0 } },

		/* NCP */
		{ VID_NCP_SERVER, VID_KEEP | VID_SUBSTRING_MATCH, NULL, "NCP Server",
			{ "\xc6\xf5\x7a\xc3\x98\xf4\x93\x20\x81\x45\xb7\x58", 12 } },
		{ VID_NCP_CLIENT, VID_KEEP | VID_SUBSTRING_MATCH, NULL, "NCP Client",
			{ "\xeb\x4c\x1b\x78\x8a\xfd\x4a\x9c\xb7\x73\x0a\x68", 12 } },

		/*
		 * Windows Vista (and Windows Server 2008?)
		 */
		DEC_MD5_VID(VISTA_AUTHIP, "MS-Negotiation Discovery Capable")
		DEC_MD5_VID(VISTA_AUTHIP2, "IKE CGA version 1")
		DEC_MD5_VID(VISTA_AUTHIP3, "MS-MamieExists")

		/*
		 * strongSwan
		 */
		DEC_MD5_VID(STRONGSWAN,       "strongSwan")
		DEC_MD5_VID(STRONGSWAN_4_3_5, "strongSwan 4.3.5")
		DEC_MD5_VID(STRONGSWAN_4_3_4, "strongSwan 4.3.4")
		DEC_MD5_VID(STRONGSWAN_4_3_3, "strongSwan 4.3.3")
		DEC_MD5_VID(STRONGSWAN_4_3_2, "strongSwan 4.3.2")
		DEC_MD5_VID(STRONGSWAN_4_3_1, "strongSwan 4.3.1")
		DEC_MD5_VID(STRONGSWAN_4_3_0, "strongSwan 4.3.0")
		DEC_MD5_VID(STRONGSWAN_4_2_17,"strongSwan 4.2.17")
		DEC_MD5_VID(STRONGSWAN_4_2_16,"strongSwan 4.2.16")
		DEC_MD5_VID(STRONGSWAN_4_2_15,"strongSwan 4.2.15")
		DEC_MD5_VID(STRONGSWAN_4_2_14,"strongSwan 4.2.14")
		DEC_MD5_VID(STRONGSWAN_4_2_13,"strongSwan 4.2.13")
		DEC_MD5_VID(STRONGSWAN_4_2_12,"strongSwan 4.2.12")
		DEC_MD5_VID(STRONGSWAN_4_2_11,"strongSwan 4.2.11")
		DEC_MD5_VID(STRONGSWAN_4_2_10,"strongSwan 4.2.10")
		DEC_MD5_VID(STRONGSWAN_4_2_9, "strongSwan 4.2.9")
		DEC_MD5_VID(STRONGSWAN_4_2_8, "strongSwan 4.2.8")
		DEC_MD5_VID(STRONGSWAN_4_2_7, "strongSwan 4.2.7")
		DEC_MD5_VID(STRONGSWAN_4_2_6, "strongSwan 4.2.6")
		DEC_MD5_VID(STRONGSWAN_4_2_5, "strongSwan 4.2.5")
		DEC_MD5_VID(STRONGSWAN_4_2_4, "strongSwan 4.2.4")
		DEC_MD5_VID(STRONGSWAN_4_2_3, "strongSwan 4.2.3")
		DEC_MD5_VID(STRONGSWAN_4_2_2, "strongSwan 4.2.2")
		DEC_MD5_VID(STRONGSWAN_4_2_1, "strongSwan 4.2.1")
		DEC_MD5_VID(STRONGSWAN_4_2_0, "strongSwan 4.2.0")
		DEC_MD5_VID(STRONGSWAN_4_1_11,"strongSwan 4.1.11")
		DEC_MD5_VID(STRONGSWAN_4_1_10,"strongSwan 4.1.10")
		DEC_MD5_VID(STRONGSWAN_4_1_9, "strongSwan 4.1.9")
		DEC_MD5_VID(STRONGSWAN_4_1_8, "strongSwan 4.1.8")
		DEC_MD5_VID(STRONGSWAN_4_1_7, "strongSwan 4.1.7")
		DEC_MD5_VID(STRONGSWAN_4_1_6, "strongSwan 4.1.6")
		DEC_MD5_VID(STRONGSWAN_4_1_5, "strongSwan 4.1.5")
		DEC_MD5_VID(STRONGSWAN_4_1_4, "strongSwan 4.1.4")
		DEC_MD5_VID(STRONGSWAN_4_1_3, "strongSwan 4.1.3")
		DEC_MD5_VID(STRONGSWAN_4_1_2, "strongSwan 4.1.2")
		DEC_MD5_VID(STRONGSWAN_4_1_1, "strongSwan 4.1.1")
		DEC_MD5_VID(STRONGSWAN_4_1_0, "strongSwan 4.1.0")
		DEC_MD5_VID(STRONGSWAN_4_0_7, "strongSwan 4.0.7")
		DEC_MD5_VID(STRONGSWAN_4_0_6, "strongSwan 4.0.6")
		DEC_MD5_VID(STRONGSWAN_4_0_5, "strongSwan 4.0.5")
		DEC_MD5_VID(STRONGSWAN_4_0_4, "strongSwan 4.0.4")
		DEC_MD5_VID(STRONGSWAN_4_0_3, "strongSwan 4.0.3")
		DEC_MD5_VID(STRONGSWAN_4_0_2, "strongSwan 4.0.2")
		DEC_MD5_VID(STRONGSWAN_4_0_1, "strongSwan 4.0.1")
		DEC_MD5_VID(STRONGSWAN_4_0_0, "strongSwan 4.0.0")

		DEC_MD5_VID(STRONGSWAN_2_8_11,"strongSwan 2.8.11")
		DEC_MD5_VID(STRONGSWAN_2_8_10,"strongSwan 2.8.10")
		DEC_MD5_VID(STRONGSWAN_2_8_9, "strongSwan 2.8.9")
		DEC_MD5_VID(STRONGSWAN_2_8_8, "strongSwan 2.8.8")
		DEC_MD5_VID(STRONGSWAN_2_8_7, "strongSwan 2.8.7")
		DEC_MD5_VID(STRONGSWAN_2_8_6, "strongSwan 2.8.6")
		DEC_MD5_VID(STRONGSWAN_2_8_5, "strongSwan 2.8.5")
		DEC_MD5_VID(STRONGSWAN_2_8_4, "strongSwan 2.8.4")
		DEC_MD5_VID(STRONGSWAN_2_8_3, "strongSwan 2.8.3")
		DEC_MD5_VID(STRONGSWAN_2_8_2, "strongSwan 2.8.2")
		DEC_MD5_VID(STRONGSWAN_2_8_1, "strongSwan 2.8.1")
		DEC_MD5_VID(STRONGSWAN_2_8_0, "strongSwan 2.8.0")
		DEC_MD5_VID(STRONGSWAN_2_7_3, "strongSwan 2.7.3")
		DEC_MD5_VID(STRONGSWAN_2_7_2, "strongSwan 2.7.2")
		DEC_MD5_VID(STRONGSWAN_2_7_1, "strongSwan 2.7.1")
		DEC_MD5_VID(STRONGSWAN_2_7_0, "strongSwan 2.7.0")
		DEC_MD5_VID(STRONGSWAN_2_6_4, "strongSwan 2.6.4")
		DEC_MD5_VID(STRONGSWAN_2_6_3, "strongSwan 2.6.3")
		DEC_MD5_VID(STRONGSWAN_2_6_2, "strongSwan 2.6.2")
		DEC_MD5_VID(STRONGSWAN_2_6_1, "strongSwan 2.6.1")
		DEC_MD5_VID(STRONGSWAN_2_6_0, "strongSwan 2.6.0")
		DEC_MD5_VID(STRONGSWAN_2_5_7, "strongSwan 2.5.7")
		DEC_MD5_VID(STRONGSWAN_2_5_6, "strongSwan 2.5.6")
		DEC_MD5_VID(STRONGSWAN_2_5_5, "strongSwan 2.5.5")
		DEC_MD5_VID(STRONGSWAN_2_5_4, "strongSwan 2.5.4")
		DEC_MD5_VID(STRONGSWAN_2_5_3, "strongSwan 2.5.3")
		DEC_MD5_VID(STRONGSWAN_2_5_2, "strongSwan 2.5.2")
		DEC_MD5_VID(STRONGSWAN_2_5_1, "strongSwan 2.5.1")
		DEC_MD5_VID(STRONGSWAN_2_5_0, "strongSwan 2.5.0")
		DEC_MD5_VID(STRONGSWAN_2_4_4, "strongSwan 2.4.4")
		DEC_MD5_VID(STRONGSWAN_2_4_3, "strongSwan 2.4.3")
		DEC_MD5_VID(STRONGSWAN_2_4_2, "strongSwan 2.4.2")
		DEC_MD5_VID(STRONGSWAN_2_4_1, "strongSwan 2.4.1")
		DEC_MD5_VID(STRONGSWAN_2_4_0, "strongSwan 2.4.0")
		DEC_MD5_VID(STRONGSWAN_2_3_2, "strongSwan 2.3.2")
		DEC_MD5_VID(STRONGSWAN_2_3_1, "strongSwan 2.3.1")
		DEC_MD5_VID(STRONGSWAN_2_3_0, "strongSwan 2.3.0")
		DEC_MD5_VID(STRONGSWAN_2_2_2, "strongSwan 2.2.2")
		DEC_MD5_VID(STRONGSWAN_2_2_1, "strongSwan 2.2.1")
		DEC_MD5_VID(STRONGSWAN_2_2_0, "strongSwan 2.2.0")

		/* NAT-Traversal */

		DEC_MD5_VID(NATT_STENBERG_01, "draft-stenberg-ipsec-nat-traversal-01")
		DEC_MD5_VID(NATT_STENBERG_02, "draft-stenberg-ipsec-nat-traversal-02")
		DEC_MD5_VID(NATT_HUTTUNEN, "ESPThruNAT")
		DEC_MD5_VID(NATT_HUTTUNEN_ESPINUDP, "draft-huttunen-ipsec-esp-in-udp-00.txt")
		DEC_MD5_VID(NATT_IETF_00, "draft-ietf-ipsec-nat-t-ike-00")
		DEC_MD5_VID(NATT_IETF_02, "draft-ietf-ipsec-nat-t-ike-02")
		/* hash in draft-ietf-ipsec-nat-t-ike-02 contains '\n'... Accept both */
		DEC_MD5_VID_D(NATT_IETF_02_N, "draft-ietf-ipsec-nat-t-ike-02\n", "draft-ietf-ipsec-nat-t-ike-02_n")
		DEC_MD5_VID(NATT_IETF_03, "draft-ietf-ipsec-nat-t-ike-03")
		DEC_MD5_VID(NATT_RFC, "RFC 3947")

		/* misc */

		{ VID_MISC_XAUTH, VID_KEEP, NULL, "XAUTH",
			{ "\x09\x00\x26\x89\xdf\xd6\xb7\x12", 8 } },

		{ VID_MISC_DPD, VID_KEEP, NULL, "Dead Peer Detection",
			{ "\xaf\xca\xd7\x13\x68\xa1\xf1\xc9\x6b\x86\x96\xfc\x77\x57\x01\x00", 16 } },

		DEC_MD5_VID(MISC_FRAGMENTATION, "FRAGMENTATION")

		DEC_MD5_VID(INITIAL_CONTACT, "Vid-Initial-Contact")

		/**
		 * Cisco VPN 3000
		 */
		{ VID_MISC_FRAGMENTATION, VID_MD5HASH | VID_SUBSTRING_DUMPHEXA,
			"FRAGMENTATION", NULL, { NULL, 0 } },

		/* -- */
		{ 0, 0, NULL, NULL, { NULL, 0 } }

};

static const char _hexdig[] = "0123456789abcdef";

static int _vid_struct_init = 0;

void init_vendorid(void)
{
	hasher_t *hasher = lib->crypto->create_hasher(lib->crypto, HASH_MD5);
	struct vid_struct *vid;

	for (vid = _vid_tab; vid->id; vid++)
	{
		if (vid->flags & VID_STRING)
		{
			/** VendorID is a string **/
			vid->vid = chunk_create((u_char *)vid->data, strlen(vid->data));
			vid->vid = chunk_clone(vid->vid);
		}
		else if (vid->flags & VID_MD5HASH)
		{
			chunk_t vid_data = { (u_char *)vid->data, strlen(vid->data) };

			/** VendorID is a string to hash with MD5 **/
			hasher->allocate_hash(hasher, vid_data, &vid->vid);
		}

		if (vid->descr == NULL)
		{
			/** Find something to display **/
			vid->descr = vid->data;
		}
	}
	hasher->destroy(hasher);
	_vid_struct_init = 1;
}

void free_vendorid(void)
{
	struct vid_struct *vid;

	for (vid = _vid_tab; vid->id; vid++)
	{
		if (vid->flags & (VID_STRING | VID_MD5HASH | VID_FSWAN_HASH))
		{
			free(vid->vid.ptr);
		}
	}
}

static void handle_known_vendorid (struct msg_digest *md, const char *vidstr,
								   size_t len, struct vid_struct *vid)
{
	char vid_dump[128];
	bool vid_useful = FALSE;
	size_t i, j;

	switch (vid->id) {
	/* Remote side supports OpenPGP certificates */
	case VID_OPENPGP:
		md->openpgp = TRUE;
		vid_useful = TRUE;
		break;

	/*
	 * Use most recent supported NAT-Traversal method and ignore the
	 * other ones (implementations will send all supported methods but
	 * only one will be used)
	 *
	 * Note: most recent == higher id in vendor.h
	 */
	case VID_NATT_IETF_00:
		if (!nat_traversal_support_non_ike)
			break;
		if ((nat_traversal_enabled) && (!md->nat_traversal_vid))
		{
			md->nat_traversal_vid = vid->id;
			vid_useful = TRUE;
		}
		break;
	case VID_NATT_IETF_02:
	case VID_NATT_IETF_02_N:
	case VID_NATT_IETF_03:
	case VID_NATT_RFC:
		if (nat_traversal_support_port_floating
		&& md->nat_traversal_vid < vid->id)
		{
			md->nat_traversal_vid = vid->id;
			vid_useful = TRUE;
		}
		break;

	/* Remote side would like to do DPD with us on this connection */
	case VID_MISC_DPD:
		md->dpd = TRUE;
		vid_useful = TRUE;
		break;
	case VID_MISC_XAUTH:
		vid_useful = TRUE;
		break;
	default:
		break;
	}

	if (vid->flags & VID_SUBSTRING_DUMPHEXA)
	{
		/* Dump description + Hexa */
		memset(vid_dump, 0, sizeof(vid_dump));
		snprintf(vid_dump, sizeof(vid_dump), "%s ",
				 vid->descr ? vid->descr : "");
		for (i = strlen(vid_dump), j = vid->vid.len;
			 j < len && i < sizeof(vid_dump) - 2;
			 i += 2, j++)
		{
			vid_dump[i] = _hexdig[(vidstr[j] >> 4) & 0xF];
			vid_dump[i+1] = _hexdig[vidstr[j] & 0xF];
		}
	}
	else if (vid->flags & VID_SUBSTRING_DUMPASCII)
	{
		/* Dump ASCII content */
		memset(vid_dump, 0, sizeof(vid_dump));
		for (i = 0; i < len && i < sizeof(vid_dump) - 1; i++)
		{
			vid_dump[i] = (isprint(vidstr[i])) ? vidstr[i] : '.';
		}
	}
	else
	{
		/* Dump description (descr) */
		snprintf(vid_dump, sizeof(vid_dump), "%s",
				 vid->descr ? vid->descr : "");
	}

	loglog(RC_LOG_SERIOUS, "%s Vendor ID payload [%s]",
			vid_useful ? "received" : "ignoring", vid_dump);
}

void handle_vendorid (struct msg_digest *md, const char *vid, size_t len)
{
	struct vid_struct *pvid;

	if (!_vid_struct_init)
		init_vendorid();

	/*
	 * Find known VendorID in _vid_tab
	 */
	for (pvid = _vid_tab; pvid->id; pvid++)
	{
		if (pvid->vid.ptr && vid && pvid->vid.len && len)
		{
			if (pvid->vid.len == len)
			{
				if (memeq(pvid->vid.ptr, vid, len))
				{
					handle_known_vendorid(md, vid, len, pvid);
					return;
				}
			}
			else if ((pvid->vid.len < len) && (pvid->flags & VID_SUBSTRING))
			{
				if (memeq(pvid->vid.ptr, vid, pvid->vid.len))
				{
					handle_known_vendorid(md, vid, len, pvid);
					return;
				}
			}
		}
	}

	/*
	 * Unknown VendorID. Log the beginning.
	 */
	{
		char log_vid[2*MAX_LOG_VID_LEN+1];
		size_t i;

		memset(log_vid, 0, sizeof(log_vid));

		for (i = 0; i < len && i < MAX_LOG_VID_LEN; i++)
		{
			log_vid[2*i] = _hexdig[(vid[i] >> 4) & 0xF];
			log_vid[2*i+1] = _hexdig[vid[i] & 0xF];
		}
		loglog(RC_LOG_SERIOUS, "ignoring Vendor ID payload [%s%s]",
			   log_vid, (len>MAX_LOG_VID_LEN) ? "..." : "");
	}
}

/**
 * Add a vendor id payload to the msg
 */
bool out_vendorid (u_int8_t np, pb_stream *outs, enum known_vendorid vid)
{
	struct vid_struct *pvid;

	if (!_vid_struct_init)
		init_vendorid();

	for (pvid = _vid_tab; pvid->id && pvid->id != vid; pvid++);

	if (pvid->id != vid)
		return STF_INTERNAL_ERROR; /* not found */
	if (!pvid->vid.ptr)
		return STF_INTERNAL_ERROR; /* not initialized */

	DBG(DBG_EMITTING,
		DBG_log("out_vendorid(): sending [%s]", pvid->descr)
	)
	return out_generic_raw(np, &isakmp_vendor_id_desc, outs,
				pvid->vid.ptr, pvid->vid.len, "V_ID");
}