original files of m241

components/ip_net2-6.9/ipmip6ha/config/ipmip6ha_pmipv6_linklocal.c

@@ -0,0 +1,221 @@
+
+/*
+ ******************************************************************************
+ *                     INTERPEAK SOURCE FILE
+ *
+ *   Document no: @(#) $Name: VXWORKS_ITER40_2019102207 $ $RCSfile: ipmip6ha_pmipv6_linklocal.c,v $ $Revision: 1.6 $
+ *   $Source: /home/interpeak/CVSRoot/ipmip6ha/config/ipmip6ha_pmipv6_linklocal.c,v $
+ *   $Author: jhorteli $
+ *   $State: Exp $ $Locker:  $
+ *
+ *   INTERPEAK_COPYRIGHT_STRING
+ *     Design and implementation by Joel Hortelius <joel.hortelis@interpeak.se>
+ ******************************************************************************
+ */
+
+
+/*
+ ****************************************************************************
+ * 1                    DESCRIPTION
+ ****************************************************************************
+ */
+
+/*
+ ****************************************************************************
+ * 2                    CONFIGURATION
+ ****************************************************************************
+ */
+
+#include "ipmip6ha_config.h"
+
+
+/*
+ ****************************************************************************
+ * 3                    INCLUDE FILES
+ ****************************************************************************
+ */
+
+#define IPCOM_USE_CLIB_PROTO
+#include <ipcom_clib.h>
+#include <ipcom_err.h>
+#include <ipcom_hash.h>
+#include <ipcom_inet.h>
+#include <ipcom_ipd.h>
+#include <ipcom_list.h>
+#include <ipcom_os.h>
+#include <ipcom_sock.h>
+#include <ipcom_sock2.h>
+#include <ipcom_syslog.h>
+#include <ipcom_sysvar.h>
+#include <ipcom_atomic.h>
+
+#include <ipmip.h>
+#include <private/ipmip_sysvar.h>
+
+#include <ipmip6.h>
+#include <private/ipmip6_context.h>
+#include <private/ipmip6_netlink.h>
+#include <private/ipmip6_if.h>
+#include <private/ipmip6_icmp.h>
+#include <private/ipmip6_util.h>
+
+#include "ipmip6ha_h.h"
+#include "ipmip6ha_attr_h.h"
+#include "ipmip6ha_if.h"
+#include "ipmip6ha_node.h"
+#include "ipmip6ha_pktbuf.h"
+
+/*
+ ****************************************************************************
+ * 4                    DEFINES
+ ****************************************************************************
+ */
+#define IPMIP6HA_PMIPV6_LINKLOCAL "LINKLOCAL"
+
+/*
+ ****************************************************************************
+ * 5                    TYPES
+ ****************************************************************************
+ */
+typedef struct Ipmip6ha_pmipv6_linklocal_config
+{
+    Ipcom_atomic_t                      counter;
+} Ipmip6ha_pmipv6_linklocal_config_t;
+
+/*
+ ****************************************************************************
+ * 6                    EXTERN PROTOTYPES
+ ****************************************************************************
+ */
+
+/*
+ ****************************************************************************
+ * 7                    LOCAL PROTOTYPES
+ ****************************************************************************
+ */
+
+/*
+ ****************************************************************************
+ * 8                    DATA
+ ****************************************************************************
+ */
+
+/*
+ ****************************************************************************
+ * 9                    STATIC FUNCTIONS
+ ****************************************************************************
+ */
+IP_STATIC void 
+ipmip6ha_pmipv6_linklocal_config(struct Ipmip6ha_context                   *ctx,
+                                 struct Ipmip_proc                         *proc,
+                                 int                                       action,
+                                 struct Ipmip6ha_if                        *ifp,
+                                 void                                      *gcfg,
+                                 Ipmip6ha_pmipv6_linklocal_config_t        *cfg,
+                                 Ipmip_cli_message_t                       *request)
+{   
+    IPMIP_UNUSED_PARAMETER(ctx);
+    IPMIP_UNUSED_PARAMETER(proc);
+    IPMIP_UNUSED_PARAMETER(ifp);
+    IPMIP_UNUSED_PARAMETER(gcfg);
+
+    if (action == IPMIP_CALLBACK_CONFIG_READ)
+    {
+        ipcom_atomic_set(&cfg->counter, 0);
+    }   
+    else if (action == IPMIP_CALLBACK_CONFIG_FREE)
+    {
+        /* Do nothing */
+    }
+    else if (action == IPMIP_CALLBACK_CONFIG_DUMP)
+    {
+        IPMIP_UNUSED_PARAMETER(request);
+    }
+}
+
+
+IP_STATIC int
+ipmip6ha_pmipv6_linklocal_provide(struct Ipmip6ha_context                  *ctx,
+                                  struct Ipmip_proc                        *proc,
+                                  int                                      action,
+                                  void                                     *gcfg,
+                                  Ipmip6ha_pmipv6_linklocal_config_t       *cfg,
+                                  void                                     *handle,
+                                  struct Ipmip6ha_node_P                   *node,
+                                  struct Ipmip_timer                       *service)
+{
+    IPMIP_UNUSED_PARAMETER(service);
+    IPMIP_UNUSED_PARAMETER(cfg);
+    IPMIP_UNUSED_PARAMETER(handle);
+    IPMIP_UNUSED_PARAMETER(gcfg);
+
+    if (action == IPMIP_CALLBACK_ENABLE)
+    {
+        if (IP_IN6_IS_ADDR_UNSPECIFIED(&node->pmipv6_link_local_address.prefix))
+        {
+            Ip_u32                              low;
+
+            while ((low = (Ip_u32)ipcom_atomic_add_and_return(&cfg->counter, 1)) == 0)
+                ;
+
+            ipcom_memset(&node->pmipv6_link_local_address.prefix, 0, sizeof(node->pmipv6_link_local_address.prefix));
+
+            /**/
+            IP_SET_HTONS(&node->pmipv6_link_local_address.prefix.in6.addr16[0], 0xfe80);
+            IP_SET_HTONL(&node->pmipv6_link_local_address.prefix.in6.addr32[3], low);
+
+            IPMIP6_EVENT_IF(DEBUG2, proc, 
+                            ipmip_log_event_add(&ctx->ipmip6.ipmip, 
+                                                proc, 
+                                                "Generated Link-Local address %s for node %s",
+                                                ipmip_ntop_inet6(proc, &node->pmipv6_link_local_address.prefix, IP_NULL),
+                                                ipmip6ha_node_describe(proc, &node->node)));
+        }
+    }
+    else if (action == IPMIP_CALLBACK_DISABLE)
+    {
+        /* DO NOTHING */
+    }
+
+    /* Don't delay */
+    return IPMIP_CALLBACK_RET_SUCCESS;
+}
+
+/*
+ ****************************************************************************
+ * 10                   GLOBAL FUNCTIONS
+ ****************************************************************************
+ */
+
+IP_GLOBAL void ipmip6ha_pmipv6_linklocal_install(struct Ipmip6ha_context *ctx);
+IP_GLOBAL void
+ipmip6ha_pmipv6_linklocal_install(struct Ipmip6ha_context *ctx)
+{
+    static Ipmip6ha_extension_t   srv;
+
+    ipcom_memset(&srv, 0, sizeof(srv));
+
+    srv.name            = IPMIP6HA_PMIPV6_LINKLOCAL;
+    srv.ifp_data_size   = sizeof(Ipmip6ha_pmipv6_linklocal_config_t);
+
+    srv.config_ifp      = (Ipmip6ha_extension_config_ifp_t)ipmip6ha_pmipv6_linklocal_config;
+    srv.provide         = (Ipmip6ha_extension_provide_t)ipmip6ha_pmipv6_linklocal_provide;
+
+    /* This is a PMIP only feature */
+    ipmip6ha_context_register_extension(ctx, &srv, IP_FALSE, IP_TRUE);
+}
+
+
+/*
+ ****************************************************************************
+ * 11                   PUBLIC FUNCTIONS
+ ****************************************************************************
+ */
+
+/*
+ ****************************************************************************
+ *                      END OF FILE
+ ****************************************************************************
+ */
+
+