441 lines
18 KiB
C
441 lines
18 KiB
C
|
|
/*
|
|
******************************************************************************
|
|
* 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
|
|
****************************************************************************
|
|
*/
|