original files of m241
This commit is contained in:
neelimap
@@ -0,0 +1,436 @@
|
||||
|
||||
/*
|
||||
******************************************************************************
|
||||
* INTERPEAK SOURCE FILE
|
||||
*
|
||||
* Document no: @(#) $Name: VXWORKS_ITER40_2019102207 $ $RCSfile: ipmipfa_regext_test.c,v $ $Revision: 1.4.16.1 $
|
||||
* $Source: /home/interpeak/CVSRoot/ipmipfa/config/ipmipfa_regext_test.c,v $
|
||||
* $Author: svc-cmnet $
|
||||
* $State: Exp $ $Locker: $
|
||||
*
|
||||
* INTERPEAK_COPYRIGHT_STRING
|
||||
* Design and implementation by Joel Hortelius <joel.hortelis@interpeak.se>
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
|
||||
/*
|
||||
****************************************************************************
|
||||
* 1 DESCRIPTION
|
||||
****************************************************************************
|
||||
*/
|
||||
|
||||
/*
|
||||
****************************************************************************
|
||||
* 2 CONFIGURATION
|
||||
****************************************************************************
|
||||
*/
|
||||
|
||||
#include "ipmipfa_config.h"
|
||||
|
||||
/*
|
||||
****************************************************************************
|
||||
* 3 INCLUDE FILES
|
||||
****************************************************************************
|
||||
*/
|
||||
#ifdef IPTESTENGINE
|
||||
|
||||
#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_radvd.h>
|
||||
|
||||
#include <ipmip.h>
|
||||
#include <private/ipmip_util.h>
|
||||
#include <private/ipmip_sysvar.h>
|
||||
|
||||
#include <ipmip4.h>
|
||||
#include <private/ipmip4_context.h>
|
||||
#include <private/ipmip4_util.h>
|
||||
#include <private/ipmip4_sysext.h>
|
||||
|
||||
#include "ipmipfa.h"
|
||||
#include "ipmipfa_h.h"
|
||||
#include "ipmipfa_attr_h.h"
|
||||
#include "ipmipfa_if.h"
|
||||
#include "ipmipfa_node.h"
|
||||
#include "ipmipfa_pktbuf.h"
|
||||
|
||||
/*
|
||||
****************************************************************************
|
||||
* 4 DEFINES
|
||||
****************************************************************************
|
||||
*/
|
||||
#define IPMIPFA_REGEXT_TEST_VENDOR_WR "VENDOR-WR"
|
||||
|
||||
/*
|
||||
****************************************************************************
|
||||
* 5 TYPES
|
||||
****************************************************************************
|
||||
*/
|
||||
|
||||
typedef struct Ipmipfa_regext_test_vendor_ext_wr_config_ifp
|
||||
{
|
||||
union Ipmip4_msgext_uhdr *nvse_noop_mn;
|
||||
union Ipmip4_msgext_uhdr *nvse_noop_fa;
|
||||
union Ipmip4_msgext_uhdr *nvse_noop_ha;
|
||||
union Ipmip4_msgext_uhdr *nvse_noop_all;
|
||||
union Ipmip4_msgext_uhdr *cvse_noop_mn;
|
||||
union Ipmip4_msgext_uhdr *cvse_noop_fa;
|
||||
union Ipmip4_msgext_uhdr *cvse_noop_ha;
|
||||
union Ipmip4_msgext_uhdr *cvse_noop_all;
|
||||
} Ipmipfa_regext_test_vendor_ext_wr_config_ifp_t;
|
||||
|
||||
/*
|
||||
****************************************************************************
|
||||
* 6 EXTERN PROTOTYPES
|
||||
****************************************************************************
|
||||
*/
|
||||
|
||||
/*
|
||||
****************************************************************************
|
||||
* 7 LOCAL PROTOTYPES
|
||||
****************************************************************************
|
||||
*/
|
||||
|
||||
/*
|
||||
****************************************************************************
|
||||
* 8 DATA
|
||||
****************************************************************************
|
||||
*/
|
||||
static Ipmipfa_extension_t ipmipfa_regext_test_srv_wr;
|
||||
static Ipmip4_msgext_vendor_parse_ext_t ipmipfa_regext_msgext_wr;
|
||||
|
||||
/*
|
||||
****************************************************************************
|
||||
* 9 STATIC FUNCTIONS
|
||||
****************************************************************************
|
||||
*/
|
||||
|
||||
IP_STATIC int
|
||||
ipmipfa_regext_test_vendor_wr_parse(Ipmipfa_data_t *ctx,
|
||||
Ipmip_proc_t *proc,
|
||||
Ipmipfa_pktbuf_t *pbuf,
|
||||
union Ipmip4_msgext_uhdr *uhdr,
|
||||
Ipmipfa_regext_test_vendor_ext_wr_config_ifp_t *wr)
|
||||
{
|
||||
Ip_size_t sz;
|
||||
|
||||
IPMIP_UNUSED_PARAMETER(pbuf);
|
||||
|
||||
/* There are no CISCO CVSE's */
|
||||
if (IPMIP4_MSGEXT_UHDR_TYPE(uhdr) == IPMIP4_EXT_TYPE_CVSE)
|
||||
{
|
||||
Ipmip4_cvse_t *vse;
|
||||
/* Get the CVSE data */
|
||||
vse = (void *)IPMIP4_MSGEXT_LHDR_EXT_DATA(uhdr);
|
||||
sz = IPMIP4_MSGEXT_CVSE_EXT_SIZE(uhdr);
|
||||
|
||||
switch (IP_GET_NTOHS(&vse->vendor_type))
|
||||
{
|
||||
case IPMIP4_VENDOR_EXT_MSGEXT_WINDRIVER_NOOP_FA:
|
||||
/* Must be atleast 4 byte data */
|
||||
if (sz < 4)
|
||||
return IPMIP4_REG_EXT_POORLY_FORMED;
|
||||
wr->cvse_noop_fa = uhdr;
|
||||
|
||||
IPMIP4_EVENT_IF(INFO, proc,
|
||||
ipmip_log_event_add(&ctx->ipmip4.ipmip,
|
||||
proc,
|
||||
"Wind River Critical Vendor Extension Extension cvse_noop_fa"));
|
||||
break;
|
||||
case IPMIP4_VENDOR_EXT_MSGEXT_WINDRIVER_NOOP_ALL:
|
||||
/* Must be atleast 4 byte data */
|
||||
if (sz < 4)
|
||||
return IPMIP4_REG_EXT_POORLY_FORMED;
|
||||
wr->cvse_noop_all = uhdr;
|
||||
IPMIP4_EVENT_IF(INFO, proc,
|
||||
ipmip_log_event_add(&ctx->ipmip4.ipmip,
|
||||
proc,
|
||||
"Wind River Critical Vendor Extension Extension cvse_noop_all"));
|
||||
break;
|
||||
default:
|
||||
IPMIP4_EVENT_IF(INFO, proc,
|
||||
ipmip_log_event_add(&ctx->ipmip4.ipmip,
|
||||
proc,
|
||||
"Unknown Wind River Critical Vendor Extension Extension %d", IP_GET_NTOHS(&vse->vendor_type)));
|
||||
return IPMIP4_REG_EXT_UNKNOWN_VSE;
|
||||
}
|
||||
|
||||
}
|
||||
else
|
||||
{
|
||||
Ipmip4_nvse_t *vse;
|
||||
/* Get the NVSE data */
|
||||
vse = (void *)IPMIP4_MSGEXT_SHDR_EXT_DATA(uhdr);
|
||||
sz = IPMIP4_MSGEXT_NVSE_EXT_SIZE(uhdr);
|
||||
|
||||
switch (IP_GET_NTOHS(&vse->vendor_type))
|
||||
{
|
||||
case IPMIP4_VENDOR_EXT_MSGEXT_WINDRIVER_NOOP_FA:
|
||||
/* Must be atleast 4 byte data */
|
||||
if (sz < 4)
|
||||
return IPMIP4_REG_EXT_POORLY_FORMED;
|
||||
wr->nvse_noop_fa = uhdr;
|
||||
IPMIP4_EVENT_IF(INFO, proc,
|
||||
ipmip_log_event_add(&ctx->ipmip4.ipmip,
|
||||
proc,
|
||||
"Wind River Normal Vendor Extension Extension nvse_noop_fa"));
|
||||
break;
|
||||
case IPMIP4_VENDOR_EXT_MSGEXT_WINDRIVER_NOOP_ALL:
|
||||
/* Must be atleast 4 byte data */
|
||||
if (sz < 4)
|
||||
return IPMIP4_REG_EXT_POORLY_FORMED;
|
||||
wr->nvse_noop_all = uhdr;
|
||||
IPMIP4_EVENT_IF(INFO, proc,
|
||||
ipmip_log_event_add(&ctx->ipmip4.ipmip,
|
||||
proc,
|
||||
"Wind River Normal Vendor Extension Extension nvse_noop_all"));
|
||||
break;
|
||||
default:
|
||||
IPMIP4_EVENT_IF(INFO, proc,
|
||||
ipmip_log_event_add(&ctx->ipmip4.ipmip,
|
||||
proc,
|
||||
"Unknown Wind River Normal Vendor Extension Extension %d", IP_GET_NTOHS(&vse->vendor_type)));
|
||||
return IPMIP4_REG_EXT_UNKNOWN_VSE;
|
||||
}
|
||||
}
|
||||
|
||||
return IPMIP4_REG_EXT_SUCCESS;
|
||||
}
|
||||
|
||||
IP_STATIC Ipmip4_msgext_uhdr_t *
|
||||
ipmipfa_regext_test_vendor_wr_vse_wr(Ip_bool cvse,
|
||||
Ip_u16 subtype,
|
||||
const char *format,
|
||||
...)
|
||||
{
|
||||
va_list ap;
|
||||
char *value;
|
||||
Ipmip4_msgext_uhdr_t *vse = IP_NULL;
|
||||
|
||||
va_start(ap, format);
|
||||
value = ipmip_vsysvar(format, ap);
|
||||
va_end(ap);
|
||||
|
||||
/**/
|
||||
if (value)
|
||||
{
|
||||
if (cvse)
|
||||
vse = ipmip4_sysext_cvse_alloc(IPMIP_SMI_WIND_RIVER,
|
||||
subtype,
|
||||
value,
|
||||
ipcom_strlen(value));
|
||||
else
|
||||
vse = ipmip4_sysext_nvse_alloc(IPMIP_SMI_WIND_RIVER,
|
||||
subtype,
|
||||
value,
|
||||
ipcom_strlen(value));
|
||||
ipcom_free(value);
|
||||
}
|
||||
|
||||
return vse;
|
||||
}
|
||||
|
||||
IP_STATIC void
|
||||
ipmipfa_regext_test_vendor_wr_req_forward(struct Ipmipfa_data *ctx,
|
||||
struct Ipmip_proc *proc,
|
||||
void *global_config,
|
||||
Ipmipfa_regext_test_vendor_ext_wr_config_ifp_t *ifp_config,
|
||||
void *node_config,
|
||||
struct Ipmipfa_node *node,
|
||||
struct Ipmipfa_pktbuf *pbuf)
|
||||
{
|
||||
IPMIP_UNUSED_PARAMETER(ctx);
|
||||
IPMIP_UNUSED_PARAMETER(proc);
|
||||
IPMIP_UNUSED_PARAMETER(global_config);
|
||||
IPMIP_UNUSED_PARAMETER(node_config);
|
||||
IPMIP_UNUSED_PARAMETER(node);
|
||||
|
||||
if (ifp_config->nvse_noop_mn)
|
||||
ipmip4_msgext_buffer_append_shdr(&pbuf->ipmip4.ipmip.packet, ifp_config->nvse_noop_mn);
|
||||
if (ifp_config->cvse_noop_mn)
|
||||
ipmip4_msgext_buffer_append_lhdr(&pbuf->ipmip4.ipmip.packet, ifp_config->cvse_noop_mn);
|
||||
if (ifp_config->nvse_noop_ha)
|
||||
ipmip4_msgext_buffer_append_shdr(&pbuf->ipmip4.ipmip.packet, ifp_config->nvse_noop_ha);
|
||||
if (ifp_config->cvse_noop_ha)
|
||||
ipmip4_msgext_buffer_append_lhdr(&pbuf->ipmip4.ipmip.packet, ifp_config->cvse_noop_ha);
|
||||
if (ifp_config->nvse_noop_fa)
|
||||
ipmip4_msgext_buffer_append_shdr(&pbuf->ipmip4.ipmip.packet, ifp_config->nvse_noop_fa);
|
||||
if (ifp_config->cvse_noop_fa)
|
||||
ipmip4_msgext_buffer_append_lhdr(&pbuf->ipmip4.ipmip.packet, ifp_config->cvse_noop_fa);
|
||||
if (ifp_config->nvse_noop_all)
|
||||
ipmip4_msgext_buffer_append_shdr(&pbuf->ipmip4.ipmip.packet, ifp_config->nvse_noop_all);
|
||||
if (ifp_config->cvse_noop_all)
|
||||
ipmip4_msgext_buffer_append_lhdr(&pbuf->ipmip4.ipmip.packet, ifp_config->cvse_noop_all);
|
||||
}
|
||||
|
||||
|
||||
IP_STATIC void
|
||||
ipmipfa_regext_test_vendor_wr_rep_forward(struct Ipmipfa_data *ctx,
|
||||
struct Ipmip_proc *proc,
|
||||
void *global_config,
|
||||
Ipmipfa_regext_test_vendor_ext_wr_config_ifp_t *ifp_config,
|
||||
void *node_config,
|
||||
struct Ipmipfa_node *node,
|
||||
struct Ipmipfa_pktbuf *pbuf)
|
||||
{
|
||||
IPMIP_UNUSED_PARAMETER(ctx);
|
||||
IPMIP_UNUSED_PARAMETER(proc);
|
||||
IPMIP_UNUSED_PARAMETER(global_config);
|
||||
IPMIP_UNUSED_PARAMETER(node_config);
|
||||
IPMIP_UNUSED_PARAMETER(node);
|
||||
|
||||
if (ifp_config->nvse_noop_mn)
|
||||
ipmip4_msgext_buffer_append_shdr(&pbuf->ipmip4.ipmip.packet, ifp_config->nvse_noop_mn);
|
||||
if (ifp_config->cvse_noop_mn)
|
||||
ipmip4_msgext_buffer_append_lhdr(&pbuf->ipmip4.ipmip.packet, ifp_config->cvse_noop_mn);
|
||||
if (ifp_config->nvse_noop_ha)
|
||||
ipmip4_msgext_buffer_append_shdr(&pbuf->ipmip4.ipmip.packet, ifp_config->nvse_noop_ha);
|
||||
if (ifp_config->cvse_noop_ha)
|
||||
ipmip4_msgext_buffer_append_lhdr(&pbuf->ipmip4.ipmip.packet, ifp_config->cvse_noop_ha);
|
||||
if (ifp_config->nvse_noop_fa)
|
||||
ipmip4_msgext_buffer_append_shdr(&pbuf->ipmip4.ipmip.packet, ifp_config->nvse_noop_fa);
|
||||
if (ifp_config->cvse_noop_fa)
|
||||
ipmip4_msgext_buffer_append_lhdr(&pbuf->ipmip4.ipmip.packet, ifp_config->cvse_noop_fa);
|
||||
if (ifp_config->nvse_noop_all)
|
||||
ipmip4_msgext_buffer_append_shdr(&pbuf->ipmip4.ipmip.packet, ifp_config->nvse_noop_all);
|
||||
if (ifp_config->cvse_noop_all)
|
||||
ipmip4_msgext_buffer_append_lhdr(&pbuf->ipmip4.ipmip.packet, ifp_config->cvse_noop_all);
|
||||
}
|
||||
|
||||
|
||||
IP_STATIC void
|
||||
ipmipfa_regext_test_vendor_wr_config(struct Ipmipfa_data *ctx,
|
||||
struct Ipmip_proc *proc,
|
||||
int action,
|
||||
struct Ipmipfa_iff *ifp,
|
||||
void *gcfg,
|
||||
Ipmipfa_regext_test_vendor_ext_wr_config_ifp_t *cfg,
|
||||
Ipmip_cli_message_t *request)
|
||||
{
|
||||
IPMIP_UNUSED_PARAMETER(ctx);
|
||||
IPMIP_UNUSED_PARAMETER(proc);
|
||||
IPMIP_UNUSED_PARAMETER(gcfg);
|
||||
IPMIP_UNUSED_PARAMETER(request);
|
||||
|
||||
if (action == IPMIP_CALLBACK_CONFIG_READ)
|
||||
{
|
||||
cfg->nvse_noop_mn = ipmipfa_regext_test_vendor_wr_vse_wr(IP_FALSE,
|
||||
IPMIP4_VENDOR_EXT_MSGEXT_WINDRIVER_NOOP_MN,
|
||||
"ipmipfa.if.%s.nvse.wr.mn",
|
||||
ifp->iff.ipmip.ifname);
|
||||
cfg->cvse_noop_mn = ipmipfa_regext_test_vendor_wr_vse_wr(IP_TRUE,
|
||||
IPMIP4_VENDOR_EXT_MSGEXT_WINDRIVER_NOOP_MN,
|
||||
"ipmipfa.if.%s.cvse.wr.mn",
|
||||
ifp->iff.ipmip.ifname);
|
||||
cfg->nvse_noop_ha = ipmipfa_regext_test_vendor_wr_vse_wr(IP_FALSE,
|
||||
IPMIP4_VENDOR_EXT_MSGEXT_WINDRIVER_NOOP_HA,
|
||||
"ipmipfa.if.%s.nvse.wr.ha",
|
||||
ifp->iff.ipmip.ifname);
|
||||
cfg->cvse_noop_ha = ipmipfa_regext_test_vendor_wr_vse_wr(IP_TRUE,
|
||||
IPMIP4_VENDOR_EXT_MSGEXT_WINDRIVER_NOOP_HA,
|
||||
"ipmipfa.if.%s.cvse.wr.ha",
|
||||
ifp->iff.ipmip.ifname);
|
||||
cfg->nvse_noop_fa = ipmipfa_regext_test_vendor_wr_vse_wr(IP_FALSE,
|
||||
IPMIP4_VENDOR_EXT_MSGEXT_WINDRIVER_NOOP_FA,
|
||||
"ipmipfa.if.%s.nvse.wr.fa",
|
||||
ifp->iff.ipmip.ifname);
|
||||
cfg->cvse_noop_fa = ipmipfa_regext_test_vendor_wr_vse_wr(IP_TRUE,
|
||||
IPMIP4_VENDOR_EXT_MSGEXT_WINDRIVER_NOOP_FA,
|
||||
"ipmipfa.if.%s.cvse.wr.fa",
|
||||
ifp->iff.ipmip.ifname);
|
||||
cfg->nvse_noop_all = ipmipfa_regext_test_vendor_wr_vse_wr(IP_FALSE,
|
||||
IPMIP4_VENDOR_EXT_MSGEXT_WINDRIVER_NOOP_ALL,
|
||||
"ipmipfa.if.%s.nvse.wr.all",
|
||||
ifp->iff.ipmip.ifname);
|
||||
cfg->cvse_noop_all = ipmipfa_regext_test_vendor_wr_vse_wr(IP_TRUE,
|
||||
IPMIP4_VENDOR_EXT_MSGEXT_WINDRIVER_NOOP_ALL,
|
||||
"ipmipfa.if.%s.cvse.wr.all",
|
||||
ifp->iff.ipmip.ifname);
|
||||
}
|
||||
else if (action == IPMIP_CALLBACK_CONFIG_FREE)
|
||||
{
|
||||
if (cfg->nvse_noop_mn)
|
||||
ipcom_free(cfg->nvse_noop_mn);
|
||||
if (cfg->cvse_noop_mn)
|
||||
ipcom_free(cfg->cvse_noop_mn);
|
||||
if (cfg->nvse_noop_ha)
|
||||
ipcom_free(cfg->nvse_noop_ha);
|
||||
if (cfg->cvse_noop_ha)
|
||||
ipcom_free(cfg->cvse_noop_ha);
|
||||
if (cfg->nvse_noop_fa)
|
||||
ipcom_free(cfg->nvse_noop_fa);
|
||||
if (cfg->cvse_noop_fa)
|
||||
ipcom_free(cfg->cvse_noop_fa);
|
||||
if (cfg->nvse_noop_all)
|
||||
ipcom_free(cfg->nvse_noop_all);
|
||||
if (cfg->cvse_noop_all)
|
||||
ipcom_free(cfg->cvse_noop_all);
|
||||
}
|
||||
else if (action == IPMIP_CALLBACK_CONFIG_DUMP)
|
||||
{
|
||||
/* Could dump, but dont bother */
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
****************************************************************************
|
||||
* 10 GLOBAL FUNCTIONS
|
||||
****************************************************************************
|
||||
*/
|
||||
|
||||
IP_GLOBAL void ipmipfa_regext_test_install(void);
|
||||
IP_GLOBAL void
|
||||
ipmipfa_regext_test_install(void)
|
||||
{
|
||||
ipcom_memset(&ipmipfa_regext_test_srv_wr, 0, sizeof(ipmipfa_regext_test_srv_wr));
|
||||
|
||||
ipmipfa_regext_test_srv_wr.name = IPMIPFA_REGEXT_TEST_VENDOR_WR;
|
||||
ipmipfa_regext_test_srv_wr.ifp_data_size = sizeof(Ipmipfa_regext_test_vendor_ext_wr_config_ifp_t);
|
||||
ipmipfa_regext_test_srv_wr.config_ifp = (Ipmipfa_extension_config_ifp_t)ipmipfa_regext_test_vendor_wr_config;
|
||||
|
||||
ipmipfa_regext_test_srv_wr.pkt_rep_forward = (Ipmipfa_extension_pkt_rep_forward_t)ipmipfa_regext_test_vendor_wr_rep_forward;
|
||||
ipmipfa_regext_test_srv_wr.pkt_req_forward = (Ipmipfa_extension_pkt_req_forward_t)ipmipfa_regext_test_vendor_wr_req_forward;
|
||||
|
||||
ipmipfa_context_register_extension(&ipmipfa_regext_test_srv_wr, IPMIPFA_FUNCTION_REGEXT);
|
||||
|
||||
ipcom_memset(&ipmipfa_regext_msgext_wr, 0, sizeof(ipmipfa_regext_msgext_wr));
|
||||
ipmipfa_regext_msgext_wr.vendor_id = IPMIP_SMI_WIND_RIVER;
|
||||
ipmipfa_regext_msgext_wr.parse = (Ipmip4_msgext_parse_ext_t) ipmipfa_regext_test_vendor_wr_parse;
|
||||
ipmipfa_regext_msgext_wr.pktaux.pktbuf_data_size = sizeof(Ipmipfa_regext_test_vendor_ext_wr_config_ifp_t);
|
||||
ipmipfa_msgext_vendor_parse_ext_register(&ipmipfa_regext_msgext_wr);
|
||||
}
|
||||
|
||||
#else
|
||||
IP_GLOBAL void ipmipfa_regext_test_install(void);
|
||||
IP_GLOBAL void
|
||||
ipmipfa_regext_test_install(void)
|
||||
{
|
||||
}
|
||||
#endif
|
||||
|
||||
/*
|
||||
****************************************************************************
|
||||
* 11 PUBLIC FUNCTIONS
|
||||
****************************************************************************
|
||||
*/
|
||||
|
||||
/*
|
||||
****************************************************************************
|
||||
* END OF FILE
|
||||
****************************************************************************
|
||||
*/
|
||||
Reference in New Issue
Block a user