]> git.saurik.com Git - apple/ipsec.git/blobdiff - ipsec-tools/racoon/isakmp_quick.c
ipsec-292.40.4.tar.gz
[apple/ipsec.git] / ipsec-tools / racoon / isakmp_quick.c
index fc3c2594f326bd10a48054b76e17e3adc3053591..8bb4a877c32c92fa6f25295c71ede609976283b6 100644 (file)
@@ -1,4 +1,6 @@
-/* $Id: isakmp_quick.c,v 1.13.2.7 2005/07/20 08:02:05 vanhu Exp $ */
+/*     $NetBSD: isakmp_quick.c,v 1.11.4.1 2007/08/01 11:52:21 vanhu Exp $      */
+
+/* Id: isakmp_quick.c,v 1.29 2006/08/22 18:17:17 manubsd Exp */
 
 /*
  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
@@ -51,6 +53,9 @@
 #  include <time.h>
 # endif
 #endif
+#ifdef ENABLE_HYBRID
+#include <resolv.h>
+#endif
 
 #ifndef HAVE_NETINET6_IPSEC
 #include <netinet/ipsec.h>
 #include "plog.h"
 #include "debug.h"
 
+#include "fsm.h"
 #include "localconf.h"
 #include "remoteconf.h"
+#include "handler.h"
+#include "policy.h"
+#include "proposal.h"
 #include "isakmp_var.h"
 #include "isakmp.h"
 #include "isakmp_inf.h"
 #include "isakmp_quick.h"
 #include "oakley.h"
-#include "handler.h"
 #include "ipsec_doi.h"
 #include "crypto_openssl.h"
 #include "pfkey.h"
 #include "sockmisc.h"
 #include "proposal.h"
 #include "sainfo.h"
-#include "admin.h"
 #include "strnames.h"
 #include "nattraversal.h"
+#include "ipsecSessionTracer.h"
+#include "ipsecMessageTracer.h"
+#ifndef HAVE_OPENSSL
+#include <Security/SecDH.h>
+#endif
 
 /* quick mode */
-static vchar_t *quick_ir1mx __P((struct ph2handle *, vchar_t *, vchar_t *));
-static int get_sainfo_r __P((struct ph2handle *));
-static int get_proposal_r __P((struct ph2handle *));
+static vchar_t *quick_ir1mx (phase2_handle_t *, vchar_t *, vchar_t *);
+static int get_proposal_r_remote (phase2_handle_t *, int);
 
 /* \f%%%
  * Quick Mode
@@ -97,25 +108,27 @@ static int get_proposal_r __P((struct ph2handle *));
  * begin Quick Mode as initiator.  send pfkey getspi message to kernel.
  */
 int
-quick_i1prep(iph2, msg)
-       struct ph2handle *iph2;
+quick_iprep(iph2, msg)
+       phase2_handle_t *iph2;
        vchar_t *msg; /* must be null pointer */
 {
        int error = ISAKMP_INTERNAL_ERROR;
 
        /* validity check */
-       if (iph2->status != PHASE2ST_STATUS2) {
-               plog(LLV_ERROR, LOCATION, NULL,
+       if (iph2->status != IKEV1_STATE_QUICK_I_START) {
+               plog(ASL_LEVEL_ERR,
                        "status mismatched %d.\n", iph2->status);
                goto end;
        }
 
        iph2->msgid = isakmp_newmsgid2(iph2->ph1);
+       if (iph2->ivm != NULL)
+               oakley_delivm(iph2->ivm);
        iph2->ivm = oakley_newiv2(iph2->ph1, iph2->msgid);
        if (iph2->ivm == NULL)
                return 0;
 
-       iph2->status = PHASE2ST_GETSPISENT;
+       fsm_set_state(&iph2->status, IKEV1_STATE_QUICK_I_GETSPISENT);
 
        /* don't anything if local test mode. */
        if (f_local) {
@@ -124,10 +137,13 @@ quick_i1prep(iph2, msg)
        }
 
        /* send getspi message */
-       if (pk_sendgetspi(iph2) < 0)
+       if (pk_sendgetspi(iph2) < 0) {
+               plog(ASL_LEVEL_ERR, 
+                        "failed to send getspi message");
                goto end;
+       }
 
-       plog(LLV_DEBUG, LOCATION, NULL, "pfkey getspi sent.\n");
+       plog(ASL_LEVEL_DEBUG, "pfkey getspi sent.\n");
 
        iph2->sce = sched_new(lcconf->wait_ph2complete,
                pfkey_timeover_stub, iph2);
@@ -140,17 +156,19 @@ end:
 
 /*
  * send to responder
- *     HDR*, HASH(1), SA, Ni [, KE ] [, IDi2, IDr2 ]
+ *     HDR*, HASH(1), SA, Ni [, KE ] [, IDi2, IDr2 ] [, NAT-OAi, NAT-OAr ]
  */
 int
 quick_i1send(iph2, msg)
-       struct ph2handle *iph2;
+       phase2_handle_t *iph2;
        vchar_t *msg; /* must be null pointer */
 {
        vchar_t *body = NULL;
        vchar_t *hash = NULL;
+#ifdef ENABLE_NATT     
        vchar_t *natoa_i = NULL;
        vchar_t *natoa_r = NULL;
+#endif /* ENABLE_NATT */
        int             natoa_type = 0;
        struct isakmp_gen *gen;
        char *p;
@@ -162,24 +180,30 @@ quick_i1send(iph2, msg)
 
        /* validity check */
        if (msg != NULL) {
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR,
                        "msg has to be NULL in this function.\n");
                goto end;
        }
-       if (iph2->status != PHASE2ST_GETSPIDONE) {
-               plog(LLV_ERROR, LOCATION, NULL,
+       if (iph2->status != IKEV1_STATE_QUICK_I_GETSPIDONE) {
+               plog(ASL_LEVEL_ERR,
                        "status mismatched %d.\n", iph2->status);
                goto end;
        }
 
        /* create SA payload for my proposal */
-       if (ipsecdoi_setph2proposal(iph2) < 0)
+       if (ipsecdoi_setph2proposal(iph2, FALSE) < 0) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to set proposal");
                goto end;
+       }
 
        /* generate NONCE value */
        iph2->nonce = eay_set_random(iph2->ph1->rmconf->nonce_size);
-       if (iph2->nonce == NULL)
+       if (iph2->nonce == NULL) {
+               plog(ASL_LEVEL_ERR, 
+                        "failed to generate NONCE");
                goto end;
+       }
 
        /*
         * DH value calculation is kicked out into cfparse.y.
@@ -191,26 +215,31 @@ quick_i1send(iph2, msg)
        if (pfsgroup) {
                /* DH group settting if PFS is required. */
                if (oakley_setdhgroup(pfsgroup, &iph2->pfsgrp) < 0) {
-                       plog(LLV_ERROR, LOCATION, NULL,
+                       plog(ASL_LEVEL_ERR, 
                                "failed to set DH value.\n");
                        goto end;
                }
+#ifdef HAVE_OPENSSL
                if (oakley_dh_generate(iph2->pfsgrp,
-                               &iph2->dhpub, &iph2->dhpriv) < 0) {
+                                                          &iph2->dhpub, &iph2->dhpriv) < 0) {
+#else
+               if (oakley_dh_generate(iph2->pfsgrp,
+                               &iph2->dhpub, &iph2->publicKeySize, &iph2->dhC) < 0) {
+#endif
+                       plog(ASL_LEVEL_ERR, 
+                                "failed to generate DH");
                        goto end;
                }
        }
 
        /* generate ID value */
        if (ipsecdoi_setid2(iph2) < 0) {
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR, 
                        "failed to get ID.\n");
                goto end;
        }
-       plog(LLV_DEBUG, LOCATION, NULL, "IDci:");
-       plogdump(LLV_DEBUG, iph2->id->v, iph2->id->l);
-       plog(LLV_DEBUG, LOCATION, NULL, "IDcr:");
-       plogdump(LLV_DEBUG, iph2->id_p->v, iph2->id_p->l);
+       plogdump(ASL_LEVEL_DEBUG, iph2->id->v, iph2->id->l, "IDci:\n");
+       plogdump(ASL_LEVEL_DEBUG, iph2->id_p->v, iph2->id_p->l, "IDcr:\n");
 
        /*
         * we do not attach IDci nor IDcr, under the following condition:
@@ -219,8 +248,8 @@ quick_i1send(iph2, msg)
         * - id payload suggests to encrypt all the traffic (no specific
         *   protocol type)
         */
-       id = (struct ipsecdoi_id_b *)iph2->id->v;
-       id_p = (struct ipsecdoi_id_b *)iph2->id_p->v;
+       id = ALIGNED_CAST(struct ipsecdoi_id_b *)iph2->id->v;
+       id_p = ALIGNED_CAST(struct ipsecdoi_id_b *)iph2->id_p->v;
        if (id->proto_id == 0
         && id_p->proto_id == 0
         && iph2->ph1->rmconf->support_proxy == 0
@@ -239,27 +268,31 @@ quick_i1send(iph2, msg)
        if (idcr)
                tlen += sizeof(*gen) + iph2->id_p->l;
 
-#ifdef NOT_NOW
 #ifdef ENABLE_NATT     
-       /* 
-        * create natoa payloads if needed but only
-        * if transport mode proposals are present
+       /*
+        * RFC3947 5.2. if we propose UDP-Encapsulated-Transport
+        * we should send NAT-OA
         */
-       if (ipsecdoi_tunnelmode(iph2) != 1) {
+       if (ipsecdoi_any_transportmode(iph2->proposal)
+               && (iph2->ph1->natt_flags & NAT_DETECTED)) {
                natoa_type = create_natoa_payloads(iph2, &natoa_i, &natoa_r);
-               if (natoa_type == -1)
+               if (natoa_type == -1) {
+                       plog(ASL_LEVEL_ERR, 
+                                "failed to generate NAT-OA payload.\n");
                        goto end;
-               else if (natoa_type != 0) {
+               else if (natoa_type != 0) {
                        tlen += sizeof(*gen) + natoa_i->l;
                        tlen += sizeof(*gen) + natoa_r->l;
+                       
+                       //plogdump(ASL_LEVEL_DEBUG, natoa_i->v, natoa_i->l, "initiator send NAT-OAi:\n");
+                       //plogdump(ASL_LEVEL_DEBUG, natoa_r->v, natoa_r->l, "initiator send NAT-OAr:\n");
                }
        }
-#endif
 #endif
 
        body = vmalloc(tlen);
        if (body == NULL) {
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR, 
                        "failed to get buffer to send.\n");
                goto end;
        }
@@ -275,34 +308,21 @@ quick_i1send(iph2, msg)
        else if (idci || idcr)
                np = ISAKMP_NPTYPE_ID;
        else
-#ifdef NOT_NOW
                np = (natoa_type ? natoa_type : ISAKMP_NPTYPE_NONE);
-#else
-               np = ISAKMP_NPTYPE_NONE;
-#endif
        p = set_isakmp_payload(p, iph2->nonce, np);
 
        /* add KE payload if need. */
-#ifdef NOT_NOW
        np = (idci || idcr) ? ISAKMP_NPTYPE_ID : (natoa_type ? natoa_type : ISAKMP_NPTYPE_NONE);
-#else
-       np = (idci || idcr) ? ISAKMP_NPTYPE_ID : ISAKMP_NPTYPE_NONE;
-#endif
        if (pfsgroup)
                p = set_isakmp_payload(p, iph2->dhpub, np);
 
        /* IDci */
-#ifdef NOT_NOW
        np = (idcr) ? ISAKMP_NPTYPE_ID : (natoa_type ? natoa_type : ISAKMP_NPTYPE_NONE);
-#else
-       np = (idcr) ? ISAKMP_NPTYPE_ID : ISAKMP_NPTYPE_NONE;
-#endif
        if (idci)
                p = set_isakmp_payload(p, iph2->id, np);
 
        /* IDcr */
        if (idcr)
-#ifdef NOT_NOW
                p = set_isakmp_payload(p, iph2->id_p, natoa_type ? natoa_type : ISAKMP_NPTYPE_NONE);
                
        /* natoa */
@@ -310,52 +330,69 @@ quick_i1send(iph2, msg)
                p = set_isakmp_payload(p, natoa_i, natoa_type);
                p = set_isakmp_payload(p, natoa_r, ISAKMP_NPTYPE_NONE);
        }
-#else
-               p = set_isakmp_payload(p, iph2->id_p, ISAKMP_NPTYPE_NONE);
-#endif
 
        /* generate HASH(1) */
        hash = oakley_compute_hash1(iph2->ph1, iph2->msgid, body);
-       if (hash == NULL)
+       if (hash == NULL) {
+               plog(ASL_LEVEL_ERR, 
+                        "failed to compute HASH");
                goto end;
+       }
 
        /* send isakmp payload */
        iph2->sendbuf = quick_ir1mx(iph2, body, hash);
-       if (iph2->sendbuf == NULL)
+       if (iph2->sendbuf == NULL) {
+               plog(ASL_LEVEL_ERR, 
+                        "failed to get send buffer");
                goto end;
+       }
 
        /* send the packet, add to the schedule to resend */
        iph2->retry_counter = iph2->ph1->rmconf->retry_counter;
-       if (isakmp_ph2resend(iph2) == -1)
+       if (isakmp_ph2resend(iph2) == -1) {
+               plog(ASL_LEVEL_ERR, 
+                        "failed to send packet");
                goto end;
+       }
 
        /* change status of isakmp status entry */
-       iph2->status = PHASE2ST_MSG1SENT;
+    fsm_set_state(&iph2->status, IKEV1_STATE_QUICK_I_MSG1SENT);
 
        error = 0;
 
+       IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                       IPSECSESSIONEVENTCODE_IKE_PACKET_TX_SUCC,
+                                                       CONSTSTR("Initiator, Quick-Mode message 1"),
+                                                       CONSTSTR(NULL));
+       
 end:
+       if (error) {
+               IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                               IPSECSESSIONEVENTCODE_IKE_PACKET_TX_FAIL,
+                                                               CONSTSTR("Initiator, Quick-Mode Message 1"),
+                                                               CONSTSTR("Failed to transmit Quick-Mode Message 1"));
+       }
        if (body != NULL)
                vfree(body);
        if (hash != NULL)
                vfree(hash);
-#ifdef NOT_NOW
+#ifdef ENABLE_NATT     
        if (natoa_i)
                vfree(natoa_i);
        if (natoa_r)
                vfree(natoa_r);
-#endif
+#endif /* ENABLE_NATT */
 
        return error;
 }
 
 /*
  * receive from responder
- *     HDR*, HASH(2), SA, Nr [, KE ] [, IDi2, IDr2 ]
+ *     HDR*, HASH(2), SA, Nr [, KE ] [, IDi2, IDr2 ] [, NAT-OAi, NAT-OAr ]
  */
 int
 quick_i2recv(iph2, msg0)
-       struct ph2handle *iph2;
+       phase2_handle_t *iph2;
        vchar_t *msg0;
 {
        vchar_t *msg = NULL;
@@ -368,23 +405,28 @@ quick_i2recv(iph2, msg0)
        char *p;
        int tlen;
        int error = ISAKMP_INTERNAL_ERROR;
+       struct sockaddr_storage *natoa_i = NULL;
+       struct sockaddr_storage *natoa_r = NULL;
 
        /* validity check */
-       if (iph2->status != PHASE2ST_MSG1SENT) {
-               plog(LLV_ERROR, LOCATION, NULL,
+       if (iph2->status != IKEV1_STATE_QUICK_I_MSG1SENT) {
+               plog(ASL_LEVEL_ERR,
                        "status mismatched %d.\n", iph2->status);
                goto end;
        }
 
        /* decrypt packet */
        if (!ISSET(((struct isakmp *)msg0->v)->flags, ISAKMP_FLAG_E)) {
-               plog(LLV_ERROR, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_ERR,
                        "Packet wasn't encrypted.\n");
                goto end;
        }
        msg = oakley_do_decrypt(iph2->ph1, msg0, iph2->ivm->iv, iph2->ivm->ive);
-       if (msg == NULL)
+       if (msg == NULL) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to decrypt");
                goto end;
+       }
 
        /* create buffer for validating HASH(2) */
        /*
@@ -394,13 +436,16 @@ quick_i2recv(iph2, msg0)
         *      3. two IDs must be considered as IDci, then IDcr
         */
        pbuf = isakmp_parse(msg);
-       if (pbuf == NULL)
+       if (pbuf == NULL) {
+               plog(ASL_LEVEL_ERR, 
+                        "failed to parse msg");
                goto end;
-       pa = (struct isakmp_parse_t *)pbuf->v;
+       }
+       pa = ALIGNED_CAST(struct isakmp_parse_t *)pbuf->v;
 
        /* HASH payload is fixed postion */
        if (pa->type != ISAKMP_NPTYPE_HASH) {
-               plog(LLV_ERROR, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_ERR,
                        "received invalid next payload type %d, "
                        "expecting %d.\n",
                        pa->type, ISAKMP_NPTYPE_HASH);
@@ -416,7 +461,7 @@ quick_i2recv(iph2, msg0)
         */
        /* HASH payload is fixed postion */
        if (pa->type != ISAKMP_NPTYPE_SA) {
-               plog(LLV_WARNING, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_WARNING,
                        "received invalid next payload type %d, "
                        "expecting %d.\n",
                        pa->type, ISAKMP_NPTYPE_HASH);
@@ -425,9 +470,15 @@ quick_i2recv(iph2, msg0)
        /* allocate buffer for computing HASH(2) */
        tlen = iph2->nonce->l
                + ntohl(isakmp->len) - sizeof(*isakmp);
+       if (tlen < 0) {
+               plog(ASL_LEVEL_ERR, 
+                        "invalid length (%lu,%d) while getting hash buffer.\n",
+                        iph2->nonce->l, ntohl(isakmp->len));
+               goto end;
+       }
        hbuf = vmalloc(tlen);
        if (hbuf == NULL) {
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR, 
                        "failed to get hash buffer.\n");
                goto end;
        }
@@ -449,81 +500,153 @@ quick_i2recv(iph2, msg0)
                switch (pa->type) {
                case ISAKMP_NPTYPE_SA:
                        if (iph2->sa_ret != NULL) {
-                               plog(LLV_ERROR, LOCATION, NULL,
+                               plog(ASL_LEVEL_ERR, 
                                        "Ignored, multiple SA "
                                        "isn't supported.\n");
                                break;
                        }
-                       if (isakmp_p2ph(&iph2->sa_ret, pa->ptr) < 0)
+                       if (isakmp_p2ph(&iph2->sa_ret, pa->ptr) < 0) {
+                               plog(ASL_LEVEL_ERR, 
+                                        "failed to process SA payload");
                                goto end;
+                       }
                        break;
 
                case ISAKMP_NPTYPE_NONCE:
-                       if (isakmp_p2ph(&iph2->nonce_p, pa->ptr) < 0)
+                       if (isakmp_p2ph(&iph2->nonce_p, pa->ptr) < 0) {
+                               plog(ASL_LEVEL_ERR, 
+                                        "failed to process NONCE payload");
                                goto end;
+                       }
                        break;
 
                case ISAKMP_NPTYPE_KE:
-                       if (isakmp_p2ph(&iph2->dhpub_p, pa->ptr) < 0)
+                       if (isakmp_p2ph(&iph2->dhpub_p, pa->ptr) < 0) {
+                               plog(ASL_LEVEL_ERR, 
+                                        "failed to process KE payload");
                                goto end;
+                       }
                        break;
 
                case ISAKMP_NPTYPE_ID:
                    {
-                       vchar_t *vp;
-
-                       /* check ID value */
-                       if (f_id == 0) {
-                               /* for IDci */
-                               f_id = 1;
-                               vp = iph2->id;
-                       } else {
-                               /* for IDcr */
-                               vp = iph2->id_p;
-                       }
-
-                       /* These ids may not match when natt is used with some devices.
-                        * RFC 2407 says that the protocol and port fields should be ignored
-                        * if they are zero, therefore they need to be checked individually.
-                        */
-                       struct ipsecdoi_id_b *id_ptr = (struct ipsecdoi_id_b *)vp->v;
-                       struct ipsecdoi_pl_id *idp_ptr = (struct ipsecdoi_pl_id *)pa->ptr;
-                       
-                       if (id_ptr->type != idp_ptr->b.type
-                               || (idp_ptr->b.proto_id != 0 && idp_ptr->b.proto_id != id_ptr->proto_id)
-                               || (idp_ptr->b.port != 0 && idp_ptr->b.port != id_ptr->port)
-                               || memcmp(vp->v + sizeof(struct ipsecdoi_id_b), (caddr_t)pa->ptr + sizeof(struct ipsecdoi_pl_id), 
-                                               vp->l - sizeof(struct ipsecdoi_id_b))) {
-                               //%%% BUG_FIX - to support some servers
-                               if (iph2->ph1->natt_flags & NAT_DETECTED) {
-                                       plog(LLV_WARNING, LOCATION, NULL,
-                                               "mismatched ID was returned - ignored because nat traversal is being used.\n");
-                                       break;
+                               vchar_t *vp;
+
+                if (iph2->id == NULL || iph2->id_p == NULL) {
+                    error = ISAKMP_INTERNAL_ERROR;  // shouldn't happen
+                    goto end;
+                }
+                
+                               /* check ID value */
+                               if (f_id == 0) {
+                                       /* for IDci */
+                                       vp = iph2->id;
+                               } else {
+                                       /* for IDcr */
+                                       vp = iph2->id_p;
                                }
-                               plog(LLV_ERROR, LOCATION, NULL,
-                                       "mismatched ID was returned.\n");
-                               error = ISAKMP_NTYPE_ATTRIBUTES_NOT_SUPPORTED;
-                               goto end;
+
+                               /* These ids may not match when natt is used with some devices.
+                                * RFC 2407 says that the protocol and port fields should be ignored
+                                * if they are zero, therefore they need to be checked individually.
+                                */
+                               struct ipsecdoi_id_b *id_ptr = ALIGNED_CAST(struct ipsecdoi_id_b *)vp->v;
+                               struct ipsecdoi_pl_id *idp_ptr = (struct ipsecdoi_pl_id *)pa->ptr;
+                               
+                               if (id_ptr->type != idp_ptr->b.type
+                                       || (idp_ptr->b.proto_id != 0 && idp_ptr->b.proto_id != id_ptr->proto_id)
+                                       || (idp_ptr->b.port != 0 && idp_ptr->b.port != id_ptr->port)
+                                       || memcmp(vp->v + sizeof(struct ipsecdoi_id_b), (caddr_t)pa->ptr + sizeof(struct ipsecdoi_pl_id), 
+                                                       vp->l - sizeof(struct ipsecdoi_id_b))) {
+                                       // to support servers that use our external nat address as our ID
+                                       if (iph2->ph1->natt_flags & NAT_DETECTED) {
+                                               plog(ASL_LEVEL_WARNING, 
+                                                       "mismatched ID was returned - ignored because nat traversal is being used.\n");
+                                               /* If I'm behind a nat and the ID is type address - save the address
+                                                * and port for when the peer rekeys.
+                                                */
+                                               if (f_id == 0 && (iph2->ph1->natt_flags & NAT_DETECTED_ME)) {
+                                                       if (lcconf->ext_nat_id)
+                                                               vfree(lcconf->ext_nat_id);
+                                                       if (idp_ptr->h.len < sizeof(struct isakmp_gen)) {
+                                                               plog(ASL_LEVEL_ERR, "invalid length (%d) while allocating external nat id.\n", idp_ptr->h.len);
+                                                               goto end;
+                                                       }
+                                                       lcconf->ext_nat_id = vmalloc(ntohs(idp_ptr->h.len) - sizeof(struct isakmp_gen));
+                                                       if (lcconf->ext_nat_id == NULL) {
+                                                               plog(ASL_LEVEL_ERR, "memory error while allocating external nat id.\n");
+                                                               goto end;
+                                                       }
+                                                       memcpy(lcconf->ext_nat_id->v, &(idp_ptr->b), lcconf->ext_nat_id->l);
+                                                       if (iph2->ext_nat_id)
+                                                               vfree(iph2->ext_nat_id);
+                                                       iph2->ext_nat_id = vdup(lcconf->ext_nat_id);
+                                                       if (iph2->ext_nat_id == NULL) {
+                                                               plog(ASL_LEVEL_ERR, "memory error while allocating ph2's external nat id.\n");
+                                                               goto end;
+                                                       }
+                                                       plogdump(ASL_LEVEL_DEBUG, iph2->ext_nat_id->v, iph2->ext_nat_id->l, "external nat address saved.\n");
+                                               } else if (f_id && (iph2->ph1->natt_flags & NAT_DETECTED_PEER)) {
+                                                       if (iph2->ext_nat_id_p)
+                                                               vfree(iph2->ext_nat_id_p);
+                                                       iph2->ext_nat_id_p = vmalloc(ntohs(idp_ptr->h.len) - sizeof(struct isakmp_gen));
+                                                       if (iph2->ext_nat_id_p == NULL) {
+                                                               plog(ASL_LEVEL_ERR, "memory error while allocating peers ph2's external nat id.\n");
+                                                               goto end;
+                                                       }
+                                                       memcpy(iph2->ext_nat_id_p->v, &(idp_ptr->b), iph2->ext_nat_id_p->l);
+                                                       plogdump(ASL_LEVEL_DEBUG, iph2->ext_nat_id_p->v, iph2->ext_nat_id_p->l, "peer's external nat address saved.\n");
+                                               } 
+                                       } else {
+                                               plog(ASL_LEVEL_ERR, "mismatched ID was returned.\n");
+                                               error = ISAKMP_NTYPE_ATTRIBUTES_NOT_SUPPORTED;
+                                               goto end;
+                                       }
                                }
+                               if (f_id == 0)
+                                       f_id = 1;
                        }
-
                        break;
 
                case ISAKMP_NPTYPE_N:
-                       isakmp_check_notify(pa->ptr, iph2->ph1);
+                       isakmp_check_ph2_notify(pa->ptr, iph2);
                        break;
 
 #ifdef ENABLE_NATT
                case ISAKMP_NPTYPE_NATOA_DRAFT:
                case ISAKMP_NPTYPE_NATOA_BADDRAFT:
                case ISAKMP_NPTYPE_NATOA_RFC:
-                       /* Ignore original source/destination messages */
+                   {
+                               vchar_t         *vp = NULL;
+                               struct sockaddr_storage *daddr;
+
+                               isakmp_p2ph(&vp, pa->ptr);
+
+                               if (vp) {
+                                       daddr = process_natoa_payload(vp);
+                                       if (daddr) {
+                                               if (natoa_i == NULL) {
+                                                       natoa_i = daddr;
+                                                       plog(ASL_LEVEL_DEBUG, "initiaor rcvd NAT-OA i: %s\n",
+                                                                saddr2str((struct sockaddr *)natoa_i));
+                                               } else if (natoa_r == NULL) {
+                                                       natoa_r = daddr;
+                                                       plog(ASL_LEVEL_DEBUG, "initiator rcvd NAT-OA r: %s\n",
+                                                                saddr2str((struct sockaddr *)natoa_r));
+                                               } else {
+                                                       racoon_free(daddr);
+                                               }
+                                       }
+                                       vfree(vp);
+                               }
+
+                       }
                        break;
 #endif
 
                default:
                        /* don't send information, see ident_r1recv() */
-                       plog(LLV_ERROR, LOCATION, iph2->ph1->remote,
+                       plog(ASL_LEVEL_ERR,
                                "ignore the packet, "
                                "received unexpecting payload type %d.\n",
                                pa->type);
@@ -538,14 +661,14 @@ quick_i2recv(iph2, msg0)
 
        /* payload existency check */
        if (hash == NULL || iph2->sa_ret == NULL || iph2->nonce_p == NULL) {
-               plog(LLV_ERROR, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_ERR,
                        "few isakmp message received.\n");
                goto end;
        }
 
        /* Fixed buffer for calculating HASH */
        memcpy(hbuf->v, iph2->nonce->v, iph2->nonce->l);
-       plog(LLV_DEBUG, LOCATION, NULL,
+       plog(ASL_LEVEL_DEBUG, 
                "HASH allocated:hbuf->l=%zu actual:tlen=%zu\n",
                hbuf->l, tlen + iph2->nonce->l);
        /* adjust buffer length for HASH */
@@ -559,18 +682,20 @@ quick_i2recv(iph2, msg0)
 
        r_hash = (char *)hash + sizeof(*hash);
 
-       plog(LLV_DEBUG, LOCATION, NULL, "HASH(2) received:");
-       plogdump(LLV_DEBUG, r_hash, ntohs(hash->h.len) - sizeof(*hash));
+       //plogdump(ASL_LEVEL_DEBUG, r_hash, ntohs(hash->h.len) - sizeof(*hash), "HASH(2) received:");
 
        my_hash = oakley_compute_hash1(iph2->ph1, iph2->msgid, hbuf);
-       if (my_hash == NULL)
+       if (my_hash == NULL) {
+               plog(ASL_LEVEL_ERR, 
+                        "failed to compute HASH");
                goto end;
+       }
 
        result = memcmp(my_hash->v, r_hash, my_hash->l);
        vfree(my_hash);
 
        if (result) {
-               plog(LLV_DEBUG, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_DEBUG,
                        "HASH(2) mismatch.\n");
                error = ISAKMP_NTYPE_INVALID_HASH_INFORMATION;
                goto end;
@@ -579,16 +704,29 @@ quick_i2recv(iph2, msg0)
 
        /* validity check SA payload sent from responder */
        if (ipsecdoi_checkph2proposal(iph2) < 0) {
+               plog(ASL_LEVEL_ERR, 
+                        "failed to validate SA proposal");
                error = ISAKMP_NTYPE_NO_PROPOSAL_CHOSEN;
                goto end;
        }
 
        /* change status of isakmp status entry */
-       iph2->status = PHASE2ST_STATUS6;
+       fsm_set_state(&iph2->status, IKEV1_STATE_QUICK_I_MSG2RCVD);
 
        error = 0;
 
+       IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                       IPSECSESSIONEVENTCODE_IKE_PACKET_RX_SUCC,
+                                                       CONSTSTR("Initiator, Quick-Mode message 2"),
+                                                       CONSTSTR(NULL));
+       
 end:
+       if (error) {
+               IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                               IPSECSESSIONEVENTCODE_IKE_PACKET_RX_FAIL,
+                                                               CONSTSTR("Initiator, Quick-Mode Message 2"),
+                                                               CONSTSTR("Failed to process Quick-Mode Message 2 "));
+       }
        if (hbuf)
                vfree(hbuf);
        if (pbuf)
@@ -596,12 +734,18 @@ end:
        if (msg)
                vfree(msg);
 
+#ifdef ENABLE_NATT
+       if (natoa_i) {
+               racoon_free(natoa_i);
+       }
+       if (natoa_r) {
+               racoon_free(natoa_r);
+       }
+#endif
        if (error) {
                VPTRINIT(iph2->sa_ret);
                VPTRINIT(iph2->nonce_p);
                VPTRINIT(iph2->dhpub_p);
-               VPTRINIT(iph2->id);
-               VPTRINIT(iph2->id_p);
        }
 
        return error;
@@ -612,8 +756,8 @@ end:
  *     HDR*, HASH(3)
  */
 int
-quick_i2send(iph2, msg0)
-       struct ph2handle *iph2;
+quick_i3send(iph2, msg0)
+       phase2_handle_t *iph2;
        vchar_t *msg0;
 {
        vchar_t *msg = NULL;
@@ -622,10 +766,11 @@ quick_i2send(iph2, msg0)
        char *p = NULL;
        int tlen;
        int error = ISAKMP_INTERNAL_ERROR;
+       int packet_error = -1;
 
        /* validity check */
-       if (iph2->status != PHASE2ST_STATUS6) {
-               plog(LLV_ERROR, LOCATION, NULL,
+       if (iph2->status != IKEV1_STATE_QUICK_I_MSG2RCVD) {
+               plog(ASL_LEVEL_ERR,
                        "status mismatched %d.\n", iph2->status);
                goto end;
        }
@@ -634,11 +779,11 @@ quick_i2send(iph2, msg0)
     {
        vchar_t *tmp = NULL;
 
-       plog(LLV_DEBUG, LOCATION, NULL, "HASH(3) generate\n");
+       plog(ASL_LEVEL_DEBUG, "HASH(3) generate\n");
 
        tmp = vmalloc(iph2->nonce->l + iph2->nonce_p->l);
        if (tmp == NULL) { 
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR, 
                        "failed to get hash buffer.\n");
                goto end;
        }
@@ -648,8 +793,11 @@ quick_i2send(iph2, msg0)
        hash = oakley_compute_hash3(iph2->ph1, iph2->msgid, tmp);
        vfree(tmp);
 
-       if (hash == NULL)
+       if (hash == NULL) {
+               plog(ASL_LEVEL_ERR, 
+                        "failed to compute HASH");
                goto end;
+       }
     }
 
        /* create buffer for isakmp payload */
@@ -657,15 +805,18 @@ quick_i2send(iph2, msg0)
                + sizeof(struct isakmp_gen) + hash->l;
        buf = vmalloc(tlen);
        if (buf == NULL) { 
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR, 
                        "failed to get buffer to send.\n");
                goto end;
        }
 
        /* create isakmp header */
        p = set_isakmp_header2(buf, iph2, ISAKMP_NPTYPE_HASH);
-       if (p == NULL)
+       if (p == NULL) {
+               plog(ASL_LEVEL_ERR, 
+                        "failed to create ISAKMP header");
                goto end;
+       }
 
        /* add HASH(3) payload */
        p = set_isakmp_payload(p, hash, ISAKMP_NPTYPE_NONE);
@@ -676,66 +827,85 @@ quick_i2send(iph2, msg0)
 
        /* encoding */
        iph2->sendbuf = oakley_do_encrypt(iph2->ph1, buf, iph2->ivm->ive, iph2->ivm->iv);
-       if (iph2->sendbuf == NULL)
+       if (iph2->sendbuf == NULL) {
+               plog(ASL_LEVEL_ERR, 
+                        "failed to encrypt packet");
                goto end;
+       }
 
        /* if there is commit bit, need resending */
        if (ISSET(iph2->flags, ISAKMP_FLAG_C)) {
                /* send the packet, add to the schedule to resend */
                iph2->retry_counter = iph2->ph1->rmconf->retry_counter;
-               if (isakmp_ph2resend(iph2) == -1)
+               if (isakmp_ph2resend(iph2) == -1) {
+                       plog(ASL_LEVEL_ERR, 
+                                "failed to send packet, commit-bit");
                        goto end;
+               }
        } else {
                /* send the packet */
-               if (isakmp_send(iph2->ph1, iph2->sendbuf) < 0)
+               if (isakmp_send(iph2->ph1, iph2->sendbuf) < 0) {
+                       plog(ASL_LEVEL_ERR, 
+                                "failed to send packet");
                        goto end;
+               }
        }
 
        /* the sending message is added to the received-list. */
-       if (add_recvdpkt(iph2->ph1->remote, iph2->ph1->local,
-                       iph2->sendbuf, msg0) == -1) {
-               plog(LLV_ERROR , LOCATION, NULL,
+       if (ike_session_add_recvdpkt(iph2->ph1->remote, iph2->ph1->local,
+                     iph2->sendbuf, msg0,
+                     PH2_NON_ESP_EXTRA_LEN(iph2, iph2->sendbuf), PH2_FRAG_FLAGS(iph2)) == -1) {
+               plog(ASL_LEVEL_ERR , 
                        "failed to add a response packet to the tree.\n");
                goto end;
        }
 
-       /* compute both of KEYMATs */
-       if (oakley_compute_keymat(iph2, INITIATOR) < 0)
-               goto end;
-
-       iph2->status = PHASE2ST_ADDSA;
+       IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                       IPSECSESSIONEVENTCODE_IKE_PACKET_TX_SUCC,
+                                                       CONSTSTR("Initiator, Quick-Mode message 3"),
+                                                       CONSTSTR(NULL));
+       packet_error = 0;
 
-       /* don't anything if local test mode. */
-       if (f_local) {
-               error = 0;
+       /* compute both of KEYMATs */
+       if (oakley_compute_keymat(iph2, INITIATOR) < 0) {
+               plog(ASL_LEVEL_ERR, 
+                        "failed to compute KEYMAT");
                goto end;
        }
 
        /* if there is commit bit don't set up SA now. */
        if (ISSET(iph2->flags, ISAKMP_FLAG_C)) {
-               iph2->status = PHASE2ST_COMMIT;
+        fsm_set_state(&iph2->status, IKEV1_STATE_QUICK_I_MSG3SENT);
                error = 0;
                goto end;
        }
+       
+    fsm_set_state(&iph2->status, IKEV1_STATE_QUICK_I_ADDSA);
 
        /* Do UPDATE for initiator */
-       plog(LLV_DEBUG, LOCATION, NULL, "call pk_sendupdate\n");
+       plog(ASL_LEVEL_DEBUG, "call pk_sendupdate\n");
        if (pk_sendupdate(iph2) < 0) {
-               plog(LLV_ERROR, LOCATION, NULL, "pfkey update failed.\n");
+               plog(ASL_LEVEL_ERR, "pfkey update failed.\n");
                goto end;
        }
-       plog(LLV_DEBUG, LOCATION, NULL, "pfkey update sent.\n");
+       plog(ASL_LEVEL_DEBUG, "pfkey update sent.\n");
 
        /* Do ADD for responder */
        if (pk_sendadd(iph2) < 0) {
-               plog(LLV_ERROR, LOCATION, NULL, "pfkey add failed.\n");
+               plog(ASL_LEVEL_ERR, "pfkey add failed.\n");
                goto end;
        }
-       plog(LLV_DEBUG, LOCATION, NULL, "pfkey add sent.\n");
+       plog(ASL_LEVEL_DEBUG, "pfkey add sent.\n");
 
        error = 0;
 
 end:
+       if (packet_error) {
+               IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                               IPSECSESSIONEVENTCODE_IKE_PACKET_TX_FAIL,
+                                                               CONSTSTR("Initiator, Quick-Mode Message 3"),
+                                                               CONSTSTR("Failed to transmit Quick-Mode Message 3"));
+       }
        if (buf != NULL)
                vfree(buf);
        if (msg != NULL)
@@ -751,8 +921,8 @@ end:
  *     HDR#*, HASH(4), notify
  */
 int
-quick_i3recv(iph2, msg0)
-       struct ph2handle *iph2;
+quick_i4recv(iph2, msg0)
+       phase2_handle_t *iph2;
        vchar_t *msg0;
 {
        vchar_t *msg = NULL;
@@ -761,30 +931,37 @@ quick_i3recv(iph2, msg0)
        struct isakmp_pl_hash *hash = NULL;
        vchar_t *notify = NULL;
        int error = ISAKMP_INTERNAL_ERROR;
+       int packet_error = -1;
 
        /* validity check */
-       if (iph2->status != PHASE2ST_COMMIT) {
-               plog(LLV_ERROR, LOCATION, NULL,
+       if (iph2->status != IKEV1_STATE_QUICK_I_MSG3SENT) {
+               plog(ASL_LEVEL_ERR,
                        "status mismatched %d.\n", iph2->status);
                goto end;
        }
 
        /* decrypt packet */
        if (!ISSET(((struct isakmp *)msg0->v)->flags, ISAKMP_FLAG_E)) {
-               plog(LLV_ERROR, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_ERR,
                        "Packet wasn't encrypted.\n");
                goto end;
        }
        msg = oakley_do_decrypt(iph2->ph1, msg0, iph2->ivm->iv, iph2->ivm->ive);
-       if (msg == NULL)
+       if (msg == NULL) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to decrypt packet\n");
                goto end;
+       }
 
        /* validate the type of next payload */
        pbuf = isakmp_parse(msg);
-       if (pbuf == NULL)
+       if (pbuf == NULL) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to parse msg\n");
                goto end;
+       }
 
-       for (pa = (struct isakmp_parse_t *)pbuf->v;
+       for (pa = ALIGNED_CAST(struct isakmp_parse_t *)pbuf->v;
             pa->type != ISAKMP_NPTYPE_NONE;
             pa++) {
 
@@ -793,10 +970,15 @@ quick_i3recv(iph2, msg0)
                        hash = (struct isakmp_pl_hash *)pa->ptr;
                        break;
                case ISAKMP_NPTYPE_N:
-                       isakmp_check_notify(pa->ptr, iph2->ph1);
+                       if (notify != NULL) {
+                               plog(ASL_LEVEL_WARNING,
+                                   "Ignoring multiple notifications\n");
+                               break;
+                       }
+                       isakmp_check_ph2_notify(pa->ptr, iph2);
                        notify = vmalloc(pa->len);
                        if (notify == NULL) {
-                               plog(LLV_ERROR, LOCATION, NULL,
+                               plog(ASL_LEVEL_ERR,
                                        "failed to get notify buffer.\n");
                                goto end;
                        }
@@ -804,7 +986,7 @@ quick_i3recv(iph2, msg0)
                        break;
                default:
                        /* don't send information, see ident_r1recv() */
-                       plog(LLV_ERROR, LOCATION, iph2->ph1->remote,
+                       plog(ASL_LEVEL_ERR,
                                "ignore the packet, "
                                "received unexpecting payload type %d.\n",
                                pa->type);
@@ -814,7 +996,7 @@ quick_i3recv(iph2, msg0)
 
        /* payload existency check */
        if (hash == NULL) {
-               plog(LLV_ERROR, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_ERR,
                        "few isakmp message received.\n");
                goto end;
        }
@@ -828,26 +1010,35 @@ quick_i3recv(iph2, msg0)
 
        r_hash = (char *)hash + sizeof(*hash);
 
-       plog(LLV_DEBUG, LOCATION, NULL, "HASH(4) validate:");
-       plogdump(LLV_DEBUG, r_hash, ntohs(hash->h.len) - sizeof(*hash));
+       //plogdump(ASL_LEVEL_DEBUG, r_hash, ntohs(hash->h.len) - sizeof(*hash), "HASH(4) validate:");
 
        my_hash = oakley_compute_hash1(iph2->ph1, iph2->msgid, notify);
        vfree(tmp);
-       if (my_hash == NULL)
+       if (my_hash == NULL) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to compute HASH\n");
                goto end;
+       }
 
        result = memcmp(my_hash->v, r_hash, my_hash->l);
        vfree(my_hash);
 
        if (result) {
-               plog(LLV_DEBUG, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_DEBUG,
                        "HASH(4) mismatch.\n");
                error = ISAKMP_NTYPE_INVALID_HASH_INFORMATION;
                goto end;
        }
     }
 
-       iph2->status = PHASE2ST_ADDSA;
+       IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                       IPSECSESSIONEVENTCODE_IKE_PACKET_RX_SUCC,
+                                                       CONSTSTR("Initiator, Quick-Mode message 4"),
+                                                       CONSTSTR(NULL));
+       packet_error = 0;
+
+       fsm_set_state(&iph2->status, IKEV1_STATE_QUICK_I_ADDSA);
+    
        iph2->flags ^= ISAKMP_FLAG_C;   /* reset bit */
 
        /* don't anything if local test mode. */
@@ -857,23 +1048,29 @@ quick_i3recv(iph2, msg0)
        }
 
        /* Do UPDATE for initiator */
-       plog(LLV_DEBUG, LOCATION, NULL, "call pk_sendupdate\n");
+       plog(ASL_LEVEL_DEBUG, "call pk_sendupdate\n");
        if (pk_sendupdate(iph2) < 0) {
-               plog(LLV_ERROR, LOCATION, NULL, "pfkey update failed.\n");
+               plog(ASL_LEVEL_ERR, "pfkey update failed.\n");
                goto end;
        }
-       plog(LLV_DEBUG, LOCATION, NULL, "pfkey update sent.\n");
+       plog(ASL_LEVEL_DEBUG, "pfkey update sent.\n");
 
        /* Do ADD for responder */
        if (pk_sendadd(iph2) < 0) {
-               plog(LLV_ERROR, LOCATION, NULL, "pfkey add failed.\n");
+               plog(ASL_LEVEL_ERR, "pfkey add failed.\n");
                goto end;
        }
-       plog(LLV_DEBUG, LOCATION, NULL, "pfkey add sent.\n");
+       plog(ASL_LEVEL_DEBUG, "pfkey add sent.\n");
 
        error = 0;
 
 end:
+       if (packet_error) {
+               IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                               IPSECSESSIONEVENTCODE_IKE_PACKET_RX_FAIL,
+                                                               CONSTSTR("Initiator, Quick-Mode Message 4"),
+                                                               CONSTSTR("Failed to process Quick-Mode Message 4"));
+       }
        if (msg != NULL)
                vfree(msg);
        if (pbuf != NULL)
@@ -886,11 +1083,11 @@ end:
 
 /*
  * receive from initiator
- *     HDR*, HASH(1), SA, Ni [, KE ] [, IDi2, IDr2 ]
+ *     HDR*, HASH(1), SA, Ni [, KE ] [, IDi2, IDr2 ] [, NAT-OAi, NAT-OAr ]
  */
 int
 quick_r1recv(iph2, msg0)
-       struct ph2handle *iph2;
+       phase2_handle_t *iph2;
        vchar_t *msg0;
 {
        vchar_t *msg = NULL;
@@ -903,25 +1100,30 @@ quick_r1recv(iph2, msg0)
        int tlen;
        int f_id_order; /* for ID payload detection */
        int error = ISAKMP_INTERNAL_ERROR;
+       struct sockaddr_storage *natoa_i = NULL;
+       struct sockaddr_storage *natoa_r = NULL;
 
        /* validity check */
-       if (iph2->status != PHASE2ST_START) {
-               plog(LLV_ERROR, LOCATION, NULL,
+       if (iph2->status != IKEV1_STATE_QUICK_R_START) {
+               plog(ASL_LEVEL_ERR,
                        "status mismatched %d.\n", iph2->status);
                goto end;
        }
 
        /* decrypting */
        if (!ISSET(((struct isakmp *)msg0->v)->flags, ISAKMP_FLAG_E)) {
-               plog(LLV_ERROR, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_ERR,
                        "Packet wasn't encrypted.\n");
                error = ISAKMP_NTYPE_PAYLOAD_MALFORMED;
                goto end;
        }
        /* decrypt packet */
        msg = oakley_do_decrypt(iph2->ph1, msg0, iph2->ivm->iv, iph2->ivm->ive);
-       if (msg == NULL)
+       if (msg == NULL) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to decrypt packet\n");
                goto end;
+       }
 
        /* create buffer for using to validate HASH(1) */
        /*
@@ -931,13 +1133,16 @@ quick_r1recv(iph2, msg0)
         *      3. two IDs must be considered as IDci, then IDcr
         */
        pbuf = isakmp_parse(msg);
-       if (pbuf == NULL)
+       if (pbuf == NULL) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to parse msg\n");
                goto end;
-       pa = (struct isakmp_parse_t *)pbuf->v;
+       }
+       pa = ALIGNED_CAST(struct isakmp_parse_t *)pbuf->v;
 
        /* HASH payload is fixed postion */
        if (pa->type != ISAKMP_NPTYPE_HASH) {
-               plog(LLV_ERROR, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_ERR,
                        "received invalid next payload type %d, "
                        "expecting %d.\n",
                        pa->type, ISAKMP_NPTYPE_HASH);
@@ -954,7 +1159,7 @@ quick_r1recv(iph2, msg0)
         */
        /* HASH payload is fixed postion */
        if (pa->type != ISAKMP_NPTYPE_SA) {
-               plog(LLV_WARNING, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_WARNING,
                        "received invalid next payload type %d, "
                        "expecting %d.\n",
                        pa->type, ISAKMP_NPTYPE_SA);
@@ -963,9 +1168,14 @@ quick_r1recv(iph2, msg0)
 
        /* allocate buffer for computing HASH(1) */
        tlen = ntohl(isakmp->len) - sizeof(*isakmp);
+       if (tlen < 0) {
+               plog(ASL_LEVEL_ERR, "invalid length (%d) while extracting hash.\n",
+                        ntohl(isakmp->len));
+               goto end;
+       }
        hbuf = vmalloc(tlen);
        if (hbuf == NULL) {
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR,
                        "failed to get hash buffer.\n");
                goto end;
        }
@@ -1001,22 +1211,31 @@ quick_r1recv(iph2, msg0)
                switch (pa->type) {
                case ISAKMP_NPTYPE_SA:
                        if (iph2->sa != NULL) {
-                               plog(LLV_ERROR, LOCATION, NULL,
+                               plog(ASL_LEVEL_ERR,
                                        "Multi SAs isn't supported.\n");
                                goto end;
                        }
-                       if (isakmp_p2ph(&iph2->sa, pa->ptr) < 0)
+                       if (isakmp_p2ph(&iph2->sa, pa->ptr) < 0) {
+                               plog(ASL_LEVEL_ERR,
+                                        "failed to process SA payload\n");
                                goto end;
+                       }
                        break;
 
                case ISAKMP_NPTYPE_NONCE:
-                       if (isakmp_p2ph(&iph2->nonce_p, pa->ptr) < 0)
+                       if (isakmp_p2ph(&iph2->nonce_p, pa->ptr) < 0) {
+                               plog(ASL_LEVEL_ERR,
+                                        "failed to process NONCE payload\n");
                                goto end;
+                       }
                        break;
 
                case ISAKMP_NPTYPE_KE:
-                       if (isakmp_p2ph(&iph2->dhpub_p, pa->ptr) < 0)
+                       if (isakmp_p2ph(&iph2->dhpub_p, pa->ptr) < 0) {
+                               plog(ASL_LEVEL_ERR,
+                                        "failed to process KE payload\n");
                                goto end;
+                       }
                        break;
 
                case ISAKMP_NPTYPE_ID:
@@ -1024,44 +1243,72 @@ quick_r1recv(iph2, msg0)
                                /* for IDci */
                                f_id_order++;
 
-                               if (isakmp_p2ph(&iph2->id_p, pa->ptr) < 0)
+                               if (isakmp_p2ph(&iph2->id_p, pa->ptr) < 0) {
+                                       plog(ASL_LEVEL_ERR,
+                                                "failed to process IDci2 payload\n");
                                        goto end;
+                               }
 
                        } else if (iph2->id == NULL) {
                                /* for IDcr */
                                if (f_id_order == 0) {
-                                       plog(LLV_ERROR, LOCATION, NULL,
+                                       plog(ASL_LEVEL_ERR,
                                                "IDr2 payload is not "
                                                "immediatelly followed "
                                                "by IDi2. We allowed.\n");
                                        /* XXX we allowed in this case. */
                                }
 
-                               if (isakmp_p2ph(&iph2->id, pa->ptr) < 0)
+                               if (isakmp_p2ph(&iph2->id, pa->ptr) < 0) {
+                                       plog(ASL_LEVEL_ERR,
+                                                "failed to process IDcr2 payload\n");
                                        goto end;
+                               }
                        } else {
-                               plog(LLV_ERROR, LOCATION, NULL,
-                                       "received too many ID payloads.\n");
-                               plogdump(LLV_ERROR, iph2->id->v, iph2->id->l);
+                               plogdump(ASL_LEVEL_ERR, iph2->id->v, iph2->id->l, "received too many ID payloads");
                                error = ISAKMP_NTYPE_INVALID_ID_INFORMATION;
                                goto end;
                        }
                        break;
 
                case ISAKMP_NPTYPE_N:
-                       isakmp_check_notify(pa->ptr, iph2->ph1);
+                       isakmp_check_ph2_notify(pa->ptr, iph2);
                        break;
 
 #ifdef ENABLE_NATT
                case ISAKMP_NPTYPE_NATOA_DRAFT:
                case ISAKMP_NPTYPE_NATOA_BADDRAFT:
                case ISAKMP_NPTYPE_NATOA_RFC:
-                       /* Ignore original source/destination messages */
+                   {
+                               vchar_t         *vp = NULL;
+                               struct sockaddr_storage *daddr;
+                               
+                               isakmp_p2ph(&vp, pa->ptr);
+                               
+                               if (vp) {
+                                       daddr = process_natoa_payload(vp);
+                                       if (daddr) {
+                                               if (natoa_i == NULL) {
+                                                       natoa_i = daddr;
+                                                       plog(ASL_LEVEL_DEBUG, "responder rcvd NAT-OA i: %s\n",
+                                                                saddr2str((struct sockaddr *)natoa_i));
+                                               } else if (natoa_r == NULL) {
+                                                       natoa_r = daddr;
+                                                       plog(ASL_LEVEL_DEBUG, "responder rcvd NAT-OA r: %s\n",
+                                                                saddr2str((struct sockaddr *)natoa_r));
+                                               } else {
+                                                       racoon_free(daddr);
+                                               }
+                                       }
+                                       vfree(vp);
+                               }
+                               
+                       }
                        break;
 #endif
 
                default:
-                       plog(LLV_ERROR, LOCATION, iph2->ph1->remote,
+                       plog(ASL_LEVEL_ERR,
                                "ignore the packet, "
                                "received unexpected payload type %d.\n",
                                pa->type);
@@ -1077,19 +1324,17 @@ quick_r1recv(iph2, msg0)
 
        /* payload existency check */
        if (hash == NULL || iph2->sa == NULL || iph2->nonce_p == NULL) {
-               plog(LLV_ERROR, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_ERR,
                        "expected isakmp payloads missing.\n");
                error = ISAKMP_NTYPE_PAYLOAD_MALFORMED;
                goto end;
        }
 
        if (iph2->id_p) {
-               plog(LLV_DEBUG, LOCATION, NULL, "received IDci2:");
-               plogdump(LLV_DEBUG, iph2->id_p->v, iph2->id_p->l);
+               plogdump(ASL_LEVEL_DEBUG, iph2->id_p->v, iph2->id_p->l, "received IDci2:");
        }
        if (iph2->id) {
-               plog(LLV_DEBUG, LOCATION, NULL, "received IDcr2:");
-               plogdump(LLV_DEBUG, iph2->id->v, iph2->id->l);
+               plogdump(ASL_LEVEL_DEBUG, iph2->id->v, iph2->id->l, "received IDcr2:");
        }
 
        /* adjust buffer length for HASH */
@@ -1103,18 +1348,20 @@ quick_r1recv(iph2, msg0)
 
        r_hash = (caddr_t)hash + sizeof(*hash);
 
-       plog(LLV_DEBUG, LOCATION, NULL, "HASH(1) validate:");
-       plogdump(LLV_DEBUG, r_hash, ntohs(hash->h.len) - sizeof(*hash));
+       //plogdump(ASL_LEVEL_DEBUG, r_hash, ntohs(hash->h.len) - sizeof(*hash), "HASH(1) validate:");
 
        my_hash = oakley_compute_hash1(iph2->ph1, iph2->msgid, hbuf);
-       if (my_hash == NULL)
+       if (my_hash == NULL) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to compute HASH\n");
                goto end;
+       }
 
        result = memcmp(my_hash->v, r_hash, my_hash->l);
        vfree(my_hash);
 
        if (result) {
-               plog(LLV_DEBUG, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_ERR,
                        "HASH(1) mismatch.\n");
                error = ISAKMP_NTYPE_INVALID_HASH_INFORMATION;
                goto end;
@@ -1124,18 +1371,18 @@ quick_r1recv(iph2, msg0)
        /* get sainfo */
        error = get_sainfo_r(iph2);
        if (error) {
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR,
                        "failed to get sainfo.\n");
                goto end;
        }
 
-       /* check the existence of ID payload and create responder's proposal */
+    /* check the existence of ID payload and create responder's proposal */
        error = get_proposal_r(iph2);
        switch (error) {
        case -2:
                /* generate a policy template from peer's proposal */
                if (set_proposal_from_proposal(iph2)) {
-                       plog(LLV_ERROR, LOCATION, NULL,
+                       plog(ASL_LEVEL_ERR,
                                "failed to generate a proposal template "
                                "from client's proposal.\n");
                        return ISAKMP_INTERNAL_ERROR;
@@ -1144,30 +1391,34 @@ quick_r1recv(iph2, msg0)
        case 0:
                /* select single proposal or reject it. */
                if (ipsecdoi_selectph2proposal(iph2) < 0) {
+                       plog(ASL_LEVEL_ERR,
+                                "failed to select proposal.\n");
                        error = ISAKMP_NTYPE_NO_PROPOSAL_CHOSEN;
                        goto end;
                }
                break;
        default:
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR,
                        "failed to get proposal for responder.\n");
                goto end;
        }
 
        /* check KE and attribute of PFS */
        if (iph2->dhpub_p != NULL && iph2->approval->pfs_group == 0) {
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR,
                        "no PFS is specified, but peer sends KE.\n");
                error = ISAKMP_NTYPE_NO_PROPOSAL_CHOSEN;
                goto end;
        }
        if (iph2->dhpub_p == NULL && iph2->approval->pfs_group != 0) {
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR,
                        "PFS is specified, but peer doesn't sends KE.\n");
                error = ISAKMP_NTYPE_NO_PROPOSAL_CHOSEN;
                goto end;
        }
 
+       ike_session_update_mode(iph2); /* update the mode, now that we have a proposal */
+
        /*
         * save the packet from the initiator in order to resend the
         * responder's first packet against this packet.
@@ -1175,11 +1426,22 @@ quick_r1recv(iph2, msg0)
        iph2->msg1 = vdup(msg0);
 
        /* change status of isakmp status entry */
-       iph2->status = PHASE2ST_STATUS2;
+       fsm_set_state(&iph2->status, IKEV1_STATE_QUICK_R_MSG1RCVD);
 
        error = 0;
 
+       IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                       IPSECSESSIONEVENTCODE_IKE_PACKET_RX_SUCC,
+                                                       CONSTSTR("Responder, Quick-Mode message 1"),
+                                                       CONSTSTR(NULL));
+       
 end:
+       if (error) {
+               IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                               IPSECSESSIONEVENTCODE_IKE_PACKET_RX_FAIL,
+                                                               CONSTSTR("Responder, Quick-Mode Message 1"),
+                                                               CONSTSTR("Failed to process Quick-Mode Message 1"));
+       }
        if (hbuf)
                vfree(hbuf);
        if (msg)
@@ -1187,6 +1449,15 @@ end:
        if (pbuf)
                vfree(pbuf);
 
+#ifdef ENABLE_NATT
+       if (natoa_i) {
+               racoon_free(natoa_i);
+       }
+       if (natoa_r) {
+               racoon_free(natoa_r);
+       }
+#endif
+
        if (error) {
                VPTRINIT(iph2->sa);
                VPTRINIT(iph2->nonce_p);
@@ -1202,26 +1473,29 @@ end:
  * call pfkey_getspi.
  */
 int
-quick_r1prep(iph2, msg)
-       struct ph2handle *iph2;
+quick_rprep(iph2, msg)
+       phase2_handle_t *iph2;
        vchar_t *msg;
 {
        int error = ISAKMP_INTERNAL_ERROR;
 
        /* validity check */
-       if (iph2->status != PHASE2ST_STATUS2) {
-               plog(LLV_ERROR, LOCATION, NULL,
+       if (iph2->status != IKEV1_STATE_QUICK_R_MSG1RCVD) {
+               plog(ASL_LEVEL_ERR,
                        "status mismatched %d.\n", iph2->status);
                goto end;
        }
 
-       iph2->status = PHASE2ST_GETSPISENT;
+       fsm_set_state(&iph2->status, IKEV1_STATE_QUICK_R_GETSPISENT);
 
        /* send getspi message */
-       if (pk_sendgetspi(iph2) < 0)
+       if (pk_sendgetspi(iph2) < 0) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to send getspi");
                goto end;
+       }
 
-       plog(LLV_DEBUG, LOCATION, NULL, "pfkey getspi sent.\n");
+       plog(ASL_LEVEL_DEBUG, "pfkey getspi sent.\n");
 
        iph2->sce = sched_new(lcconf->wait_ph2complete,
                pfkey_timeover_stub, iph2);
@@ -1234,11 +1508,11 @@ end:
 
 /*
  * send to initiator
- *     HDR*, HASH(2), SA, Nr [, KE ] [, IDi2, IDr2 ]
+ *     HDR*, HASH(2), SA, Nr [, KE ] [, IDi2, IDr2 ] [, NAT-OAi, NAT-OAr ]
  */
 int
 quick_r2send(iph2, msg)
-       struct ph2handle *iph2;
+       phase2_handle_t *iph2;
        vchar_t *msg;
 {
        vchar_t *body = NULL;
@@ -1246,7 +1520,6 @@ quick_r2send(iph2, msg)
        vchar_t *natoa_i = NULL;
        vchar_t *natoa_r = NULL;
        int             natoa_type = 0;
-       int             encmode;
        struct isakmp_gen *gen;
        char *p;
        int tlen;
@@ -1256,39 +1529,49 @@ quick_r2send(iph2, msg)
 
        /* validity check */
        if (msg != NULL) {
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR,
                        "msg has to be NULL in this function.\n");
                goto end;
        }
-       if (iph2->status != PHASE2ST_GETSPIDONE) {
-               plog(LLV_ERROR, LOCATION, NULL,
+       if (iph2->status != IKEV1_STATE_QUICK_R_GETSPIDONE) {
+               plog(ASL_LEVEL_ERR,
                        "status mismatched %d.\n", iph2->status);
                goto end;
        }
 
        /* update responders SPI */
        if (ipsecdoi_updatespi(iph2) < 0) {
-               plog(LLV_ERROR, LOCATION, NULL, "failed to update spi.\n");
+               plog(ASL_LEVEL_ERR, "failed to update spi.\n");
                goto end;
        }
 
        /* generate NONCE value */
        iph2->nonce = eay_set_random(iph2->ph1->rmconf->nonce_size);
-       if (iph2->nonce == NULL)
+       if (iph2->nonce == NULL) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to generate NONCE");
                goto end;
+       }
 
        /* generate KE value if need */
        pfsgroup = iph2->approval->pfs_group;
        if (iph2->dhpub_p != NULL && pfsgroup != 0) {
                /* DH group settting if PFS is required. */
                if (oakley_setdhgroup(pfsgroup, &iph2->pfsgrp) < 0) {
-                       plog(LLV_ERROR, LOCATION, NULL,
+                       plog(ASL_LEVEL_ERR,
                                "failed to set DH value.\n");
                        goto end;
                }
                /* generate DH public value */
+#ifdef HAVE_OPENSSL
                if (oakley_dh_generate(iph2->pfsgrp,
                                &iph2->dhpub, &iph2->dhpriv) < 0) {
+#else
+                       if (oakley_dh_generate(iph2->pfsgrp,
+                                                                  &iph2->dhpub, &iph2->publicKeySize, &iph2->dhC) < 0) {
+#endif         
+                       plog(ASL_LEVEL_ERR,
+                                "failed to generate DH public");
                        goto end;
                }
        }
@@ -1302,29 +1585,35 @@ quick_r2send(iph2, msg)
                tlen += (sizeof(*gen) + iph2->id_p->l
                        + sizeof(*gen) + iph2->id->l);
 
-#ifdef NOT_NOW
 #ifdef ENABLE_NATT
-       /* create natoa payloads if needed */
-       encmode = iph2->approval->head->encmode;
-       if (encmode == IPSECDOI_ATTR_ENC_MODE_TRNS ||
-               encmode == IPSECDOI_ATTR_ENC_MODE_UDPTRNS_RFC ||
-               encmode == IPSECDOI_ATTR_ENC_MODE_UDPTRNS_DRAFT) {
-
+       /*
+        * RFC3947 5.2. if we chose UDP-Encapsulated-Transport
+        * we should send NAT-OA
+        */
+       if (ipsecdoi_any_transportmode(iph2->approval)
+               && (iph2->ph1->natt_flags & NAT_DETECTED)) {
                natoa_type = create_natoa_payloads(iph2, &natoa_i, &natoa_r);
-               if (natoa_type == -1)
+               if (natoa_type == -1) {
+                       plog(ASL_LEVEL_ERR,
+                                "failed to create NATOA payloads");
                        goto end;
+               }
                else if (natoa_type != 0) {
                        tlen += sizeof(*gen) + natoa_i->l;
                        tlen += sizeof(*gen) + natoa_r->l;
+                       
+                       //plogdump(ASL_LEVEL_DEBUG, natoa_i->v, natoa_i->l, "responder send NAT-OAi:");
+                       //plogdump(ASL_LEVEL_DEBUG, natoa_r->v, natoa_r->l, "responder send NAT-OAr:");
                }
        }
 #endif
-#endif
 
+       plog(ASL_LEVEL_DEBUG, "Approved SA\n");
+       printsaprop0(ASL_LEVEL_DEBUG, iph2->approval);
 
        body = vmalloc(tlen);
        if (body == NULL) { 
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR,
                        "failed to get buffer to send.\n");
                goto end;
        }
@@ -1340,36 +1629,24 @@ quick_r2send(iph2, msg)
                                ? ISAKMP_NPTYPE_KE
                                : (iph2->id_p != NULL
                                        ? ISAKMP_NPTYPE_ID
-#ifdef NOT_NOW
                                        : (natoa_type ? natoa_type : ISAKMP_NPTYPE_NONE)));
-#else
-                                       : ISAKMP_NPTYPE_ID));
-#endif
 
        /* add KE payload if need. */
        if (iph2->dhpub_p != NULL && pfsgroup != 0) {
                np_p = &((struct isakmp_gen *)p)->np;   /* XXX */
                p = set_isakmp_payload(p, iph2->dhpub,
-                       (iph2->id_p == NULL)
-#ifdef NOT_NOW
-                               ? (natoa_type ? natoa_type : ISAKMP_NPTYPE_NONE)
-#else
-                               ? ISAKMP_NPTYPE_NONE
-#endif
-                               : ISAKMP_NPTYPE_ID);
+                       (iph2->id_p == NULL) ? (natoa_type ? natoa_type : ISAKMP_NPTYPE_NONE) : ISAKMP_NPTYPE_ID);
        }
 
        /* add ID payloads received. */
        if (iph2->id_p != NULL) {
                /* IDci */
                p = set_isakmp_payload(p, iph2->id_p, ISAKMP_NPTYPE_ID);
+               plogdump(ASL_LEVEL_DEBUG, iph2->id_p->v, iph2->id_p->l, "sending IDci2:");
                /* IDcr */
                np_p = &((struct isakmp_gen *)p)->np;   /* XXX */
-#ifdef NOT_NOW
                p = set_isakmp_payload(p, iph2->id, (natoa_type ? natoa_type : ISAKMP_NPTYPE_NONE));
-#else
-               p = set_isakmp_payload(p, iph2->id, ISAKMP_NPTYPE_NONE);
-#endif
+               plogdump(ASL_LEVEL_DEBUG, iph2->id->v, iph2->id->l, "sending IDcr2:");
        }
 
        /* add a RESPONDER-LIFETIME notify payload if needed */
@@ -1382,23 +1659,35 @@ quick_r2send(iph2, msg)
                u_int32_t v = htonl((u_int32_t)pp->lifetime);
                data = isakmp_add_attr_l(data, IPSECDOI_ATTR_SA_LD_TYPE,
                                        IPSECDOI_ATTR_SA_LD_TYPE_SEC);
-               if (!data)
+               if (!data) {
+                       plog(ASL_LEVEL_ERR,
+                                "failed to add RESPONDER-LIFETIME notify (type) payload");
                        goto end;
+               }
                data = isakmp_add_attr_v(data, IPSECDOI_ATTR_SA_LD,
                                        (caddr_t)&v, sizeof(v));
-               if (!data)
+               if (!data) {
+                       plog(ASL_LEVEL_ERR,
+                                "failed to add RESPONDER-LIFETIME notify (value) payload");
                        goto end;
+               }
        }
        if (pp->claim & IPSECDOI_ATTR_SA_LD_TYPE_KB) {
                u_int32_t v = htonl((u_int32_t)pp->lifebyte);
                data = isakmp_add_attr_l(data, IPSECDOI_ATTR_SA_LD_TYPE,
                                        IPSECDOI_ATTR_SA_LD_TYPE_KB);
-               if (!data)
+               if (!data) {
+                       plog(ASL_LEVEL_ERR,
+                                "failed to add RESPONDER-LIFETIME notify (type) payload");
                        goto end;
+               }
                data = isakmp_add_attr_v(data, IPSECDOI_ATTR_SA_LD,
                                        (caddr_t)&v, sizeof(v));
-               if (!data)
+               if (!data) {
+                       plog(ASL_LEVEL_ERR,
+                                "failed to add RESPONDER-LIFETIME notify (value) payload");
                        goto end;
+               }
        }
 
        /*
@@ -1410,6 +1699,8 @@ quick_r2send(iph2, msg)
                        body = isakmp_add_pl_n(body, &np_p,
                                        ISAKMP_NTYPE_RESPONDER_LIFETIME, pr, data);
                        if (!body) {
+                               plog(ASL_LEVEL_ERR,
+                                        "invalid RESPONDER-LIFETIME payload");
                                vfree(data);
                                return error;   /* XXX */
                        }
@@ -1418,13 +1709,11 @@ quick_r2send(iph2, msg)
        }
     }
 
-#ifdef NOT_NOW
        /* natoa */
        if (natoa_type) {
                p = set_isakmp_payload(p, natoa_i, natoa_type);
                p = set_isakmp_payload(p, natoa_r, ISAKMP_NPTYPE_NONE);
        }
-#endif
 
        /* generate HASH(2) */
     {
@@ -1432,7 +1721,7 @@ quick_r2send(iph2, msg)
 
        tmp = vmalloc(iph2->nonce_p->l + body->l);
        if (tmp == NULL) { 
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR,
                        "failed to get hash buffer.\n");
                goto end;
        }
@@ -1442,43 +1731,62 @@ quick_r2send(iph2, msg)
        hash = oakley_compute_hash1(iph2->ph1, iph2->msgid, tmp);
        vfree(tmp);
 
-       if (hash == NULL)
+       if (hash == NULL) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to compute HASH");
                goto end;
     }
+       }
 
        /* send isakmp payload */
        iph2->sendbuf = quick_ir1mx(iph2, body, hash);
-       if (iph2->sendbuf == NULL)
+       if (iph2->sendbuf == NULL) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to get send buffer");
                goto end;
+       }
 
        /* send the packet, add to the schedule to resend */
        iph2->retry_counter = iph2->ph1->rmconf->retry_counter;
-       if (isakmp_ph2resend(iph2) == -1)
+       if (isakmp_ph2resend(iph2) == -1) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to send packet");
                goto end;
+       }
 
        /* the sending message is added to the received-list. */
-       if (add_recvdpkt(iph2->ph1->remote, iph2->ph1->local, iph2->sendbuf, iph2->msg1) == -1) {
-               plog(LLV_ERROR , LOCATION, NULL,
+       if (ike_session_add_recvdpkt(iph2->ph1->remote, iph2->ph1->local, iph2->sendbuf, iph2->msg1,
+                     PH2_NON_ESP_EXTRA_LEN(iph2, iph2->sendbuf), PH2_FRAG_FLAGS(iph2)) == -1) {
+               plog(ASL_LEVEL_ERR,
                        "failed to add a response packet to the tree.\n");
                goto end;
        }
 
        /* change status of isakmp status entry */
-       iph2->status = PHASE2ST_MSG1SENT;
+    fsm_set_state(&iph2->status, IKEV1_STATE_QUICK_R_MSG2SENT);
 
        error = 0;
 
+       IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                       IPSECSESSIONEVENTCODE_IKE_PACKET_TX_SUCC,
+                                                       CONSTSTR("Responder, Quick-Mode message 2"),
+                                                       CONSTSTR(NULL));
+       
 end:
+       if (error) {
+               IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                               IPSECSESSIONEVENTCODE_IKE_PACKET_TX_FAIL,
+                                                               CONSTSTR("Responder, Quick-Mode Message 2"),
+                                                               CONSTSTR("Failed to transmit Quick-Mode Message 2"));
+       }
        if (body != NULL)
                vfree(body);
        if (hash != NULL)
                vfree(hash);
-#ifdef NOT_NOW
        if (natoa_i)
                vfree(natoa_i);
        if (natoa_r)
                vfree(natoa_r);
-#endif
 
        return error;
 }
@@ -1489,7 +1797,7 @@ end:
  */
 int
 quick_r3recv(iph2, msg0)
-       struct ph2handle *iph2;
+       phase2_handle_t *iph2;
        vchar_t *msg0;
 {
        vchar_t *msg = NULL;
@@ -1499,28 +1807,34 @@ quick_r3recv(iph2, msg0)
        int error = ISAKMP_INTERNAL_ERROR;
 
        /* validity check */
-       if (iph2->status != PHASE2ST_MSG1SENT) {
-               plog(LLV_ERROR, LOCATION, NULL,
+       if (iph2->status != IKEV1_STATE_QUICK_R_MSG2SENT) {
+               plog(ASL_LEVEL_ERR,
                        "status mismatched %d.\n", iph2->status);
                goto end;
        }
 
        /* decrypt packet */
        if (!ISSET(((struct isakmp *)msg0->v)->flags, ISAKMP_FLAG_E)) {
-               plog(LLV_ERROR, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_ERR,
                        "Packet wasn't encrypted.\n");
                goto end;
        }
        msg = oakley_do_decrypt(iph2->ph1, msg0, iph2->ivm->iv, iph2->ivm->ive);
-       if (msg == NULL)
+       if (msg == NULL) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to decrypt packet\n");
                goto end;
+       }
 
        /* validate the type of next payload */
        pbuf = isakmp_parse(msg);
-       if (pbuf == NULL)
+       if (pbuf == NULL) {
+               plog(ASL_LEVEL_ERR, 
+                        "failed to parse msg\n");
                goto end;
+       }
 
-       for (pa = (struct isakmp_parse_t *)pbuf->v;
+       for (pa = ALIGNED_CAST(struct isakmp_parse_t *)pbuf->v;
             pa->type != ISAKMP_NPTYPE_NONE;
             pa++) {
 
@@ -1529,11 +1843,11 @@ quick_r3recv(iph2, msg0)
                        hash = (struct isakmp_pl_hash *)pa->ptr;
                        break;
                case ISAKMP_NPTYPE_N:
-                       isakmp_check_notify(pa->ptr, iph2->ph1);
+                       isakmp_check_ph2_notify(pa->ptr, iph2);
                        break;
                default:
                        /* don't send information, see ident_r1recv() */
-                       plog(LLV_ERROR, LOCATION, iph2->ph1->remote,
+                       plog(ASL_LEVEL_ERR,
                                "ignore the packet, "
                                "received unexpecting payload type %d.\n",
                                pa->type);
@@ -1543,7 +1857,7 @@ quick_r3recv(iph2, msg0)
 
        /* payload existency check */
        if (hash == NULL) {
-               plog(LLV_ERROR, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_ERR,
                        "few isakmp message received.\n");
                goto end;
        }
@@ -1558,12 +1872,11 @@ quick_r3recv(iph2, msg0)
 
        r_hash = (char *)hash + sizeof(*hash);
 
-       plog(LLV_DEBUG, LOCATION, NULL, "HASH(3) validate:");
-       plogdump(LLV_DEBUG, r_hash, ntohs(hash->h.len) - sizeof(*hash));
+       //plogdump(ASL_LEVEL_DEBUG, r_hash, ntohs(hash->h.len) - sizeof(*hash), "HASH(3) validate:");
 
        tmp = vmalloc(iph2->nonce_p->l + iph2->nonce->l);
        if (tmp == NULL) { 
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR, 
                        "failed to get hash buffer.\n");
                goto end;
        }
@@ -1572,14 +1885,17 @@ quick_r3recv(iph2, msg0)
 
        my_hash = oakley_compute_hash3(iph2->ph1, iph2->msgid, tmp);
        vfree(tmp);
-       if (my_hash == NULL)
+       if (my_hash == NULL) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to compute HASH\n");
                goto end;
+       }
 
        result = memcmp(my_hash->v, r_hash, my_hash->l);
        vfree(my_hash);
 
        if (result) {
-               plog(LLV_ERROR, LOCATION, iph2->ph1->remote,
+               plog(ASL_LEVEL_ERR,
                        "HASH(3) mismatch.\n");
                error = ISAKMP_NTYPE_INVALID_HASH_INFORMATION;
                goto end;
@@ -1588,13 +1904,24 @@ quick_r3recv(iph2, msg0)
 
        /* if there is commit bit, don't set up SA now. */
        if (ISSET(iph2->flags, ISAKMP_FLAG_C)) {
-               iph2->status = PHASE2ST_COMMIT;
+               fsm_set_state(&iph2->status, IKEV1_STATE_QUICK_R_MSG3RCVD);
        } else
-               iph2->status = PHASE2ST_STATUS6;
+               fsm_set_state(&iph2->status, IKEV1_STATE_QUICK_R_COMMIT);
 
        error = 0;
 
+       IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                       IPSECSESSIONEVENTCODE_IKE_PACKET_RX_SUCC,
+                                                       CONSTSTR("Responder, Quick-Mode message 3"),
+                                                       CONSTSTR(NULL));
+       
 end:
+       if (error) {
+               IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                               IPSECSESSIONEVENTCODE_IKE_PACKET_RX_FAIL,
+                                                               CONSTSTR("Responder, Quick-Mode Message 3"),
+                                                               CONSTSTR("Failed to process Quick-Mode Message 3"));
+       }
        if (pbuf != NULL)
                vfree(pbuf);
        if (msg != NULL)
@@ -1608,8 +1935,8 @@ end:
  *     HDR#*, HASH(4), notify
  */
 int
-quick_r3send(iph2, msg0)
-       struct ph2handle *iph2;
+quick_r4send(iph2, msg0)
+       phase2_handle_t *iph2;
        vchar_t *msg0;
 {
        vchar_t *buf = NULL;
@@ -1621,21 +1948,21 @@ quick_r3send(iph2, msg0)
        int error = ISAKMP_INTERNAL_ERROR;
 
        /* validity check */
-       if (iph2->status != PHASE2ST_COMMIT) {
-               plog(LLV_ERROR, LOCATION, NULL,
+       if (iph2->status != IKEV1_STATE_QUICK_R_MSG3RCVD) {
+               plog(ASL_LEVEL_ERR,
                        "status mismatched %d.\n", iph2->status);
                goto end;
        }
 
        /* generate HASH(4) */
        /* XXX What can I do in the case of multiple different SA */
-       plog(LLV_DEBUG, LOCATION, NULL, "HASH(4) generate\n");
+       plog(ASL_LEVEL_DEBUG, "HASH(4) generate\n");
 
        /* XXX What should I do if there are multiple SAs ? */
        tlen = sizeof(struct isakmp_pl_n) + iph2->approval->head->spisize;
        notify = vmalloc(tlen);
        if (notify == NULL) { 
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR,
                        "failed to get notify buffer.\n");
                goto end;
        }
@@ -1649,8 +1976,11 @@ quick_r3send(iph2, msg0)
        memcpy(n + 1, &iph2->approval->head->spi, iph2->approval->head->spisize);
 
        myhash = oakley_compute_hash1(iph2->ph1, iph2->msgid, notify);
-       if (myhash == NULL)
+       if (myhash == NULL) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to compute HASH");
                goto end;
+       }
 
        /* create buffer for isakmp payload */
        tlen = sizeof(struct isakmp)
@@ -1658,15 +1988,18 @@ quick_r3send(iph2, msg0)
                + notify->l;
        buf = vmalloc(tlen);
        if (buf == NULL) { 
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR,
                        "failed to get buffer to send.\n");
                goto end;
        }
 
        /* create isakmp header */
        p = set_isakmp_header2(buf, iph2, ISAKMP_NPTYPE_HASH);
-       if (p == NULL)
+       if (p == NULL) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to set ISAKMP header");
                goto end;
+       }
 
        /* add HASH(4) payload */
        p = set_isakmp_payload(p, myhash, ISAKMP_NPTYPE_N);
@@ -1680,25 +2013,43 @@ quick_r3send(iph2, msg0)
 
        /* encoding */
        iph2->sendbuf = oakley_do_encrypt(iph2->ph1, buf, iph2->ivm->ive, iph2->ivm->iv);
-       if (iph2->sendbuf == NULL)
+       if (iph2->sendbuf == NULL) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to encrypt packet");
                goto end;
+       }
 
        /* send the packet */
-       if (isakmp_send(iph2->ph1, iph2->sendbuf) < 0)
+       if (isakmp_send(iph2->ph1, iph2->sendbuf) < 0) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to send packet");
                goto end;
+       }
 
        /* the sending message is added to the received-list. */
-       if (add_recvdpkt(iph2->ph1->remote, iph2->ph1->local, iph2->sendbuf, msg0) == -1) {
-               plog(LLV_ERROR , LOCATION, NULL,
+       if (ike_session_add_recvdpkt(iph2->ph1->remote, iph2->ph1->local, iph2->sendbuf, msg0,
+                     PH2_NON_ESP_EXTRA_LEN(iph2, iph2->sendbuf), PH2_FRAG_FLAGS(iph2)) == -1) {
+               plog(ASL_LEVEL_ERR , 
                        "failed to add a response packet to the tree.\n");
                goto end;
        }
 
-       iph2->status = PHASE2ST_COMMIT;
+       fsm_set_state(&iph2->status, IKEV1_STATE_QUICK_R_COMMIT);
 
        error = 0;
 
+       IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                       IPSECSESSIONEVENTCODE_IKE_PACKET_TX_SUCC,
+                                                       CONSTSTR("Responder, Quick-Mode message 4"),
+                                                       CONSTSTR(NULL));
+       
 end:
+       if (error) {
+               IPSECSESSIONTRACEREVENT(iph2->parent_session,
+                                                               IPSECSESSIONEVENTCODE_IKE_PACKET_TX_FAIL,
+                                                               CONSTSTR("Responder, Quick-Mode Message 4"),
+                                                               CONSTSTR("Failed to transmit Quick-Mode Message 4"));
+       }
        if (buf != NULL)
                vfree(buf);
        if (myhash != NULL)
@@ -1709,29 +2060,34 @@ end:
        return error;
 }
 
+
 /*
  * set SA to kernel.
  */
 int
-quick_r3prep(iph2, msg0)
-       struct ph2handle *iph2;
+quick_rfinalize(iph2, msg0)
+       phase2_handle_t *iph2;
        vchar_t *msg0;
 {
        vchar_t *msg = NULL;
        int error = ISAKMP_INTERNAL_ERROR;
 
        /* validity check */
-       if (iph2->status != PHASE2ST_STATUS6) {
-               plog(LLV_ERROR, LOCATION, NULL,
+       if (iph2->status != IKEV1_STATE_QUICK_R_COMMIT) {
+               plog(ASL_LEVEL_ERR,
                        "status mismatched %d.\n", iph2->status);
                goto end;
        }
 
        /* compute both of KEYMATs */
-       if (oakley_compute_keymat(iph2, RESPONDER) < 0)
+       if (oakley_compute_keymat(iph2, RESPONDER) < 0) {
+               plog(ASL_LEVEL_ERR,
+                        "failed to compute KEYMAT");
                goto end;
+       }
 
-       iph2->status = PHASE2ST_ADDSA;
+       fsm_set_state(&iph2->status, IKEV1_STATE_QUICK_R_ADDSA);
+    
        iph2->flags ^= ISAKMP_FLAG_C;   /* reset bit */
 
        /* don't anything if local test mode. */
@@ -1741,19 +2097,19 @@ quick_r3prep(iph2, msg0)
        }
 
        /* Do UPDATE as responder */
-       plog(LLV_DEBUG, LOCATION, NULL, "call pk_sendupdate\n");
+       plog(ASL_LEVEL_DEBUG, "call pk_sendupdate\n");
        if (pk_sendupdate(iph2) < 0) {
-               plog(LLV_ERROR, LOCATION, NULL, "pfkey update failed.\n");
+               plog(ASL_LEVEL_ERR, "pfkey update failed.\n");
                goto end;
        }
-       plog(LLV_DEBUG, LOCATION, NULL, "pfkey update sent.\n");
+       plog(ASL_LEVEL_DEBUG, "pfkey update sent.\n");
 
        /* Do ADD for responder */
        if (pk_sendadd(iph2) < 0) {
-               plog(LLV_ERROR, LOCATION, NULL, "pfkey add failed.\n");
+               plog(ASL_LEVEL_ERR, "pfkey add failed.\n");
                goto end;
        }
-       plog(LLV_DEBUG, LOCATION, NULL, "pfkey add sent.\n");
+       plog(ASL_LEVEL_DEBUG, "pfkey add sent.\n");
 
        /*
         * set policies into SPD if the policy is generated
@@ -1764,31 +2120,31 @@ quick_r3prep(iph2, msg0)
                struct policyindex *spidx;
                struct sockaddr_storage addr;
                u_int8_t pref;
-               struct sockaddr *src = iph2->src;
-               struct sockaddr *dst = iph2->dst;
+               struct sockaddr_storage *src = iph2->src;
+               struct sockaddr_storage *dst = iph2->dst;
 
                /* make inbound policy */
                iph2->src = dst;
                iph2->dst = src;
                if (pk_sendspdupdate2(iph2) < 0) {
-                       plog(LLV_ERROR, LOCATION, NULL,
+                       plog(ASL_LEVEL_ERR,
                                "pfkey spdupdate2(inbound) failed.\n");
                        goto end;
                }
-               plog(LLV_DEBUG, LOCATION, NULL,
+               plog(ASL_LEVEL_DEBUG,
                        "pfkey spdupdate2(inbound) sent.\n");
 
-               spidx = (struct policyindex *)iph2->spidx_gen;
+               spidx = iph2->spidx_gen;
 #ifdef HAVE_POLICY_FWD
                /* make forward policy if required */
                if (tunnel_mode_prop(iph2->approval)) {
                        spidx->dir = IPSEC_DIR_FWD;
                        if (pk_sendspdupdate2(iph2) < 0) {
-                               plog(LLV_ERROR, LOCATION, NULL,
+                               plog(ASL_LEVEL_ERR,
                                        "pfkey spdupdate2(forward) failed.\n");
                                goto end;
                        }
-                       plog(LLV_DEBUG, LOCATION, NULL,
+                       plog(ASL_LEVEL_DEBUG,
                                "pfkey spdupdate2(forward) sent.\n");
                }
 #endif
@@ -1805,15 +2161,15 @@ quick_r3prep(iph2, msg0)
                spidx->prefd = pref;
 
                if (pk_sendspdupdate2(iph2) < 0) {
-                       plog(LLV_ERROR, LOCATION, NULL,
+                       plog(ASL_LEVEL_ERR,
                                "pfkey spdupdate2(outbound) failed.\n");
                        goto end;
                }
-               plog(LLV_DEBUG, LOCATION, NULL,
+               plog(ASL_LEVEL_DEBUG,
                        "pfkey spdupdate2(outbound) sent.\n");
 
                /* spidx_gen is unnecessary any more */
-               delsp_bothdir((struct policyindex *)iph2->spidx_gen);
+               delsp_bothdir(iph2->spidx_gen);
                racoon_free(iph2->spidx_gen);
                iph2->spidx_gen = NULL;
                iph2->generated_spidx=1;
@@ -1833,7 +2189,7 @@ end:
  */
 static vchar_t *
 quick_ir1mx(iph2, body, hash)
-       struct ph2handle *iph2;
+       phase2_handle_t *iph2;
        vchar_t *body, *hash;
 {
        struct isakmp *isakmp;
@@ -1849,7 +2205,7 @@ quick_ir1mx(iph2, body, hash)
                + body->l;
        buf = vmalloc(tlen);
        if (buf == NULL) { 
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR, 
                        "failed to get buffer to send.\n");
                goto end;
        }
@@ -1859,8 +2215,11 @@ quick_ir1mx(iph2, body, hash)
 
        /* set isakmp header */
        p = set_isakmp_header2(buf, iph2, ISAKMP_NPTYPE_HASH);
-       if (p == NULL)
+       if (p == NULL) {
+               plog(ASL_LEVEL_ERR, 
+                        "failed to set ISAKMP header");
                goto end;
+       }
 
        /* add HASH payload */
        /* XXX is next type always SA ? */
@@ -1875,8 +2234,11 @@ quick_ir1mx(iph2, body, hash)
 
        /* encoding */
        new = oakley_do_encrypt(iph2->ph1, buf, iph2->ivm->ive, iph2->ivm->iv);
-       if (new == NULL)
+       if (new == NULL) {
+               plog(ASL_LEVEL_ERR, 
+                        "failed to encrypt packet");
                goto end;
+       }
 
        vfree(buf);
 
@@ -1897,16 +2259,17 @@ end:
  * get remote's sainfo.
  * NOTE: this function is for responder.
  */
-static int
+int
 get_sainfo_r(iph2)
-       struct ph2handle *iph2;
+       phase2_handle_t *iph2;
 {
        vchar_t *idsrc = NULL, *iddst = NULL;
        int prefixlen;
        int error = ISAKMP_INTERNAL_ERROR;
+       struct sainfo *anonymous = NULL;
 
-       if (iph2->id_p == NULL) {
-               switch (iph2->src->sa_family) {
+       if (iph2->id == NULL) {
+               switch (iph2->src->ss_family) {
                case AF_INET:
                        prefixlen = sizeof(struct in_addr) << 3;
                        break;
@@ -1914,8 +2277,8 @@ get_sainfo_r(iph2)
                        prefixlen = sizeof(struct in6_addr) << 3;
                        break;
                default:
-                       plog(LLV_ERROR, LOCATION, NULL,
-                               "invalid family: %d\n", iph2->src->sa_family);
+                       plog(ASL_LEVEL_ERR, 
+                               "invalid family: %d\n", iph2->src->ss_family);
                        goto end;
                }
                idsrc = ipsecdoi_sockaddr2id(iph2->src, prefixlen,
@@ -1924,13 +2287,13 @@ get_sainfo_r(iph2)
                idsrc = vdup(iph2->id);
        }
        if (idsrc == NULL) {
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR, 
                        "failed to set ID for source.\n");
                goto end;
        }
 
-       if (iph2->id == NULL) {
-               switch (iph2->dst->sa_family) {
+       if (iph2->id_p == NULL) {
+               switch (iph2->dst->ss_family) {
                case AF_INET:
                        prefixlen = sizeof(struct in_addr) << 3;
                        break;
@@ -1938,8 +2301,8 @@ get_sainfo_r(iph2)
                        prefixlen = sizeof(struct in6_addr) << 3;
                        break;
                default:
-                       plog(LLV_ERROR, LOCATION, NULL,
-                               "invalid family: %d\n", iph2->dst->sa_family);
+                       plog(ASL_LEVEL_ERR, 
+                               "invalid family: %d\n", iph2->dst->ss_family);
                        goto end;
                }
                iddst = ipsecdoi_sockaddr2id(iph2->dst, prefixlen,
@@ -1948,20 +2311,68 @@ get_sainfo_r(iph2)
                iddst = vdup(iph2->id_p);
        }
        if (iddst == NULL) {
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR, 
                        "failed to set ID for destination.\n");
                goto end;
        }
 
-       iph2->sainfo = getsainfo(idsrc, iddst, iph2->ph1->id_p);
-       if (iph2->sainfo == NULL) {
-               plog(LLV_ERROR, LOCATION, NULL,
-                       "failed to get sainfo.\n");
-               goto end;
+       iph2->sainfo = getsainfo(idsrc, iddst, iph2->ph1->id_p, 0);
+       // track anonymous sainfo, because we'll try to find a better sainfo if this is a client
+       if (iph2->sainfo && iph2->sainfo->idsrc == NULL)
+               anonymous = iph2->sainfo;
+
+       if (iph2->sainfo == NULL ||
+               (anonymous &&  iph2->parent_session && iph2->parent_session->is_client)) {
+               if ((iph2->ph1->natt_flags & NAT_DETECTED_ME) && lcconf->ext_nat_id != NULL)
+                       iph2->sainfo = getsainfo(idsrc, iddst, iph2->ph1->id_p, 1);
+               if (iph2->sainfo) {
+                       plog(ASL_LEVEL_DEBUG, 
+                                "get_sainfo_r case 1.\n");
+               }
+               // still no sainfo (or anonymous): for client, fallback to sainfo used by a previous established phase2
+               if (iph2->sainfo == NULL ||
+                       (iph2->sainfo->idsrc == NULL && iph2->parent_session && iph2->parent_session->is_client)) {
+                       ike_session_get_sainfo_r(iph2);
+                       if (iph2->sainfo) {
+                               plog(ASL_LEVEL_DEBUG, 
+                                        "get_sainfo_r case 2.\n");
+                       }
+                       // still no sainfo (or anonymous): fallback to sainfo picked by dst id
+                       if ((iph2->sainfo == NULL || iph2->sainfo->idsrc == NULL) && iph2->id_p) {
+                               plog(ASL_LEVEL_DEBUG, 
+                                        "get_sainfo_r about to try dst id only.\n");
+                               iph2->sainfo = getsainfo_by_dst_id(iph2->id_p, iph2->ph1->id_p);
+                               if (iph2->sainfo) {
+                                       plog(ASL_LEVEL_DEBUG, 
+                                                "get_sainfo_r case 3.\n");
+                                       if (iph2->sainfo->idsrc == NULL)
+                                               anonymous = iph2->sainfo;
+                               }
+                       }
+               }
        }
+       if (iph2->sainfo == NULL) {
+               if (anonymous == NULL) {
+                       plog(ASL_LEVEL_ERR, 
+                                "failed to get sainfo.\n");
+                       goto end;
+               }
+               iph2->sainfo = anonymous;
+       }
+       retain_sainfo(iph2->sainfo);
+    
+#ifdef ENABLE_HYBRID
+       /* xauth group inclusion check */
+       if (iph2->sainfo->group != NULL)
+               if(group_check(iph2->ph1,&iph2->sainfo->group->v,1)) {
+                       plog(ASL_LEVEL_ERR, 
+                                "failed to group check");
+                       goto end;
+               }
+#endif
 
-       plog(LLV_DEBUG, LOCATION, NULL,
-               "get sa info: %s\n", sainfo2str(iph2->sainfo));
+       plog(ASL_LEVEL_DEBUG, 
+               "selected sainfo: %s\n", sainfo2str(iph2->sainfo));
 
        error = 0;
 end:
@@ -1973,6 +2384,22 @@ end:
        return error;
 }
 
+int
+get_proposal_r(iph2)
+       phase2_handle_t *iph2;
+{
+       int error = get_proposal_r_remote(iph2, 0);
+       if (error != -2 && error != 0 && 
+               (((iph2->ph1->natt_flags & NAT_DETECTED_ME) && lcconf->ext_nat_id != NULL) ||
+                (iph2->parent_session && iph2->parent_session->is_client))) {
+               if (iph2->parent_session && iph2->parent_session->is_client)
+                       error = ike_session_get_proposal_r(iph2);
+               if (error != -2 && error != 0)
+                       error = get_proposal_r_remote(iph2, 1);                                 
+       }
+       return error;
+}
+
 /*
  * Copy both IP addresses in ID payloads into [src,dst]_id if both ID types
  * are IP address and same address family.
@@ -1984,33 +2411,37 @@ end:
  * NOTE: This function is only for responder.
  */
 static int
-get_proposal_r(iph2)
-       struct ph2handle *iph2;
+get_proposal_r_remote(iph2, ignore_id)
+       phase2_handle_t *iph2;
+       int ignore_id;
 {
        struct policyindex spidx;
        struct secpolicy *sp_in, *sp_out;
        int idi2type = 0;       /* switch whether copy IDs into id[src,dst]. */
        int error = ISAKMP_INTERNAL_ERROR;
+    int generated_policy_exit_early = 0;
 
        /* check the existence of ID payload */
        if ((iph2->id_p != NULL && iph2->id == NULL)
         || (iph2->id_p == NULL && iph2->id != NULL)) {
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR, 
                        "Both IDs wasn't found in payload.\n");
                return ISAKMP_NTYPE_INVALID_ID_INFORMATION;
        }
 
-       /* make sure if id[src,dst] is null. */
-       if (iph2->src_id || iph2->dst_id) {
-               plog(LLV_ERROR, LOCATION, NULL,
+       /* make sure if id[src,dst] is null (if use_remote_addr == 0). */
+       if (!ignore_id && (iph2->src_id || iph2->dst_id)) {
+               plog(ASL_LEVEL_ERR, 
                        "Why do ID[src,dst] exist already.\n");
                return ISAKMP_INTERNAL_ERROR;
        }
 
-       memset(&spidx, 0, sizeof(spidx));
+       plog(ASL_LEVEL_DEBUG, 
+                "%s: ignore_id %x.\n", __FUNCTION__, ignore_id);
 
-#define _XIDT(d) ((struct ipsecdoi_id_b *)(d)->v)->type
+       memset(&spidx, 0, sizeof(spidx));
 
+#define _XIDT(d) (ALIGNED_CAST(struct ipsecdoi_id_b *)((d)->v))->type
        /* make a spidx; a key to search SPD */
        spidx.dir = IPSEC_DIR_INBOUND;
        spidx.ul_proto = 0;
@@ -2018,16 +2449,18 @@ get_proposal_r(iph2)
        /*
         * make destination address in spidx from either ID payload
         * or phase 1 address into a address in spidx.
+        * If behind a nat - use phase1 address because server's
+        * use the nat's address in the ID payload.
         */
        if (iph2->id != NULL
+        && ignore_id == 0
         && (_XIDT(iph2->id) == IPSECDOI_ID_IPV4_ADDR
          || _XIDT(iph2->id) == IPSECDOI_ID_IPV6_ADDR
          || _XIDT(iph2->id) == IPSECDOI_ID_IPV4_ADDR_SUBNET
          || _XIDT(iph2->id) == IPSECDOI_ID_IPV6_ADDR_SUBNET)) {
                /* get a destination address of a policy */
-               error = ipsecdoi_id2sockaddr(iph2->id,
-                               (struct sockaddr *)&spidx.dst,
-                               &spidx.prefd, &spidx.ul_proto);
+               error = ipsecdoi_id2sockaddr(iph2->id, &spidx.dst,
+                               &spidx.prefd, &spidx.ul_proto, iph2->version);
                if (error)
                        return error;
 
@@ -2039,8 +2472,7 @@ get_proposal_r(iph2)
                 * because rcoon is responder.
                 */
                if (_XIDT(iph2->id) == IPSECDOI_ID_IPV6_ADDR) {
-                       error = setscopeid((struct sockaddr *)&spidx.dst,
-                                           iph2->src);
+                       error = setscopeid(&spidx.dst, iph2->src);
                        if (error)
                                return error;
                }
@@ -2052,9 +2484,9 @@ get_proposal_r(iph2)
 
        } else {
 
-               plog(LLV_DEBUG, LOCATION, NULL,
-                       "get a destination address of SP index "
-                       "from phase1 address "
+               plog(ASL_LEVEL_DEBUG, 
+                       "Get a destination address of SP index "
+                       "from Phase 1 address "
                        "due to no ID payloads found "
                        "OR because ID type is not address.\n");
 
@@ -2063,10 +2495,14 @@ get_proposal_r(iph2)
                 * of the key to search the SPD because the direction of policy
                 * is inbound.
                 */
-               memcpy(&spidx.dst, iph2->src, sysdep_sa_len(iph2->src));
+               memcpy(&spidx.dst, iph2->src, sysdep_sa_len((struct sockaddr *)iph2->src));
                switch (spidx.dst.ss_family) {
                case AF_INET:
-                       spidx.prefd = sizeof(struct in_addr) << 3;
+                       {
+                               struct sockaddr_in *s = (struct sockaddr_in *)&spidx.dst;
+                               spidx.prefd = sizeof(struct in_addr) << 3;                      
+                               s->sin_port = htons(0);
+                       }
                        break;
 #ifdef INET6
                case AF_INET6:
@@ -2081,14 +2517,14 @@ get_proposal_r(iph2)
 
        /* make source address in spidx */
        if (iph2->id_p != NULL
+        && ignore_id == 0
         && (_XIDT(iph2->id_p) == IPSECDOI_ID_IPV4_ADDR
          || _XIDT(iph2->id_p) == IPSECDOI_ID_IPV6_ADDR
          || _XIDT(iph2->id_p) == IPSECDOI_ID_IPV4_ADDR_SUBNET
          || _XIDT(iph2->id_p) == IPSECDOI_ID_IPV6_ADDR_SUBNET)) {
                /* get a source address of inbound SA */
-               error = ipsecdoi_id2sockaddr(iph2->id_p,
-                               (struct sockaddr *)&spidx.src,
-                               &spidx.prefs, &spidx.ul_proto);
+               error = ipsecdoi_id2sockaddr(iph2->id_p, &spidx.src,
+                               &spidx.prefs, &spidx.ul_proto, iph2->version);
                if (error)
                        return error;
 
@@ -2098,8 +2534,7 @@ get_proposal_r(iph2)
                 * for more detail, see above of this function.
                 */
                if (_XIDT(iph2->id_p) == IPSECDOI_ID_IPV6_ADDR) {
-                       error = setscopeid((struct sockaddr *)&spidx.src,
-                                           iph2->dst);
+                       error = setscopeid(&spidx.src, iph2->dst);
                        if (error)
                                return error;
                }
@@ -2108,22 +2543,36 @@ get_proposal_r(iph2)
                /* make id[src,dst] if both ID types are IP address and same */
                if (_XIDT(iph2->id_p) == idi2type
                 && spidx.dst.ss_family == spidx.src.ss_family) {
-                       iph2->src_id = dupsaddr((struct sockaddr *)&spidx.dst);
-                       iph2->dst_id = dupsaddr((struct sockaddr *)&spidx.src);
+                       iph2->src_id = dupsaddr(&spidx.dst);
+                       if (iph2->src_id  == NULL) {
+                               plog(ASL_LEVEL_ERR, 
+                                   "buffer allocation failed.\n");
+                               return ISAKMP_INTERNAL_ERROR;
+                       }
+                       iph2->dst_id = dupsaddr(&spidx.src);
+                       if (iph2->dst_id  == NULL) {
+                               plog(ASL_LEVEL_ERR, 
+                                   "buffer allocation failed.\n");
+                               return ISAKMP_INTERNAL_ERROR;
+                       }
                }
 
        } else {
-               plog(LLV_DEBUG, LOCATION, NULL,
-                       "get a source address of SP index "
-                       "from phase1 address "
+               plog(ASL_LEVEL_DEBUG, 
+                       "Get a source address of SP index "
+                       "from Phase 1 address "
                        "due to no ID payloads found "
                        "OR because ID type is not address.\n");
 
                /* see above comment. */
-               memcpy(&spidx.src, iph2->dst, sysdep_sa_len(iph2->dst));
+               memcpy(&spidx.src, iph2->dst, sysdep_sa_len((struct sockaddr *)iph2->dst));
                switch (spidx.src.ss_family) {
                case AF_INET:
-                       spidx.prefs = sizeof(struct in_addr) << 3;
+                       {
+                               struct sockaddr_in *s = (struct sockaddr_in *)&spidx.src;
+                               spidx.prefs = sizeof(struct in_addr) << 3;
+                               s->sin_port = htons(0);
+                       }
                        break;
 #ifdef INET6
                case AF_INET6:
@@ -2138,12 +2587,12 @@ get_proposal_r(iph2)
 
 #undef _XIDT
 
-       plog(LLV_DEBUG, LOCATION, NULL,
+       plog(ASL_LEVEL_DEBUG, 
                "get a src address from ID payload "
                "%s prefixlen=%u ul_proto=%u\n",
                saddr2str((struct sockaddr *)&spidx.src),
                spidx.prefs, spidx.ul_proto);
-       plog(LLV_DEBUG, LOCATION, NULL,
+       plog(ASL_LEVEL_DEBUG, 
                "get dst address from ID payload "
                "%s prefixlen=%u ul_proto=%u\n",
                saddr2str((struct sockaddr *)&spidx.dst),
@@ -2157,41 +2606,33 @@ get_proposal_r(iph2)
                spidx.ul_proto = IPSEC_ULPROTO_ANY;
 
        /* get inbound policy */
-       sp_in = getsp_r(&spidx);
+       sp_in = getsp_r(&spidx, iph2);
        if (sp_in == NULL || sp_in->policy == IPSEC_POLICY_GENERATE) {
                if (iph2->ph1->rmconf->gen_policy) {
-                       plog(LLV_INFO, LOCATION, NULL,
-                               "no policy found, "
-                               "try to generate the policy : %s\n",
-                               spidx2str(&spidx));
-                       iph2->spidx_gen = racoon_malloc(sizeof(spidx));
+                       if (sp_in)
+                                plog(ASL_LEVEL_INFO, 
+                                       "Update the generated policy : %s\n",
+                                       spidx2str(&spidx));
+                       else
+                               plog(ASL_LEVEL_INFO, 
+                                       "no policy found, "
+                                       "try to generate the policy : %s\n",
+                                       spidx2str(&spidx));
+                       iph2->spidx_gen = (struct policyindex *)racoon_malloc(sizeof(spidx));
                        if (!iph2->spidx_gen) {
-                               plog(LLV_ERROR, LOCATION, NULL,
-                                       "buffer allocation failed.\n");
+                               plog(ASL_LEVEL_ERR, 
+                                       "buffer allocation failed.\n");
                                return ISAKMP_INTERNAL_ERROR;
                        }
                        memcpy(iph2->spidx_gen, &spidx, sizeof(spidx));
-                       return -2;      /* special value */
-               }
-               plog(LLV_ERROR, LOCATION, NULL,
-                       "no policy found: %s\n", spidx2str(&spidx));
-               return ISAKMP_INTERNAL_ERROR;
-       }
-       /* Refresh existing generated policies
-        */
-       if (iph2->ph1->rmconf->gen_policy) {
-               plog(LLV_INFO, LOCATION, NULL,
-                        "Update the generated policy : %s\n",
-                        spidx2str(&spidx));
-               iph2->spidx_gen = racoon_malloc(sizeof(spidx));
-               if (!iph2->spidx_gen) {
-                       plog(LLV_ERROR, LOCATION, NULL,
-                                "buffer allocation failed.\n");
+                       generated_policy_exit_early = 1;        /* special value */
+               } else {
+                       plog(ASL_LEVEL_ERR, 
+                               "no policy found: %s\n", spidx2str(&spidx));
                        return ISAKMP_INTERNAL_ERROR;
                }
-               memcpy(iph2->spidx_gen, &spidx, sizeof(spidx));
        }
-
+    
        /* get outbound policy */
     {
        struct sockaddr_storage addr;
@@ -2205,23 +2646,32 @@ get_proposal_r(iph2)
        spidx.prefs = spidx.prefd;
        spidx.prefd = pref;
 
-       sp_out = getsp_r(&spidx);
+       sp_out = getsp_r(&spidx, iph2);
        if (!sp_out) {
-               plog(LLV_WARNING, LOCATION, NULL,
+               plog(ASL_LEVEL_WARNING, 
                        "no outbound policy found: %s\n",
                        spidx2str(&spidx));
+       } else {
+
+               if (!iph2->spid) {
+                       iph2->spid = sp_out->id;
+               }
        }
     }
 
-       plog(LLV_DEBUG, LOCATION, NULL,
+       plog(ASL_LEVEL_DEBUG, 
                "suitable SP found:%s\n", spidx2str(&spidx));
 
+       if (generated_policy_exit_early) {
+               return -2;
+       }
+
        /*
         * In the responder side, the inbound policy should be using IPsec.
         * outbound policy is not checked currently.
         */
        if (sp_in->policy != IPSEC_POLICY_IPSEC) {
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR, 
                        "policy found, but no IPsec required: %s\n",
                        spidx2str(&spidx));
                return ISAKMP_INTERNAL_ERROR;
@@ -2229,7 +2679,7 @@ get_proposal_r(iph2)
 
        /* set new proposal derived from a policy into the iph2->proposal. */
        if (set_proposal_from_policy(iph2, sp_in, sp_out) < 0) {
-               plog(LLV_ERROR, LOCATION, NULL,
+               plog(ASL_LEVEL_ERR, 
                        "failed to create saprop.\n");
                return ISAKMP_INTERNAL_ERROR;
        }