358 lines
14 KiB
C
358 lines
14 KiB
C
|
|
/*
|
|
******************************************************************************
|
|
* INTERPEAK SOURCE FILE
|
|
*
|
|
* Document no: @(#) $Name: VXWORKS_ITER40_2019102207 $ $RCSfile: ipmip6mn_service_mpdisc.c,v $ $Revision: 1.6 $
|
|
* $Source: /home/interpeak/CVSRoot/ipmip6mn/config/ipmip6mn_service_mpdisc.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 "ipmip6mn_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 <ipmip.h>
|
|
#include <private/ipmip_sysvar.h>
|
|
#include <private/ipmip_cli.h>
|
|
|
|
#include <ipmip6.h>
|
|
#include <private/ipmip6_pkt.h>
|
|
#include <private/ipmip6_context.h>
|
|
#include <private/ipmip6_netlink.h>
|
|
#include <private/ipmip6_util.h>
|
|
|
|
#include "ipmip6mn_h.h"
|
|
#include "ipmip6mn_pktbuf.h"
|
|
#include "ipmip6mn_coa.h"
|
|
|
|
/*
|
|
****************************************************************************
|
|
* 4 DEFINES
|
|
****************************************************************************
|
|
*/
|
|
|
|
/*
|
|
****************************************************************************
|
|
* 5 TYPES
|
|
****************************************************************************
|
|
*/
|
|
typedef struct Ipmip6mn_service_mpdisc_config
|
|
{
|
|
Ip_bool save_config;
|
|
Ip_bool derive_from_config;
|
|
Ip_u32 derive_from_ifindex;
|
|
Ip_bool derive_from_interface;
|
|
} Ipmip6mn_service_mpdisc_config_t;
|
|
/*
|
|
****************************************************************************
|
|
* 6 EXTERN PROTOTYPES
|
|
****************************************************************************
|
|
*/
|
|
|
|
/*
|
|
****************************************************************************
|
|
* 7 LOCAL PROTOTYPES
|
|
****************************************************************************
|
|
*/
|
|
|
|
/*
|
|
****************************************************************************
|
|
* 8 DATA
|
|
****************************************************************************
|
|
*/
|
|
|
|
/*
|
|
****************************************************************************
|
|
* 9 STATIC FUNCTIONS
|
|
****************************************************************************
|
|
*/
|
|
IP_STATIC Ip_bool
|
|
ipmip6mn_mpdisc_prefix_renumber_if(struct Ipmip6mn_context *ctx,
|
|
struct Ipmip_proc *proc,
|
|
struct Ipmip6mn_node *node,
|
|
Ip_u32 ifindex,
|
|
struct Ip_in6_addr *prefix,
|
|
Ip_u8 *prefix_len)
|
|
{
|
|
Ipmip6_address_t reply;
|
|
|
|
IPMIP_UNUSED_PARAMETER(node);
|
|
|
|
if (ifindex == 0)
|
|
return IP_FALSE;
|
|
|
|
if (ipmip6_netlink_prefix_generate(&ctx->ipmip6,
|
|
proc,
|
|
ifindex,
|
|
prefix,
|
|
*prefix_len,
|
|
&reply))
|
|
{
|
|
ipcom_memcpy(prefix, &reply.prefix, sizeof(*prefix));
|
|
*prefix_len = reply.len;
|
|
return IP_TRUE;
|
|
}
|
|
|
|
return IP_FALSE;
|
|
}
|
|
|
|
IP_STATIC Ip_bool
|
|
ipmip6mn_mpdisc_prefix_renumber_resolve(struct Ipmip6mn_context *ctx,
|
|
struct Ipmip_proc *proc,
|
|
struct Ipmip6mn_node *node,
|
|
Ipmip6mn_service_mpdisc_config_t *rcfg,
|
|
struct Ip_in6_addr *new_addr,
|
|
Ip_u8 *new_addr_len)
|
|
{
|
|
unsigned int i;
|
|
|
|
if (rcfg->derive_from_config)
|
|
{
|
|
for (i = 0; i < node->mobile_prefix.mobile_prefix_size; i++)
|
|
{
|
|
Ipmip6_pkt_nd_opt_prefix_info_t *pinfo = &node->mobile_prefix.mobile_prefix[i];
|
|
if (IP_BIT_ISSET(pinfo->nd_opt_pi_flags_reserved, IPMIP6_ND_OPT_PI_FLAG_AUTO))
|
|
{
|
|
*new_addr_len = pinfo->nd_opt_pi_prefix_len;
|
|
if (*new_addr_len == node->config->inet6.len)
|
|
{
|
|
ipcom_memcpy(new_addr, &node->config->inet6.prefix, sizeof(*new_addr));
|
|
ipmip6_address_apply_prefix(new_addr, &pinfo->nd_opt_pi_prefix, *new_addr_len);
|
|
return IP_TRUE;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
if (rcfg->derive_from_interface)
|
|
{
|
|
Ipmip6mn_coa_notify_t *ifn;
|
|
|
|
/* Try form a CoA based on explicitly specified interface */
|
|
if (rcfg->derive_from_ifindex != 0)
|
|
{
|
|
for (i = 0; i < node->mobile_prefix.mobile_prefix_size; i++)
|
|
{
|
|
Ipmip6_pkt_nd_opt_prefix_info_t *pinfo = &node->mobile_prefix.mobile_prefix[i];
|
|
if (IP_BIT_ISSET(pinfo->nd_opt_pi_flags_reserved, IPMIP6_ND_OPT_PI_FLAG_AUTO))
|
|
{
|
|
*new_addr_len = pinfo->nd_opt_pi_prefix_len;
|
|
ipcom_memcpy(new_addr, &pinfo->nd_opt_pi_prefix, sizeof(*new_addr));
|
|
if (ipmip6mn_mpdisc_prefix_renumber_if(ctx, proc, node, rcfg->derive_from_ifindex, new_addr, new_addr_len))
|
|
return IP_TRUE;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Try form an address based on current CoA interface */
|
|
for (i = 0; i < node->mobile_prefix.mobile_prefix_size; i++)
|
|
{
|
|
Ipmip6_pkt_nd_opt_prefix_info_t *pinfo = &node->mobile_prefix.mobile_prefix[i];
|
|
if (IP_BIT_ISSET(pinfo->nd_opt_pi_flags_reserved, IPMIP6_ND_OPT_PI_FLAG_AUTO))
|
|
{
|
|
*new_addr_len = pinfo->nd_opt_pi_prefix_len;
|
|
ipcom_memcpy(new_addr, &pinfo->nd_opt_pi_prefix, sizeof(*new_addr));
|
|
if (ipmip6mn_mpdisc_prefix_renumber_if(ctx, proc, node, node->ha.coa->ifn->ipmip6.ifp->iff.ifindex, new_addr, new_addr_len))
|
|
return IP_TRUE;
|
|
}
|
|
}
|
|
|
|
/* Go through the interfaces; select the best we'll get */
|
|
for (ifn = IPCOM_LIST_FIRST(&node->config->ifs); ifn != IP_NULL; ifn = IPCOM_LIST_NEXT(&ifn->next))
|
|
{
|
|
if (ifn != node->ha.coa->ifn && ifn->ipmip6.ifp->iff_down == IP_FALSE)
|
|
{
|
|
/* Try form an address based on current CoA interface */
|
|
for (i = 0; i < node->mobile_prefix.mobile_prefix_size; i++)
|
|
{
|
|
Ipmip6_pkt_nd_opt_prefix_info_t *pinfo = &node->mobile_prefix.mobile_prefix[i];
|
|
if (IP_BIT_ISSET(pinfo->nd_opt_pi_flags_reserved, IPMIP6_ND_OPT_PI_FLAG_AUTO))
|
|
{
|
|
*new_addr_len = pinfo->nd_opt_pi_prefix_len;
|
|
ipcom_memcpy(new_addr, &pinfo->nd_opt_pi_prefix, sizeof(*new_addr));
|
|
if (ipmip6mn_mpdisc_prefix_renumber_if(ctx, proc, node, ifn->ipmip6.ifp->iff.ifindex, new_addr, new_addr_len))
|
|
return IP_TRUE;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
return IP_FALSE;
|
|
}
|
|
|
|
IP_STATIC int
|
|
ipmip6mn_service_mpdisc_provide(struct Ipmip6mn_context *ctx,
|
|
struct Ipmip_proc *proc,
|
|
int action,
|
|
struct Ipmip6mn_node *node,
|
|
struct Ipmip6mn_node_config *cfg,
|
|
Ipmip6mn_service_mpdisc_config_t *priv_cfg,
|
|
void *node_data,
|
|
struct Ipmip_timer *service)
|
|
{
|
|
IPMIP_UNUSED_PARAMETER(node_data);
|
|
IPMIP_UNUSED_PARAMETER(cfg);
|
|
IPMIP_UNUSED_PARAMETER(service);
|
|
|
|
if (action == IPMIP_CALLBACK_ENABLE)
|
|
{
|
|
struct Ip_in6_addr new_addr;
|
|
Ip_u8 new_addr_len;
|
|
|
|
if (ipmip6mn_mpdisc_prefix_renumber_resolve(ctx, proc, node, priv_cfg, &new_addr, &new_addr_len))
|
|
{
|
|
if (priv_cfg->save_config)
|
|
{
|
|
ipcom_snprintf(proc->ntop.ntop_pbuf, sizeof(proc->ntop.ntop_pbuf), "%s/%d", ipmip_ntop_inet6(proc, &new_addr, IP_NULL), new_addr_len);
|
|
ipmip_sysvar_set(proc->ntop.ntop_pbuf, "ipmip6mn.%s.homeaddress", node->name);
|
|
}
|
|
|
|
/* Do renumber */
|
|
ipmip6mn_node_renumber(ctx, proc, node, &new_addr, new_addr_len);
|
|
}
|
|
}
|
|
else if (action == IPMIP_CALLBACK_DISABLE)
|
|
{
|
|
/* Currently no action */
|
|
}
|
|
|
|
return IPMIP_CALLBACK_RET_SUCCESS;
|
|
}
|
|
|
|
IP_STATIC void
|
|
ipmip6mn_service_mpdisc_config(struct Ipmip6mn_context *ctx,
|
|
struct Ipmip_proc *proc,
|
|
int action,
|
|
struct Ipmip6mn_node *node,
|
|
struct Ipmip6mn_node_config *cfg,
|
|
Ipmip6mn_service_mpdisc_config_t *priv_cfg,
|
|
Ipmip_cli_message_t *request)
|
|
{
|
|
IPMIP_UNUSED_PARAMETER(ctx);
|
|
IPMIP_UNUSED_PARAMETER(proc);
|
|
IPMIP_UNUSED_PARAMETER(cfg);
|
|
|
|
if (action == IPMIP_CALLBACK_CONFIG_READ)
|
|
{
|
|
char *ifname = ipmip_sysvar("ipmip6mn.%s.mobile_prefix.renumber.derive_from_interface", node->name);
|
|
|
|
priv_cfg->derive_from_config = ipmip_sysvar_bool(IP_FALSE, "ipmip6mn.%s.mobile_prefix.renumber.derive_from_configured", node->name);
|
|
if (ifname)
|
|
{
|
|
priv_cfg->derive_from_ifindex = ipcom_if_nametoindex(ifname);
|
|
if (priv_cfg->derive_from_ifindex == 0)
|
|
{
|
|
int op_val = ipmip_sysvar_cmd_str_to_key(ipmip_sysvar_bool_ops, ifname);
|
|
if (op_val != -1)
|
|
priv_cfg->derive_from_interface = IP_TRUE;
|
|
}
|
|
else
|
|
priv_cfg->derive_from_interface = IP_TRUE;
|
|
ipcom_free(ifname);
|
|
}
|
|
priv_cfg->save_config = ipmip_sysvar_bool(IP_FALSE, "ipmip6mn.%s.mobile_prefix.renumber.save", node->name);
|
|
}
|
|
else if (action == IPMIP_CALLBACK_CONFIG_FREE)
|
|
{
|
|
/* Do nothing */
|
|
}
|
|
else if (action == IPMIP_CALLBACK_CONFIG_DUMP)
|
|
{
|
|
if (priv_cfg->derive_from_ifindex)
|
|
{
|
|
ipmip_cli_config_printf(&request->message,
|
|
"ipmip6mn.%s.mobile_prefix.renumber.derive_from_interface=%s",
|
|
node->name, ipcom_if_indextoname(priv_cfg->derive_from_ifindex, proc->ntop.ntop_name));
|
|
}
|
|
else
|
|
{
|
|
ipmip_cli_config_printf(&request->message,
|
|
"ipmip6mn.%s.mobile_prefix.renumber.derive_from_interface=%s",
|
|
node->name, priv_cfg->derive_from_interface? "true" : "false");
|
|
}
|
|
|
|
ipmip_cli_config_printf(&request->message,
|
|
"ipmip6mn.%s.mobile_prefix.renumber.derive_from_configured=%s",
|
|
node->name, priv_cfg->derive_from_config? "true" : "false");
|
|
|
|
|
|
ipmip_cli_config_printf(&request->message,
|
|
"ipmip6mn.%s.mobile_prefix.renumber.save=%s",
|
|
node->name, priv_cfg->save_config? "true" : "false");
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
****************************************************************************
|
|
* 10 GLOBAL FUNCTIONS
|
|
****************************************************************************
|
|
*/
|
|
|
|
IP_GLOBAL void ipmip6mn_service_mpdisc_install(struct Ipmip6mn_context *ctx);
|
|
IP_GLOBAL void
|
|
ipmip6mn_service_mpdisc_install(struct Ipmip6mn_context *ctx)
|
|
{
|
|
static Ipmip6mn_extension_t srv;
|
|
|
|
srv.name = IPMIP6MN_SERVICE_NAME_MPDISC;
|
|
srv.node_data_size = 0;
|
|
srv.node_config_size = sizeof(Ipmip6mn_service_mpdisc_config_t);
|
|
|
|
srv.config = (Ipmip6mn_extension_config_t)ipmip6mn_service_mpdisc_config;
|
|
srv.provide = (Ipmip6mn_extension_provide_t)ipmip6mn_service_mpdisc_provide;
|
|
|
|
/* This is a PMIP only feature */
|
|
ipmip6mn_context_register_function_mpdisc(ctx, &srv);
|
|
}
|
|
|
|
/*
|
|
****************************************************************************
|
|
* 11 PUBLIC FUNCTIONS
|
|
****************************************************************************
|
|
*/
|
|
|
|
/*
|
|
****************************************************************************
|
|
* END OF FILE
|
|
****************************************************************************
|
|
*/
|