2 * Copyright (c) 2015 Cisco and/or its affiliates.
3 * Licensed under the Apache License, Version 2.0 (the "License");
4 * you may not use this file except in compliance with the License.
5 * You may obtain a copy of the License at:
7 * http://www.apache.org/licenses/LICENSE-2.0
9 * Unless required by applicable law or agreed to in writing, software
10 * distributed under the License is distributed on an "AS IS" BASIS,
11 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
12 * See the License for the specific language governing permissions and
13 * limitations under the License.
18 #include <vnet/vnet.h>
19 #include <vnet/api_errno.h>
20 #include <vnet/ip/ip.h>
21 #include <vnet/interface.h>
23 #include <vnet/ipsec/ipsec.h>
24 #include <vnet/ipsec/ikev2.h>
25 #include <vnet/ipsec/ikev2_priv.h>
28 typedef CLIB_PACKED (struct
36 u8 payload[0];}) ike_notify_payload_header_t;
40 typedef CLIB_PACKED (struct
47 ip4_address_t start_addr;
48 ip4_address_t end_addr;}) ikev2_ts_payload_entry_t;
52 typedef CLIB_PACKED (struct
59 ikev2_ts_payload_entry_t ts[0];})
60 ike_ts_payload_header_t;
64 typedef CLIB_PACKED (struct {
71 u8 num_transforms; u32 spi[0];
72 }) ike_sa_proposal_data_t;
76 typedef CLIB_PACKED (struct {
84 }) ike_sa_transform_data_t;
88 typedef CLIB_PACKED (struct {
96 }) ike_delete_payload_header_t;
99 static ike_payload_header_t *
100 ikev2_payload_add_hdr (ikev2_payload_chain_t * c, u8 payload_type, int len)
102 ike_payload_header_t *hdr =
103 (ike_payload_header_t *) & c->data[c->last_hdr_off];
107 hdr->nextpayload = payload_type;
109 c->first_payload_type = payload_type;
111 c->last_hdr_off = vec_len (c->data);
112 vec_add2 (c->data, tmp, len);
113 hdr = (ike_payload_header_t *) tmp;
114 memset (hdr, 0, len);
116 hdr->length = clib_host_to_net_u16 (len);
122 ikev2_payload_add_data (ikev2_payload_chain_t * c, u8 * data)
125 ike_payload_header_t *hdr;
127 vec_append (c->data, data);
128 hdr = (ike_payload_header_t *) & c->data[c->last_hdr_off];
129 len = clib_net_to_host_u16 (hdr->length);
130 hdr->length = clib_host_to_net_u16 (len + vec_len (data));
134 ikev2_payload_add_notify (ikev2_payload_chain_t * c, u16 msg_type, u8 * data)
136 ike_notify_payload_header_t *n;
139 (ike_notify_payload_header_t *) ikev2_payload_add_hdr (c,
140 IKEV2_PAYLOAD_NOTIFY,
142 n->msg_type = clib_host_to_net_u16 (msg_type);
143 ikev2_payload_add_data (c, data);
147 ikev2_payload_add_sa (ikev2_payload_chain_t * c,
148 ikev2_sa_proposal_t * proposals)
150 ike_payload_header_t *ph;
151 ike_sa_proposal_data_t *prop;
152 ike_sa_transform_data_t *tr;
153 ikev2_sa_proposal_t *p;
154 ikev2_sa_transform_t *t;
160 ikev2_payload_add_hdr (c, IKEV2_PAYLOAD_SA, sizeof (*ph));
162 vec_foreach (p, proposals)
164 int spi_size = (p->protocol_id == IKEV2_PROTOCOL_ESP) ? 4 : 0;
165 pr_data = vec_new (u8, sizeof (ike_sa_proposal_data_t) + spi_size);
166 prop = (ike_sa_proposal_data_t *) pr_data;
167 prop->last_or_more = proposals - p + 1 < vec_len (proposals) ? 2 : 0;
168 prop->protocol_id = p->protocol_id;
169 prop->proposal_num = p->proposal_num;
170 prop->spi_size = spi_size;
171 prop->num_transforms = vec_len (p->transforms);
174 prop->spi[0] = clib_host_to_net_u32 (p->spi);
176 DBG_PLD ("proposal num %u protocol_id %u last_or_more %u spi_size %u%s%U",
177 prop->proposal_num, prop->protocol_id, prop->last_or_more,
178 prop->spi_size, prop->spi_size ? " spi_data " : "",
179 format_hex_bytes, prop->spi, prop->spi_size);
181 vec_foreach (t, p->transforms)
183 vec_add2 (tr_data, tmp, sizeof (*tr) + vec_len (t->attrs));
184 tr = (ike_sa_transform_data_t *) tmp;
186 ((t - p->transforms) + 1 < vec_len (p->transforms)) ? 3 : 0;
187 tr->transform_type = t->type;
188 tr->transform_id = clib_host_to_net_u16 (t->transform_id);
190 clib_host_to_net_u16 (sizeof (*tr) + vec_len (t->attrs));
192 if (vec_len (t->attrs) > 0)
193 clib_memcpy (tr->attributes, t->attrs, vec_len (t->attrs));
196 ("transform type %U transform_id %u last_or_more %u attr_size %u%s%U",
197 format_ikev2_transform_type, tr->transform_type, t->transform_id,
198 tr->last_or_more, vec_len (t->attrs),
199 vec_len (t->attrs) ? " attrs " : "", format_hex_bytes,
200 tr->attributes, vec_len (t->attrs));
204 clib_host_to_net_u16 (vec_len (tr_data) + vec_len (pr_data));
205 ikev2_payload_add_data (c, pr_data);
206 ikev2_payload_add_data (c, tr_data);
213 ikev2_payload_add_ke (ikev2_payload_chain_t * c, u16 dh_group, u8 * dh_data)
215 ike_ke_payload_header_t *ke;
216 ke = (ike_ke_payload_header_t *) ikev2_payload_add_hdr (c, IKEV2_PAYLOAD_KE,
219 ke->dh_group = clib_host_to_net_u16 (dh_group);
220 ikev2_payload_add_data (c, dh_data);
224 ikev2_payload_add_nonce (ikev2_payload_chain_t * c, u8 * nonce)
226 ikev2_payload_add_hdr (c, IKEV2_PAYLOAD_NONCE,
227 sizeof (ike_payload_header_t));
228 ikev2_payload_add_data (c, nonce);
232 ikev2_payload_add_id (ikev2_payload_chain_t * c, ikev2_id_t * id, u8 type)
234 ike_id_payload_header_t *idp;
236 (ike_id_payload_header_t *) ikev2_payload_add_hdr (c, type,
239 idp->id_type = id->type;
240 ikev2_payload_add_data (c, id->data);
244 ikev2_payload_add_delete (ikev2_payload_chain_t * c, ikev2_delete_t * d)
246 ike_delete_payload_header_t *dp;
247 u16 num_of_spi = vec_len (d);
250 (ike_delete_payload_header_t *) ikev2_payload_add_hdr (c,
251 IKEV2_PAYLOAD_DELETE,
254 if (d[0].protocol_id == IKEV2_PROTOCOL_IKE)
260 dp->protocol_id = d[0].protocol_id;
262 dp->num_of_spi = clib_host_to_net_u16 (num_of_spi);
265 u8 *data = vec_new (u8, 4);
266 u32 spi = clib_host_to_net_u32 (d2->spi);
267 clib_memcpy (data, &spi, 4);
268 ikev2_payload_add_data (c, data);
275 ikev2_payload_add_auth (ikev2_payload_chain_t * c, ikev2_auth_t * auth)
277 ike_auth_payload_header_t *ap;
279 (ike_auth_payload_header_t *) ikev2_payload_add_hdr (c,
283 ap->auth_method = auth->method;
284 ikev2_payload_add_data (c, auth->data);
288 ikev2_payload_add_ts (ikev2_payload_chain_t * c, ikev2_ts_t * ts, u8 type)
290 ike_ts_payload_header_t *tsh;
295 (ike_ts_payload_header_t *) ikev2_payload_add_hdr (c, type,
297 tsh->num_ts = vec_len (ts);
299 vec_foreach (ts2, ts)
301 ASSERT (ts2->ts_type == 7); /*TS_IPV4_ADDR_RANGE */
302 ikev2_ts_payload_entry_t *entry;
303 vec_add2 (data, tmp, sizeof (*entry));
304 entry = (ikev2_ts_payload_entry_t *) tmp;
305 entry->ts_type = ts2->ts_type;
306 entry->protocol_id = ts2->protocol_id;
307 entry->selector_len = clib_host_to_net_u16 (16);
308 entry->start_port = clib_host_to_net_u16 (ts2->start_port);
309 entry->end_port = clib_host_to_net_u16 (ts2->end_port);
310 entry->start_addr.as_u32 = ts2->start_addr.as_u32;
311 entry->end_addr.as_u32 = ts2->end_addr.as_u32;
314 ikev2_payload_add_data (c, data);
319 ikev2_payload_chain_add_padding (ikev2_payload_chain_t * c, int bs)
321 u8 *tmp __attribute__ ((unused));
322 u8 pad_len = (vec_len (c->data) / bs + 1) * bs - vec_len (c->data);
323 vec_add2 (c->data, tmp, pad_len);
324 c->data[vec_len (c->data) - 1] = pad_len - 1;
327 ikev2_sa_proposal_t *
328 ikev2_parse_sa_payload (ike_payload_header_t * ikep)
330 ikev2_sa_proposal_t *v = 0;
331 ikev2_sa_proposal_t *proposal;
332 ikev2_sa_transform_t *transform;
334 u32 plen = clib_net_to_host_u16 (ikep->length);
336 ike_sa_proposal_data_t *sap;
337 int proposal_ptr = 0;
341 sap = (ike_sa_proposal_data_t *) & ikep->payload[proposal_ptr];
345 DBG_PLD ("proposal num %u len %u last_or_more %u id %u "
346 "spi_size %u num_transforms %u",
347 sap->proposal_num, clib_net_to_host_u16 (sap->proposal_len),
348 sap->last_or_more, sap->protocol_id, sap->spi_size,
349 sap->num_transforms);
351 /* IKE proposal should not have SPI */
352 if (sap->protocol_id == IKEV2_PROTOCOL_IKE && sap->spi_size != 0)
355 /* IKE proposal should not have SPI */
356 if (sap->protocol_id == IKEV2_PROTOCOL_ESP && sap->spi_size != 4)
359 transform_ptr = proposal_ptr + sizeof (*sap) + sap->spi_size;
361 vec_add2 (v, proposal, 1);
362 proposal->proposal_num = sap->proposal_num;
363 proposal->protocol_id = sap->protocol_id;
365 if (sap->spi_size == 4)
367 proposal->spi = clib_net_to_host_u32 (sap->spi[0]);
370 for (i = 0; i < sap->num_transforms; i++)
372 ike_sa_transform_data_t *tr =
373 (ike_sa_transform_data_t *) & ikep->payload[transform_ptr];
374 u16 tlen = clib_net_to_host_u16 (tr->transform_len);
376 if (tlen < sizeof (*tr))
379 vec_add2 (proposal->transforms, transform, 1);
381 transform->type = tr->transform_type;
382 transform->transform_id = clib_net_to_host_u16 (tr->transform_id);
383 if (tlen > sizeof (*tr))
384 vec_add (transform->attrs, tr->attributes, tlen - sizeof (*tr));
387 ("transform num %u len %u last_or_more %u type %U id %u%s%U", i,
388 tlen, tr->last_or_more, format_ikev2_sa_transform, transform,
389 clib_net_to_host_u16 (tr->transform_id),
390 tlen > sizeof (*tr) ? " attrs " : "", format_hex_bytes,
391 tr->attributes, tlen - sizeof (*tr));
393 transform_ptr += tlen;
396 proposal_ptr += clib_net_to_host_u16 (sap->proposal_len);
398 while (proposal_ptr < (plen - sizeof (*ikep)) && sap->last_or_more == 2);
400 /* data validation */
401 if (proposal_ptr != (plen - sizeof (*ikep)) || sap->last_or_more)
407 DBG_PLD ("SA payload data corrupted");
408 ikev2_sa_free_proposal_vector (&v);
413 ikev2_parse_ts_payload (ike_payload_header_t * ikep)
415 ike_ts_payload_header_t *tsp = (ike_ts_payload_header_t *) ikep;
416 ikev2_ts_t *r = 0, *ts;
419 for (i = 0; i < tsp->num_ts; i++)
421 if (tsp->ts[i].ts_type != 7) /* TS_IPV4_ADDR_RANGE */
423 DBG_PLD ("unsupported TS type received (%u)", tsp->ts[i].ts_type);
428 ts->ts_type = tsp->ts[i].ts_type;
429 ts->protocol_id = tsp->ts[i].protocol_id;
430 ts->start_port = tsp->ts[i].start_port;
431 ts->end_port = tsp->ts[i].end_port;
432 ts->start_addr.as_u32 = tsp->ts[i].start_addr.as_u32;
433 ts->end_addr.as_u32 = tsp->ts[i].end_addr.as_u32;
439 ikev2_parse_notify_payload (ike_payload_header_t * ikep)
441 ike_notify_payload_header_t *n = (ike_notify_payload_header_t *) ikep;
442 u32 plen = clib_net_to_host_u16 (ikep->length);
443 ikev2_notify_t *r = 0;
446 DBG_PLD ("msg_type %U len %u%s%U",
447 format_ikev2_notify_msg_type, clib_net_to_host_u16 (n->msg_type),
448 plen, plen > sizeof (*n) ? " data " : "",
449 format_hex_bytes, n->payload, plen - sizeof (*n));
451 r = vec_new (ikev2_notify_t, 1);
452 r->msg_type = clib_net_to_host_u16 (n->msg_type);
453 r->protocol_id = n->protocol_id;
455 if (n->spi_size == 4)
457 clib_memcpy (&spi, n->payload, n->spi_size);
458 r->spi = clib_net_to_host_u32 (spi);
459 DBG_PLD ("spi %lx", r->spi);
461 else if (n->spi_size == 0)
467 clib_warning ("invalid SPI Size %d", n->spi_size);
470 if (plen > (sizeof (*n) + n->spi_size))
472 vec_add (r->data, n->payload + n->spi_size,
473 plen - sizeof (*n) - n->spi_size);
480 ikev2_parse_vendor_payload (ike_payload_header_t * ikep)
482 u32 plen = clib_net_to_host_u16 (ikep->length);
486 for (i = 0; i < plen - 4; i++)
487 if (!isprint (ikep->payload[i]))
490 DBG_PLD ("len %u data %s:%U",
492 is_string ? "string" : "hex",
493 is_string ? format_ascii_bytes : format_hex_bytes,
494 ikep->payload, plen - sizeof (*ikep));
498 ikev2_parse_delete_payload (ike_payload_header_t * ikep)
500 ike_delete_payload_header_t *d = (ike_delete_payload_header_t *) ikep;
501 u32 plen = clib_net_to_host_u16 (ikep->length);
502 ikev2_delete_t *r = 0, *del;
503 u16 num_of_spi = clib_net_to_host_u16 (d->num_of_spi);
506 DBG_PLD ("protocol_id %u spi_size %u num_of_spi %u len %u%s%U",
507 d->protocol_id, d->spi_size, num_of_spi,
508 plen, plen > sizeof (d) ? " data " : "",
509 format_hex_bytes, d->spi, plen - sizeof (*d));
511 if (d->protocol_id == IKEV2_PROTOCOL_IKE)
513 r = vec_new (ikev2_delete_t, 1);
518 r = vec_new (ikev2_delete_t, num_of_spi);
521 del->protocol_id = d->protocol_id;
522 del->spi = clib_net_to_host_u32 (d->spi[i++]);
530 * fd.io coding-style-patch-verification: ON
533 * eval: (c-set-style "gnu")