/*
 ******************************************************************************
 *                     INTERPEAK SOURCE FILE
 *
 *   Document no: @(#) $Name: VXWORKS_ITER40_2019102207 $ $RCSfile: ipmip6pm_link_local.c,v $ $Revision: 1.5 $
 *   $Source: /home/interpeak/CVSRoot/ipmip6pm/config/ipmip6pm_link_local.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 "ipmip6pm_config.h"

/*
 ****************************************************************************
 * 3                    INCLUDE FILES
 ****************************************************************************
 */
#define IPCOM_USE_CLIB_PROTO
#include <ipcom_clib.h>
#include <ipcom_os.h>
#include <ipcom_sock.h>
#include <ipcom_sock6.h>
#include <ipcom_inet.h>
#include <ipcom_list.h>
#include <ipcom_hash.h>
#include <ipcom_err.h>
#include <ipcom_sysvar.h>
#include <ipcom_syslog.h>
#include <ipcom_shell.h>
#include <ipcom_route.h>

#include <ipnet.h>
#include <ipnet_policy_routing.h>

#include <ipmip.h>
#include <private/ipmip_util.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 "ipmip6pm_h.h"
#include "ipmip6pm_attr_h.h"
#include "ipmip6pm_if.h"
#include "ipmip6pm_node.h"
#include "ipmip6pm_pktbuf.h"

/*
 ****************************************************************************
 * 4                    DEFINES
 ****************************************************************************
 */
#define IPMIP6PM_LINK_LOCAL_NAME "LINK-LOCAL"

/*
 ****************************************************************************
 * 5                    TYPES
 ****************************************************************************
 */

typedef struct Ipmip6pm_link_local_config_global
{
    Ipmip6_address_t    FixedMAGLinkLocalAddressOnAllAccessLinks;
    Ip_bool             FixedMAGLinkLocalAddressOnAllAccessLinks_ALL_ZERO;
} Ipmip6pm_link_local_config_global_t;

typedef struct Ipmip6pm_link_local_config
{
    Ipmip6_address_t    FixedMAGLinkLocalAddressOnAllAccessLinks;
    Ip_bool             FixedMAGLinkLocalAddressOnAllAccessLinks_ALL_ZERO;
} Ipmip6pm_link_local_config_t;

typedef struct Ipmip6pm_link_local_node_config
{
    Ipmip6_address_t    FixedMAGLinkLocalAddressOnAllAccessLinks;
} Ipmip6pm_link_local_node_config_t;

/*
 ****************************************************************************
 * 6                    EXTERN PROTOTYPES
 ****************************************************************************
 */

/*
 ****************************************************************************
 * 7                    LOCAL PROTOTYPES
 ****************************************************************************
 */

/*
 ****************************************************************************
 * 8                    DATA
 ****************************************************************************
 */

/*
 ****************************************************************************
 * 9                    STATIC FUNCTIONS
 ****************************************************************************
 */

IP_STATIC Ip_bool
ipmip6pm_link_local_request_req_accept(struct Ipmip6pm_context              *ctx,
                                       struct Ipmip_proc                    *proc,
                                       Ipmip6pm_link_local_config_global_t  *gcfg,
                                       Ipmip6pm_link_local_config_t         *ifcfg,
                                       Ipmip6pm_link_local_node_config_t    *nodecfg,
                                       struct Ipmip6pm_node                 *node,
                                       struct Ipmip6pm_pktbuf               *pbuf,
                                       struct Ipmip_timer                   *service)
{
    IPMIP_UNUSED_PARAMETER(node);
    IPMIP_UNUSED_PARAMETER(service);
    IPMIP_UNUSED_PARAMETER(ctx);
    IPMIP_UNUSED_PARAMETER(proc);
    IPMIP_UNUSED_PARAMETER(gcfg);

    if (ifcfg->FixedMAGLinkLocalAddressOnAllAccessLinks_ALL_ZERO)
    {
        if (pbuf->ipmip6.mo.pmipv6_link_local_address != IP_NULL)
            ipcom_memcpy(&nodecfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix, &pbuf->ipmip6.mo.pmipv6_link_local_address->prefix, sizeof(struct Ip_in6_addr));
    }   

    return IP_FALSE;
}

IP_STATIC void
ipmip6pm_link_local_request_rep_apply(struct Ipmip6pm_context               *ctx,
                                      struct Ipmip_proc                     *proc,
                                      Ipmip6pm_link_local_config_global_t   *gcfg,
                                      Ipmip6pm_link_local_config_t          *ifcfg,
                                      Ipmip6pm_link_local_node_config_t     *nodecfg,
                                      struct Ipmip6pm_node                  *node,
                                      struct Ipmip6pm_pktbuf                *pbuf)
{
    IPMIP_UNUSED_PARAMETER(node);
    IPMIP_UNUSED_PARAMETER(gcfg);

    if (ifcfg->FixedMAGLinkLocalAddressOnAllAccessLinks_ALL_ZERO)
    {
        Ipmip6_mh_mo_pmipv6_link_local_address_t ll;

        ll.hdr.val  = IPMIP6_MH_MO_PMIPV6_LINK_LOCAL_ADDRESS_OPTION;
        ll.hdr.len  = 16;
        ipcom_memcpy(&ll.prefix, &nodecfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix, sizeof(nodecfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix));

        /* Refresh */
        ipmip6_mh_pkt_opt_add_mo(&ctx->ipmip6, 
                                 proc, 
                                 &pbuf->ipmip6, 
                                 &ll.hdr);
    }
}


IP_STATIC void 
ipmip6pm_link_local_config_global(struct Ipmip6pm_context                   *ctx,
                                  struct Ipmip_proc                         *proc,
                                  int                                       action,
                                  Ipmip6pm_link_local_config_global_t       *gcfg,
                                  Ipmip_cli_message_t                       *request)
{   
    IPMIP_UNUSED_PARAMETER(ctx);
    IPMIP_UNUSED_PARAMETER(proc);

    if (action == IPMIP_CALLBACK_CONFIG_READ)
    {
        /* Read the prefix list allowed for this interface */    
        ipmip_sysvar_inet6(&ip_in6addr_any, &gcfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix, &gcfg->FixedMAGLinkLocalAddressOnAllAccessLinks.len, "ipmip6pm.FixedMAGLinkLocalAddressOnAllAccessLinks");

        /* Check if its unspecified */
        if (IP_IN6_IS_ADDR_UNSPECIFIED(&gcfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix))
            gcfg->FixedMAGLinkLocalAddressOnAllAccessLinks_ALL_ZERO = IP_TRUE;

        /**/
        if (gcfg->FixedMAGLinkLocalAddressOnAllAccessLinks.len == 0)
            gcfg->FixedMAGLinkLocalAddressOnAllAccessLinks.len = 64;
    }   
    else if (action == IPMIP_CALLBACK_CONFIG_FREE)
    {
        /* Do nothing */
    }
    else if (action == IPMIP_CALLBACK_CONFIG_DUMP)
    {
        ipmip_cli_config_printf(&request->message,
                                "ipmip6pm.FixedMAGLinkLocalAddressOnAllAccessLinks=%s/%d",
                                ipmip_ntop_inet6(proc, &gcfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix, IP_NULL), gcfg->FixedMAGLinkLocalAddressOnAllAccessLinks.len);
    }
}


IP_STATIC void 
ipmip6pm_link_local_config(struct Ipmip6pm_context                   *ctx,
                           struct Ipmip_proc                         *proc,
                           int                                       action,
                           struct Ipmip6pm_if                        *ifp,
                           Ipmip6pm_link_local_config_global_t       *gcfg,
                           Ipmip6pm_link_local_config_t              *cfg,
                           Ipmip_cli_message_t                       *request)
{   
    IPMIP_UNUSED_PARAMETER(ctx);
    IPMIP_UNUSED_PARAMETER(proc);

    if (action == IPMIP_CALLBACK_CONFIG_READ)
    {
        /* Read the prefix list allowed for this interface */    
        if (!ipmip_sysvar_inet6(&gcfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix, &cfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix, &cfg->FixedMAGLinkLocalAddressOnAllAccessLinks.len, "ipmip6pm.interface.%s.FixedMAGLinkLocalAddressOnAllAccessLinks", ifp->ipmip6.iff.ifname))
        {
            cfg->FixedMAGLinkLocalAddressOnAllAccessLinks.len       = gcfg->FixedMAGLinkLocalAddressOnAllAccessLinks.len;
            cfg->FixedMAGLinkLocalAddressOnAllAccessLinks_ALL_ZERO  = gcfg->FixedMAGLinkLocalAddressOnAllAccessLinks_ALL_ZERO;
        }
        else
        {
            /* Check if its unspecified */
            if (IP_IN6_IS_ADDR_UNSPECIFIED(&cfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix))
                cfg->FixedMAGLinkLocalAddressOnAllAccessLinks_ALL_ZERO = IP_TRUE;

            /**/
            if (cfg->FixedMAGLinkLocalAddressOnAllAccessLinks.len == 0)
                cfg->FixedMAGLinkLocalAddressOnAllAccessLinks.len = 64;
        }
    }   
    else if (action == IPMIP_CALLBACK_CONFIG_FREE)
    {
        /* Do nothing */
    }
    else if (action == IPMIP_CALLBACK_CONFIG_DUMP)
    {
        ipmip_cli_config_printf(&request->message,
                                "ipmip6pm.interface.%s.FixedMAGLinkLocalAddressOnAllAccessLinks=%s/%d",
                                ifp->ipmip6.iff.ifname, ipmip_ntop_inet6(proc, &cfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix, IP_NULL), cfg->FixedMAGLinkLocalAddressOnAllAccessLinks.len);
    }
}


IP_STATIC int
ipmip6pm_link_local_provide(struct Ipmip6pm_context                   *ctx,
                            struct Ipmip_proc                         *proc,
                            int                                       action,
                            Ipmip6pm_link_local_config_global_t       *gcfg,
                            Ipmip6pm_link_local_config_t              *ifcfg,
                            Ipmip6pm_link_local_node_config_t         *nodecfg,
                            struct Ipmip6pm_node                      *node,
                            struct Ipmip_timer                        *service)
{
    IPMIP_UNUSED_PARAMETER(service);
    IPMIP_UNUSED_PARAMETER(ifcfg);
    IPMIP_UNUSED_PARAMETER(gcfg);

    if (action == IPMIP_CALLBACK_ENABLE)
    {
        if (!IP_IN6_IS_ADDR_UNSPECIFIED(&nodecfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix))
        {
            Ipmip6_if_inet6_t *addr;

            ipmip_timer_lock_acquire(&ctx->ipmip6.ipmip, proc, node->ifp_private.ipmip6.ifp->iff_lock);
            for (addr = IPCOM_LIST_FIRST(&node->ifp_private.ipmip6.ifp->inet6); addr != IP_NULL; addr = IPCOM_LIST_NEXT(&addr->ifa_next))
            {
                if (addr->ifa_scope == IP_RT_SCOPE_LINK)
                {
                    int ret;
                    if ((ret = ipmip_netlink_inX_addr(&ctx->ipmip6.ipmip,
                                                      proc,
                                                      IP_AF_INET6,
                                                      IP_RTM_DELADDR,
                                                      node->ifp_private.ipmip6.ifp->iff.ifindex,
                                                      &addr->ifa_address.prefix,
                                                      addr->ifa_address.len,
                                                      0,
                                                      0)) != 0)
                    {
                        /**/
                        IPMIP6_EVENT_IF(INFO, proc, 
                                        ipmip_log_event_add(&ctx->ipmip6.ipmip, 
                                                            proc, 
                                                            "Proxy Mobile node %s interface %s unable to delete link local address %s/%d = %d",
                                                            ipmip6pm_node_describe(proc, node),
                                                            node->ifp_private.ipmip6.ifp->iff.ifname,
                                                            ipmip_ntop_inet6(proc,&addr->ifa_address.prefix, IP_NULL),
                                                            addr->ifa_address.len,
                                                            ret));
                    }
                }
            }

            if (ipmip_netlink_inX_addr(&ctx->ipmip6.ipmip,
                                       proc,
                                       IP_AF_INET6,
                                       IP_RTM_NEWADDR,
                                       node->ifp_private.ipmip6.ifp->iff.ifindex,
                                       &nodecfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix,
                                       nodecfg->FixedMAGLinkLocalAddressOnAllAccessLinks.len,
                                       0,
                                       0) != 0)
            {
                IPMIP6_EVENT_IF(INFO, proc, 
                                ipmip_log_event_add(&ctx->ipmip6.ipmip, 
                                                    proc, 
                                                    "Proxy Mobile node %s interface %s unable to add link local address %s/%d",
                                                    ipmip6pm_node_describe(proc, node),
                                                    node->ifp_private.ipmip6.ifp->iff.ifname,
                                                    ipmip_ntop_inet6(proc, &nodecfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix, IP_NULL),
                                                    nodecfg->FixedMAGLinkLocalAddressOnAllAccessLinks.len));
            }

            ipmip_timer_lock_release(&ctx->ipmip6.ipmip, proc, node->ifp_private.ipmip6.ifp->iff_lock);
        }
    }
    else if (action == IPMIP_CALLBACK_DISABLE)
    {

    }

    /* Don't delay */
    return IPMIP_CALLBACK_RET_SUCCESS;
}

IP_STATIC Ip_bool
ipmip6pm_link_local_setup(struct Ipmip6pm_context                *ctx,
                          struct Ipmip_proc                      *proc,
                          int                                    action,
                          Ipmip6pm_link_local_config_global_t    *gcfg,
                          Ipmip6pm_link_local_config_t           *ifcfg,
                          Ipmip6pm_link_local_node_config_t      *nodecfg,
                          struct Ipmip6pm_node                   *node,
                          const char                             *value,
                          Ipmip_cli_message_t                    *request)
{   
    IPMIP_UNUSED_PARAMETER(ctx);
    IPMIP_UNUSED_PARAMETER(proc);
    IPMIP_UNUSED_PARAMETER(node);
    IPMIP_UNUSED_PARAMETER(gcfg);

    if (action == IPMIP_CALLBACK_CONFIG_READ)
    {
        nodecfg->FixedMAGLinkLocalAddressOnAllAccessLinks.len = 64;

        if (value == IP_NULL)
        {
            if (!ifcfg->FixedMAGLinkLocalAddressOnAllAccessLinks_ALL_ZERO)
                ipcom_memcpy(&nodecfg->FixedMAGLinkLocalAddressOnAllAccessLinks, &ifcfg->FixedMAGLinkLocalAddressOnAllAccessLinks, sizeof(Ipmip6_address_t));
        }
        else
        {
            ipmip_util_inet6(value, &nodecfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix, &nodecfg->FixedMAGLinkLocalAddressOnAllAccessLinks.len);
        }

        return IP_TRUE;
    }   
    else if (action == IPMIP_CALLBACK_CONFIG_FREE)
    {
        /* Do Nothing */
    }
    else if (action == IPMIP_CALLBACK_CONFIG_DUMP)
    {
        if (!IP_IN6_IS_ADDR_UNSPECIFIED(&nodecfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix))
        {
            Ip_size_t rta = ipmip_attr_begin(&request->message, IPMIP6PM_CLI_ATTR_BC_P_LINK);

            ipmip_attr_put_str(&request->message, 
                               IPMIP6PM_CLI_ATTR_BC_P_SRV_MODULE,
                               IPMIP6PM_LINK_LOCAL_NAME);

            ipcom_snprintf(proc->ntop.ntop_pbuf, sizeof(proc->ntop.ntop_pbuf), "%s/%d", 
                           ipmip_ntop_inet6(proc, &nodecfg->FixedMAGLinkLocalAddressOnAllAccessLinks.prefix, IP_NULL),
                           nodecfg->FixedMAGLinkLocalAddressOnAllAccessLinks.len);

            ipmip_attr_put_str(&request->message, 
                               IPMIP6PM_CLI_ATTR_BC_P_SRV_VALUE,
                               proc->ntop.ntop_pbuf);

            ipmip_attr_end(&request->message, rta);
        }
    }

    return IP_FALSE;
}

/*
 ****************************************************************************
 * 10                   GLOBAL FUNCTIONS
 ****************************************************************************
 */

IP_GLOBAL void ipmip6pm_link_local_install(struct Ipmip6pm_context *ctx);
IP_GLOBAL void
ipmip6pm_link_local_install(struct Ipmip6pm_context *ctx)
{
    static Ipmip6pm_extension_t   srv;

    srv.name            = IPMIP6PM_LINK_LOCAL_NAME;
    srv.syntax          = "<link-local address>";
    srv.node_data_size  = sizeof(Ipmip6pm_link_local_node_config_t);
    srv.ifp_data_size   = sizeof(Ipmip6pm_link_local_config_t);
    srv.global_data_size= sizeof(Ipmip6pm_link_local_config_global_t);

    srv.config_global   = (Ipmip6pm_extension_config_global_t)ipmip6pm_link_local_config_global;
    srv.config_ifp      = (Ipmip6pm_extension_config_ifp_t)ipmip6pm_link_local_config;
    srv.provide         = (Ipmip6pm_extension_provide_t)ipmip6pm_link_local_provide;
    srv.setup           = (Ipmip6pm_extension_setup_t)ipmip6pm_link_local_setup;
    srv.pkt_rep_accept  = (Ipmip6pm_extension_pkt_rep_accept_t)ipmip6pm_link_local_request_req_accept;
    srv.pkt_req_apply   = (Ipmip6pm_extension_pkt_req_apply_t)ipmip6pm_link_local_request_rep_apply;

    ipmip6pm_context_register_extension(ctx, &srv, IPMIP6PM_FUNCTION_LINK);
}


/*
 ****************************************************************************
 * 11                   PUBLIC FUNCTIONS
 ****************************************************************************
 */

/*
 ****************************************************************************
 *                      END OF FILE
 ****************************************************************************
 */