kernel-libipsec: Handle packets between charon socket, libipsec and TUN device

diff --git a/src/libcharon/plugins/kernel_libipsec/kernel_libipsec_plugin.c b/src/libcharon/plugins/kernel_libipsec/kernel_libipsec_plugin.c
index 9fa811d023a409e9dc645e12048449851178c482..06bde52ae731b9f7f06b74be4cd0aa43a7c49432 100644 (file)
--- a/src/libcharon/plugins/kernel_libipsec/kernel_libipsec_plugin.c
+++ b/src/libcharon/plugins/kernel_libipsec/kernel_libipsec_plugin.c
@@ -16,8 +16,10 @@
 #include "kernel_libipsec_plugin.h"
 #include "kernel_libipsec_ipsec.h"
 
+#include <daemon.h>
 #include <ipsec.h>
 #include <networking/tun_device.h>
+#include <processing/jobs/callback_job.h>
 #include <utils/debug.h>
 
 #define TUN_DEFAULT_MTU 1400
@@ -47,12 +49,95 @@ METHOD(plugin_t, get_name, char*,
        return "kernel-libipsec";
 }
 
+/**
+ * Outbound callback
+ */
+static void send_esp(void *data, esp_packet_t *packet)
+{
+       charon->sender->send_no_marker(charon->sender, (packet_t*)packet);
+}
+
+/**
+ * Inbound callback
+ */
+static void deliver_plain(private_kernel_libipsec_plugin_t *this,
+                                                 ip_packet_t *packet)
+{
+       this->tun->write_packet(this->tun, packet->get_encoding(packet));
+       packet->destroy(packet);
+}
+
+/**
+ * Receiver callback
+ */
+static void receiver_esp_cb(void *data, packet_t *packet)
+{
+       ipsec->processor->queue_inbound(ipsec->processor,
+                                                                       esp_packet_create_from_packet(packet));
+}
+
+/**
+ * Job handling outbound plaintext packets
+ */
+static job_requeue_t handle_plain(private_kernel_libipsec_plugin_t *this)
+{
+       chunk_t raw;
+
+       if (this->tun->read_packet(this->tun, &raw))
+       {
+               ip_packet_t *packet;
+
+               packet = ip_packet_create(raw);
+               if (packet)
+               {
+                       ipsec->processor->queue_outbound(ipsec->processor, packet);
+               }
+               else
+               {
+                       DBG1(DBG_KNL, "invalid IP packet read from TUN device");
+               }
+       }
+       return JOB_REQUEUE_DIRECT;
+}
+
+/**
+ * Initialize/deinitialize sender and receiver
+ */
+static bool packet_handler_cb(private_kernel_libipsec_plugin_t *this,
+                                                         plugin_feature_t *feature, bool reg, void *arg)
+{
+       if (reg)
+       {
+               ipsec->processor->register_outbound(ipsec->processor, send_esp, NULL);
+               ipsec->processor->register_inbound(ipsec->processor,
+                                                                       (ipsec_inbound_cb_t)deliver_plain, this);
+               charon->receiver->add_esp_cb(charon->receiver,
+                                                                       (receiver_esp_cb_t)receiver_esp_cb, NULL);
+               lib->processor->queue_job(lib->processor,
+                       (job_t*)callback_job_create((callback_job_cb_t)handle_plain, this,
+                                                                       NULL, (callback_job_cancel_t)return_false));
+       }
+       else
+       {
+               charon->receiver->del_esp_cb(charon->receiver,
+                                                                       (receiver_esp_cb_t)receiver_esp_cb);
+               ipsec->processor->unregister_outbound(ipsec->processor,
+                                                                                        (ipsec_outbound_cb_t)send_esp);
+               ipsec->processor->unregister_inbound(ipsec->processor,
+                                                                                        (ipsec_inbound_cb_t)deliver_plain);
+       }
+       return TRUE;
+}
+
 METHOD(plugin_t, get_features, int,
        private_kernel_libipsec_plugin_t *this, plugin_feature_t *features[])
 {
        static plugin_feature_t f[] = {
                PLUGIN_CALLBACK(kernel_ipsec_register, kernel_libipsec_ipsec_create),
                        PLUGIN_PROVIDE(CUSTOM, "kernel-ipsec"),
+               PLUGIN_CALLBACK((plugin_feature_callback_t)packet_handler_cb, NULL),
+                       PLUGIN_PROVIDE(CUSTOM, "kernel-libipsec-handler"),
+                               PLUGIN_DEPENDS(CUSTOM, "libcharon-receiver"),
        };
        *features = f;
        return countof(f);