Annotation of embedaddon/ipsec-tools/src/racoon/isakmp_agg.c, revision 1.1

1.1     ! misho       1: /*     $NetBSD: isakmp_agg.c,v 1.16 2009/09/18 10:31:11 tteras Exp $   */
        !             2: 
        !             3: /* Id: isakmp_agg.c,v 1.28 2006/04/06 16:46:08 manubsd Exp */
        !             4: 
        !             5: /*
        !             6:  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
        !             7:  * All rights reserved.
        !             8:  *
        !             9:  * Redistribution and use in source and binary forms, with or without
        !            10:  * modification, are permitted provided that the following conditions
        !            11:  * are met:
        !            12:  * 1. Redistributions of source code must retain the above copyright
        !            13:  *    notice, this list of conditions and the following disclaimer.
        !            14:  * 2. Redistributions in binary form must reproduce the above copyright
        !            15:  *    notice, this list of conditions and the following disclaimer in the
        !            16:  *    documentation and/or other materials provided with the distribution.
        !            17:  * 3. Neither the name of the project nor the names of its contributors
        !            18:  *    may be used to endorse or promote products derived from this software
        !            19:  *    without specific prior written permission.
        !            20:  *
        !            21:  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
        !            22:  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
        !            23:  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
        !            24:  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
        !            25:  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
        !            26:  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
        !            27:  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
        !            28:  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
        !            29:  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
        !            30:  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
        !            31:  * SUCH DAMAGE.
        !            32:  */
        !            33: 
        !            34: /* Aggressive Exchange (Aggressive Mode) */
        !            35: 
        !            36: #include "config.h"
        !            37: 
        !            38: #include <sys/types.h>
        !            39: #include <sys/param.h>
        !            40: 
        !            41: #include <stdlib.h>
        !            42: #include <stdio.h>
        !            43: #include <string.h>
        !            44: #include <errno.h>
        !            45: #if TIME_WITH_SYS_TIME
        !            46: # include <sys/time.h>
        !            47: # include <time.h>
        !            48: #else
        !            49: # if HAVE_SYS_TIME_H
        !            50: #  include <sys/time.h>
        !            51: # else
        !            52: #  include <time.h>
        !            53: # endif
        !            54: #endif
        !            55: 
        !            56: #include "var.h"
        !            57: #include "misc.h"
        !            58: #include "vmbuf.h"
        !            59: #include "plog.h"
        !            60: #include "sockmisc.h"
        !            61: #include "schedule.h"
        !            62: #include "debug.h"
        !            63: 
        !            64: #ifdef ENABLE_HYBRID
        !            65: #include <resolv.h>
        !            66: #endif
        !            67: 
        !            68: #include "localconf.h"
        !            69: #include "remoteconf.h"
        !            70: #include "isakmp_var.h"
        !            71: #include "isakmp.h"
        !            72: #include "evt.h"
        !            73: #include "oakley.h"
        !            74: #include "handler.h"
        !            75: #include "ipsec_doi.h"
        !            76: #include "crypto_openssl.h"
        !            77: #include "pfkey.h"
        !            78: #include "isakmp_agg.h"
        !            79: #include "isakmp_inf.h"
        !            80: #ifdef ENABLE_HYBRID
        !            81: #include "isakmp_xauth.h"
        !            82: #include "isakmp_cfg.h"
        !            83: #endif
        !            84: #ifdef ENABLE_FRAG
        !            85: #include "isakmp_frag.h"
        !            86: #endif
        !            87: #include "vendorid.h"
        !            88: #include "strnames.h"
        !            89: 
        !            90: #ifdef ENABLE_NATT
        !            91: #include "nattraversal.h"
        !            92: #endif
        !            93: 
        !            94: #ifdef HAVE_GSSAPI
        !            95: #include "gssapi.h"
        !            96: #endif
        !            97: 
        !            98: /*
        !            99:  * begin Aggressive Mode as initiator.
        !           100:  */
        !           101: /*
        !           102:  * send to responder
        !           103:  *     psk: HDR, SA, KE, Ni, IDi1
        !           104:  *     sig: HDR, SA, KE, Ni, IDi1 [, CR ]
        !           105:  *   gssapi: HDR, SA, KE, Ni, IDi1, GSSi
        !           106:  *     rsa: HDR, SA, [ HASH(1),] KE, <IDi1_b>Pubkey_r, <Ni_b>Pubkey_r
        !           107:  *     rev: HDR, SA, [ HASH(1),] <Ni_b>Pubkey_r, <KE_b>Ke_i,
        !           108:  *          <IDii_b>Ke_i [, <Cert-I_b>Ke_i ]
        !           109:  */
        !           110: int
        !           111: agg_i1send(iph1, msg)
        !           112:        struct ph1handle *iph1;
        !           113:        vchar_t *msg; /* must be null */
        !           114: {
        !           115:        struct payload_list *plist = NULL;
        !           116:        int error = -1;
        !           117: #ifdef ENABLE_NATT
        !           118:        vchar_t *vid_natt[MAX_NATT_VID_COUNT] = { NULL };
        !           119:        int i;
        !           120: #endif
        !           121: #ifdef ENABLE_HYBRID
        !           122:        vchar_t *vid_xauth = NULL;
        !           123:        vchar_t *vid_unity = NULL;
        !           124: #endif
        !           125: #ifdef ENABLE_FRAG
        !           126:        vchar_t *vid_frag = NULL;
        !           127: #endif
        !           128: #ifdef HAVE_GSSAPI
        !           129:        vchar_t *gsstoken = NULL;
        !           130:        int len;
        !           131: #endif
        !           132: #ifdef ENABLE_DPD
        !           133:        vchar_t *vid_dpd = NULL;
        !           134: #endif
        !           135: 
        !           136:        /* validity check */
        !           137:        if (msg != NULL) {
        !           138:                plog(LLV_ERROR, LOCATION, NULL,
        !           139:                        "msg has to be NULL in this function.\n");
        !           140:                goto end;
        !           141:        }
        !           142:        if (iph1->status != PHASE1ST_START) {
        !           143:                plog(LLV_ERROR, LOCATION, NULL,
        !           144:                        "status mismatched %d.\n", iph1->status);
        !           145:                goto end;
        !           146:        }
        !           147: 
        !           148:        /* create isakmp index */
        !           149:        memset(&iph1->index, 0, sizeof(iph1->index));
        !           150:        isakmp_newcookie((caddr_t)&iph1->index, iph1->remote, iph1->local);
        !           151: 
        !           152:        /* make ID payload into isakmp status */
        !           153:        if (ipsecdoi_setid1(iph1) < 0)
        !           154:                goto end;
        !           155: 
        !           156:        /* create SA payload for my proposal */
        !           157:        iph1->sa = ipsecdoi_setph1proposal(iph1->rmconf, iph1->rmconf->proposal);
        !           158:        if (iph1->sa == NULL)
        !           159:                goto end;
        !           160: 
        !           161:        /* consistency check of proposals */
        !           162:        if (iph1->rmconf->dhgrp == NULL) {
        !           163:                plog(LLV_ERROR, LOCATION, NULL,
        !           164:                        "configuration failure about DH group.\n");
        !           165:                goto end;
        !           166:        }
        !           167: 
        !           168:        /* generate DH public value */
        !           169:        if (oakley_dh_generate(iph1->rmconf->dhgrp,
        !           170:                                &iph1->dhpub, &iph1->dhpriv) < 0)
        !           171:                goto end;
        !           172: 
        !           173:        /* generate NONCE value */
        !           174:        iph1->nonce = eay_set_random(iph1->rmconf->nonce_size);
        !           175:        if (iph1->nonce == NULL)
        !           176:                goto end;
        !           177: 
        !           178: #ifdef ENABLE_HYBRID
        !           179:        /* Do we need Xauth VID? */
        !           180:        switch (iph1->rmconf->proposal->authmethod) {
        !           181:        case OAKLEY_ATTR_AUTH_METHOD_XAUTH_PSKEY_I:
        !           182:        case OAKLEY_ATTR_AUTH_METHOD_HYBRID_RSA_I:
        !           183:        case OAKLEY_ATTR_AUTH_METHOD_HYBRID_DSS_I:
        !           184:        case OAKLEY_ATTR_AUTH_METHOD_XAUTH_RSASIG_I:
        !           185:        case OAKLEY_ATTR_AUTH_METHOD_XAUTH_DSSSIG_I:
        !           186:        case OAKLEY_ATTR_AUTH_METHOD_XAUTH_RSAENC_I:
        !           187:        case OAKLEY_ATTR_AUTH_METHOD_XAUTH_RSAREV_I:
        !           188:                if ((vid_xauth = set_vendorid(VENDORID_XAUTH)) == NULL)
        !           189:                        plog(LLV_ERROR, LOCATION, NULL,
        !           190:                             "Xauth vendor ID generation failed\n");
        !           191:                if ((vid_unity = set_vendorid(VENDORID_UNITY)) == NULL)
        !           192:                        plog(LLV_ERROR, LOCATION, NULL,
        !           193:                             "Unity vendor ID generation failed\n");
        !           194:                break;
        !           195:        default:
        !           196:                break;
        !           197:        }
        !           198: #endif
        !           199: 
        !           200: #ifdef ENABLE_FRAG
        !           201:        if (iph1->rmconf->ike_frag) {
        !           202:                vid_frag = set_vendorid(VENDORID_FRAG);
        !           203:                if (vid_frag != NULL)
        !           204:                        vid_frag = isakmp_frag_addcap(vid_frag,
        !           205:                            VENDORID_FRAG_AGG);
        !           206:                if (vid_frag == NULL)
        !           207:                        plog(LLV_ERROR, LOCATION, NULL,
        !           208:                            "Frag vendorID construction failed\n");
        !           209:        }
        !           210: #endif
        !           211: 
        !           212:        plog(LLV_DEBUG, LOCATION, NULL, "authmethod is %s\n",
        !           213:                s_oakley_attr_method(iph1->rmconf->proposal->authmethod));
        !           214: #ifdef HAVE_GSSAPI
        !           215:        if (iph1->rmconf->proposal->authmethod == OAKLEY_ATTR_AUTH_METHOD_GSSAPI_KRB)
        !           216:                gssapi_get_itoken(iph1, &len);
        !           217: #endif
        !           218: 
        !           219:        /* set SA payload to propose */
        !           220:        plist = isakmp_plist_append(plist, iph1->sa, ISAKMP_NPTYPE_SA);
        !           221: 
        !           222:        /* create isakmp KE payload */
        !           223:        plist = isakmp_plist_append(plist, iph1->dhpub, ISAKMP_NPTYPE_KE);
        !           224: 
        !           225:        /* create isakmp NONCE payload */
        !           226:        plist = isakmp_plist_append(plist, iph1->nonce, ISAKMP_NPTYPE_NONCE);
        !           227: 
        !           228:        /* create isakmp ID payload */
        !           229:        plist = isakmp_plist_append(plist, iph1->id, ISAKMP_NPTYPE_ID);
        !           230: 
        !           231: #ifdef HAVE_GSSAPI
        !           232:        if (iph1->rmconf->proposal->authmethod == OAKLEY_ATTR_AUTH_METHOD_GSSAPI_KRB) {
        !           233:                if (gssapi_get_token_to_send(iph1, &gsstoken) < 0) {
        !           234:                        plog(LLV_ERROR, LOCATION, NULL,
        !           235:                             "Failed to get gssapi token.\n");
        !           236:                        goto end;
        !           237:                }
        !           238:                plist = isakmp_plist_append(plist, gsstoken, ISAKMP_NPTYPE_GSS);
        !           239:        }
        !           240: #endif
        !           241:        /* create isakmp CR payload */
        !           242:        if (oakley_needcr(iph1->rmconf->proposal->authmethod))
        !           243:                plist = oakley_append_cr(plist, iph1);
        !           244: 
        !           245: #ifdef ENABLE_FRAG
        !           246:        if (vid_frag)
        !           247:                plist = isakmp_plist_append(plist, vid_frag, ISAKMP_NPTYPE_VID);
        !           248: #endif
        !           249: #ifdef ENABLE_NATT
        !           250:        /*
        !           251:         * set VID payload for NAT-T if NAT-T
        !           252:         * support allowed in the config file
        !           253:         */
        !           254:        if (iph1->rmconf->nat_traversal)
        !           255:                plist = isakmp_plist_append_natt_vids(plist, vid_natt);
        !           256: #endif
        !           257: #ifdef ENABLE_HYBRID
        !           258:        if (vid_xauth)
        !           259:                plist = isakmp_plist_append(plist,
        !           260:                    vid_xauth, ISAKMP_NPTYPE_VID);
        !           261:        if (vid_unity)
        !           262:                plist = isakmp_plist_append(plist,
        !           263:                    vid_unity, ISAKMP_NPTYPE_VID);
        !           264: #endif
        !           265: #ifdef ENABLE_DPD
        !           266:        if(iph1->rmconf->dpd){
        !           267:                vid_dpd = set_vendorid(VENDORID_DPD);
        !           268:                if (vid_dpd != NULL)
        !           269:                        plist = isakmp_plist_append(plist, vid_dpd, ISAKMP_NPTYPE_VID);
        !           270:        }
        !           271: #endif
        !           272: 
        !           273:        iph1->sendbuf = isakmp_plist_set_all (&plist, iph1);
        !           274: 
        !           275: #ifdef HAVE_PRINT_ISAKMP_C
        !           276:        isakmp_printpacket(iph1->sendbuf, iph1->local, iph1->remote, 0);
        !           277: #endif
        !           278: 
        !           279:        /* send the packet, add to the schedule to resend */
        !           280:        if (isakmp_ph1send(iph1) == -1)
        !           281:                goto end;
        !           282: 
        !           283:        iph1->status = PHASE1ST_MSG1SENT;
        !           284: 
        !           285:        error = 0;
        !           286: 
        !           287: end:
        !           288: #ifdef HAVE_GSSAPI
        !           289:        if (gsstoken)
        !           290:                vfree(gsstoken);
        !           291: #endif
        !           292: #ifdef ENABLE_FRAG
        !           293:        if (vid_frag)
        !           294:                vfree(vid_frag);
        !           295: #endif
        !           296: #ifdef ENABLE_NATT
        !           297:        for (i = 0; i < MAX_NATT_VID_COUNT && vid_natt[i] != NULL; i++)
        !           298:                vfree(vid_natt[i]);
        !           299: #endif
        !           300: #ifdef ENABLE_HYBRID
        !           301:        if (vid_xauth != NULL)
        !           302:                vfree(vid_xauth);
        !           303:        if (vid_unity != NULL)
        !           304:                vfree(vid_unity);
        !           305: #endif
        !           306: #ifdef ENABLE_DPD
        !           307:        if (vid_dpd != NULL)
        !           308:                vfree(vid_dpd);
        !           309: #endif
        !           310: 
        !           311:        return error;
        !           312: }
        !           313: 
        !           314: /*
        !           315:  * receive from responder
        !           316:  *     psk: HDR, SA, KE, Nr, IDr1, HASH_R
        !           317:  *     sig: HDR, SA, KE, Nr, IDr1, [ CR, ] [ CERT, ] SIG_R
        !           318:  *   gssapi: HDR, SA, KE, Nr, IDr1, GSSr, HASH_R
        !           319:  *     rsa: HDR, SA, KE, <IDr1_b>PubKey_i, <Nr_b>PubKey_i, HASH_R
        !           320:  *     rev: HDR, SA, <Nr_b>PubKey_i, <KE_b>Ke_r, <IDir_b>Ke_r, HASH_R
        !           321:  */
        !           322: int
        !           323: agg_i2recv(iph1, msg)
        !           324:        struct ph1handle *iph1;
        !           325:        vchar_t *msg;
        !           326: {
        !           327:        vchar_t *pbuf = NULL;
        !           328:        struct isakmp_parse_t *pa;
        !           329:        vchar_t *satmp = NULL;
        !           330:        int error = -1;
        !           331:        int ptype;
        !           332: #ifdef ENABLE_HYBRID
        !           333:        vchar_t *unity_vid;
        !           334:        vchar_t *xauth_vid;
        !           335: #endif
        !           336: #ifdef HAVE_GSSAPI
        !           337:        vchar_t *gsstoken = NULL;
        !           338: #endif
        !           339: 
        !           340: #ifdef ENABLE_NATT
        !           341:        int natd_seq = 0;
        !           342:        struct natd_payload {
        !           343:                int seq;
        !           344:                vchar_t *payload;
        !           345:                TAILQ_ENTRY(natd_payload) chain;
        !           346:        };
        !           347:        TAILQ_HEAD(_natd_payload, natd_payload) natd_tree;
        !           348:        TAILQ_INIT(&natd_tree);
        !           349: #endif
        !           350: 
        !           351:        /* validity check */
        !           352:        if (iph1->status != PHASE1ST_MSG1SENT) {
        !           353:                plog(LLV_ERROR, LOCATION, NULL,
        !           354:                        "status mismatched %d.\n", iph1->status);
        !           355:                goto end;
        !           356:        }
        !           357: 
        !           358:        /* validate the type of next payload */
        !           359:        pbuf = isakmp_parse(msg);
        !           360:        if (pbuf == NULL)
        !           361:                goto end;
        !           362:        pa = (struct isakmp_parse_t *)pbuf->v;
        !           363: 
        !           364:        iph1->pl_hash = NULL;
        !           365: 
        !           366:        /* SA payload is fixed postion */
        !           367:        if (pa->type != ISAKMP_NPTYPE_SA) {
        !           368:                plog(LLV_ERROR, LOCATION, iph1->remote,
        !           369:                        "received invalid next payload type %d, "
        !           370:                        "expecting %d.\n",
        !           371:                        pa->type, ISAKMP_NPTYPE_SA);
        !           372:                goto end;
        !           373:        }
        !           374: 
        !           375:        if (isakmp_p2ph(&satmp, pa->ptr) < 0)
        !           376:                goto end;
        !           377:        pa++;
        !           378: 
        !           379:        for (/*nothing*/;
        !           380:             pa->type != ISAKMP_NPTYPE_NONE;
        !           381:             pa++) {
        !           382: 
        !           383:                switch (pa->type) {
        !           384:                case ISAKMP_NPTYPE_KE:
        !           385:                        if (isakmp_p2ph(&iph1->dhpub_p, pa->ptr) < 0)
        !           386:                                goto end;
        !           387:                        break;
        !           388:                case ISAKMP_NPTYPE_NONCE:
        !           389:                        if (isakmp_p2ph(&iph1->nonce_p, pa->ptr) < 0)
        !           390:                                goto end;
        !           391:                        break;
        !           392:                case ISAKMP_NPTYPE_ID:
        !           393:                        if (isakmp_p2ph(&iph1->id_p, pa->ptr) < 0)
        !           394:                                goto end;
        !           395:                        break;
        !           396:                case ISAKMP_NPTYPE_HASH:
        !           397:                        iph1->pl_hash = (struct isakmp_pl_hash *)pa->ptr;
        !           398:                        break;
        !           399:                case ISAKMP_NPTYPE_CR:
        !           400:                        if (oakley_savecr(iph1, pa->ptr) < 0)
        !           401:                                goto end;
        !           402:                        break;
        !           403:                case ISAKMP_NPTYPE_CERT:
        !           404:                        if (oakley_savecert(iph1, pa->ptr) < 0)
        !           405:                                goto end;
        !           406:                        break;
        !           407:                case ISAKMP_NPTYPE_SIG:
        !           408:                        if (isakmp_p2ph(&iph1->sig_p, pa->ptr) < 0)
        !           409:                                goto end;
        !           410:                        break;
        !           411:                case ISAKMP_NPTYPE_VID:
        !           412:                        handle_vendorid(iph1, pa->ptr);
        !           413:                        break;
        !           414:                case ISAKMP_NPTYPE_N:
        !           415:                        isakmp_log_notify(iph1,
        !           416:                                (struct isakmp_pl_n *) pa->ptr,
        !           417:                                "aggressive exchange");
        !           418:                        break;
        !           419: #ifdef HAVE_GSSAPI
        !           420:                case ISAKMP_NPTYPE_GSS:
        !           421:                        if (isakmp_p2ph(&gsstoken, pa->ptr) < 0)
        !           422:                                goto end;
        !           423:                        gssapi_save_received_token(iph1, gsstoken);
        !           424:                        break;
        !           425: #endif
        !           426: 
        !           427: #ifdef ENABLE_NATT
        !           428:                case ISAKMP_NPTYPE_NATD_DRAFT:
        !           429:                case ISAKMP_NPTYPE_NATD_RFC:
        !           430:                        if (NATT_AVAILABLE(iph1) && iph1->natt_options != NULL &&
        !           431:                            pa->type == iph1->natt_options->payload_nat_d) {
        !           432:                                struct natd_payload *natd;
        !           433:                                natd = (struct natd_payload *)racoon_malloc(sizeof(*natd));
        !           434:                                if (!natd)
        !           435:                                        goto end;
        !           436: 
        !           437:                                natd->payload = NULL;
        !           438: 
        !           439:                                if (isakmp_p2ph (&natd->payload, pa->ptr) < 0)
        !           440:                                        goto end;
        !           441: 
        !           442:                                natd->seq = natd_seq++;
        !           443: 
        !           444:                                TAILQ_INSERT_TAIL(&natd_tree, natd, chain);
        !           445:                                break;
        !           446:                        }
        !           447:                        /* passthrough to default... */
        !           448: #endif
        !           449: 
        !           450:                default:
        !           451:                        /* don't send information, see isakmp_ident_r1() */
        !           452:                        plog(LLV_ERROR, LOCATION, iph1->remote,
        !           453:                                "ignore the packet, "
        !           454:                                "received unexpecting payload type %d.\n",
        !           455:                                pa->type);
        !           456:                        goto end;
        !           457:                }
        !           458:        }
        !           459: 
        !           460:        /* payload existency check */
        !           461:        if (iph1->dhpub_p == NULL || iph1->nonce_p == NULL) {
        !           462:                plog(LLV_ERROR, LOCATION, iph1->remote,
        !           463:                        "few isakmp message received.\n");
        !           464:                goto end;
        !           465:        }
        !           466: 
        !           467:        /* verify identifier */
        !           468:        if (ipsecdoi_checkid1(iph1) != 0) {
        !           469:                plog(LLV_ERROR, LOCATION, iph1->remote,
        !           470:                        "invalid ID payload.\n");
        !           471:                goto end;
        !           472:        }
        !           473: 
        !           474:        /* check SA payload and set approval SA for use */
        !           475:        if (ipsecdoi_checkph1proposal(satmp, iph1) < 0) {
        !           476:                plog(LLV_ERROR, LOCATION, iph1->remote,
        !           477:                        "failed to get valid proposal.\n");
        !           478:                /* XXX send information */
        !           479:                goto end;
        !           480:        }
        !           481:        VPTRINIT(iph1->sa_ret);
        !           482: 
        !           483:        /* fix isakmp index */
        !           484:        memcpy(&iph1->index.r_ck, &((struct isakmp *)msg->v)->r_ck,
        !           485:                sizeof(cookie_t));
        !           486: 
        !           487: #ifdef ENABLE_NATT
        !           488:        if (NATT_AVAILABLE(iph1)) {
        !           489:                struct natd_payload *natd = NULL;
        !           490:                int natd_verified;
        !           491: 
        !           492:                plog(LLV_INFO, LOCATION, iph1->remote,
        !           493:                     "Selected NAT-T version: %s\n",
        !           494:                     vid_string_by_id(iph1->natt_options->version));
        !           495: 
        !           496:                /* set both bits first so that we can clear them
        !           497:                   upon verifying hashes */
        !           498:                iph1->natt_flags |= NAT_DETECTED;
        !           499: 
        !           500:                while ((natd = TAILQ_FIRST(&natd_tree)) != NULL) {
        !           501:                        /* this function will clear appropriate bits bits
        !           502:                           from iph1->natt_flags */
        !           503:                        natd_verified = natt_compare_addr_hash (iph1,
        !           504:                                natd->payload, natd->seq);
        !           505: 
        !           506:                        plog (LLV_INFO, LOCATION, NULL, "NAT-D payload #%d %s\n",
        !           507:                                natd->seq - 1,
        !           508:                                natd_verified ? "verified" : "doesn't match");
        !           509: 
        !           510:                        vfree (natd->payload);
        !           511: 
        !           512:                        TAILQ_REMOVE(&natd_tree, natd, chain);
        !           513:                        racoon_free (natd);
        !           514:                }
        !           515: 
        !           516:                plog (LLV_INFO, LOCATION, NULL, "NAT %s %s%s\n",
        !           517:                      iph1->natt_flags & NAT_DETECTED ?
        !           518:                                "detected:" : "not detected",
        !           519:                      iph1->natt_flags & NAT_DETECTED_ME ? "ME " : "",
        !           520:                      iph1->natt_flags & NAT_DETECTED_PEER ? "PEER" : "");
        !           521: 
        !           522:                if (iph1->natt_flags & NAT_DETECTED)
        !           523:                        natt_float_ports (iph1);
        !           524:        }
        !           525: #endif
        !           526: 
        !           527:        /* compute sharing secret of DH */
        !           528:        if (oakley_dh_compute(iph1->rmconf->dhgrp, iph1->dhpub,
        !           529:                                iph1->dhpriv, iph1->dhpub_p, &iph1->dhgxy) < 0)
        !           530:                goto end;
        !           531: 
        !           532:        /* generate SKEYIDs & IV & final cipher key */
        !           533:        if (oakley_skeyid(iph1) < 0)
        !           534:                goto end;
        !           535:        if (oakley_skeyid_dae(iph1) < 0)
        !           536:                goto end;
        !           537:        if (oakley_compute_enckey(iph1) < 0)
        !           538:                goto end;
        !           539:        if (oakley_newiv(iph1) < 0)
        !           540:                goto end;
        !           541: 
        !           542:        /* validate authentication value */
        !           543:        ptype = oakley_validate_auth(iph1);
        !           544:        if (ptype != 0) {
        !           545:                if (ptype == -1) {
        !           546:                        /* message printed inner oakley_validate_auth() */
        !           547:                        goto end;
        !           548:                }
        !           549:                evt_phase1(iph1, EVT_PHASE1_AUTH_FAILED, NULL);
        !           550:                isakmp_info_send_n1(iph1, ptype, NULL);
        !           551:                goto end;
        !           552:        }
        !           553: 
        !           554:        if (oakley_checkcr(iph1) < 0) {
        !           555:                /* Ignore this error in order to be interoperability. */
        !           556:                ;
        !           557:        }
        !           558: 
        !           559:        /* change status of isakmp status entry */
        !           560:        iph1->status = PHASE1ST_MSG2RECEIVED;
        !           561: 
        !           562:        error = 0;
        !           563: 
        !           564: end:
        !           565: #ifdef HAVE_GSSAPI
        !           566:        if (gsstoken)
        !           567:                vfree(gsstoken);
        !           568: #endif
        !           569:        if (pbuf)
        !           570:                vfree(pbuf);
        !           571:        if (satmp)
        !           572:                vfree(satmp);
        !           573:        if (error) {
        !           574:                VPTRINIT(iph1->dhpub_p);
        !           575:                VPTRINIT(iph1->nonce_p);
        !           576:                VPTRINIT(iph1->id_p);
        !           577:                VPTRINIT(iph1->cert_p);
        !           578:                VPTRINIT(iph1->crl_p);
        !           579:                VPTRINIT(iph1->sig_p);
        !           580:                VPTRINIT(iph1->cr_p);
        !           581:        }
        !           582: 
        !           583:        return error;
        !           584: }
        !           585: 
        !           586: /*
        !           587:  * send to responder
        !           588:  *     psk: HDR, HASH_I
        !           589:  *   gssapi: HDR, HASH_I
        !           590:  *     sig: HDR, [ CERT, ] SIG_I
        !           591:  *     rsa: HDR, HASH_I
        !           592:  *     rev: HDR, HASH_I
        !           593:  */
        !           594: int
        !           595: agg_i2send(iph1, msg)
        !           596:        struct ph1handle *iph1;
        !           597:        vchar_t *msg;
        !           598: {
        !           599:        struct payload_list *plist = NULL;
        !           600:        int need_cert = 0;
        !           601:        int error = -1;
        !           602:        vchar_t *gsshash = NULL;
        !           603: 
        !           604:        /* validity check */
        !           605:        if (iph1->status != PHASE1ST_MSG2RECEIVED) {
        !           606:                plog(LLV_ERROR, LOCATION, NULL,
        !           607:                        "status mismatched %d.\n", iph1->status);
        !           608:                goto end;
        !           609:        }
        !           610: 
        !           611:        /* generate HASH to send */
        !           612:        plog(LLV_DEBUG, LOCATION, NULL, "generate HASH_I\n");
        !           613:        iph1->hash = oakley_ph1hash_common(iph1, GENERATE);
        !           614:        if (iph1->hash == NULL) {
        !           615: #ifdef HAVE_GSSAPI
        !           616:                if (gssapi_more_tokens(iph1) &&
        !           617: #ifdef ENABLE_HYBRID
        !           618:                    !iph1->rmconf->xauth &&
        !           619: #endif
        !           620:                    1)
        !           621:                        isakmp_info_send_n1(iph1,
        !           622:                            ISAKMP_NTYPE_INVALID_EXCHANGE_TYPE, NULL);
        !           623: #endif
        !           624:                goto end;
        !           625:        }
        !           626: 
        !           627:        switch (iph1->approval->authmethod) {
        !           628:        case OAKLEY_ATTR_AUTH_METHOD_PSKEY:
        !           629: #ifdef ENABLE_HYBRID
        !           630:        case OAKLEY_ATTR_AUTH_METHOD_XAUTH_PSKEY_I:
        !           631:        case OAKLEY_ATTR_AUTH_METHOD_HYBRID_RSA_I:
        !           632:        case OAKLEY_ATTR_AUTH_METHOD_HYBRID_DSS_I:
        !           633: #endif
        !           634:                /* set HASH payload */
        !           635:                plist = isakmp_plist_append(plist,
        !           636:                    iph1->hash, ISAKMP_NPTYPE_HASH);
        !           637:                break;
        !           638: 
        !           639:        case OAKLEY_ATTR_AUTH_METHOD_DSSSIG:
        !           640:        case OAKLEY_ATTR_AUTH_METHOD_RSASIG:
        !           641: #ifdef ENABLE_HYBRID
        !           642:        case OAKLEY_ATTR_AUTH_METHOD_XAUTH_RSASIG_I:
        !           643:        case OAKLEY_ATTR_AUTH_METHOD_XAUTH_DSSSIG_I:
        !           644: #endif
        !           645:                /* XXX if there is CR or not ? */
        !           646: 
        !           647:                if (oakley_getmycert(iph1) < 0)
        !           648:                        goto end;
        !           649: 
        !           650:                if (oakley_getsign(iph1) < 0)
        !           651:                        goto end;
        !           652: 
        !           653:                if (iph1->cert != NULL && iph1->rmconf->send_cert)
        !           654:                        need_cert = 1;
        !           655: 
        !           656:                /* add CERT payload if there */
        !           657:                if (need_cert)
        !           658:                        plist = isakmp_plist_append(plist, iph1->cert,
        !           659:                                                    ISAKMP_NPTYPE_CERT);
        !           660: 
        !           661:                /* add SIG payload */
        !           662:                plist = isakmp_plist_append(plist,
        !           663:                    iph1->sig, ISAKMP_NPTYPE_SIG);
        !           664:                break;
        !           665: 
        !           666:        case OAKLEY_ATTR_AUTH_METHOD_RSAENC:
        !           667:        case OAKLEY_ATTR_AUTH_METHOD_RSAREV:
        !           668: #ifdef ENABLE_HYBRID
        !           669:        case OAKLEY_ATTR_AUTH_METHOD_XAUTH_RSAENC_I:
        !           670:        case OAKLEY_ATTR_AUTH_METHOD_XAUTH_RSAREV_I:
        !           671: #endif
        !           672:                break;
        !           673: #ifdef HAVE_GSSAPI
        !           674:        case OAKLEY_ATTR_AUTH_METHOD_GSSAPI_KRB:
        !           675:                gsshash = gssapi_wraphash(iph1);
        !           676:                if (gsshash == NULL) {
        !           677:                        plog(LLV_ERROR, LOCATION, NULL,
        !           678:                                "failed to wrap hash\n");
        !           679:                        isakmp_info_send_n1(iph1,
        !           680:                                ISAKMP_NTYPE_INVALID_EXCHANGE_TYPE, NULL);
        !           681:                        goto end;
        !           682:                }
        !           683: 
        !           684:                plist = isakmp_plist_append(plist,
        !           685:                    gsshash, ISAKMP_NPTYPE_HASH);
        !           686:                break;
        !           687: #endif
        !           688:        }
        !           689: 
        !           690: #ifdef ENABLE_NATT
        !           691:        /* generate NAT-D payloads */
        !           692:        if (NATT_AVAILABLE(iph1)) {
        !           693:                vchar_t *natd[2] = { NULL, NULL };
        !           694: 
        !           695:                plog(LLV_INFO, LOCATION,
        !           696:                    NULL, "Adding remote and local NAT-D payloads.\n");
        !           697: 
        !           698:                if ((natd[0] = natt_hash_addr (iph1, iph1->remote)) == NULL) {
        !           699:                        plog(LLV_ERROR, LOCATION, NULL,
        !           700:                            "NAT-D hashing failed for %s\n",
        !           701:                            saddr2str(iph1->remote));
        !           702:                        goto end;
        !           703:                }
        !           704: 
        !           705:                if ((natd[1] = natt_hash_addr (iph1, iph1->local)) == NULL) {
        !           706:                        plog(LLV_ERROR, LOCATION, NULL,
        !           707:                            "NAT-D hashing failed for %s\n",
        !           708:                            saddr2str(iph1->local));
        !           709:                        goto end;
        !           710:                }
        !           711: 
        !           712:                plist = isakmp_plist_append(plist,
        !           713:                    natd[0], iph1->natt_options->payload_nat_d);
        !           714:                plist = isakmp_plist_append(plist,
        !           715:                    natd[1], iph1->natt_options->payload_nat_d);
        !           716:        }
        !           717: #endif
        !           718: 
        !           719:        iph1->sendbuf = isakmp_plist_set_all (&plist, iph1);
        !           720: 
        !           721: #ifdef HAVE_PRINT_ISAKMP_C
        !           722:        isakmp_printpacket(iph1->sendbuf, iph1->local, iph1->remote, 0);
        !           723: #endif
        !           724: 
        !           725:        /* send to responder */
        !           726:        if (isakmp_send(iph1, iph1->sendbuf) < 0)
        !           727:                goto end;
        !           728: 
        !           729:        /* the sending message is added to the received-list. */
        !           730:        if (add_recvdpkt(iph1->remote, iph1->local, iph1->sendbuf, msg) == -1) {
        !           731:                plog(LLV_ERROR , LOCATION, NULL,
        !           732:                        "failed to add a response packet to the tree.\n");
        !           733:                goto end;
        !           734:        }
        !           735: 
        !           736:        /* set encryption flag */
        !           737:        iph1->flags |= ISAKMP_FLAG_E;
        !           738: 
        !           739:        iph1->status = PHASE1ST_ESTABLISHED;
        !           740: 
        !           741:        error = 0;
        !           742: 
        !           743: end:
        !           744:        if (gsshash)
        !           745:                vfree(gsshash);
        !           746:        return error;
        !           747: }
        !           748: 
        !           749: /*
        !           750:  * receive from initiator
        !           751:  *     psk: HDR, SA, KE, Ni, IDi1
        !           752:  *     sig: HDR, SA, KE, Ni, IDi1 [, CR ]
        !           753:  *   gssapi: HDR, SA, KE, Ni, IDi1 , GSSi
        !           754:  *     rsa: HDR, SA, [ HASH(1),] KE, <IDi1_b>Pubkey_r, <Ni_b>Pubkey_r
        !           755:  *     rev: HDR, SA, [ HASH(1),] <Ni_b>Pubkey_r, <KE_b>Ke_i,
        !           756:  *          <IDii_b>Ke_i [, <Cert-I_b>Ke_i ]
        !           757:  */
        !           758: int
        !           759: agg_r1recv(iph1, msg)
        !           760:        struct ph1handle *iph1;
        !           761:        vchar_t *msg;
        !           762: {
        !           763:        int error = -1;
        !           764:        vchar_t *pbuf = NULL;
        !           765:        struct isakmp_parse_t *pa;
        !           766:        int vid_numeric;
        !           767: #ifdef HAVE_GSSAPI
        !           768:        vchar_t *gsstoken = NULL;
        !           769: #endif
        !           770: 
        !           771:        /* validity check */
        !           772:        if (iph1->status != PHASE1ST_START) {
        !           773:                plog(LLV_ERROR, LOCATION, NULL,
        !           774:                        "status mismatched %d.\n", iph1->status);
        !           775:                goto end;
        !           776:        }
        !           777: 
        !           778:        /* validate the type of next payload */
        !           779:        pbuf = isakmp_parse(msg);
        !           780:        if (pbuf == NULL)
        !           781:                goto end;
        !           782:        pa = (struct isakmp_parse_t *)pbuf->v;
        !           783: 
        !           784:        /* SA payload is fixed postion */
        !           785:        if (pa->type != ISAKMP_NPTYPE_SA) {
        !           786:                plog(LLV_ERROR, LOCATION, iph1->remote,
        !           787:                        "received invalid next payload type %d, "
        !           788:                        "expecting %d.\n",
        !           789:                        pa->type, ISAKMP_NPTYPE_SA);
        !           790:                goto end;
        !           791:        }
        !           792:        if (isakmp_p2ph(&iph1->sa, pa->ptr) < 0)
        !           793:                goto end;
        !           794:        pa++;
        !           795: 
        !           796:        for (/*nothing*/;
        !           797:             pa->type != ISAKMP_NPTYPE_NONE;
        !           798:             pa++) {
        !           799: 
        !           800:                plog(LLV_DEBUG, LOCATION, NULL,
        !           801:                        "received payload of type %s\n",
        !           802:                        s_isakmp_nptype(pa->type));
        !           803: 
        !           804:                switch (pa->type) {
        !           805:                case ISAKMP_NPTYPE_KE:
        !           806:                        if (isakmp_p2ph(&iph1->dhpub_p, pa->ptr) < 0)
        !           807:                                goto end;
        !           808:                        break;
        !           809:                case ISAKMP_NPTYPE_NONCE:
        !           810:                        if (isakmp_p2ph(&iph1->nonce_p, pa->ptr) < 0)
        !           811:                                goto end;
        !           812:                        break;
        !           813:                case ISAKMP_NPTYPE_ID:
        !           814:                        if (isakmp_p2ph(&iph1->id_p, pa->ptr) < 0)
        !           815:                                goto end;
        !           816:                        break;
        !           817:                case ISAKMP_NPTYPE_VID:
        !           818:                        vid_numeric = handle_vendorid(iph1, pa->ptr);
        !           819: #ifdef ENABLE_FRAG
        !           820:                        if ((vid_numeric == VENDORID_FRAG) &&
        !           821:                            (vendorid_frag_cap(pa->ptr) & VENDORID_FRAG_AGG))
        !           822:                                iph1->frag = 1;
        !           823: #endif
        !           824:                        break;
        !           825: 
        !           826:                case ISAKMP_NPTYPE_CR:
        !           827:                        if (oakley_savecr(iph1, pa->ptr) < 0)
        !           828:                                goto end;
        !           829:                        break;
        !           830: 
        !           831: #ifdef HAVE_GSSAPI
        !           832:                case ISAKMP_NPTYPE_GSS:
        !           833:                        if (isakmp_p2ph(&gsstoken, pa->ptr) < 0)
        !           834:                                goto end;
        !           835:                        gssapi_save_received_token(iph1, gsstoken);
        !           836:                        break;
        !           837: #endif
        !           838:                default:
        !           839:                        /* don't send information, see isakmp_ident_r1() */
        !           840:                        plog(LLV_ERROR, LOCATION, iph1->remote,
        !           841:                                "ignore the packet, "
        !           842:                                "received unexpecting payload type %d.\n",
        !           843:                                pa->type);
        !           844:                        goto end;
        !           845:                }
        !           846:        }
        !           847: 
        !           848:        /* payload existency check */
        !           849:        if (iph1->dhpub_p == NULL || iph1->nonce_p == NULL) {
        !           850:                plog(LLV_ERROR, LOCATION, iph1->remote,
        !           851:                        "few isakmp message received.\n");
        !           852:                goto end;
        !           853:        }
        !           854: 
        !           855:        /* verify identifier */
        !           856:        if (ipsecdoi_checkid1(iph1) != 0) {
        !           857:                plog(LLV_ERROR, LOCATION, iph1->remote,
        !           858:                        "invalid ID payload.\n");
        !           859:                goto end;
        !           860:        }
        !           861: 
        !           862: #ifdef ENABLE_NATT
        !           863:        if (NATT_AVAILABLE(iph1))
        !           864:                plog(LLV_INFO, LOCATION, iph1->remote,
        !           865:                     "Selected NAT-T version: %s\n",
        !           866:                     vid_string_by_id(iph1->natt_options->version));
        !           867: #endif
        !           868: 
        !           869:        /* check SA payload and set approval SA for use */
        !           870:        if (ipsecdoi_checkph1proposal(iph1->sa, iph1) < 0) {
        !           871:                plog(LLV_ERROR, LOCATION, iph1->remote,
        !           872:                        "failed to get valid proposal.\n");
        !           873:                /* XXX send information */
        !           874:                goto end;
        !           875:        }
        !           876: 
        !           877:        if (oakley_checkcr(iph1) < 0) {
        !           878:                /* Ignore this error in order to be interoperability. */
        !           879:                ;
        !           880:        }
        !           881: 
        !           882:        iph1->status = PHASE1ST_MSG1RECEIVED;
        !           883: 
        !           884:        error = 0;
        !           885: 
        !           886: end:
        !           887: #ifdef HAVE_GSSAPI
        !           888:        if (gsstoken)
        !           889:                vfree(gsstoken);
        !           890: #endif
        !           891:        if (pbuf)
        !           892:                vfree(pbuf);
        !           893:        if (error) {
        !           894:                VPTRINIT(iph1->sa);
        !           895:                VPTRINIT(iph1->dhpub_p);
        !           896:                VPTRINIT(iph1->nonce_p);
        !           897:                VPTRINIT(iph1->id_p);
        !           898:                VPTRINIT(iph1->cr_p);
        !           899:        }
        !           900: 
        !           901:        return error;
        !           902: }
        !           903: 
        !           904: /*
        !           905:  * send to initiator
        !           906:  *     psk: HDR, SA, KE, Nr, IDr1, HASH_R
        !           907:  *     sig: HDR, SA, KE, Nr, IDr1, [ CR, ] [ CERT, ] SIG_R
        !           908:  *   gssapi: HDR, SA, KE, Nr, IDr1, GSSr, HASH_R
        !           909:  *     rsa: HDR, SA, KE, <IDr1_b>PubKey_i, <Nr_b>PubKey_i, HASH_R
        !           910:  *     rev: HDR, SA, <Nr_b>PubKey_i, <KE_b>Ke_r, <IDir_b>Ke_r, HASH_R
        !           911:  */
        !           912: int
        !           913: agg_r1send(iph1, msg)
        !           914:        struct ph1handle *iph1;
        !           915:        vchar_t *msg;
        !           916: {
        !           917:        struct payload_list *plist = NULL;
        !           918:        int need_cert = 0;
        !           919:        int error = -1;
        !           920: #ifdef ENABLE_HYBRID
        !           921:        vchar_t *xauth_vid = NULL;
        !           922:        vchar_t *unity_vid = NULL;
        !           923: #endif
        !           924: #ifdef ENABLE_NATT
        !           925:        vchar_t *vid_natt = NULL;
        !           926:        vchar_t *natd[2] = { NULL, NULL };
        !           927: #endif
        !           928: #ifdef ENABLE_DPD
        !           929:        vchar_t *vid_dpd = NULL;
        !           930: #endif
        !           931: #ifdef ENABLE_FRAG
        !           932:        vchar_t *vid_frag = NULL;
        !           933: #endif
        !           934: 
        !           935: #ifdef HAVE_GSSAPI
        !           936:        int gsslen;
        !           937:        vchar_t *gsstoken = NULL, *gsshash = NULL;
        !           938:        vchar_t *gss_sa = NULL;
        !           939:        int free_gss_sa = 0;
        !           940: #endif
        !           941: 
        !           942:        /* validity check */
        !           943:        if (iph1->status != PHASE1ST_MSG1RECEIVED) {
        !           944:                plog(LLV_ERROR, LOCATION, NULL,
        !           945:                        "status mismatched %d.\n", iph1->status);
        !           946:                goto end;
        !           947:        }
        !           948: 
        !           949:        /* set responder's cookie */
        !           950:        isakmp_newcookie((caddr_t)&iph1->index.r_ck, iph1->remote, iph1->local);
        !           951: 
        !           952:        /* make ID payload into isakmp status */
        !           953:        if (ipsecdoi_setid1(iph1) < 0)
        !           954:                goto end;
        !           955: 
        !           956:        /* generate DH public value */
        !           957:        if (oakley_dh_generate(iph1->rmconf->dhgrp,
        !           958:                                &iph1->dhpub, &iph1->dhpriv) < 0)
        !           959:                goto end;
        !           960: 
        !           961:        /* generate NONCE value */
        !           962:        iph1->nonce = eay_set_random(iph1->rmconf->nonce_size);
        !           963:        if (iph1->nonce == NULL)
        !           964:                goto end;
        !           965: 
        !           966:        /* compute sharing secret of DH */
        !           967:        if (oakley_dh_compute(iph1->approval->dhgrp, iph1->dhpub,
        !           968:                                iph1->dhpriv, iph1->dhpub_p, &iph1->dhgxy) < 0)
        !           969:                goto end;
        !           970: 
        !           971:        /* generate SKEYIDs & IV & final cipher key */
        !           972:        if (oakley_skeyid(iph1) < 0)
        !           973:                goto end;
        !           974:        if (oakley_skeyid_dae(iph1) < 0)
        !           975:                goto end;
        !           976:        if (oakley_compute_enckey(iph1) < 0)
        !           977:                goto end;
        !           978:        if (oakley_newiv(iph1) < 0)
        !           979:                goto end;
        !           980: 
        !           981: #ifdef HAVE_GSSAPI
        !           982:        if (iph1->rmconf->proposal->authmethod == OAKLEY_ATTR_AUTH_METHOD_GSSAPI_KRB)
        !           983:                gssapi_get_rtoken(iph1, &gsslen);
        !           984: #endif
        !           985: 
        !           986:        /* generate HASH to send */
        !           987:        plog(LLV_DEBUG, LOCATION, NULL, "generate HASH_R\n");
        !           988:        iph1->hash = oakley_ph1hash_common(iph1, GENERATE);
        !           989:        if (iph1->hash == NULL) {
        !           990: #ifdef HAVE_GSSAPI
        !           991:                if (gssapi_more_tokens(iph1))
        !           992:                        isakmp_info_send_n1(iph1,
        !           993:                            ISAKMP_NTYPE_INVALID_EXCHANGE_TYPE, NULL);
        !           994: #endif
        !           995:                goto end;
        !           996:        }
        !           997: 
        !           998: #ifdef ENABLE_NATT
        !           999:        /* Has the peer announced NAT-T? */
        !          1000:        if (NATT_AVAILABLE(iph1)) {
        !          1001:                /* set chosen VID */
        !          1002:                vid_natt = set_vendorid(iph1->natt_options->version);
        !          1003: 
        !          1004:                /* generate NAT-D payloads */
        !          1005:                plog (LLV_INFO, LOCATION, NULL, "Adding remote and local NAT-D payloads.\n");
        !          1006:                if ((natd[0] = natt_hash_addr (iph1, iph1->remote)) == NULL) {
        !          1007:                        plog(LLV_ERROR, LOCATION, NULL,
        !          1008:                                "NAT-D hashing failed for %s\n", saddr2str(iph1->remote));
        !          1009:                        goto end;
        !          1010:                }
        !          1011: 
        !          1012:                if ((natd[1] = natt_hash_addr (iph1, iph1->local)) == NULL) {
        !          1013:                        plog(LLV_ERROR, LOCATION, NULL,
        !          1014:                                "NAT-D hashing failed for %s\n", saddr2str(iph1->local));
        !          1015:                        goto end;
        !          1016:                }
        !          1017:        }
        !          1018: #endif
        !          1019: #ifdef ENABLE_DPD
        !          1020:        /* Only send DPD support if remote announced DPD and if DPD support is active */
        !          1021:        if (iph1->dpd_support && iph1->rmconf->dpd)
        !          1022:                vid_dpd = set_vendorid(VENDORID_DPD);
        !          1023: #endif
        !          1024: #ifdef ENABLE_FRAG
        !          1025:        if (iph1->frag) {
        !          1026:                vid_frag = set_vendorid(VENDORID_FRAG);
        !          1027:                if (vid_frag != NULL)
        !          1028:                        vid_frag = isakmp_frag_addcap(vid_frag,
        !          1029:                            VENDORID_FRAG_AGG);
        !          1030:                if (vid_frag == NULL)
        !          1031:                        plog(LLV_ERROR, LOCATION, NULL,
        !          1032:                            "Frag vendorID construction failed\n");
        !          1033:        }
        !          1034: #endif
        !          1035: 
        !          1036:        switch (iph1->approval->authmethod) {
        !          1037:        case OAKLEY_ATTR_AUTH_METHOD_PSKEY:
        !          1038: #ifdef ENABLE_HYBRID
        !          1039:        case OAKLEY_ATTR_AUTH_METHOD_XAUTH_PSKEY_R:
        !          1040: #endif
        !          1041:                /* set SA payload to reply */
        !          1042:                plist = isakmp_plist_append(plist,
        !          1043:                    iph1->sa_ret, ISAKMP_NPTYPE_SA);
        !          1044: 
        !          1045:                /* create isakmp KE payload */
        !          1046:                plist = isakmp_plist_append(plist,
        !          1047:                    iph1->dhpub, ISAKMP_NPTYPE_KE);
        !          1048: 
        !          1049:                /* create isakmp NONCE payload */
        !          1050:                plist = isakmp_plist_append(plist,
        !          1051:                    iph1->nonce, ISAKMP_NPTYPE_NONCE);
        !          1052: 
        !          1053:                /* create isakmp ID payload */
        !          1054:                plist = isakmp_plist_append(plist,
        !          1055:                    iph1->id, ISAKMP_NPTYPE_ID);
        !          1056: 
        !          1057:                /* create isakmp HASH payload */
        !          1058:                plist = isakmp_plist_append(plist,
        !          1059:                    iph1->hash, ISAKMP_NPTYPE_HASH);
        !          1060: 
        !          1061:                /* create isakmp CR payload if needed */
        !          1062:                if (oakley_needcr(iph1->approval->authmethod))
        !          1063:                        plist = oakley_append_cr(plist, iph1);
        !          1064:                break;
        !          1065:        case OAKLEY_ATTR_AUTH_METHOD_DSSSIG:
        !          1066:        case OAKLEY_ATTR_AUTH_METHOD_RSASIG:
        !          1067: #ifdef ENABLE_HYBRID
        !          1068:        case OAKLEY_ATTR_AUTH_METHOD_HYBRID_RSA_R:
        !          1069:        case OAKLEY_ATTR_AUTH_METHOD_HYBRID_DSS_R:
        !          1070:        case OAKLEY_ATTR_AUTH_METHOD_XAUTH_RSASIG_R:
        !          1071:        case OAKLEY_ATTR_AUTH_METHOD_XAUTH_DSSSIG_R:
        !          1072: #endif
        !          1073:                /* XXX if there is CR or not ? */
        !          1074: 
        !          1075:                if (oakley_getmycert(iph1) < 0)
        !          1076:                        goto end;
        !          1077: 
        !          1078:                if (oakley_getsign(iph1) < 0)
        !          1079:                        goto end;
        !          1080: 
        !          1081:                if (iph1->cert != NULL && iph1->rmconf->send_cert)
        !          1082:                        need_cert = 1;
        !          1083: 
        !          1084:                /* set SA payload to reply */
        !          1085:                plist = isakmp_plist_append(plist,
        !          1086:                    iph1->sa_ret, ISAKMP_NPTYPE_SA);
        !          1087: 
        !          1088:                /* create isakmp KE payload */
        !          1089:                plist = isakmp_plist_append(plist,
        !          1090:                    iph1->dhpub, ISAKMP_NPTYPE_KE);
        !          1091: 
        !          1092:                /* create isakmp NONCE payload */
        !          1093:                plist = isakmp_plist_append(plist,
        !          1094:                    iph1->nonce, ISAKMP_NPTYPE_NONCE);
        !          1095: 
        !          1096:                /* add ID payload */
        !          1097:                plist = isakmp_plist_append(plist,
        !          1098:                    iph1->id, ISAKMP_NPTYPE_ID);
        !          1099: 
        !          1100:                /* add CERT payload if there */
        !          1101:                if (need_cert)
        !          1102:                        plist = isakmp_plist_append(plist, iph1->cert,
        !          1103:                                                    ISAKMP_NPTYPE_CERT);
        !          1104: 
        !          1105:                /* add SIG payload */
        !          1106:                plist = isakmp_plist_append(plist,
        !          1107:                    iph1->sig, ISAKMP_NPTYPE_SIG);
        !          1108: 
        !          1109:                /* create isakmp CR payload if needed */
        !          1110:                if (oakley_needcr(iph1->approval->authmethod))
        !          1111:                        plist = oakley_append_cr(plist, iph1);
        !          1112:                break;
        !          1113: 
        !          1114:        case OAKLEY_ATTR_AUTH_METHOD_RSAENC:
        !          1115:        case OAKLEY_ATTR_AUTH_METHOD_RSAREV:
        !          1116: #ifdef ENABLE_HYBRID
        !          1117:        case OAKLEY_ATTR_AUTH_METHOD_XAUTH_RSAENC_R:
        !          1118:        case OAKLEY_ATTR_AUTH_METHOD_XAUTH_RSAREV_R:
        !          1119: #endif
        !          1120:                break;
        !          1121: #ifdef HAVE_GSSAPI
        !          1122:        case OAKLEY_ATTR_AUTH_METHOD_GSSAPI_KRB:
        !          1123:                        /* create buffer to send isakmp payload */
        !          1124:                        gsshash = gssapi_wraphash(iph1);
        !          1125:                        if (gsshash == NULL) {
        !          1126:                                plog(LLV_ERROR, LOCATION, NULL,
        !          1127:                                        "failed to wrap hash\n");
        !          1128:                                /*
        !          1129:                                 * This is probably due to the GSS
        !          1130:                                 * roundtrips not being finished yet.
        !          1131:                                 * Return this error in the hope that
        !          1132:                                 * a fallback to main mode will be done.
        !          1133:                                 */
        !          1134:                                isakmp_info_send_n1(iph1,
        !          1135:                                    ISAKMP_NTYPE_INVALID_EXCHANGE_TYPE, NULL);
        !          1136:                                goto end;
        !          1137:                        }
        !          1138:                        if (iph1->approval->gssid != NULL)
        !          1139:                                gss_sa = ipsecdoi_setph1proposal(iph1->rmconf,
        !          1140:                                                                 iph1->approval);
        !          1141:                        else
        !          1142:                                gss_sa = iph1->sa_ret;
        !          1143: 
        !          1144:                        if (gss_sa != iph1->sa_ret)
        !          1145:                                free_gss_sa = 1;
        !          1146: 
        !          1147:                        /* set SA payload to reply */
        !          1148:                        plist = isakmp_plist_append(plist,
        !          1149:                            gss_sa, ISAKMP_NPTYPE_SA);
        !          1150: 
        !          1151:                        /* create isakmp KE payload */
        !          1152:                        plist = isakmp_plist_append(plist,
        !          1153:                            iph1->dhpub, ISAKMP_NPTYPE_KE);
        !          1154: 
        !          1155:                        /* create isakmp NONCE payload */
        !          1156:                        plist = isakmp_plist_append(plist,
        !          1157:                            iph1->nonce, ISAKMP_NPTYPE_NONCE);
        !          1158: 
        !          1159:                        /* create isakmp ID payload */
        !          1160:                        plist = isakmp_plist_append(plist,
        !          1161:                            iph1->id, ISAKMP_NPTYPE_ID);
        !          1162: 
        !          1163:                        /* create GSS payload */
        !          1164:                        if (gssapi_get_token_to_send(iph1, &gsstoken) < 0) {
        !          1165:                                plog(LLV_ERROR, LOCATION, NULL,
        !          1166:                                    "Failed to get gssapi token.\n");
        !          1167:                                goto end;
        !          1168:                        }
        !          1169:                        plist = isakmp_plist_append(plist,
        !          1170:                            gsstoken, ISAKMP_NPTYPE_GSS);
        !          1171: 
        !          1172:                        /* create isakmp HASH payload */
        !          1173:                        plist = isakmp_plist_append(plist,
        !          1174:                            gsshash, ISAKMP_NPTYPE_HASH);
        !          1175: 
        !          1176:                        /* append vendor id, if needed */
        !          1177:                        break;
        !          1178: #endif
        !          1179:        }
        !          1180: 
        !          1181: #ifdef ENABLE_HYBRID
        !          1182:        if (iph1->mode_cfg->flags & ISAKMP_CFG_VENDORID_XAUTH) {
        !          1183:                plog (LLV_INFO, LOCATION, NULL, "Adding xauth VID payload.\n");
        !          1184:                if ((xauth_vid = set_vendorid(VENDORID_XAUTH)) == NULL) {
        !          1185:                        plog(LLV_ERROR, LOCATION, NULL,
        !          1186:                            "Cannot create Xauth vendor ID\n");
        !          1187:                        goto end;
        !          1188:                }
        !          1189:                plist = isakmp_plist_append(plist,
        !          1190:                    xauth_vid, ISAKMP_NPTYPE_VID);
        !          1191:        }
        !          1192: 
        !          1193:        if (iph1->mode_cfg->flags & ISAKMP_CFG_VENDORID_UNITY) {
        !          1194:                if ((unity_vid = set_vendorid(VENDORID_UNITY)) == NULL) {
        !          1195:                        plog(LLV_ERROR, LOCATION, NULL,
        !          1196:                            "Cannot create Unity vendor ID\n");
        !          1197:                        goto end;
        !          1198:                }
        !          1199:                plist = isakmp_plist_append(plist,
        !          1200:                    unity_vid, ISAKMP_NPTYPE_VID);
        !          1201:        }
        !          1202: #endif
        !          1203: 
        !          1204: #ifdef ENABLE_NATT
        !          1205:        /* append NAT-T payloads */
        !          1206:        if (vid_natt) {
        !          1207:                /* chosen VID */
        !          1208:                plist = isakmp_plist_append(plist, vid_natt, ISAKMP_NPTYPE_VID);
        !          1209:                /* NAT-D */
        !          1210:                plist = isakmp_plist_append(plist, natd[0], iph1->natt_options->payload_nat_d);
        !          1211:                plist = isakmp_plist_append(plist, natd[1], iph1->natt_options->payload_nat_d);
        !          1212:        }
        !          1213: #endif
        !          1214: 
        !          1215: #ifdef ENABLE_FRAG
        !          1216:        if (vid_frag)
        !          1217:                plist = isakmp_plist_append(plist, vid_frag, ISAKMP_NPTYPE_VID);
        !          1218: #endif
        !          1219: 
        !          1220: #ifdef ENABLE_DPD
        !          1221:        if (vid_dpd)
        !          1222:                plist = isakmp_plist_append(plist, vid_dpd, ISAKMP_NPTYPE_VID);
        !          1223: #endif
        !          1224: 
        !          1225:        iph1->sendbuf = isakmp_plist_set_all (&plist, iph1);
        !          1226: 
        !          1227: #ifdef HAVE_PRINT_ISAKMP_C
        !          1228:        isakmp_printpacket(iph1->sendbuf, iph1->local, iph1->remote, 1);
        !          1229: #endif
        !          1230: 
        !          1231:        /* send the packet, add to the schedule to resend */
        !          1232:        if (isakmp_ph1send(iph1) == -1)
        !          1233:                goto end;
        !          1234: 
        !          1235:        /* the sending message is added to the received-list. */
        !          1236:        if (add_recvdpkt(iph1->remote, iph1->local, iph1->sendbuf, msg) == -1) {
        !          1237:                plog(LLV_ERROR , LOCATION, NULL,
        !          1238:                        "failed to add a response packet to the tree.\n");
        !          1239:                goto end;
        !          1240:        }
        !          1241: 
        !          1242:        iph1->status = PHASE1ST_MSG1SENT;
        !          1243: 
        !          1244:        error = 0;
        !          1245: 
        !          1246: end:
        !          1247: #ifdef ENABLE_HYBRID
        !          1248:        if (xauth_vid)
        !          1249:                vfree(xauth_vid);
        !          1250:        if (unity_vid)
        !          1251:                vfree(unity_vid);
        !          1252: #endif
        !          1253: #ifdef HAVE_GSSAPI
        !          1254:        if (gsstoken)
        !          1255:                vfree(gsstoken);
        !          1256:        if (gsshash)
        !          1257:                vfree(gsshash);
        !          1258:        if (free_gss_sa)
        !          1259:                vfree(gss_sa);
        !          1260: #endif
        !          1261: #ifdef ENABLE_DPD
        !          1262:        if (vid_dpd)
        !          1263:                vfree(vid_dpd);
        !          1264: #endif
        !          1265: #ifdef ENABLE_FRAG
        !          1266:        if (vid_frag)
        !          1267:                vfree(vid_frag);
        !          1268: #endif
        !          1269: 
        !          1270:        return error;
        !          1271: }
        !          1272: 
        !          1273: /*
        !          1274:  * receive from initiator
        !          1275:  *     psk: HDR, HASH_I
        !          1276:  *   gssapi: HDR, HASH_I
        !          1277:  *     sig: HDR, [ CERT, ] SIG_I
        !          1278:  *     rsa: HDR, HASH_I
        !          1279:  *     rev: HDR, HASH_I
        !          1280:  */
        !          1281: int
        !          1282: agg_r2recv(iph1, msg0)
        !          1283:        struct ph1handle *iph1;
        !          1284:        vchar_t *msg0;
        !          1285: {
        !          1286:        vchar_t *msg = NULL;
        !          1287:        vchar_t *pbuf = NULL;
        !          1288:        struct isakmp_parse_t *pa;
        !          1289:        int error = -1, ptype;
        !          1290: #ifdef ENABLE_NATT
        !          1291:        int natd_seq = 0;
        !          1292: #endif
        !          1293: 
        !          1294:        /* validity check */
        !          1295:        if (iph1->status != PHASE1ST_MSG1SENT) {
        !          1296:                plog(LLV_ERROR, LOCATION, NULL,
        !          1297:                        "status mismatched %d.\n", iph1->status);
        !          1298:                goto end;
        !          1299:        }
        !          1300: 
        !          1301:        /* decrypting if need. */
        !          1302:        /* XXX configurable ? */
        !          1303:        if (ISSET(((struct isakmp *)msg0->v)->flags, ISAKMP_FLAG_E)) {
        !          1304:                msg = oakley_do_decrypt(iph1, msg0,
        !          1305:                                        iph1->ivm->iv, iph1->ivm->ive);
        !          1306:                if (msg == NULL)
        !          1307:                        goto end;
        !          1308:        } else
        !          1309:                msg = vdup(msg0);
        !          1310: 
        !          1311:        /* validate the type of next payload */
        !          1312:        pbuf = isakmp_parse(msg);
        !          1313:        if (pbuf == NULL)
        !          1314:                goto end;
        !          1315: 
        !          1316:        iph1->pl_hash = NULL;
        !          1317: 
        !          1318:        for (pa = (struct isakmp_parse_t *)pbuf->v;
        !          1319:             pa->type != ISAKMP_NPTYPE_NONE;
        !          1320:             pa++) {
        !          1321: 
        !          1322:                switch (pa->type) {
        !          1323:                case ISAKMP_NPTYPE_HASH:
        !          1324:                        iph1->pl_hash = (struct isakmp_pl_hash *)pa->ptr;
        !          1325:                        break;
        !          1326:                case ISAKMP_NPTYPE_VID:
        !          1327:                        handle_vendorid(iph1, pa->ptr);
        !          1328:                        break;
        !          1329:                case ISAKMP_NPTYPE_CERT:
        !          1330:                        if (oakley_savecert(iph1, pa->ptr) < 0)
        !          1331:                                goto end;
        !          1332:                        break;
        !          1333:                case ISAKMP_NPTYPE_SIG:
        !          1334:                        if (isakmp_p2ph(&iph1->sig_p, pa->ptr) < 0)
        !          1335:                                goto end;
        !          1336:                        break;
        !          1337:                case ISAKMP_NPTYPE_N:
        !          1338:                        isakmp_log_notify(iph1,
        !          1339:                                (struct isakmp_pl_n *) pa->ptr,
        !          1340:                                "aggressive exchange");
        !          1341:                        break;
        !          1342: 
        !          1343: #ifdef ENABLE_NATT
        !          1344:                case ISAKMP_NPTYPE_NATD_DRAFT:
        !          1345:                case ISAKMP_NPTYPE_NATD_RFC:
        !          1346:                        if (NATT_AVAILABLE(iph1) && iph1->natt_options != NULL &&
        !          1347:                                pa->type == iph1->natt_options->payload_nat_d)
        !          1348:                        {
        !          1349:                                vchar_t *natd_received = NULL;
        !          1350:                                int natd_verified;
        !          1351: 
        !          1352:                                if (isakmp_p2ph (&natd_received, pa->ptr) < 0)
        !          1353:                                        goto end;
        !          1354: 
        !          1355:                                if (natd_seq == 0)
        !          1356:                                        iph1->natt_flags |= NAT_DETECTED;
        !          1357: 
        !          1358:                                natd_verified = natt_compare_addr_hash (iph1,
        !          1359:                                        natd_received, natd_seq++);
        !          1360: 
        !          1361:                                plog (LLV_INFO, LOCATION, NULL, "NAT-D payload #%d %s\n",
        !          1362:                                        natd_seq - 1,
        !          1363:                                        natd_verified ? "verified" : "doesn't match");
        !          1364: 
        !          1365:                                vfree (natd_received);
        !          1366:                                break;
        !          1367:                        }
        !          1368:                        /* passthrough to default... */
        !          1369: #endif
        !          1370: 
        !          1371:                default:
        !          1372:                        /* don't send information, see isakmp_ident_r1() */
        !          1373:                        plog(LLV_ERROR, LOCATION, iph1->remote,
        !          1374:                                "ignore the packet, "
        !          1375:                                "received unexpecting payload type %d.\n",
        !          1376:                                pa->type);
        !          1377:                        goto end;
        !          1378:                }
        !          1379:        }
        !          1380: 
        !          1381: #ifdef ENABLE_NATT
        !          1382:        if (NATT_AVAILABLE(iph1))
        !          1383:                plog (LLV_INFO, LOCATION, NULL, "NAT %s %s%s\n",
        !          1384:                      iph1->natt_flags & NAT_DETECTED ?
        !          1385:                                "detected:" : "not detected",
        !          1386:                      iph1->natt_flags & NAT_DETECTED_ME ? "ME " : "",
        !          1387:                      iph1->natt_flags & NAT_DETECTED_PEER ? "PEER" : "");
        !          1388: #endif
        !          1389: 
        !          1390:        /* validate authentication value */
        !          1391:        ptype = oakley_validate_auth(iph1);
        !          1392:        if (ptype != 0) {
        !          1393:                if (ptype == -1) {
        !          1394:                        /* message printed inner oakley_validate_auth() */
        !          1395:                        goto end;
        !          1396:                }
        !          1397:                evt_phase1(iph1, EVT_PHASE1_AUTH_FAILED, NULL);
        !          1398:                isakmp_info_send_n1(iph1, ptype, NULL);
        !          1399:                goto end;
        !          1400:        }
        !          1401: 
        !          1402:        iph1->status = PHASE1ST_MSG2RECEIVED;
        !          1403: 
        !          1404:        error = 0;
        !          1405: 
        !          1406: end:
        !          1407:        if (pbuf)
        !          1408:                vfree(pbuf);
        !          1409:        if (msg)
        !          1410:                vfree(msg);
        !          1411:        if (error) {
        !          1412:                VPTRINIT(iph1->cert_p);
        !          1413:                VPTRINIT(iph1->crl_p);
        !          1414:                VPTRINIT(iph1->sig_p);
        !          1415:        }
        !          1416: 
        !          1417:        return error;
        !          1418: }
        !          1419: 
        !          1420: /*
        !          1421:  * status update and establish isakmp sa.
        !          1422:  */
        !          1423: int
        !          1424: agg_r2send(iph1, msg)
        !          1425:        struct ph1handle *iph1;
        !          1426:        vchar_t *msg;
        !          1427: {
        !          1428:        int error = -1;
        !          1429: 
        !          1430:        /* validity check */
        !          1431:        if (iph1->status != PHASE1ST_MSG2RECEIVED) {
        !          1432:                plog(LLV_ERROR, LOCATION, NULL,
        !          1433:                        "status mismatched %d.\n", iph1->status);
        !          1434:                goto end;
        !          1435:        }
        !          1436: 
        !          1437:        /* IV synchronized when packet encrypted. */
        !          1438:        /* see handler.h about IV synchronization. */
        !          1439:        if (ISSET(((struct isakmp *)msg->v)->flags, ISAKMP_FLAG_E))
        !          1440:                memcpy(iph1->ivm->iv->v, iph1->ivm->ive->v, iph1->ivm->iv->l);
        !          1441: 
        !          1442:        /* set encryption flag */
        !          1443:        iph1->flags |= ISAKMP_FLAG_E;
        !          1444: 
        !          1445:        iph1->status = PHASE1ST_ESTABLISHED;
        !          1446: 
        !          1447:        error = 0;
        !          1448: 
        !          1449: end:
        !          1450:        return error;
        !          1451: }

FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>