f615bf7321ef8882fe42134a93518e444faee7cb
[strongswan.git] / src / pluto / vendor.c
1 /* ISAKMP VendorID
2 * Copyright (C) 2002-2005 Mathieu Lafon - Arkoon Network Security
3 *
4 * This program is free software; you can redistribute it and/or modify it
5 * under the terms of the GNU General Public License as published by the
6 * Free Software Foundation; either version 2 of the License, or (at your
7 * option) any later version. See <http://www.fsf.org/copyleft/gpl.txt>.
8 *
9 * This program is distributed in the hope that it will be useful, but
10 * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
11 * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
12 * for more details.
13 *
14 * RCSID $Id$
15 */
16
17 #include <stdlib.h>
18 #include <string.h>
19 #include <ctype.h>
20 #include <sys/queue.h>
21 #include <freeswan.h>
22
23 #include "constants.h"
24 #include "defs.h"
25 #include "log.h"
26 #include "md5.h"
27 #include "connections.h"
28 #include "packet.h"
29 #include "demux.h"
30 #include "whack.h"
31 #include "vendor.h"
32 #include "kernel.h"
33 #include "nat_traversal.h"
34
35 /**
36 * Unknown/Special VID:
37 *
38 * SafeNet SoftRemote 8.0.0:
39 * 47bbe7c993f1fc13b4e6d0db565c68e5010201010201010310382e302e3020284275696c6420313029000000
40 * >> 382e302e3020284275696c6420313029 = '8.0.0 (Build 10)'
41 * da8e937880010000
42 *
43 * SafeNet SoftRemote 9.0.1
44 * 47bbe7c993f1fc13b4e6d0db565c68e5010201010201010310392e302e3120284275696c6420313229000000
45 * >> 392e302e3120284275696c6420313229 = '9.0.1 (Build 12)'
46 * da8e937880010000
47 *
48 * Netscreen:
49 * d6b45f82f24bacb288af59a978830ab7
50 * cf49908791073fb46439790fdeb6aeed981101ab0000000500000300
51 *
52 * Cisco:
53 * 1f07f70eaa6514d3b0fa96542a500300 (VPN 3000 version 3.0.0)
54 * 1f07f70eaa6514d3b0fa96542a500301 (VPN 3000 version 3.0.1)
55 * 1f07f70eaa6514d3b0fa96542a500305 (VPN 3000 version 3.0.5)
56 * 1f07f70eaa6514d3b0fa96542a500407 (VPN 3000 version 4.0.7)
57 * (Can you see the pattern?)
58 * afcad71368a1f1c96b8696fc77570100 (Non-RFC Dead Peer Detection ?)
59 * c32364b3b4f447eb17c488ab2a480a57
60 * 6d761ddc26aceca1b0ed11fabbb860c4
61 * 5946c258f99a1a57b03eb9d1759e0f24 (From a Cisco VPN 3k)
62 * ebbc5b00141d0c895e11bd395902d690 (From a Cisco VPN 3k)
63 *
64 * Microsoft L2TP (???):
65 * 47bbe7c993f1fc13b4e6d0db565c68e5010201010201010310382e312e3020284275696c6420313029000000
66 * >> 382e312e3020284275696c6420313029 = '8.1.0 (Build 10)'
67 * 3025dbd21062b9e53dc441c6aab5293600000000
68 * da8e937880010000
69 *
70 * 3COM-superstack
71 * da8e937880010000
72 * 404bf439522ca3f6
73 *
74
75 * If someone know what they mean, mail me.
76 */
77
78 #define MAX_LOG_VID_LEN 32
79
80 #define VID_KEEP 0x0000
81 #define VID_MD5HASH 0x0001
82 #define VID_STRING 0x0002
83 #define VID_FSWAN_HASH 0x0004
84
85 #define VID_SUBSTRING_DUMPHEXA 0x0100
86 #define VID_SUBSTRING_DUMPASCII 0x0200
87 #define VID_SUBSTRING_MATCH 0x0400
88 #define VID_SUBSTRING (VID_SUBSTRING_DUMPHEXA | VID_SUBSTRING_DUMPASCII | VID_SUBSTRING_MATCH)
89
90 struct vid_struct {
91 enum known_vendorid id;
92 unsigned short flags;
93 const char *data;
94 const char *descr;
95 const char *vid;
96 u_int vid_len;
97 };
98
99 #define DEC_MD5_VID_D(id,str,descr) \
100 { VID_##id, VID_MD5HASH, str, descr, NULL, 0 },
101 #define DEC_MD5_VID(id,str) \
102 { VID_##id, VID_MD5HASH, str, NULL, NULL, 0 },
103 #define DEC_FSWAN_VID(id,str,descr) \
104 { VID_##id, VID_FSWAN_HASH, str, descr, NULL, 0 },
105
106 static struct vid_struct _vid_tab[] = {
107
108 /* Implementation names */
109
110 { VID_OPENPGP, VID_STRING, "OpenPGP10171", "OpenPGP", NULL, 0 },
111
112 DEC_MD5_VID(KAME_RACOON, "KAME/racoon")
113
114 { VID_MS_NT5, VID_MD5HASH | VID_SUBSTRING_DUMPHEXA,
115 "MS NT5 ISAKMPOAKLEY", NULL, NULL, 0 },
116
117 DEC_MD5_VID(SSH_SENTINEL, "SSH Sentinel")
118 DEC_MD5_VID(SSH_SENTINEL_1_1, "SSH Sentinel 1.1")
119 DEC_MD5_VID(SSH_SENTINEL_1_2, "SSH Sentinel 1.2")
120 DEC_MD5_VID(SSH_SENTINEL_1_3, "SSH Sentinel 1.3")
121 DEC_MD5_VID(SSH_SENTINEL_1_4, "SSH Sentinel 1.4")
122 DEC_MD5_VID(SSH_SENTINEL_1_4_1, "SSH Sentinel 1.4.1")
123
124 /* These ones come from SSH vendors.txt */
125 DEC_MD5_VID(SSH_IPSEC_1_1_0,
126 "Ssh Communications Security IPSEC Express version 1.1.0")
127 DEC_MD5_VID(SSH_IPSEC_1_1_1,
128 "Ssh Communications Security IPSEC Express version 1.1.1")
129 DEC_MD5_VID(SSH_IPSEC_1_1_2,
130 "Ssh Communications Security IPSEC Express version 1.1.2")
131 DEC_MD5_VID(SSH_IPSEC_1_2_1,
132 "Ssh Communications Security IPSEC Express version 1.2.1")
133 DEC_MD5_VID(SSH_IPSEC_1_2_2,
134 "Ssh Communications Security IPSEC Express version 1.2.2")
135 DEC_MD5_VID(SSH_IPSEC_2_0_0,
136 "SSH Communications Security IPSEC Express version 2.0.0")
137 DEC_MD5_VID(SSH_IPSEC_2_1_0,
138 "SSH Communications Security IPSEC Express version 2.1.0")
139 DEC_MD5_VID(SSH_IPSEC_2_1_1,
140 "SSH Communications Security IPSEC Express version 2.1.1")
141 DEC_MD5_VID(SSH_IPSEC_2_1_2,
142 "SSH Communications Security IPSEC Express version 2.1.2")
143 DEC_MD5_VID(SSH_IPSEC_3_0_0,
144 "SSH Communications Security IPSEC Express version 3.0.0")
145 DEC_MD5_VID(SSH_IPSEC_3_0_1,
146 "SSH Communications Security IPSEC Express version 3.0.1")
147 DEC_MD5_VID(SSH_IPSEC_4_0_0,
148 "SSH Communications Security IPSEC Express version 4.0.0")
149 DEC_MD5_VID(SSH_IPSEC_4_0_1,
150 "SSH Communications Security IPSEC Express version 4.0.1")
151 DEC_MD5_VID(SSH_IPSEC_4_1_0,
152 "SSH Communications Security IPSEC Express version 4.1.0")
153 DEC_MD5_VID(SSH_IPSEC_4_2_0,
154 "SSH Communications Security IPSEC Express version 4.2.0")
155
156 /* note: md5('CISCO-UNITY') = 12f5f28c457168a9702d9fe274cc02d4 */
157 { VID_CISCO_UNITY, VID_KEEP, NULL, "Cisco-Unity",
158 "\x12\xf5\xf2\x8c\x45\x71\x68\xa9\x70\x2d\x9f\xe2\x74\xcc\x01\x00",
159 16 },
160
161 { VID_CISCO3K, VID_KEEP | VID_SUBSTRING_MATCH,
162 NULL, "Cisco VPN 3000 Series" , "\x1f\x07\xf7\x0e\xaa\x65\x14\xd3\xb0\xfa\x96\x54\x2a\x50", 14},
163
164 { VID_CISCO_IOS, VID_KEEP | VID_SUBSTRING_MATCH,
165 NULL, "Cisco IOS Device", "\x3e\x98\x40\x48", 4},
166
167 /*
168 * Timestep VID seen:
169 * - 54494d455354455020312053475720313532302033313520322e303145303133
170 * = 'TIMESTEP 1 SGW 1520 315 2.01E013'
171 */
172 { VID_TIMESTEP, VID_STRING | VID_SUBSTRING_DUMPASCII, "TIMESTEP",
173 NULL, NULL, 0 },
174
175 /*
176 * Netscreen:
177 * 4865617274426561745f4e6f74696679386b0100 (HeartBeat_Notify + 386b0100)
178 */
179 { VID_MISC_HEARTBEAT_NOTIFY, VID_STRING | VID_SUBSTRING_DUMPHEXA,
180 "HeartBeat_Notify", "HeartBeat Notify", NULL, 0 },
181
182 /*
183 * MacOS X
184 */
185 { VID_MACOSX, VID_STRING|VID_SUBSTRING_DUMPHEXA, "Mac OSX 10.x",
186 "\x4d\xf3\x79\x28\xe9\xfc\x4f\xd1\xb3\x26\x21\x70\xd5\x15\xc6\x62", NULL, 0},
187
188 /*
189 * Openswan
190 */
191 DEC_FSWAN_VID(OPENSWAN2, "Openswan 2.2.0", "Openswan 2.2.0")
192
193 /* NCP */
194 { VID_NCP_SERVER, VID_KEEP | VID_SUBSTRING_MATCH, NULL, "NCP Server",
195 "\xc6\xf5\x7a\xc3\x98\xf4\x93\x20\x81\x45\xb7\x58", 12},
196 { VID_NCP_CLIENT, VID_KEEP | VID_SUBSTRING_MATCH, NULL, "NCP Client",
197 "\xeb\x4c\x1b\x78\x8a\xfd\x4a\x9c\xb7\x73\x0a\x68", 12},
198
199 /*
200 * Windows Vista (and Windows Server 2008?)
201 */
202 DEC_MD5_VID(VISTA_AUTHIP, "MS-Negotiation Discovery Capable")
203 DEC_MD5_VID(VISTA_AUTHIP2, "IKE CGA version 1")
204 DEC_MD5_VID(VISTA_AUTHIP3, "MS-MamieExists")
205
206 /*
207 * strongSwan
208 */
209 DEC_MD5_VID(STRONGSWAN, "strongSwan 4.2.3")
210 DEC_MD5_VID(STRONGSWAN_4_2_2, "strongSwan 4.2.2")
211 DEC_MD5_VID(STRONGSWAN_4_2_1, "strongSwan 4.2.1")
212 DEC_MD5_VID(STRONGSWAN_4_2_0, "strongSwan 4.2.0")
213 DEC_MD5_VID(STRONGSWAN_4_1_11,"strongSwan 4.1.11")
214 DEC_MD5_VID(STRONGSWAN_4_1_10,"strongSwan 4.1.10")
215 DEC_MD5_VID(STRONGSWAN_4_1_9, "strongSwan 4.1.9")
216 DEC_MD5_VID(STRONGSWAN_4_1_8, "strongSwan 4.1.8")
217 DEC_MD5_VID(STRONGSWAN_4_1_7, "strongSwan 4.1.7")
218 DEC_MD5_VID(STRONGSWAN_4_1_6, "strongSwan 4.1.6")
219 DEC_MD5_VID(STRONGSWAN_4_1_5, "strongSwan 4.1.5")
220 DEC_MD5_VID(STRONGSWAN_4_1_4, "strongSwan 4.1.4")
221 DEC_MD5_VID(STRONGSWAN_4_1_3, "strongSwan 4.1.3")
222 DEC_MD5_VID(STRONGSWAN_4_1_2, "strongSwan 4.1.2")
223 DEC_MD5_VID(STRONGSWAN_4_1_1, "strongSwan 4.1.1")
224 DEC_MD5_VID(STRONGSWAN_4_1_0, "strongSwan 4.1.0")
225 DEC_MD5_VID(STRONGSWAN_4_0_7, "strongSwan 4.0.7")
226 DEC_MD5_VID(STRONGSWAN_4_0_6, "strongSwan 4.0.6")
227 DEC_MD5_VID(STRONGSWAN_4_0_5, "strongSwan 4.0.5")
228 DEC_MD5_VID(STRONGSWAN_4_0_4, "strongSwan 4.0.4")
229 DEC_MD5_VID(STRONGSWAN_4_0_3, "strongSwan 4.0.3")
230 DEC_MD5_VID(STRONGSWAN_4_0_2, "strongSwan 4.0.2")
231 DEC_MD5_VID(STRONGSWAN_4_0_1, "strongSwan 4.0.1")
232 DEC_MD5_VID(STRONGSWAN_4_0_0, "strongSwan 4.0.0")
233
234 DEC_MD5_VID(STRONGSWAN_2_8_8, "strongSwan 2.8.8")
235 DEC_MD5_VID(STRONGSWAN_2_8_7, "strongSwan 2.8.7")
236 DEC_MD5_VID(STRONGSWAN_2_8_6, "strongSwan 2.8.6")
237 DEC_MD5_VID(STRONGSWAN_2_8_5, "strongSwan 2.8.5")
238 DEC_MD5_VID(STRONGSWAN_2_8_4, "strongSwan 2.8.4")
239 DEC_MD5_VID(STRONGSWAN_2_8_3, "strongSwan 2.8.3")
240 DEC_MD5_VID(STRONGSWAN_2_8_2, "strongSwan 2.8.2")
241 DEC_MD5_VID(STRONGSWAN_2_8_1, "strongSwan 2.8.1")
242 DEC_MD5_VID(STRONGSWAN_2_8_0, "strongSwan 2.8.0")
243 DEC_MD5_VID(STRONGSWAN_2_7_3, "strongSwan 2.7.3")
244 DEC_MD5_VID(STRONGSWAN_2_7_2, "strongSwan 2.7.2")
245 DEC_MD5_VID(STRONGSWAN_2_7_1, "strongSwan 2.7.1")
246 DEC_MD5_VID(STRONGSWAN_2_7_0, "strongSwan 2.7.0")
247 DEC_MD5_VID(STRONGSWAN_2_6_4, "strongSwan 2.6.4")
248 DEC_MD5_VID(STRONGSWAN_2_6_3, "strongSwan 2.6.3")
249 DEC_MD5_VID(STRONGSWAN_2_6_2, "strongSwan 2.6.2")
250 DEC_MD5_VID(STRONGSWAN_2_6_1, "strongSwan 2.6.1")
251 DEC_MD5_VID(STRONGSWAN_2_6_0, "strongSwan 2.6.0")
252 DEC_MD5_VID(STRONGSWAN_2_5_7, "strongSwan 2.5.7")
253 DEC_MD5_VID(STRONGSWAN_2_5_6, "strongSwan 2.5.6")
254 DEC_MD5_VID(STRONGSWAN_2_5_5, "strongSwan 2.5.5")
255 DEC_MD5_VID(STRONGSWAN_2_5_4, "strongSwan 2.5.4")
256 DEC_MD5_VID(STRONGSWAN_2_5_3, "strongSwan 2.5.3")
257 DEC_MD5_VID(STRONGSWAN_2_5_2, "strongSwan 2.5.2")
258 DEC_MD5_VID(STRONGSWAN_2_5_1, "strongSwan 2.5.1")
259 DEC_MD5_VID(STRONGSWAN_2_5_0, "strongSwan 2.5.0")
260 DEC_MD5_VID(STRONGSWAN_2_4_4, "strongSwan 2.4.4")
261 DEC_MD5_VID(STRONGSWAN_2_4_3, "strongSwan 2.4.3")
262 DEC_MD5_VID(STRONGSWAN_2_4_2, "strongSwan 2.4.2")
263 DEC_MD5_VID(STRONGSWAN_2_4_1, "strongSwan 2.4.1")
264 DEC_MD5_VID(STRONGSWAN_2_4_0, "strongSwan 2.4.0")
265 DEC_MD5_VID(STRONGSWAN_2_3_2, "strongSwan 2.3.2")
266 DEC_MD5_VID(STRONGSWAN_2_3_1, "strongSwan 2.3.1")
267 DEC_MD5_VID(STRONGSWAN_2_3_0, "strongSwan 2.3.0")
268 DEC_MD5_VID(STRONGSWAN_2_2_2, "strongSwan 2.2.2")
269 DEC_MD5_VID(STRONGSWAN_2_2_1, "strongSwan 2.2.1")
270 DEC_MD5_VID(STRONGSWAN_2_2_0, "strongSwan 2.2.0")
271
272 /* NAT-Traversal */
273
274 DEC_MD5_VID(NATT_STENBERG_01, "draft-stenberg-ipsec-nat-traversal-01")
275 DEC_MD5_VID(NATT_STENBERG_02, "draft-stenberg-ipsec-nat-traversal-02")
276 DEC_MD5_VID(NATT_HUTTUNEN, "ESPThruNAT")
277 DEC_MD5_VID(NATT_HUTTUNEN_ESPINUDP, "draft-huttunen-ipsec-esp-in-udp-00.txt")
278 DEC_MD5_VID(NATT_IETF_00, "draft-ietf-ipsec-nat-t-ike-00")
279 DEC_MD5_VID(NATT_IETF_02, "draft-ietf-ipsec-nat-t-ike-02")
280 /* hash in draft-ietf-ipsec-nat-t-ike-02 contains '\n'... Accept both */
281 DEC_MD5_VID_D(NATT_IETF_02_N, "draft-ietf-ipsec-nat-t-ike-02\n", "draft-ietf-ipsec-nat-t-ike-02_n")
282 DEC_MD5_VID(NATT_IETF_03, "draft-ietf-ipsec-nat-t-ike-03")
283 DEC_MD5_VID(NATT_RFC, "RFC 3947")
284
285 /* misc */
286
287 { VID_MISC_XAUTH, VID_KEEP, NULL, "XAUTH",
288 "\x09\x00\x26\x89\xdf\xd6\xb7\x12", 8 },
289
290 { VID_MISC_DPD, VID_KEEP, NULL, "Dead Peer Detection",
291 "\xaf\xca\xd7\x13\x68\xa1\xf1\xc9\x6b\x86\x96\xfc\x77\x57\x01\x00", 16 },
292
293 DEC_MD5_VID(MISC_FRAGMENTATION, "FRAGMENTATION")
294
295 DEC_MD5_VID(INITIAL_CONTACT, "Vid-Initial-Contact")
296
297 /**
298 * Cisco VPN 3000
299 */
300 { VID_MISC_FRAGMENTATION, VID_MD5HASH | VID_SUBSTRING_DUMPHEXA,
301 "FRAGMENTATION", NULL, NULL, 0 },
302
303 /* -- */
304 { 0, 0, NULL, NULL, NULL, 0 }
305
306 };
307
308 static const char _hexdig[] = "0123456789abcdef";
309
310 static int _vid_struct_init = 0;
311
312 void
313 init_vendorid(void)
314 {
315 struct vid_struct *vid;
316 MD5_CTX ctx;
317 int i;
318
319 for (vid = _vid_tab; vid->id; vid++)
320 {
321 if (vid->flags & VID_STRING)
322 {
323 /** VendorID is a string **/
324 vid->vid = strdup(vid->data);
325 vid->vid_len = strlen(vid->data);
326 }
327 else if (vid->flags & VID_MD5HASH)
328 {
329 /** VendorID is a string to hash with MD5 **/
330 char *vidm = malloc(MD5_DIGEST_SIZE);
331
332 vid->vid = vidm;
333 if (vidm)
334 {
335 MD5Init(&ctx);
336 MD5Update(&ctx, (const u_char *)vid->data, strlen(vid->data));
337 MD5Final(vidm, &ctx);
338 vid->vid_len = MD5_DIGEST_SIZE;
339 }
340 }
341 else if (vid->flags & VID_FSWAN_HASH)
342 {
343 /** FreeS/WAN 2.00+ specific hash **/
344 #define FSWAN_VID_SIZE 12
345 unsigned char hash[MD5_DIGEST_SIZE];
346 char *vidm = malloc(FSWAN_VID_SIZE);
347
348 vid->vid = vidm;
349 if (vidm)
350 {
351 MD5Init(&ctx);
352 MD5Update(&ctx, (const u_char *)vid->data, strlen(vid->data));
353 MD5Final(hash, &ctx);
354 vidm[0] = 'O';
355 vidm[1] = 'E';
356 #if FSWAN_VID_SIZE - 2 <= MD5_DIGEST_SIZE
357 memcpy(vidm + 2, hash, FSWAN_VID_SIZE - 2);
358 #else
359 memcpy(vidm + 2, hash, MD5_DIGEST_SIZE);
360 memset(vidm + 2 + MD5_DIGEST_SIZE, '\0',
361 FSWAN_VID_SIZE - 2 - MD5_DIGEST_SIZE);
362 #endif
363 for (i = 2; i < FSWAN_VID_SIZE; i++)
364 {
365 vidm[i] &= 0x7f;
366 vidm[i] |= 0x40;
367 }
368 vid->vid_len = FSWAN_VID_SIZE;
369 }
370 }
371
372 if (vid->descr == NULL)
373 {
374 /** Find something to display **/
375 vid->descr = vid->data;
376 }
377 }
378 _vid_struct_init = 1;
379 }
380
381 static void
382 handle_known_vendorid (struct msg_digest *md
383 , const char *vidstr, size_t len, struct vid_struct *vid)
384 {
385 char vid_dump[128];
386 bool vid_useful = FALSE;
387 size_t i, j;
388
389 switch (vid->id) {
390 /* Remote side supports OpenPGP certificates */
391 case VID_OPENPGP:
392 md->openpgp = TRUE;
393 vid_useful = TRUE;
394 break;
395
396 /*
397 * Use most recent supported NAT-Traversal method and ignore the
398 * other ones (implementations will send all supported methods but
399 * only one will be used)
400 *
401 * Note: most recent == higher id in vendor.h
402 */
403 case VID_NATT_IETF_00:
404 if (!nat_traversal_support_non_ike)
405 break;
406 if ((nat_traversal_enabled) && (!md->nat_traversal_vid))
407 {
408 md->nat_traversal_vid = vid->id;
409 vid_useful = TRUE;
410 }
411 break;
412 case VID_NATT_IETF_02:
413 case VID_NATT_IETF_02_N:
414 case VID_NATT_IETF_03:
415 case VID_NATT_RFC:
416 if (nat_traversal_support_port_floating
417 && md->nat_traversal_vid < vid->id)
418 {
419 md->nat_traversal_vid = vid->id;
420 vid_useful = TRUE;
421 }
422 break;
423
424 /* Remote side would like to do DPD with us on this connection */
425 case VID_MISC_DPD:
426 md->dpd = TRUE;
427 vid_useful = TRUE;
428 break;
429 case VID_MISC_XAUTH:
430 vid_useful = TRUE;
431 break;
432 default:
433 break;
434 }
435
436 if (vid->flags & VID_SUBSTRING_DUMPHEXA)
437 {
438 /* Dump description + Hexa */
439 memset(vid_dump, 0, sizeof(vid_dump));
440 snprintf(vid_dump, sizeof(vid_dump), "%s ",
441 vid->descr ? vid->descr : "");
442 for (i = strlen(vid_dump), j = vid->vid_len;
443 j < len && i < sizeof(vid_dump) - 2;
444 i += 2, j++)
445 {
446 vid_dump[i] = _hexdig[(vidstr[j] >> 4) & 0xF];
447 vid_dump[i+1] = _hexdig[vidstr[j] & 0xF];
448 }
449 }
450 else if (vid->flags & VID_SUBSTRING_DUMPASCII)
451 {
452 /* Dump ASCII content */
453 memset(vid_dump, 0, sizeof(vid_dump));
454 for (i = 0; i < len && i < sizeof(vid_dump) - 1; i++)
455 {
456 vid_dump[i] = (isprint(vidstr[i])) ? vidstr[i] : '.';
457 }
458 }
459 else
460 {
461 /* Dump description (descr) */
462 snprintf(vid_dump, sizeof(vid_dump), "%s",
463 vid->descr ? vid->descr : "");
464 }
465
466 loglog(RC_LOG_SERIOUS, "%s Vendor ID payload [%s]",
467 vid_useful ? "received" : "ignoring", vid_dump);
468 }
469
470 void
471 handle_vendorid (struct msg_digest *md, const char *vid, size_t len)
472 {
473 struct vid_struct *pvid;
474
475 if (!_vid_struct_init)
476 init_vendorid();
477
478 /*
479 * Find known VendorID in _vid_tab
480 */
481 for (pvid = _vid_tab; pvid->id; pvid++)
482 {
483 if (pvid->vid && vid && pvid->vid_len && len)
484 {
485 if (pvid->vid_len == len)
486 {
487 if (memcmp(pvid->vid, vid, len) == 0)
488 {
489 handle_known_vendorid(md, vid, len, pvid);
490 return;
491 }
492 }
493 else if ((pvid->vid_len < len) && (pvid->flags & VID_SUBSTRING))
494 {
495 if (memcmp(pvid->vid, vid, pvid->vid_len) == 0)
496 {
497 handle_known_vendorid(md, vid, len, pvid);
498 return;
499 }
500 }
501 }
502 }
503
504 /*
505 * Unknown VendorID. Log the beginning.
506 */
507 {
508 char log_vid[2*MAX_LOG_VID_LEN+1];
509 size_t i;
510
511 memset(log_vid, 0, sizeof(log_vid));
512
513 for (i = 0; i < len && i < MAX_LOG_VID_LEN; i++)
514 {
515 log_vid[2*i] = _hexdig[(vid[i] >> 4) & 0xF];
516 log_vid[2*i+1] = _hexdig[vid[i] & 0xF];
517 }
518 loglog(RC_LOG_SERIOUS, "ignoring Vendor ID payload [%s%s]",
519 log_vid, (len>MAX_LOG_VID_LEN) ? "..." : "");
520 }
521 }
522
523 /**
524 * Add a vendor id payload to the msg
525 */
526 bool
527 out_vendorid (u_int8_t np, pb_stream *outs, enum known_vendorid vid)
528 {
529 struct vid_struct *pvid;
530
531 if (!_vid_struct_init)
532 init_vendorid();
533
534 for (pvid = _vid_tab; pvid->id && pvid->id != vid; pvid++);
535
536 if (pvid->id != vid)
537 return STF_INTERNAL_ERROR; /* not found */
538 if (!pvid->vid)
539 return STF_INTERNAL_ERROR; /* not initialized */
540
541 DBG(DBG_EMITTING,
542 DBG_log("out_vendorid(): sending [%s]", pvid->descr)
543 )
544 return out_generic_raw(np, &isakmp_vendor_id_desc, outs,
545 pvid->vid, pvid->vid_len, "V_ID");
546 }
547