470 lines
20 KiB
C
470 lines
20 KiB
C
|
|
/*
|
|
******************************************************************************
|
|
* INTERPEAK SOURCE FILE
|
|
*
|
|
* Document no: @(#) $Name: VXWORKS_ITER40_2019102207 $ $RCSfile: ipmip6ha_service_testext.c,v $ $Revision: 1.6 $
|
|
* $Source: /home/interpeak/CVSRoot/ipmip6ha/config/ipmip6ha_service_testext.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_strlib.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 <private/ipmip6_mh.h>
|
|
#include <private/ipmip6_mh_pkt.h>
|
|
|
|
#include "ipmip6ha_h.h"
|
|
#include "ipmip6ha_attr_h.h"
|
|
#include "ipmip6ha_if.h"
|
|
#include "ipmip6ha_node.h"
|
|
#include "ipmip6ha_pktbuf.h"
|
|
#include "ipmip6ha_nemo.h"
|
|
|
|
/*
|
|
****************************************************************************
|
|
* 4 DEFINES
|
|
****************************************************************************
|
|
*/
|
|
#define IPMIP6HA_SERVICE_SERVICE_SELECTION "SERVICE-SELECTION"
|
|
#define IPMIP6HA_SERVICE_VENDOR_EXTENSION "VENDOR-EXTENSION"
|
|
|
|
/*
|
|
****************************************************************************
|
|
* 5 TYPES
|
|
****************************************************************************
|
|
*/
|
|
typedef struct Ipmip6ha_service_selection_config
|
|
{
|
|
Ip_bool enabled;
|
|
Ip_bool change_allowed;
|
|
} Ipmip6ha_service_selection_config_t;
|
|
|
|
|
|
typedef struct Ipmip6ha_service_selection_node_handle
|
|
{
|
|
Ip_bool enabled;
|
|
Ipmip6_mh_mo_service_selection_mobility_option_t *selection;
|
|
} Ipmip6ha_service_selection_node_handle_t;
|
|
|
|
|
|
/*
|
|
****************************************************************************
|
|
* 6 EXTERN PROTOTYPES
|
|
****************************************************************************
|
|
*/
|
|
|
|
/*
|
|
****************************************************************************
|
|
* 7 LOCAL PROTOTYPES
|
|
****************************************************************************
|
|
*/
|
|
|
|
/*
|
|
****************************************************************************
|
|
* 8 DATA
|
|
****************************************************************************
|
|
*/
|
|
|
|
/*
|
|
****************************************************************************
|
|
* 9 STATIC FUNCTIONS
|
|
****************************************************************************
|
|
*/
|
|
IP_STATIC void
|
|
ipmip6ha_service_selection_config_global(struct Ipmip6ha_context *ctx,
|
|
struct Ipmip_proc *proc,
|
|
int action,
|
|
Ipmip6ha_service_selection_config_t *gcfg,
|
|
Ipmip_cli_message_t *request)
|
|
{
|
|
IPMIP_UNUSED_PARAMETER(ctx);
|
|
IPMIP_UNUSED_PARAMETER(proc);
|
|
IPMIP_UNUSED_PARAMETER(gcfg);
|
|
|
|
if (action == IPMIP_CALLBACK_CONFIG_READ)
|
|
{
|
|
gcfg->enabled = ipmip_sysvar_bool(IP_FALSE, "ipmip6ha.service_selection.enabled");
|
|
gcfg->change_allowed = ipmip_sysvar_bool(IP_FALSE, "ipmip6ha.service_selection.changeable");
|
|
}
|
|
else if (action == IPMIP_CALLBACK_CONFIG_FREE)
|
|
{
|
|
/* Do nothing */
|
|
}
|
|
else if (action == IPMIP_CALLBACK_CONFIG_DUMP)
|
|
{
|
|
ipmip_cli_config_printf(&request->message,
|
|
"ipmip6ha.service_selection.enabled=%s",
|
|
gcfg->enabled? "enabled" : "disabled");
|
|
ipmip_cli_config_printf(&request->message,
|
|
"ipmip6ha.service_selection.changeable=%s",
|
|
gcfg->change_allowed? "enabled" : "disabled");
|
|
}
|
|
}
|
|
|
|
IP_STATIC void
|
|
ipmip6ha_service_selection_config(struct Ipmip6ha_context *ctx,
|
|
struct Ipmip_proc *proc,
|
|
int action,
|
|
struct Ipmip6ha_if *ifp,
|
|
Ipmip6ha_service_selection_config_t *gcfg,
|
|
Ipmip6ha_service_selection_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)
|
|
{
|
|
cfg->enabled = ipmip_sysvar_bool(gcfg->enabled, "ipmip6ha.interface.%s.service_selection.enabled", ifp->ipmip6.iff.ifname);
|
|
cfg->change_allowed = ipmip_sysvar_bool(gcfg->enabled, "ipmip6ha.interface.%s.service_selection.changeable", ifp->ipmip6.iff.ifname);
|
|
}
|
|
else if (action == IPMIP_CALLBACK_CONFIG_FREE)
|
|
{
|
|
/* Do nothing */
|
|
}
|
|
else if (action == IPMIP_CALLBACK_CONFIG_DUMP)
|
|
{
|
|
ipmip_cli_config_printf(&request->message,
|
|
"ipmip6ha.interface.%s.service_selection.enabled=%s",
|
|
ifp->ipmip6.iff.ifname, cfg->enabled? "enabled" : "disabled");
|
|
ipmip_cli_config_printf(&request->message,
|
|
"ipmip6ha.interface.%s.service_selection.changeable=%s",
|
|
ifp->ipmip6.iff.ifname, cfg->change_allowed? "enabled" : "disabled");
|
|
}
|
|
}
|
|
|
|
|
|
IP_STATIC Ip_bool
|
|
ipmip6ha_service_selection_pkt_request_validate(struct Ipmip6ha_context *ctx,
|
|
struct Ipmip_proc *proc,
|
|
Ipmip6ha_service_selection_config_t *gcfg,
|
|
Ipmip6ha_service_selection_config_t *cfg,
|
|
Ipmip6ha_service_selection_node_handle_t *handle,
|
|
struct Ipmip6ha_node *node,
|
|
struct Ipmip6ha_pktbuf *pbuf,
|
|
struct Ipmip_timer *service)
|
|
{
|
|
|
|
IPMIP_UNUSED_PARAMETER(service);
|
|
IPMIP_UNUSED_PARAMETER(handle);
|
|
IPMIP_UNUSED_PARAMETER(gcfg);
|
|
|
|
if (pbuf->ipmip6.mo.service_selection != IP_NULL)
|
|
{
|
|
if (cfg->enabled)
|
|
{
|
|
/* Here's the time to verify if the selection's valid */
|
|
if (handle->enabled != IP_FALSE)
|
|
{
|
|
/* Already have a service setup?*/
|
|
if (!ipmip6_mh_mo_cmp(&pbuf->ipmip6.mo.service_selection->hdr, &handle->selection->hdr))
|
|
{
|
|
if (cfg->change_allowed)
|
|
{
|
|
/* Mismatch; redo selection */
|
|
IPMIP6_EVENT_IF(DEBUG, proc,
|
|
ipmip_log_event_add(&ctx->ipmip6.ipmip,
|
|
proc,
|
|
"%s changing service selection to '%s'",
|
|
ipmip6ha_node_describe(proc, node),
|
|
ipmip_ntop_strn(proc, (char *)&pbuf->ipmip6.mo.service_selection->identifier[0], pbuf->ipmip6.mo.service_selection->hdr.len)));
|
|
|
|
pbuf->update_services = IP_TRUE;
|
|
}
|
|
else
|
|
{
|
|
ipmip_pktbuf_error(&pbuf->ipmip6.ipmip,
|
|
IPMIP6_MH_BA_STATUS_ERROR_SERVICE_AUTHORIZATION_FAILED,
|
|
"service selection '%s' specified, but not provided by home agent",
|
|
ipmip_ntop_strn(proc, (char *)&pbuf->ipmip6.mo.service_selection->identifier[0], pbuf->ipmip6.mo.service_selection->hdr.len));
|
|
ipmip6ha_node_delete(ctx, proc, node, "service selection disallowed");
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
ipmip_pktbuf_error(&pbuf->ipmip6.ipmip,
|
|
IPMIP6_MH_BA_STATUS_ERROR_SERVICE_AUTHORIZATION_FAILED,
|
|
"service selection '%s' specified, but not provided by home agent",
|
|
ipmip_ntop_strn(proc, (char *)&pbuf->ipmip6.mo.service_selection->identifier[0], pbuf->ipmip6.mo.service_selection->hdr.len));
|
|
}
|
|
}
|
|
|
|
/* Don't delay */
|
|
return IP_FALSE;
|
|
}
|
|
|
|
|
|
IP_STATIC Ip_bool
|
|
ipmip6ha_service_selection_pkt_request_accept(struct Ipmip6ha_context *ctx,
|
|
struct Ipmip_proc *proc,
|
|
Ipmip6ha_service_selection_config_t *gcfg,
|
|
Ipmip6ha_service_selection_config_t *cfg,
|
|
Ipmip6ha_service_selection_node_handle_t *handle,
|
|
struct Ipmip6ha_node *node,
|
|
struct Ipmip6ha_pktbuf *pbuf,
|
|
struct Ipmip_timer *service)
|
|
{
|
|
IPMIP_UNUSED_PARAMETER(service);
|
|
IPMIP_UNUSED_PARAMETER(handle);
|
|
IPMIP_UNUSED_PARAMETER(gcfg);
|
|
IPMIP_UNUSED_PARAMETER(cfg);
|
|
|
|
if (pbuf->ipmip6.mo.service_selection != IP_NULL)
|
|
{
|
|
/* Only store the service first time around */
|
|
if (handle->enabled == IP_FALSE)
|
|
{
|
|
/* Store the selected service; we'll use it later in provde */
|
|
handle->selection = (void *)ipmip6_mh_mo_dup(&pbuf->ipmip6.mo.service_selection->hdr);
|
|
handle->enabled = IP_TRUE;
|
|
|
|
/* Mismatch; redo selection */
|
|
IPMIP6_EVENT_IF(DEBUG, proc,
|
|
ipmip_log_event_add(&ctx->ipmip6.ipmip,
|
|
proc,
|
|
"%s accepting service selection '%s'",
|
|
ipmip6ha_node_describe(proc, node),
|
|
ipmip_ntop_strn(proc, (char *)&pbuf->ipmip6.mo.service_selection->identifier[0], pbuf->ipmip6.mo.service_selection->hdr.len)));
|
|
}
|
|
}
|
|
|
|
/* Don't delay */
|
|
return IP_FALSE;
|
|
}
|
|
|
|
|
|
IP_STATIC int
|
|
ipmip6ha_service_selection_provide(struct Ipmip6ha_context *ctx,
|
|
struct Ipmip_proc *proc,
|
|
int action,
|
|
Ipmip6ha_service_selection_config_t *gcfg,
|
|
Ipmip6ha_service_selection_config_t *cfg,
|
|
Ipmip6ha_service_selection_node_handle_t *handle,
|
|
struct Ipmip6ha_node *node,
|
|
struct Ipmip_timer *service)
|
|
{
|
|
IPMIP_UNUSED_PARAMETER(service);
|
|
IPMIP_UNUSED_PARAMETER(cfg);
|
|
IPMIP_UNUSED_PARAMETER(gcfg);
|
|
|
|
if (action == IPMIP_CALLBACK_ENABLE)
|
|
{
|
|
if (handle->enabled)
|
|
{
|
|
/* Do what? */
|
|
IPMIP6_EVENT_IF(INFO, proc,
|
|
ipmip_log_event_add(&ctx->ipmip6.ipmip,
|
|
proc,
|
|
"%s enabling service selection '%s'",
|
|
ipmip6ha_node_describe(proc, node),
|
|
ipmip_ntop_strn(proc, (char *)&handle->selection->identifier[0], handle->selection->hdr.len)));
|
|
}
|
|
}
|
|
else if (action == IPMIP_CALLBACK_DISABLE)
|
|
{
|
|
if (handle->enabled)
|
|
{
|
|
/* Disable whatever service setup we've got */
|
|
|
|
/* Free & Reset */
|
|
ipcom_free(handle->selection);
|
|
handle->enabled = IP_FALSE;
|
|
}
|
|
}
|
|
else if (action == IPMIP_CALLBACK_UPDATE)
|
|
{
|
|
/* We're redoing the service setups */
|
|
if (handle->enabled)
|
|
{
|
|
/* Disable whatever service setup we've got */
|
|
|
|
/* Free & Reset */
|
|
ipcom_free(handle->selection);
|
|
handle->enabled = IP_FALSE;
|
|
}
|
|
|
|
/* Indicate that this service needs to be re-setup; if you ignore UPDATE dont return failure */
|
|
return IPMIP_CALLBACK_RET_FAILED;
|
|
}
|
|
|
|
/* Don't delay */
|
|
return IPMIP_CALLBACK_RET_SUCCESS;
|
|
}
|
|
|
|
|
|
IP_STATIC Ip_bool
|
|
ipmip6ha_service_vendor_extension_pkt_request_accept(struct Ipmip6ha_context *ctx,
|
|
struct Ipmip_proc *proc,
|
|
void *gcfg,
|
|
void *cfg,
|
|
void *handle,
|
|
struct Ipmip6ha_node *node,
|
|
struct Ipmip6ha_pktbuf *pbuf,
|
|
struct Ipmip_timer *service)
|
|
{
|
|
IPMIP_UNUSED_PARAMETER(service);
|
|
IPMIP_UNUSED_PARAMETER(handle);
|
|
IPMIP_UNUSED_PARAMETER(gcfg);
|
|
IPMIP_UNUSED_PARAMETER(cfg);
|
|
|
|
if (pbuf->ipmip6.mo.vendor_options.numelem > 0)
|
|
{
|
|
Ipmip6_mh_mo_vendor_specific_mobility_option_t *mo;
|
|
unsigned i;
|
|
|
|
for (i = 0; i < pbuf->ipmip6.mo.vendor_options.numelem; i++)
|
|
{
|
|
mo = (Ipmip6_mh_mo_vendor_specific_mobility_option_t*)pbuf->ipmip6.mo.vendor_options.hdrs[i];
|
|
|
|
/* Mismatch; redo selection */
|
|
IPMIP6_EVENT_IF(INFO, proc,
|
|
ipmip_log_event_add(&ctx->ipmip6.ipmip,
|
|
proc,
|
|
"%s received Vendor Extension %u.%u",
|
|
ipmip6ha_node_describe(proc, node),
|
|
IP_GET_NTOHL(&mo->vendor_id), mo->sub_type));
|
|
}
|
|
}
|
|
|
|
/* Don't delay */
|
|
return IP_FALSE;
|
|
}
|
|
|
|
/* Echo the Vendor Extension */
|
|
IP_STATIC void
|
|
ipmip6ha_service_selection_pkt_reply_apply(struct Ipmip6ha_context *ctx,
|
|
struct Ipmip_proc *proc,
|
|
void *gcfg,
|
|
void *cfg,
|
|
void *handle,
|
|
struct Ipmip6ha_node *node,
|
|
struct Ipmip6ha_pktbuf *pbuf_reply,
|
|
struct Ipmip6ha_pktbuf *pbuf_req)
|
|
{
|
|
IPMIP_UNUSED_PARAMETER(handle);
|
|
IPMIP_UNUSED_PARAMETER(gcfg);
|
|
IPMIP_UNUSED_PARAMETER(cfg);
|
|
IPMIP_UNUSED_PARAMETER(node);
|
|
|
|
if (pbuf_req->ipmip6.mo.vendor_options.numelem > 0)
|
|
{
|
|
Ipmip6_mh_mo_vendor_specific_mobility_option_t *mo;
|
|
unsigned i;
|
|
|
|
for (i = 0; i < pbuf_req->ipmip6.mo.vendor_options.numelem; i++)
|
|
{
|
|
mo = (Ipmip6_mh_mo_vendor_specific_mobility_option_t*)pbuf_req->ipmip6.mo.vendor_options.hdrs[i];
|
|
ipmip6_mh_pkt_opt_add_mo(&ctx->ipmip6,
|
|
proc,
|
|
&pbuf_reply->ipmip6,
|
|
&mo->hdr);
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
****************************************************************************
|
|
* 10 GLOBAL FUNCTIONS
|
|
****************************************************************************
|
|
*/
|
|
|
|
IP_GLOBAL void ipmip6ha_service_testext_install(struct Ipmip6ha_context *ctx);
|
|
IP_GLOBAL void
|
|
ipmip6ha_service_testext_install(struct Ipmip6ha_context *ctx)
|
|
{
|
|
static Ipmip6ha_extension_t srv_sel;
|
|
static Ipmip6ha_extension_t srv_ven;
|
|
|
|
ipcom_memset(&srv_sel, 0, sizeof(srv_sel));
|
|
|
|
srv_sel.name = IPMIP6HA_SERVICE_SERVICE_SELECTION;
|
|
srv_sel.ifp_data_size = sizeof(Ipmip6ha_service_selection_config_t);
|
|
srv_sel.global_data_size= sizeof(Ipmip6ha_service_selection_config_t);
|
|
srv_sel.node_data_size = sizeof(Ipmip6ha_service_selection_node_handle_t);
|
|
|
|
srv_sel.config_global = (Ipmip6ha_extension_config_global_t)ipmip6ha_service_selection_config_global;
|
|
srv_sel.config_ifp = (Ipmip6ha_extension_config_ifp_t)ipmip6ha_service_selection_config;
|
|
srv_sel.provide = (Ipmip6ha_extension_provide_t)ipmip6ha_service_selection_provide;
|
|
srv_sel.pkt_req_accept = (Ipmip6ha_extension_pkt_req_accept_t)ipmip6ha_service_selection_pkt_request_accept;
|
|
srv_sel.pkt_req_validate= (Ipmip6ha_extension_pkt_req_validate_t)ipmip6ha_service_selection_pkt_request_validate;
|
|
|
|
/* This is a PMIP only feature */
|
|
ipmip6ha_context_register_extension(ctx, &srv_sel, IP_TRUE, IP_TRUE);
|
|
|
|
ipcom_memset(&srv_ven, 0, sizeof(srv_ven));
|
|
|
|
srv_ven.name = IPMIP6HA_SERVICE_VENDOR_EXTENSION;
|
|
srv_ven.pkt_req_accept = (Ipmip6ha_extension_pkt_req_accept_t)ipmip6ha_service_vendor_extension_pkt_request_accept;
|
|
srv_ven.pkt_rep_apply = (Ipmip6ha_extension_pkt_rep_apply_t)ipmip6ha_service_selection_pkt_reply_apply;
|
|
|
|
/* This is a PMIP only feature */
|
|
ipmip6ha_context_register_extension(ctx, &srv_ven, IP_TRUE, IP_TRUE);
|
|
}
|
|
|
|
|
|
/*
|
|
****************************************************************************
|
|
* 11 PUBLIC FUNCTIONS
|
|
****************************************************************************
|
|
*/
|
|
|
|
/*
|
|
****************************************************************************
|
|
* END OF FILE
|
|
****************************************************************************
|
|
*/
|
|
|
|
|