Added a hook to reset ESP sequence numbers

diff --git a/src/conftest/Makefile.am b/src/conftest/Makefile.am
index 8aea89516bf894afb84ec46a16544a2fe5b69cb3..ffa1976f2a4a98751b226bbbd9883a4ae3d6a83e 100644 (file)
--- a/src/conftest/Makefile.am
+++ b/src/conftest/Makefile.am
@@ -10,7 +10,7 @@ conftest_SOURCES = conftest.c conftest.h config.c config.h actions.c actions.h \
        hooks/log_proposals.c hooks/set_proposal_number.c hooks/log_ke.c \
        hooks/log_id.c hooks/custom_proposal.c hooks/set_ike_spi.c \
        hooks/set_ike_request.c hooks/set_reserved.c hooks/set_ike_initiator.c \
-       hooks/log_ts.c hooks/rebuild_auth.c
+       hooks/log_ts.c hooks/rebuild_auth.c hooks/reset_seq.c
 
 INCLUDES = \
        -I$(top_srcdir)/src/libstrongswan \

diff --git a/src/conftest/hooks/reset_seq.c b/src/conftest/hooks/reset_seq.c
new file mode 100644 (file)
index 0000000..ccf8e99
--- /dev/null
+++ b/src/conftest/hooks/reset_seq.c
@@ -0,0 +1,158 @@
+/*
+ * Copyright (C) 2010 Martin Willi
+ * Copyright (C) 2010 revosec AG
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation; either version 2 of the License, or (at your
+ * option) any later version.  See <http://www.fsf.org/copyleft/gpl.txt>.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
+ * or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
+ * for more details.
+ */
+
+#include "hook.h"
+
+#include <linux/xfrm.h>
+#include <unistd.h>
+#include <errno.h>
+
+#include <processing/jobs/callback_job.h>
+#include <plugins/kernel_netlink/kernel_netlink_shared.h>
+
+#define XFRM_RTA(nlh, x) ((struct rtattr*)(NLMSG_DATA(nlh) + NLMSG_ALIGN(sizeof(x))))
+
+typedef struct private_reset_seq_t private_reset_seq_t;
+
+/**
+ * Private data of an reset_seq_t object.
+ */
+struct private_reset_seq_t {
+
+       /**
+        * Implements the hook_t interface.
+        */
+       hook_t hook;
+
+       /**
+        * Delay for reset
+        */
+       int delay;
+};
+
+/**
+ * Callback job
+ */
+static job_requeue_t reset_cb(struct xfrm_usersa_id *data)
+{
+       netlink_buf_t request;
+       struct nlmsghdr *hdr;
+       struct xfrm_aevent_id *id;
+       struct rtattr *rthdr;
+       struct xfrm_replay_state *replay;
+       struct sockaddr_nl addr;
+       int s, len;
+
+       DBG1(DBG_CFG, "resetting sequence number of SPI 0x%x", htonl(data->spi));
+
+       memset(&request, 0, sizeof(request));
+
+       hdr = (struct nlmsghdr*)request;
+       hdr->nlmsg_flags = NLM_F_REQUEST | NLM_F_ACK | NLM_F_REPLACE;
+       hdr->nlmsg_seq = 201;
+       hdr->nlmsg_pid = getpid();
+       hdr->nlmsg_type = XFRM_MSG_NEWAE;
+       hdr->nlmsg_len = NLMSG_LENGTH(sizeof(struct xfrm_aevent_id));
+
+       id = (struct xfrm_aevent_id*)NLMSG_DATA(hdr);
+       id->sa_id = *data;
+
+       rthdr = XFRM_RTA(hdr, struct xfrm_aevent_id);
+       rthdr->rta_type = XFRMA_REPLAY_VAL;
+       rthdr->rta_len = RTA_LENGTH(sizeof(struct xfrm_replay_state));
+       hdr->nlmsg_len += rthdr->rta_len;
+
+       replay = (struct xfrm_replay_state*)RTA_DATA(rthdr);
+
+       s = socket(AF_NETLINK, SOCK_RAW, NETLINK_XFRM);
+       if (s == -1)
+       {
+               DBG1(DBG_CFG, "opening XFRM socket failed: %s", strerror(errno));
+               return JOB_REQUEUE_NONE;
+       }
+       memset(&addr, 0, sizeof(addr));
+       addr.nl_family = AF_NETLINK;
+       len = sendto(s, hdr, hdr->nlmsg_len, 0,
+                                (struct sockaddr*)&addr, sizeof(addr));
+       if (len != hdr->nlmsg_len)
+       {
+               DBG1(DBG_CFG, "sending XFRM aevent failed: %s", strerror(errno));
+       }
+       close(s);
+       return JOB_REQUEUE_NONE;
+}
+
+/**
+ * Schedule sequence number reset job
+ */
+static void schedule_reset_job(private_reset_seq_t *this, host_t *dst,
+                                                          u_int32_t spi)
+{
+       struct xfrm_usersa_id *data;
+       chunk_t chunk;
+
+       INIT(data,
+               .spi = spi,
+               .family = dst->get_family(dst),
+               .proto = IPPROTO_ESP,
+       );
+
+       chunk = dst->get_address(dst);
+       memcpy(&data->daddr, chunk.ptr, min(chunk.len, sizeof(xfrm_address_t)));
+
+       lib->scheduler->schedule_job(lib->scheduler,
+                                                                (job_t*)callback_job_create(
+                                                                       (void*)reset_cb, data, (void*)free, NULL),
+                                                                this->delay);
+}
+
+METHOD(listener_t, child_updown, bool,
+       private_reset_seq_t *this, ike_sa_t *ike_sa, child_sa_t *child_sa,
+       bool up)
+{
+       if (up)
+       {
+               schedule_reset_job(this, ike_sa->get_other_host(ike_sa),
+                                                  child_sa->get_spi(child_sa, FALSE));
+       }
+       return TRUE;
+}
+
+METHOD(hook_t, destroy, void,
+       private_reset_seq_t *this)
+{
+       free(this);
+}
+
+/**
+ * Create the IKE_AUTH fill hook
+ */
+hook_t *reset_seq_hook_create(char *name)
+{
+       private_reset_seq_t *this;
+
+       INIT(this,
+               .hook = {
+                       .listener = {
+                               .child_updown = _child_updown,
+                       },
+                       .destroy = _destroy,
+               },
+               .delay = conftest->test->get_int(conftest->test,
+                                                                               "hooks.%s.delay", 10, name),
+       );
+
+       return &this->hook;
+}