NetServicesSource - NetServices Stack source

Users » donatien » Code » NetServicesSource

NetServices Stack source

Dependents: HelloWorld ServoInterfaceBoardExample1 4180_Lab4

lwip/core/snmp/mib_structs.c@0:632c9925f013, 2010-06-11 (annotated)

Committer:: donatien
Date:: Fri Jun 11 16:05:15 2010 +0000
Revision:: 0:632c9925f013
Child:: 5:dd63a1e02b1b

Who changed what in which revision?

User	Revision	Line number	New contents of line
donatien	0:632c9925f013	1	/**
donatien	0:632c9925f013	2	* @file
donatien	0:632c9925f013	3	* MIB tree access/construction functions.
donatien	0:632c9925f013	4	*/
donatien	0:632c9925f013	5
donatien	0:632c9925f013	6	/*
donatien	0:632c9925f013	7	* Copyright (c) 2006 Axon Digital Design B.V., The Netherlands.
donatien	0:632c9925f013	8	* All rights reserved.
donatien	0:632c9925f013	9	*
donatien	0:632c9925f013	10	* Redistribution and use in source and binary forms, with or without modification,
donatien	0:632c9925f013	11	* are permitted provided that the following conditions are met:
donatien	0:632c9925f013	12	*
donatien	0:632c9925f013	13	* 1. Redistributions of source code must retain the above copyright notice,
donatien	0:632c9925f013	14	* this list of conditions and the following disclaimer.
donatien	0:632c9925f013	15	* 2. Redistributions in binary form must reproduce the above copyright notice,
donatien	0:632c9925f013	16	* this list of conditions and the following disclaimer in the documentation
donatien	0:632c9925f013	17	* and/or other materials provided with the distribution.
donatien	0:632c9925f013	18	* 3. The name of the author may not be used to endorse or promote products
donatien	0:632c9925f013	19	* derived from this software without specific prior written permission.
donatien	0:632c9925f013	20	*
donatien	0:632c9925f013	21	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
donatien	0:632c9925f013	22	* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
donatien	0:632c9925f013	23	* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT
donatien	0:632c9925f013	24	* SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
donatien	0:632c9925f013	25	* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
donatien	0:632c9925f013	26	* OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
donatien	0:632c9925f013	27	* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
donatien	0:632c9925f013	28	* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
donatien	0:632c9925f013	29	* IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
donatien	0:632c9925f013	30	* OF SUCH DAMAGE.
donatien	0:632c9925f013	31	*
donatien	0:632c9925f013	32	* Author: Christiaan Simons <christiaan.simons@axon.tv>
donatien	0:632c9925f013	33	*/
donatien	0:632c9925f013	34
donatien	0:632c9925f013	35	#include "lwip/opt.h"
donatien	0:632c9925f013	36
donatien	0:632c9925f013	37	#if LWIP_SNMP /* don't build if not configured for use in lwipopts.h */
donatien	0:632c9925f013	38
donatien	0:632c9925f013	39	#include "lwip/snmp_structs.h"
donatien	0:632c9925f013	40	#include "lwip/memp.h"
donatien	0:632c9925f013	41	#include "lwip/netif.h"
donatien	0:632c9925f013	42
donatien	0:632c9925f013	43	/** .iso.org.dod.internet address prefix, @see snmp_iso_() /
donatien	0:632c9925f013	44	const s32_t prefix[4] = {1, 3, 6, 1};
donatien	0:632c9925f013	45
donatien	0:632c9925f013	46	#define NODE_STACK_SIZE (LWIP_SNMP_OBJ_ID_LEN)
donatien	0:632c9925f013	47	/** node stack entry (old news?) */
donatien	0:632c9925f013	48	struct nse
donatien	0:632c9925f013	49	{
donatien	0:632c9925f013	50	/** right child */
donatien	0:632c9925f013	51	struct mib_node* r_ptr;
donatien	0:632c9925f013	52	/** right child identifier */
donatien	0:632c9925f013	53	s32_t r_id;
donatien	0:632c9925f013	54	/** right child next level */
donatien	0:632c9925f013	55	u8_t r_nl;
donatien	0:632c9925f013	56	};
donatien	0:632c9925f013	57	static u8_t node_stack_cnt;
donatien	0:632c9925f013	58	static struct nse node_stack[NODE_STACK_SIZE];
donatien	0:632c9925f013	59
donatien	0:632c9925f013	60	/**
donatien	0:632c9925f013	61	* Pushes nse struct onto stack.
donatien	0:632c9925f013	62	*/
donatien	0:632c9925f013	63	static void
donatien	0:632c9925f013	64	push_node(struct nse* node)
donatien	0:632c9925f013	65	{
donatien	0:632c9925f013	66	LWIP_ASSERT("node_stack_cnt < NODE_STACK_SIZE",node_stack_cnt < NODE_STACK_SIZE);
donatien	0:632c9925f013	67	LWIP_DEBUGF(SNMP_MIB_DEBUG,("push_node() node=%p id=%"S32_F"\n",(void*)(node->r_ptr),node->r_id));
donatien	0:632c9925f013	68	if (node_stack_cnt < NODE_STACK_SIZE)
donatien	0:632c9925f013	69	{
donatien	0:632c9925f013	70	node_stack[node_stack_cnt] = *node;
donatien	0:632c9925f013	71	node_stack_cnt++;
donatien	0:632c9925f013	72	}
donatien	0:632c9925f013	73	}
donatien	0:632c9925f013	74
donatien	0:632c9925f013	75	/**
donatien	0:632c9925f013	76	* Pops nse struct from stack.
donatien	0:632c9925f013	77	*/
donatien	0:632c9925f013	78	static void
donatien	0:632c9925f013	79	pop_node(struct nse* node)
donatien	0:632c9925f013	80	{
donatien	0:632c9925f013	81	if (node_stack_cnt > 0)
donatien	0:632c9925f013	82	{
donatien	0:632c9925f013	83	node_stack_cnt--;
donatien	0:632c9925f013	84	*node = node_stack[node_stack_cnt];
donatien	0:632c9925f013	85	}
donatien	0:632c9925f013	86	LWIP_DEBUGF(SNMP_MIB_DEBUG,("pop_node() node=%p id=%"S32_F"\n",(void *)(node->r_ptr),node->r_id));
donatien	0:632c9925f013	87	}
donatien	0:632c9925f013	88
donatien	0:632c9925f013	89	/**
donatien	0:632c9925f013	90	* Conversion from ifIndex to lwIP netif
donatien	0:632c9925f013	91	* @param ifindex is a s32_t object sub-identifier
donatien	0:632c9925f013	92	* @param netif points to returned netif struct pointer
donatien	0:632c9925f013	93	*/
donatien	0:632c9925f013	94	void
donatien	0:632c9925f013	95	snmp_ifindextonetif(s32_t ifindex, struct netif **netif)
donatien	0:632c9925f013	96	{
donatien	0:632c9925f013	97	struct netif *nif = netif_list;
donatien	0:632c9925f013	98	s32_t i, ifidx;
donatien	0:632c9925f013	99
donatien	0:632c9925f013	100	ifidx = ifindex - 1;
donatien	0:632c9925f013	101	i = 0;
donatien	0:632c9925f013	102	while ((nif != NULL) && (i < ifidx))
donatien	0:632c9925f013	103	{
donatien	0:632c9925f013	104	nif = nif->next;
donatien	0:632c9925f013	105	i++;
donatien	0:632c9925f013	106	}
donatien	0:632c9925f013	107	*netif = nif;
donatien	0:632c9925f013	108	}
donatien	0:632c9925f013	109
donatien	0:632c9925f013	110	/**
donatien	0:632c9925f013	111	* Conversion from lwIP netif to ifIndex
donatien	0:632c9925f013	112	* @param netif points to a netif struct
donatien	0:632c9925f013	113	* @param ifidx points to s32_t object sub-identifier
donatien	0:632c9925f013	114	*/
donatien	0:632c9925f013	115	void
donatien	0:632c9925f013	116	snmp_netiftoifindex(struct netif netif, s32_t ifidx)
donatien	0:632c9925f013	117	{
donatien	0:632c9925f013	118	struct netif *nif = netif_list;
donatien	0:632c9925f013	119	u16_t i;
donatien	0:632c9925f013	120
donatien	0:632c9925f013	121	i = 0;
donatien	0:632c9925f013	122	while ((nif != NULL) && (nif != netif))
donatien	0:632c9925f013	123	{
donatien	0:632c9925f013	124	nif = nif->next;
donatien	0:632c9925f013	125	i++;
donatien	0:632c9925f013	126	}
donatien	0:632c9925f013	127	*ifidx = i+1;
donatien	0:632c9925f013	128	}
donatien	0:632c9925f013	129
donatien	0:632c9925f013	130	/**
donatien	0:632c9925f013	131	* Conversion from oid to lwIP ip_addr
donatien	0:632c9925f013	132	* @param ident points to s32_t ident[4] input
donatien	0:632c9925f013	133	* @param ip points to output struct
donatien	0:632c9925f013	134	*/
donatien	0:632c9925f013	135	void
donatien	0:632c9925f013	136	snmp_oidtoip(s32_t ident, ip_addr_t ip)
donatien	0:632c9925f013	137	{
donatien	0:632c9925f013	138	IP4_ADDR(ip, ident[0], ident[1], ident[2], ident[3]);
donatien	0:632c9925f013	139	}
donatien	0:632c9925f013	140
donatien	0:632c9925f013	141	/**
donatien	0:632c9925f013	142	* Conversion from lwIP ip_addr to oid
donatien	0:632c9925f013	143	* @param ip points to input struct
donatien	0:632c9925f013	144	* @param ident points to s32_t ident[4] output
donatien	0:632c9925f013	145	*/
donatien	0:632c9925f013	146	void
donatien	0:632c9925f013	147	snmp_iptooid(ip_addr_t ip, s32_t ident)
donatien	0:632c9925f013	148	{
donatien	0:632c9925f013	149	ident[0] = ip4_addr1(ip);
donatien	0:632c9925f013	150	ident[1] = ip4_addr2(ip);
donatien	0:632c9925f013	151	ident[2] = ip4_addr3(ip);
donatien	0:632c9925f013	152	ident[3] = ip4_addr4(ip);
donatien	0:632c9925f013	153	}
donatien	0:632c9925f013	154
donatien	0:632c9925f013	155	struct mib_list_node *
donatien	0:632c9925f013	156	snmp_mib_ln_alloc(s32_t id)
donatien	0:632c9925f013	157	{
donatien	0:632c9925f013	158	struct mib_list_node *ln;
donatien	0:632c9925f013	159
donatien	0:632c9925f013	160	ln = (struct mib_list_node *)memp_malloc(MEMP_SNMP_NODE);
donatien	0:632c9925f013	161	if (ln != NULL)
donatien	0:632c9925f013	162	{
donatien	0:632c9925f013	163	ln->prev = NULL;
donatien	0:632c9925f013	164	ln->next = NULL;
donatien	0:632c9925f013	165	ln->objid = id;
donatien	0:632c9925f013	166	ln->nptr = NULL;
donatien	0:632c9925f013	167	}
donatien	0:632c9925f013	168	return ln;
donatien	0:632c9925f013	169	}
donatien	0:632c9925f013	170
donatien	0:632c9925f013	171	void
donatien	0:632c9925f013	172	snmp_mib_ln_free(struct mib_list_node *ln)
donatien	0:632c9925f013	173	{
donatien	0:632c9925f013	174	memp_free(MEMP_SNMP_NODE, ln);
donatien	0:632c9925f013	175	}
donatien	0:632c9925f013	176
donatien	0:632c9925f013	177	struct mib_list_rootnode *
donatien	0:632c9925f013	178	snmp_mib_lrn_alloc(void)
donatien	0:632c9925f013	179	{
donatien	0:632c9925f013	180	struct mib_list_rootnode *lrn;
donatien	0:632c9925f013	181
donatien	0:632c9925f013	182	lrn = (struct mib_list_rootnode*)memp_malloc(MEMP_SNMP_ROOTNODE);
donatien	0:632c9925f013	183	if (lrn != NULL)
donatien	0:632c9925f013	184	{
donatien	0:632c9925f013	185	lrn->get_object_def = noleafs_get_object_def;
donatien	0:632c9925f013	186	lrn->get_value = noleafs_get_value;
donatien	0:632c9925f013	187	lrn->set_test = noleafs_set_test;
donatien	0:632c9925f013	188	lrn->set_value = noleafs_set_value;
donatien	0:632c9925f013	189	lrn->node_type = MIB_NODE_LR;
donatien	0:632c9925f013	190	lrn->maxlength = 0;
donatien	0:632c9925f013	191	lrn->head = NULL;
donatien	0:632c9925f013	192	lrn->tail = NULL;
donatien	0:632c9925f013	193	lrn->count = 0;
donatien	0:632c9925f013	194	}
donatien	0:632c9925f013	195	return lrn;
donatien	0:632c9925f013	196	}
donatien	0:632c9925f013	197
donatien	0:632c9925f013	198	void
donatien	0:632c9925f013	199	snmp_mib_lrn_free(struct mib_list_rootnode *lrn)
donatien	0:632c9925f013	200	{
donatien	0:632c9925f013	201	memp_free(MEMP_SNMP_ROOTNODE, lrn);
donatien	0:632c9925f013	202	}
donatien	0:632c9925f013	203
donatien	0:632c9925f013	204	/**
donatien	0:632c9925f013	205	* Inserts node in idx list in a sorted
donatien	0:632c9925f013	206	* (ascending order) fashion and
donatien	0:632c9925f013	207	* allocates the node if needed.
donatien	0:632c9925f013	208	*
donatien	0:632c9925f013	209	* @param rn points to the root node
donatien	0:632c9925f013	210	* @param objid is the object sub identifier
donatien	0:632c9925f013	211	* @param insn points to a pointer to the inserted node
donatien	0:632c9925f013	212	* used for constructing the tree.
donatien	0:632c9925f013	213	* @return -1 if failed, 1 if inserted, 2 if present.
donatien	0:632c9925f013	214	*/
donatien	0:632c9925f013	215	s8_t
donatien	0:632c9925f013	216	snmp_mib_node_insert(struct mib_list_rootnode rn, s32_t objid, struct mib_list_node *insn)
donatien	0:632c9925f013	217	{
donatien	0:632c9925f013	218	struct mib_list_node *nn;
donatien	0:632c9925f013	219	s8_t insert;
donatien	0:632c9925f013	220
donatien	0:632c9925f013	221	LWIP_ASSERT("rn != NULL",rn != NULL);
donatien	0:632c9925f013	222
donatien	0:632c9925f013	223	/* -1 = malloc failure, 0 = not inserted, 1 = inserted, 2 = was present */
donatien	0:632c9925f013	224	insert = 0;
donatien	0:632c9925f013	225	if (rn->head == NULL)
donatien	0:632c9925f013	226	{
donatien	0:632c9925f013	227	/* empty list, add first node */
donatien	0:632c9925f013	228	LWIP_DEBUGF(SNMP_MIB_DEBUG,("alloc empty list objid==%"S32_F"\n",objid));
donatien	0:632c9925f013	229	nn = snmp_mib_ln_alloc(objid);
donatien	0:632c9925f013	230	if (nn != NULL)
donatien	0:632c9925f013	231	{
donatien	0:632c9925f013	232	rn->head = nn;
donatien	0:632c9925f013	233	rn->tail = nn;
donatien	0:632c9925f013	234	*insn = nn;
donatien	0:632c9925f013	235	insert = 1;
donatien	0:632c9925f013	236	}
donatien	0:632c9925f013	237	else
donatien	0:632c9925f013	238	{
donatien	0:632c9925f013	239	insert = -1;
donatien	0:632c9925f013	240	}
donatien	0:632c9925f013	241	}
donatien	0:632c9925f013	242	else
donatien	0:632c9925f013	243	{
donatien	0:632c9925f013	244	struct mib_list_node *n;
donatien	0:632c9925f013	245	/* at least one node is present */
donatien	0:632c9925f013	246	n = rn->head;
donatien	0:632c9925f013	247	while ((n != NULL) && (insert == 0))
donatien	0:632c9925f013	248	{
donatien	0:632c9925f013	249	if (n->objid == objid)
donatien	0:632c9925f013	250	{
donatien	0:632c9925f013	251	/* node is already there */
donatien	0:632c9925f013	252	LWIP_DEBUGF(SNMP_MIB_DEBUG,("node already there objid==%"S32_F"\n",objid));
donatien	0:632c9925f013	253	*insn = n;
donatien	0:632c9925f013	254	insert = 2;
donatien	0:632c9925f013	255	}
donatien	0:632c9925f013	256	else if (n->objid < objid)
donatien	0:632c9925f013	257	{
donatien	0:632c9925f013	258	if (n->next == NULL)
donatien	0:632c9925f013	259	{
donatien	0:632c9925f013	260	/* alloc and insert at the tail */
donatien	0:632c9925f013	261	LWIP_DEBUGF(SNMP_MIB_DEBUG,("alloc ins tail objid==%"S32_F"\n",objid));
donatien	0:632c9925f013	262	nn = snmp_mib_ln_alloc(objid);
donatien	0:632c9925f013	263	if (nn != NULL)
donatien	0:632c9925f013	264	{
donatien	0:632c9925f013	265	nn->next = NULL;
donatien	0:632c9925f013	266	nn->prev = n;
donatien	0:632c9925f013	267	n->next = nn;
donatien	0:632c9925f013	268	rn->tail = nn;
donatien	0:632c9925f013	269	*insn = nn;
donatien	0:632c9925f013	270	insert = 1;
donatien	0:632c9925f013	271	}
donatien	0:632c9925f013	272	else
donatien	0:632c9925f013	273	{
donatien	0:632c9925f013	274	/* insertion failure */
donatien	0:632c9925f013	275	insert = -1;
donatien	0:632c9925f013	276	}
donatien	0:632c9925f013	277	}
donatien	0:632c9925f013	278	else
donatien	0:632c9925f013	279	{
donatien	0:632c9925f013	280	/* there's more to explore: traverse list */
donatien	0:632c9925f013	281	LWIP_DEBUGF(SNMP_MIB_DEBUG,("traverse list\n"));
donatien	0:632c9925f013	282	n = n->next;
donatien	0:632c9925f013	283	}
donatien	0:632c9925f013	284	}
donatien	0:632c9925f013	285	else
donatien	0:632c9925f013	286	{
donatien	0:632c9925f013	287	/* n->objid > objid */
donatien	0:632c9925f013	288	/* alloc and insert between n->prev and n */
donatien	0:632c9925f013	289	LWIP_DEBUGF(SNMP_MIB_DEBUG,("alloc ins n->prev, objid==%"S32_F", n\n",objid));
donatien	0:632c9925f013	290	nn = snmp_mib_ln_alloc(objid);
donatien	0:632c9925f013	291	if (nn != NULL)
donatien	0:632c9925f013	292	{
donatien	0:632c9925f013	293	if (n->prev == NULL)
donatien	0:632c9925f013	294	{
donatien	0:632c9925f013	295	/* insert at the head */
donatien	0:632c9925f013	296	nn->next = n;
donatien	0:632c9925f013	297	nn->prev = NULL;
donatien	0:632c9925f013	298	rn->head = nn;
donatien	0:632c9925f013	299	n->prev = nn;
donatien	0:632c9925f013	300	}
donatien	0:632c9925f013	301	else
donatien	0:632c9925f013	302	{
donatien	0:632c9925f013	303	/* insert in the middle */
donatien	0:632c9925f013	304	nn->next = n;
donatien	0:632c9925f013	305	nn->prev = n->prev;
donatien	0:632c9925f013	306	n->prev->next = nn;
donatien	0:632c9925f013	307	n->prev = nn;
donatien	0:632c9925f013	308	}
donatien	0:632c9925f013	309	*insn = nn;
donatien	0:632c9925f013	310	insert = 1;
donatien	0:632c9925f013	311	}
donatien	0:632c9925f013	312	else
donatien	0:632c9925f013	313	{
donatien	0:632c9925f013	314	/* insertion failure */
donatien	0:632c9925f013	315	insert = -1;
donatien	0:632c9925f013	316	}
donatien	0:632c9925f013	317	}
donatien	0:632c9925f013	318	}
donatien	0:632c9925f013	319	}
donatien	0:632c9925f013	320	if (insert == 1)
donatien	0:632c9925f013	321	{
donatien	0:632c9925f013	322	rn->count += 1;
donatien	0:632c9925f013	323	}
donatien	0:632c9925f013	324	LWIP_ASSERT("insert != 0",insert != 0);
donatien	0:632c9925f013	325	return insert;
donatien	0:632c9925f013	326	}
donatien	0:632c9925f013	327
donatien	0:632c9925f013	328	/**
donatien	0:632c9925f013	329	* Finds node in idx list and returns deletion mark.
donatien	0:632c9925f013	330	*
donatien	0:632c9925f013	331	* @param rn points to the root node
donatien	0:632c9925f013	332	* @param objid is the object sub identifier
donatien	0:632c9925f013	333	* @param fn returns pointer to found node
donatien	0:632c9925f013	334	* @return 0 if not found, 1 if deletable,
donatien	0:632c9925f013	335	* 2 can't delete (2 or more children), 3 not a list_node
donatien	0:632c9925f013	336	*/
donatien	0:632c9925f013	337	s8_t
donatien	0:632c9925f013	338	snmp_mib_node_find(struct mib_list_rootnode rn, s32_t objid, struct mib_list_node *fn)
donatien	0:632c9925f013	339	{
donatien	0:632c9925f013	340	s8_t fc;
donatien	0:632c9925f013	341	struct mib_list_node *n;
donatien	0:632c9925f013	342
donatien	0:632c9925f013	343	LWIP_ASSERT("rn != NULL",rn != NULL);
donatien	0:632c9925f013	344	n = rn->head;
donatien	0:632c9925f013	345	while ((n != NULL) && (n->objid != objid))
donatien	0:632c9925f013	346	{
donatien	0:632c9925f013	347	n = n->next;
donatien	0:632c9925f013	348	}
donatien	0:632c9925f013	349	if (n == NULL)
donatien	0:632c9925f013	350	{
donatien	0:632c9925f013	351	fc = 0;
donatien	0:632c9925f013	352	}
donatien	0:632c9925f013	353	else if (n->nptr == NULL)
donatien	0:632c9925f013	354	{
donatien	0:632c9925f013	355	/* leaf, can delete node */
donatien	0:632c9925f013	356	fc = 1;
donatien	0:632c9925f013	357	}
donatien	0:632c9925f013	358	else
donatien	0:632c9925f013	359	{
donatien	0:632c9925f013	360	struct mib_list_rootnode *r;
donatien	0:632c9925f013	361
donatien	0:632c9925f013	362	if (n->nptr->node_type == MIB_NODE_LR)
donatien	0:632c9925f013	363	{
donatien	0:632c9925f013	364	r = (struct mib_list_rootnode *)n->nptr;
donatien	0:632c9925f013	365	if (r->count > 1)
donatien	0:632c9925f013	366	{
donatien	0:632c9925f013	367	/* can't delete node */
donatien	0:632c9925f013	368	fc = 2;
donatien	0:632c9925f013	369	}
donatien	0:632c9925f013	370	else
donatien	0:632c9925f013	371	{
donatien	0:632c9925f013	372	/* count <= 1, can delete node */
donatien	0:632c9925f013	373	fc = 1;
donatien	0:632c9925f013	374	}
donatien	0:632c9925f013	375	}
donatien	0:632c9925f013	376	else
donatien	0:632c9925f013	377	{
donatien	0:632c9925f013	378	/* other node type */
donatien	0:632c9925f013	379	fc = 3;
donatien	0:632c9925f013	380	}
donatien	0:632c9925f013	381	}
donatien	0:632c9925f013	382	*fn = n;
donatien	0:632c9925f013	383	return fc;
donatien	0:632c9925f013	384	}
donatien	0:632c9925f013	385
donatien	0:632c9925f013	386	/**
donatien	0:632c9925f013	387	* Removes node from idx list
donatien	0:632c9925f013	388	* if it has a single child left.
donatien	0:632c9925f013	389	*
donatien	0:632c9925f013	390	* @param rn points to the root node
donatien	0:632c9925f013	391	* @param n points to the node to delete
donatien	0:632c9925f013	392	* @return the nptr to be freed by caller
donatien	0:632c9925f013	393	*/
donatien	0:632c9925f013	394	struct mib_list_rootnode *
donatien	0:632c9925f013	395	snmp_mib_node_delete(struct mib_list_rootnode rn, struct mib_list_node n)
donatien	0:632c9925f013	396	{
donatien	0:632c9925f013	397	struct mib_list_rootnode *next;
donatien	0:632c9925f013	398
donatien	0:632c9925f013	399	LWIP_ASSERT("rn != NULL",rn != NULL);
donatien	0:632c9925f013	400	LWIP_ASSERT("n != NULL",n != NULL);
donatien	0:632c9925f013	401
donatien	0:632c9925f013	402	/* caller must remove this sub-tree */
donatien	0:632c9925f013	403	next = (struct mib_list_rootnode*)(n->nptr);
donatien	0:632c9925f013	404	rn->count -= 1;
donatien	0:632c9925f013	405
donatien	0:632c9925f013	406	if (n == rn->head)
donatien	0:632c9925f013	407	{
donatien	0:632c9925f013	408	rn->head = n->next;
donatien	0:632c9925f013	409	if (n->next != NULL)
donatien	0:632c9925f013	410	{
donatien	0:632c9925f013	411	/* not last node, new list begin */
donatien	0:632c9925f013	412	n->next->prev = NULL;
donatien	0:632c9925f013	413	}
donatien	0:632c9925f013	414	}
donatien	0:632c9925f013	415	else if (n == rn->tail)
donatien	0:632c9925f013	416	{
donatien	0:632c9925f013	417	rn->tail = n->prev;
donatien	0:632c9925f013	418	if (n->prev != NULL)
donatien	0:632c9925f013	419	{
donatien	0:632c9925f013	420	/* not last node, new list end */
donatien	0:632c9925f013	421	n->prev->next = NULL;
donatien	0:632c9925f013	422	}
donatien	0:632c9925f013	423	}
donatien	0:632c9925f013	424	else
donatien	0:632c9925f013	425	{
donatien	0:632c9925f013	426	/* node must be in the middle */
donatien	0:632c9925f013	427	n->prev->next = n->next;
donatien	0:632c9925f013	428	n->next->prev = n->prev;
donatien	0:632c9925f013	429	}
donatien	0:632c9925f013	430	LWIP_DEBUGF(SNMP_MIB_DEBUG,("free list objid==%"S32_F"\n",n->objid));
donatien	0:632c9925f013	431	snmp_mib_ln_free(n);
donatien	0:632c9925f013	432	if (rn->count == 0)
donatien	0:632c9925f013	433	{
donatien	0:632c9925f013	434	rn->head = NULL;
donatien	0:632c9925f013	435	rn->tail = NULL;
donatien	0:632c9925f013	436	}
donatien	0:632c9925f013	437	return next;
donatien	0:632c9925f013	438	}
donatien	0:632c9925f013	439
donatien	0:632c9925f013	440
donatien	0:632c9925f013	441
donatien	0:632c9925f013	442	/**
donatien	0:632c9925f013	443	* Searches tree for the supplied (scalar?) object identifier.
donatien	0:632c9925f013	444	*
donatien	0:632c9925f013	445	* @param node points to the root of the tree ('.internet')
donatien	0:632c9925f013	446	* @param ident_len the length of the supplied object identifier
donatien	0:632c9925f013	447	* @param ident points to the array of sub identifiers
donatien	0:632c9925f013	448	* @param np points to the found object instance (rerurn)
donatien	0:632c9925f013	449	* @return pointer to the requested parent (!) node if success, NULL otherwise
donatien	0:632c9925f013	450	*/
donatien	0:632c9925f013	451	struct mib_node *
donatien	0:632c9925f013	452	snmp_search_tree(struct mib_node node, u8_t ident_len, s32_t ident, struct snmp_name_ptr *np)
donatien	0:632c9925f013	453	{
donatien	0:632c9925f013	454	u8_t node_type, ext_level;
donatien	0:632c9925f013	455
donatien	0:632c9925f013	456	ext_level = 0;
donatien	0:632c9925f013	457	LWIP_DEBUGF(SNMP_MIB_DEBUG,("node==%p ident==%"S32_F"\n",(void)node,*ident));
donatien	0:632c9925f013	458	while (node != NULL)
donatien	0:632c9925f013	459	{
donatien	0:632c9925f013	460	node_type = node->node_type;
donatien	0:632c9925f013	461	if ((node_type == MIB_NODE_AR) \|\| (node_type == MIB_NODE_RA))
donatien	0:632c9925f013	462	{
donatien	0:632c9925f013	463	struct mib_array_node *an;
donatien	0:632c9925f013	464	u16_t i;
donatien	0:632c9925f013	465
donatien	0:632c9925f013	466	if (ident_len > 0)
donatien	0:632c9925f013	467	{
donatien	0:632c9925f013	468	/* array node (internal ROM or RAM, fixed length) */
donatien	0:632c9925f013	469	an = (struct mib_array_node *)node;
donatien	0:632c9925f013	470	i = 0;
donatien	0:632c9925f013	471	while ((i < an->maxlength) && (an->objid[i] != *ident))
donatien	0:632c9925f013	472	{
donatien	0:632c9925f013	473	i++;
donatien	0:632c9925f013	474	}
donatien	0:632c9925f013	475	if (i < an->maxlength)
donatien	0:632c9925f013	476	{
donatien	0:632c9925f013	477	/* found it, if available proceed to child, otherwise inspect leaf */
donatien	0:632c9925f013	478	LWIP_DEBUGF(SNMP_MIB_DEBUG,("an->objid[%"U16_F"]==%"S32_F" ident==%"S32_F"\n",i,an->objid[i],ident));
donatien	0:632c9925f013	479	if (an->nptr[i] == NULL)
donatien	0:632c9925f013	480	{
donatien	0:632c9925f013	481	/* a scalar leaf OR table,
donatien	0:632c9925f013	482	inspect remaining instance number / table index */
donatien	0:632c9925f013	483	np->ident_len = ident_len;
donatien	0:632c9925f013	484	np->ident = ident;
donatien	0:632c9925f013	485	return (struct mib_node*)an;
donatien	0:632c9925f013	486	}
donatien	0:632c9925f013	487	else
donatien	0:632c9925f013	488	{
donatien	0:632c9925f013	489	/* follow next child pointer */
donatien	0:632c9925f013	490	ident++;
donatien	0:632c9925f013	491	ident_len--;
donatien	0:632c9925f013	492	node = an->nptr[i];
donatien	0:632c9925f013	493	}
donatien	0:632c9925f013	494	}
donatien	0:632c9925f013	495	else
donatien	0:632c9925f013	496	{
donatien	0:632c9925f013	497	/* search failed, identifier mismatch (nosuchname) */
donatien	0:632c9925f013	498	LWIP_DEBUGF(SNMP_MIB_DEBUG,("an search failed ident==%"S32_F"\n",ident));
donatien	0:632c9925f013	499	return NULL;
donatien	0:632c9925f013	500	}
donatien	0:632c9925f013	501	}
donatien	0:632c9925f013	502	else
donatien	0:632c9925f013	503	{
donatien	0:632c9925f013	504	/* search failed, short object identifier (nosuchname) */
donatien	0:632c9925f013	505	LWIP_DEBUGF(SNMP_MIB_DEBUG,("an search failed, short object identifier\n"));
donatien	0:632c9925f013	506	return NULL;
donatien	0:632c9925f013	507	}
donatien	0:632c9925f013	508	}
donatien	0:632c9925f013	509	else if(node_type == MIB_NODE_LR)
donatien	0:632c9925f013	510	{
donatien	0:632c9925f013	511	struct mib_list_rootnode *lrn;
donatien	0:632c9925f013	512	struct mib_list_node *ln;
donatien	0:632c9925f013	513
donatien	0:632c9925f013	514	if (ident_len > 0)
donatien	0:632c9925f013	515	{
donatien	0:632c9925f013	516	/* list root node (internal 'RAM', variable length) */
donatien	0:632c9925f013	517	lrn = (struct mib_list_rootnode *)node;
donatien	0:632c9925f013	518	ln = lrn->head;
donatien	0:632c9925f013	519	/* iterate over list, head to tail */
donatien	0:632c9925f013	520	while ((ln != NULL) && (ln->objid != *ident))
donatien	0:632c9925f013	521	{
donatien	0:632c9925f013	522	ln = ln->next;
donatien	0:632c9925f013	523	}
donatien	0:632c9925f013	524	if (ln != NULL)
donatien	0:632c9925f013	525	{
donatien	0:632c9925f013	526	/* found it, proceed to child */;
donatien	0:632c9925f013	527	LWIP_DEBUGF(SNMP_MIB_DEBUG,("ln->objid==%"S32_F" ident==%"S32_F"\n",ln->objid,ident));
donatien	0:632c9925f013	528	if (ln->nptr == NULL)
donatien	0:632c9925f013	529	{
donatien	0:632c9925f013	530	np->ident_len = ident_len;
donatien	0:632c9925f013	531	np->ident = ident;
donatien	0:632c9925f013	532	return (struct mib_node*)lrn;
donatien	0:632c9925f013	533	}
donatien	0:632c9925f013	534	else
donatien	0:632c9925f013	535	{
donatien	0:632c9925f013	536	/* follow next child pointer */
donatien	0:632c9925f013	537	ident_len--;
donatien	0:632c9925f013	538	ident++;
donatien	0:632c9925f013	539	node = ln->nptr;
donatien	0:632c9925f013	540	}
donatien	0:632c9925f013	541	}
donatien	0:632c9925f013	542	else
donatien	0:632c9925f013	543	{
donatien	0:632c9925f013	544	/* search failed */
donatien	0:632c9925f013	545	LWIP_DEBUGF(SNMP_MIB_DEBUG,("ln search failed ident==%"S32_F"\n",ident));
donatien	0:632c9925f013	546	return NULL;
donatien	0:632c9925f013	547	}
donatien	0:632c9925f013	548	}
donatien	0:632c9925f013	549	else
donatien	0:632c9925f013	550	{
donatien	0:632c9925f013	551	/* search failed, short object identifier (nosuchname) */
donatien	0:632c9925f013	552	LWIP_DEBUGF(SNMP_MIB_DEBUG,("ln search failed, short object identifier\n"));
donatien	0:632c9925f013	553	return NULL;
donatien	0:632c9925f013	554	}
donatien	0:632c9925f013	555	}
donatien	0:632c9925f013	556	else if(node_type == MIB_NODE_EX)
donatien	0:632c9925f013	557	{
donatien	0:632c9925f013	558	struct mib_external_node *en;
donatien	0:632c9925f013	559	u16_t i, len;
donatien	0:632c9925f013	560
donatien	0:632c9925f013	561	if (ident_len > 0)
donatien	0:632c9925f013	562	{
donatien	0:632c9925f013	563	/* external node (addressing and access via functions) */
donatien	0:632c9925f013	564	en = (struct mib_external_node *)node;
donatien	0:632c9925f013	565
donatien	0:632c9925f013	566	i = 0;
donatien	0:632c9925f013	567	len = en->level_length(en->addr_inf,ext_level);
donatien	0:632c9925f013	568	while ((i < len) && (en->ident_cmp(en->addr_inf,ext_level,i,*ident) != 0))
donatien	0:632c9925f013	569	{
donatien	0:632c9925f013	570	i++;
donatien	0:632c9925f013	571	}
donatien	0:632c9925f013	572	if (i < len)
donatien	0:632c9925f013	573	{
donatien	0:632c9925f013	574	s32_t debug_id;
donatien	0:632c9925f013	575
donatien	0:632c9925f013	576	en->get_objid(en->addr_inf,ext_level,i,&debug_id);
donatien	0:632c9925f013	577	LWIP_DEBUGF(SNMP_MIB_DEBUG,("en->objid==%"S32_F" ident==%"S32_F"\n",debug_id,ident));
donatien	0:632c9925f013	578	if ((ext_level + 1) == en->tree_levels)
donatien	0:632c9925f013	579	{
donatien	0:632c9925f013	580	np->ident_len = ident_len;
donatien	0:632c9925f013	581	np->ident = ident;
donatien	0:632c9925f013	582	return (struct mib_node*)en;
donatien	0:632c9925f013	583	}
donatien	0:632c9925f013	584	else
donatien	0:632c9925f013	585	{
donatien	0:632c9925f013	586	/* found it, proceed to child */
donatien	0:632c9925f013	587	ident_len--;
donatien	0:632c9925f013	588	ident++;
donatien	0:632c9925f013	589	ext_level++;
donatien	0:632c9925f013	590	}
donatien	0:632c9925f013	591	}
donatien	0:632c9925f013	592	else
donatien	0:632c9925f013	593	{
donatien	0:632c9925f013	594	/* search failed */
donatien	0:632c9925f013	595	LWIP_DEBUGF(SNMP_MIB_DEBUG,("en search failed ident==%"S32_F"\n",ident));
donatien	0:632c9925f013	596	return NULL;
donatien	0:632c9925f013	597	}
donatien	0:632c9925f013	598	}
donatien	0:632c9925f013	599	else
donatien	0:632c9925f013	600	{
donatien	0:632c9925f013	601	/* search failed, short object identifier (nosuchname) */
donatien	0:632c9925f013	602	LWIP_DEBUGF(SNMP_MIB_DEBUG,("en search failed, short object identifier\n"));
donatien	0:632c9925f013	603	return NULL;
donatien	0:632c9925f013	604	}
donatien	0:632c9925f013	605	}
donatien	0:632c9925f013	606	else if (node_type == MIB_NODE_SC)
donatien	0:632c9925f013	607	{
donatien	0:632c9925f013	608	mib_scalar_node *sn;
donatien	0:632c9925f013	609
donatien	0:632c9925f013	610	sn = (mib_scalar_node *)node;
donatien	0:632c9925f013	611	if ((ident_len == 1) && (*ident == 0))
donatien	0:632c9925f013	612	{
donatien	0:632c9925f013	613	np->ident_len = ident_len;
donatien	0:632c9925f013	614	np->ident = ident;
donatien	0:632c9925f013	615	return (struct mib_node*)sn;
donatien	0:632c9925f013	616	}
donatien	0:632c9925f013	617	else
donatien	0:632c9925f013	618	{
donatien	0:632c9925f013	619	/* search failed, short object identifier (nosuchname) */
donatien	0:632c9925f013	620	LWIP_DEBUGF(SNMP_MIB_DEBUG,("search failed, invalid object identifier length\n"));
donatien	0:632c9925f013	621	return NULL;
donatien	0:632c9925f013	622	}
donatien	0:632c9925f013	623	}
donatien	0:632c9925f013	624	else
donatien	0:632c9925f013	625	{
donatien	0:632c9925f013	626	/* unknown node_type */
donatien	0:632c9925f013	627	LWIP_DEBUGF(SNMP_MIB_DEBUG,("search failed node_type %"U16_F" unkown\n",(u16_t)node_type));
donatien	0:632c9925f013	628	return NULL;
donatien	0:632c9925f013	629	}
donatien	0:632c9925f013	630	}
donatien	0:632c9925f013	631	/* done, found nothing */
donatien	0:632c9925f013	632	LWIP_DEBUGF(SNMP_MIB_DEBUG,("search failed node==%p\n",(void*)node));
donatien	0:632c9925f013	633	return NULL;
donatien	0:632c9925f013	634	}
donatien	0:632c9925f013	635
donatien	0:632c9925f013	636	/**
donatien	0:632c9925f013	637	* Test table for presence of at least one table entry.
donatien	0:632c9925f013	638	*/
donatien	0:632c9925f013	639	static u8_t
donatien	0:632c9925f013	640	empty_table(struct mib_node *node)
donatien	0:632c9925f013	641	{
donatien	0:632c9925f013	642	u8_t node_type;
donatien	0:632c9925f013	643	u8_t empty = 0;
donatien	0:632c9925f013	644
donatien	0:632c9925f013	645	if (node != NULL)
donatien	0:632c9925f013	646	{
donatien	0:632c9925f013	647	node_type = node->node_type;
donatien	0:632c9925f013	648	if (node_type == MIB_NODE_LR)
donatien	0:632c9925f013	649	{
donatien	0:632c9925f013	650	struct mib_list_rootnode *lrn;
donatien	0:632c9925f013	651	lrn = (struct mib_list_rootnode *)node;
donatien	0:632c9925f013	652	if ((lrn->count == 0) \|\| (lrn->head == NULL))
donatien	0:632c9925f013	653	{
donatien	0:632c9925f013	654	empty = 1;
donatien	0:632c9925f013	655	}
donatien	0:632c9925f013	656	}
donatien	0:632c9925f013	657	else if ((node_type == MIB_NODE_AR) \|\| (node_type == MIB_NODE_RA))
donatien	0:632c9925f013	658	{
donatien	0:632c9925f013	659	struct mib_array_node *an;
donatien	0:632c9925f013	660	an = (struct mib_array_node *)node;
donatien	0:632c9925f013	661	if ((an->maxlength == 0) \|\| (an->nptr == NULL))
donatien	0:632c9925f013	662	{
donatien	0:632c9925f013	663	empty = 1;
donatien	0:632c9925f013	664	}
donatien	0:632c9925f013	665	}
donatien	0:632c9925f013	666	else if (node_type == MIB_NODE_EX)
donatien	0:632c9925f013	667	{
donatien	0:632c9925f013	668	struct mib_external_node *en;
donatien	0:632c9925f013	669	en = (struct mib_external_node *)node;
donatien	0:632c9925f013	670	if (en->tree_levels == 0)
donatien	0:632c9925f013	671	{
donatien	0:632c9925f013	672	empty = 1;
donatien	0:632c9925f013	673	}
donatien	0:632c9925f013	674	}
donatien	0:632c9925f013	675	}
donatien	0:632c9925f013	676	return empty;
donatien	0:632c9925f013	677	}
donatien	0:632c9925f013	678
donatien	0:632c9925f013	679	/**
donatien	0:632c9925f013	680	* Tree expansion.
donatien	0:632c9925f013	681	*/
donatien	0:632c9925f013	682	struct mib_node *
donatien	0:632c9925f013	683	snmp_expand_tree(struct mib_node node, u8_t ident_len, s32_t ident, struct snmp_obj_id *oidret)
donatien	0:632c9925f013	684	{
donatien	0:632c9925f013	685	u8_t node_type, ext_level, climb_tree;
donatien	0:632c9925f013	686
donatien	0:632c9925f013	687	ext_level = 0;
donatien	0:632c9925f013	688	/* reset node stack */
donatien	0:632c9925f013	689	node_stack_cnt = 0;
donatien	0:632c9925f013	690	while (node != NULL)
donatien	0:632c9925f013	691	{
donatien	0:632c9925f013	692	climb_tree = 0;
donatien	0:632c9925f013	693	node_type = node->node_type;
donatien	0:632c9925f013	694	if ((node_type == MIB_NODE_AR) \|\| (node_type == MIB_NODE_RA))
donatien	0:632c9925f013	695	{
donatien	0:632c9925f013	696	struct mib_array_node *an;
donatien	0:632c9925f013	697	u16_t i;
donatien	0:632c9925f013	698
donatien	0:632c9925f013	699	/* array node (internal ROM or RAM, fixed length) */
donatien	0:632c9925f013	700	an = (struct mib_array_node *)node;
donatien	0:632c9925f013	701	if (ident_len > 0)
donatien	0:632c9925f013	702	{
donatien	0:632c9925f013	703	i = 0;
donatien	0:632c9925f013	704	while ((i < an->maxlength) && (an->objid[i] < *ident))
donatien	0:632c9925f013	705	{
donatien	0:632c9925f013	706	i++;
donatien	0:632c9925f013	707	}
donatien	0:632c9925f013	708	if (i < an->maxlength)
donatien	0:632c9925f013	709	{
donatien	0:632c9925f013	710	LWIP_DEBUGF(SNMP_MIB_DEBUG,("an->objid[%"U16_F"]==%"S32_F" ident==%"S32_F"\n",i,an->objid[i],ident));
donatien	0:632c9925f013	711	/* add identifier to oidret */
donatien	0:632c9925f013	712	oidret->id[oidret->len] = an->objid[i];
donatien	0:632c9925f013	713	(oidret->len)++;
donatien	0:632c9925f013	714
donatien	0:632c9925f013	715	if (an->nptr[i] == NULL)
donatien	0:632c9925f013	716	{
donatien	0:632c9925f013	717	LWIP_DEBUGF(SNMP_MIB_DEBUG,("leaf node\n"));
donatien	0:632c9925f013	718	/* leaf node (e.g. in a fixed size table) */
donatien	0:632c9925f013	719	if (an->objid[i] > *ident)
donatien	0:632c9925f013	720	{
donatien	0:632c9925f013	721	return (struct mib_node*)an;
donatien	0:632c9925f013	722	}
donatien	0:632c9925f013	723	else if ((i + 1) < an->maxlength)
donatien	0:632c9925f013	724	{
donatien	0:632c9925f013	725	/* an->objid[i] == ident /
donatien	0:632c9925f013	726	(oidret->len)--;
donatien	0:632c9925f013	727	oidret->id[oidret->len] = an->objid[i + 1];
donatien	0:632c9925f013	728	(oidret->len)++;
donatien	0:632c9925f013	729	return (struct mib_node*)an;
donatien	0:632c9925f013	730	}
donatien	0:632c9925f013	731	else
donatien	0:632c9925f013	732	{
donatien	0:632c9925f013	733	/* (i + 1) == an->maxlength */
donatien	0:632c9925f013	734	(oidret->len)--;
donatien	0:632c9925f013	735	climb_tree = 1;
donatien	0:632c9925f013	736	}
donatien	0:632c9925f013	737	}
donatien	0:632c9925f013	738	else
donatien	0:632c9925f013	739	{
donatien	0:632c9925f013	740	u8_t j;
donatien	0:632c9925f013	741	struct nse cur_node;
donatien	0:632c9925f013	742
donatien	0:632c9925f013	743	LWIP_DEBUGF(SNMP_MIB_DEBUG,("non-leaf node\n"));
donatien	0:632c9925f013	744	/* non-leaf, store right child ptr and id */
donatien	0:632c9925f013	745	LWIP_ASSERT("i < 0xff", i < 0xff);
donatien	0:632c9925f013	746	j = (u8_t)i + 1;
donatien	0:632c9925f013	747	while ((j < an->maxlength) && (empty_table(an->nptr[j])))
donatien	0:632c9925f013	748	{
donatien	0:632c9925f013	749	j++;
donatien	0:632c9925f013	750	}
donatien	0:632c9925f013	751	if (j < an->maxlength)
donatien	0:632c9925f013	752	{
donatien	0:632c9925f013	753	cur_node.r_ptr = an->nptr[j];
donatien	0:632c9925f013	754	cur_node.r_id = an->objid[j];
donatien	0:632c9925f013	755	cur_node.r_nl = 0;
donatien	0:632c9925f013	756	}
donatien	0:632c9925f013	757	else
donatien	0:632c9925f013	758	{
donatien	0:632c9925f013	759	cur_node.r_ptr = NULL;
donatien	0:632c9925f013	760	}
donatien	0:632c9925f013	761	push_node(&cur_node);
donatien	0:632c9925f013	762	if (an->objid[i] == *ident)
donatien	0:632c9925f013	763	{
donatien	0:632c9925f013	764	ident_len--;
donatien	0:632c9925f013	765	ident++;
donatien	0:632c9925f013	766	}
donatien	0:632c9925f013	767	else
donatien	0:632c9925f013	768	{
donatien	0:632c9925f013	769	/* an->objid[i] < ident /
donatien	0:632c9925f013	770	ident_len = 0;
donatien	0:632c9925f013	771	}
donatien	0:632c9925f013	772	/* follow next child pointer */
donatien	0:632c9925f013	773	node = an->nptr[i];
donatien	0:632c9925f013	774	}
donatien	0:632c9925f013	775	}
donatien	0:632c9925f013	776	else
donatien	0:632c9925f013	777	{
donatien	0:632c9925f013	778	/* i == an->maxlength */
donatien	0:632c9925f013	779	climb_tree = 1;
donatien	0:632c9925f013	780	}
donatien	0:632c9925f013	781	}
donatien	0:632c9925f013	782	else
donatien	0:632c9925f013	783	{
donatien	0:632c9925f013	784	u8_t j;
donatien	0:632c9925f013	785	/* ident_len == 0, complete with leftmost '.thing' */
donatien	0:632c9925f013	786	j = 0;
donatien	0:632c9925f013	787	while ((j < an->maxlength) && empty_table(an->nptr[j]))
donatien	0:632c9925f013	788	{
donatien	0:632c9925f013	789	j++;
donatien	0:632c9925f013	790	}
donatien	0:632c9925f013	791	if (j < an->maxlength)
donatien	0:632c9925f013	792	{
donatien	0:632c9925f013	793	LWIP_DEBUGF(SNMP_MIB_DEBUG,("left an->objid[j]==%"S32_F"\n",an->objid[j]));
donatien	0:632c9925f013	794	oidret->id[oidret->len] = an->objid[j];
donatien	0:632c9925f013	795	(oidret->len)++;
donatien	0:632c9925f013	796	if (an->nptr[j] == NULL)
donatien	0:632c9925f013	797	{
donatien	0:632c9925f013	798	/* leaf node */
donatien	0:632c9925f013	799	return (struct mib_node*)an;
donatien	0:632c9925f013	800	}
donatien	0:632c9925f013	801	else
donatien	0:632c9925f013	802	{
donatien	0:632c9925f013	803	/* no leaf, continue */
donatien	0:632c9925f013	804	node = an->nptr[j];
donatien	0:632c9925f013	805	}
donatien	0:632c9925f013	806	}
donatien	0:632c9925f013	807	else
donatien	0:632c9925f013	808	{
donatien	0:632c9925f013	809	/* j == an->maxlength */
donatien	0:632c9925f013	810	climb_tree = 1;
donatien	0:632c9925f013	811	}
donatien	0:632c9925f013	812	}
donatien	0:632c9925f013	813	}
donatien	0:632c9925f013	814	else if(node_type == MIB_NODE_LR)
donatien	0:632c9925f013	815	{
donatien	0:632c9925f013	816	struct mib_list_rootnode *lrn;
donatien	0:632c9925f013	817	struct mib_list_node *ln;
donatien	0:632c9925f013	818
donatien	0:632c9925f013	819	/* list root node (internal 'RAM', variable length) */
donatien	0:632c9925f013	820	lrn = (struct mib_list_rootnode *)node;
donatien	0:632c9925f013	821	if (ident_len > 0)
donatien	0:632c9925f013	822	{
donatien	0:632c9925f013	823	ln = lrn->head;
donatien	0:632c9925f013	824	/* iterate over list, head to tail */
donatien	0:632c9925f013	825	while ((ln != NULL) && (ln->objid < *ident))
donatien	0:632c9925f013	826	{
donatien	0:632c9925f013	827	ln = ln->next;
donatien	0:632c9925f013	828	}
donatien	0:632c9925f013	829	if (ln != NULL)
donatien	0:632c9925f013	830	{
donatien	0:632c9925f013	831	LWIP_DEBUGF(SNMP_MIB_DEBUG,("ln->objid==%"S32_F" ident==%"S32_F"\n",ln->objid,ident));
donatien	0:632c9925f013	832	oidret->id[oidret->len] = ln->objid;
donatien	0:632c9925f013	833	(oidret->len)++;
donatien	0:632c9925f013	834	if (ln->nptr == NULL)
donatien	0:632c9925f013	835	{
donatien	0:632c9925f013	836	/* leaf node */
donatien	0:632c9925f013	837	if (ln->objid > *ident)
donatien	0:632c9925f013	838	{
donatien	0:632c9925f013	839	return (struct mib_node*)lrn;
donatien	0:632c9925f013	840	}
donatien	0:632c9925f013	841	else if (ln->next != NULL)
donatien	0:632c9925f013	842	{
donatien	0:632c9925f013	843	/* ln->objid == ident /
donatien	0:632c9925f013	844	(oidret->len)--;
donatien	0:632c9925f013	845	oidret->id[oidret->len] = ln->next->objid;
donatien	0:632c9925f013	846	(oidret->len)++;
donatien	0:632c9925f013	847	return (struct mib_node*)lrn;
donatien	0:632c9925f013	848	}
donatien	0:632c9925f013	849	else
donatien	0:632c9925f013	850	{
donatien	0:632c9925f013	851	/* ln->next == NULL */
donatien	0:632c9925f013	852	(oidret->len)--;
donatien	0:632c9925f013	853	climb_tree = 1;
donatien	0:632c9925f013	854	}
donatien	0:632c9925f013	855	}
donatien	0:632c9925f013	856	else
donatien	0:632c9925f013	857	{
donatien	0:632c9925f013	858	struct mib_list_node *jn;
donatien	0:632c9925f013	859	struct nse cur_node;
donatien	0:632c9925f013	860
donatien	0:632c9925f013	861	/* non-leaf, store right child ptr and id */
donatien	0:632c9925f013	862	jn = ln->next;
donatien	0:632c9925f013	863	while ((jn != NULL) && empty_table(jn->nptr))
donatien	0:632c9925f013	864	{
donatien	0:632c9925f013	865	jn = jn->next;
donatien	0:632c9925f013	866	}
donatien	0:632c9925f013	867	if (jn != NULL)
donatien	0:632c9925f013	868	{
donatien	0:632c9925f013	869	cur_node.r_ptr = jn->nptr;
donatien	0:632c9925f013	870	cur_node.r_id = jn->objid;
donatien	0:632c9925f013	871	cur_node.r_nl = 0;
donatien	0:632c9925f013	872	}
donatien	0:632c9925f013	873	else
donatien	0:632c9925f013	874	{
donatien	0:632c9925f013	875	cur_node.r_ptr = NULL;
donatien	0:632c9925f013	876	}
donatien	0:632c9925f013	877	push_node(&cur_node);
donatien	0:632c9925f013	878	if (ln->objid == *ident)
donatien	0:632c9925f013	879	{
donatien	0:632c9925f013	880	ident_len--;
donatien	0:632c9925f013	881	ident++;
donatien	0:632c9925f013	882	}
donatien	0:632c9925f013	883	else
donatien	0:632c9925f013	884	{
donatien	0:632c9925f013	885	/* ln->objid < ident /
donatien	0:632c9925f013	886	ident_len = 0;
donatien	0:632c9925f013	887	}
donatien	0:632c9925f013	888	/* follow next child pointer */
donatien	0:632c9925f013	889	node = ln->nptr;
donatien	0:632c9925f013	890	}
donatien	0:632c9925f013	891
donatien	0:632c9925f013	892	}
donatien	0:632c9925f013	893	else
donatien	0:632c9925f013	894	{
donatien	0:632c9925f013	895	/* ln == NULL */
donatien	0:632c9925f013	896	climb_tree = 1;
donatien	0:632c9925f013	897	}
donatien	0:632c9925f013	898	}
donatien	0:632c9925f013	899	else
donatien	0:632c9925f013	900	{
donatien	0:632c9925f013	901	struct mib_list_node *jn;
donatien	0:632c9925f013	902	/* ident_len == 0, complete with leftmost '.thing' */
donatien	0:632c9925f013	903	jn = lrn->head;
donatien	0:632c9925f013	904	while ((jn != NULL) && empty_table(jn->nptr))
donatien	0:632c9925f013	905	{
donatien	0:632c9925f013	906	jn = jn->next;
donatien	0:632c9925f013	907	}
donatien	0:632c9925f013	908	if (jn != NULL)
donatien	0:632c9925f013	909	{
donatien	0:632c9925f013	910	LWIP_DEBUGF(SNMP_MIB_DEBUG,("left jn->objid==%"S32_F"\n",jn->objid));
donatien	0:632c9925f013	911	oidret->id[oidret->len] = jn->objid;
donatien	0:632c9925f013	912	(oidret->len)++;
donatien	0:632c9925f013	913	if (jn->nptr == NULL)
donatien	0:632c9925f013	914	{
donatien	0:632c9925f013	915	/* leaf node */
donatien	0:632c9925f013	916	LWIP_DEBUGF(SNMP_MIB_DEBUG,("jn->nptr == NULL\n"));
donatien	0:632c9925f013	917	return (struct mib_node*)lrn;
donatien	0:632c9925f013	918	}
donatien	0:632c9925f013	919	else
donatien	0:632c9925f013	920	{
donatien	0:632c9925f013	921	/* no leaf, continue */
donatien	0:632c9925f013	922	node = jn->nptr;
donatien	0:632c9925f013	923	}
donatien	0:632c9925f013	924	}
donatien	0:632c9925f013	925	else
donatien	0:632c9925f013	926	{
donatien	0:632c9925f013	927	/* jn == NULL */
donatien	0:632c9925f013	928	climb_tree = 1;
donatien	0:632c9925f013	929	}
donatien	0:632c9925f013	930	}
donatien	0:632c9925f013	931	}
donatien	0:632c9925f013	932	else if(node_type == MIB_NODE_EX)
donatien	0:632c9925f013	933	{
donatien	0:632c9925f013	934	struct mib_external_node *en;
donatien	0:632c9925f013	935	s32_t ex_id;
donatien	0:632c9925f013	936
donatien	0:632c9925f013	937	/* external node (addressing and access via functions) */
donatien	0:632c9925f013	938	en = (struct mib_external_node *)node;
donatien	0:632c9925f013	939	if (ident_len > 0)
donatien	0:632c9925f013	940	{
donatien	0:632c9925f013	941	u16_t i, len;
donatien	0:632c9925f013	942
donatien	0:632c9925f013	943	i = 0;
donatien	0:632c9925f013	944	len = en->level_length(en->addr_inf,ext_level);
donatien	0:632c9925f013	945	while ((i < len) && (en->ident_cmp(en->addr_inf,ext_level,i,*ident) < 0))
donatien	0:632c9925f013	946	{
donatien	0:632c9925f013	947	i++;
donatien	0:632c9925f013	948	}
donatien	0:632c9925f013	949	if (i < len)
donatien	0:632c9925f013	950	{
donatien	0:632c9925f013	951	/* add identifier to oidret */
donatien	0:632c9925f013	952	en->get_objid(en->addr_inf,ext_level,i,&ex_id);
donatien	0:632c9925f013	953	LWIP_DEBUGF(SNMP_MIB_DEBUG,("en->objid[%"U16_F"]==%"S32_F" ident==%"S32_F"\n",i,ex_id,ident));
donatien	0:632c9925f013	954	oidret->id[oidret->len] = ex_id;
donatien	0:632c9925f013	955	(oidret->len)++;
donatien	0:632c9925f013	956
donatien	0:632c9925f013	957	if ((ext_level + 1) == en->tree_levels)
donatien	0:632c9925f013	958	{
donatien	0:632c9925f013	959	LWIP_DEBUGF(SNMP_MIB_DEBUG,("leaf node\n"));
donatien	0:632c9925f013	960	/* leaf node */
donatien	0:632c9925f013	961	if (ex_id > *ident)
donatien	0:632c9925f013	962	{
donatien	0:632c9925f013	963	return (struct mib_node*)en;
donatien	0:632c9925f013	964	}
donatien	0:632c9925f013	965	else if ((i + 1) < len)
donatien	0:632c9925f013	966	{
donatien	0:632c9925f013	967	/* ex_id == ident /
donatien	0:632c9925f013	968	en->get_objid(en->addr_inf,ext_level,i + 1,&ex_id);
donatien	0:632c9925f013	969	(oidret->len)--;
donatien	0:632c9925f013	970	oidret->id[oidret->len] = ex_id;
donatien	0:632c9925f013	971	(oidret->len)++;
donatien	0:632c9925f013	972	return (struct mib_node*)en;
donatien	0:632c9925f013	973	}
donatien	0:632c9925f013	974	else
donatien	0:632c9925f013	975	{
donatien	0:632c9925f013	976	/* (i + 1) == len */
donatien	0:632c9925f013	977	(oidret->len)--;
donatien	0:632c9925f013	978	climb_tree = 1;
donatien	0:632c9925f013	979	}
donatien	0:632c9925f013	980	}
donatien	0:632c9925f013	981	else
donatien	0:632c9925f013	982	{
donatien	0:632c9925f013	983	u8_t j;
donatien	0:632c9925f013	984	struct nse cur_node;
donatien	0:632c9925f013	985
donatien	0:632c9925f013	986	LWIP_DEBUGF(SNMP_MIB_DEBUG,("non-leaf node\n"));
donatien	0:632c9925f013	987	/* non-leaf, store right child ptr and id */
donatien	0:632c9925f013	988	LWIP_ASSERT("i < 0xff", i < 0xff);
donatien	0:632c9925f013	989	j = (u8_t)i + 1;
donatien	0:632c9925f013	990	if (j < len)
donatien	0:632c9925f013	991	{
donatien	0:632c9925f013	992	/* right node is the current external node */
donatien	0:632c9925f013	993	cur_node.r_ptr = node;
donatien	0:632c9925f013	994	en->get_objid(en->addr_inf,ext_level,j,&cur_node.r_id);
donatien	0:632c9925f013	995	cur_node.r_nl = ext_level + 1;
donatien	0:632c9925f013	996	}
donatien	0:632c9925f013	997	else
donatien	0:632c9925f013	998	{
donatien	0:632c9925f013	999	cur_node.r_ptr = NULL;
donatien	0:632c9925f013	1000	}
donatien	0:632c9925f013	1001	push_node(&cur_node);
donatien	0:632c9925f013	1002	if (en->ident_cmp(en->addr_inf,ext_level,i,*ident) == 0)
donatien	0:632c9925f013	1003	{
donatien	0:632c9925f013	1004	ident_len--;
donatien	0:632c9925f013	1005	ident++;
donatien	0:632c9925f013	1006	}
donatien	0:632c9925f013	1007	else
donatien	0:632c9925f013	1008	{
donatien	0:632c9925f013	1009	/* external id < ident /
donatien	0:632c9925f013	1010	ident_len = 0;
donatien	0:632c9925f013	1011	}
donatien	0:632c9925f013	1012	/* proceed to child */
donatien	0:632c9925f013	1013	ext_level++;
donatien	0:632c9925f013	1014	}
donatien	0:632c9925f013	1015	}
donatien	0:632c9925f013	1016	else
donatien	0:632c9925f013	1017	{
donatien	0:632c9925f013	1018	/* i == len (en->level_len()) */
donatien	0:632c9925f013	1019	climb_tree = 1;
donatien	0:632c9925f013	1020	}
donatien	0:632c9925f013	1021	}
donatien	0:632c9925f013	1022	else
donatien	0:632c9925f013	1023	{
donatien	0:632c9925f013	1024	/* ident_len == 0, complete with leftmost '.thing' */
donatien	0:632c9925f013	1025	en->get_objid(en->addr_inf,ext_level,0,&ex_id);
donatien	0:632c9925f013	1026	LWIP_DEBUGF(SNMP_MIB_DEBUG,("left en->objid==%"S32_F"\n",ex_id));
donatien	0:632c9925f013	1027	oidret->id[oidret->len] = ex_id;
donatien	0:632c9925f013	1028	(oidret->len)++;
donatien	0:632c9925f013	1029	if ((ext_level + 1) == en->tree_levels)
donatien	0:632c9925f013	1030	{
donatien	0:632c9925f013	1031	/* leaf node */
donatien	0:632c9925f013	1032	LWIP_DEBUGF(SNMP_MIB_DEBUG,("(ext_level + 1) == en->tree_levels\n"));
donatien	0:632c9925f013	1033	return (struct mib_node*)en;
donatien	0:632c9925f013	1034	}
donatien	0:632c9925f013	1035	else
donatien	0:632c9925f013	1036	{
donatien	0:632c9925f013	1037	/* no leaf, proceed to child */
donatien	0:632c9925f013	1038	ext_level++;
donatien	0:632c9925f013	1039	}
donatien	0:632c9925f013	1040	}
donatien	0:632c9925f013	1041	}
donatien	0:632c9925f013	1042	else if(node_type == MIB_NODE_SC)
donatien	0:632c9925f013	1043	{
donatien	0:632c9925f013	1044	mib_scalar_node *sn;
donatien	0:632c9925f013	1045
donatien	0:632c9925f013	1046	/* scalar node */
donatien	0:632c9925f013	1047	sn = (mib_scalar_node *)node;
donatien	0:632c9925f013	1048	if (ident_len > 0)
donatien	0:632c9925f013	1049	{
donatien	0:632c9925f013	1050	/* at .0 */
donatien	0:632c9925f013	1051	climb_tree = 1;
donatien	0:632c9925f013	1052	}
donatien	0:632c9925f013	1053	else
donatien	0:632c9925f013	1054	{
donatien	0:632c9925f013	1055	/* ident_len == 0, complete object identifier */
donatien	0:632c9925f013	1056	oidret->id[oidret->len] = 0;
donatien	0:632c9925f013	1057	(oidret->len)++;
donatien	0:632c9925f013	1058	/* leaf node */
donatien	0:632c9925f013	1059	LWIP_DEBUGF(SNMP_MIB_DEBUG,("completed scalar leaf\n"));
donatien	0:632c9925f013	1060	return (struct mib_node*)sn;
donatien	0:632c9925f013	1061	}
donatien	0:632c9925f013	1062	}
donatien	0:632c9925f013	1063	else
donatien	0:632c9925f013	1064	{
donatien	0:632c9925f013	1065	/* unknown/unhandled node_type */
donatien	0:632c9925f013	1066	LWIP_DEBUGF(SNMP_MIB_DEBUG,("expand failed node_type %"U16_F" unkown\n",(u16_t)node_type));
donatien	0:632c9925f013	1067	return NULL;
donatien	0:632c9925f013	1068	}
donatien	0:632c9925f013	1069
donatien	0:632c9925f013	1070	if (climb_tree)
donatien	0:632c9925f013	1071	{
donatien	0:632c9925f013	1072	struct nse child;
donatien	0:632c9925f013	1073
donatien	0:632c9925f013	1074	/* find right child ptr */
donatien	0:632c9925f013	1075	child.r_ptr = NULL;
donatien	0:632c9925f013	1076	child.r_id = 0;
donatien	0:632c9925f013	1077	child.r_nl = 0;
donatien	0:632c9925f013	1078	while ((node_stack_cnt > 0) && (child.r_ptr == NULL))
donatien	0:632c9925f013	1079	{
donatien	0:632c9925f013	1080	pop_node(&child);
donatien	0:632c9925f013	1081	/* trim returned oid */
donatien	0:632c9925f013	1082	(oidret->len)--;
donatien	0:632c9925f013	1083	}
donatien	0:632c9925f013	1084	if (child.r_ptr != NULL)
donatien	0:632c9925f013	1085	{
donatien	0:632c9925f013	1086	/* incoming ident is useless beyond this point */
donatien	0:632c9925f013	1087	ident_len = 0;
donatien	0:632c9925f013	1088	oidret->id[oidret->len] = child.r_id;
donatien	0:632c9925f013	1089	oidret->len++;
donatien	0:632c9925f013	1090	node = child.r_ptr;
donatien	0:632c9925f013	1091	ext_level = child.r_nl;
donatien	0:632c9925f013	1092	}
donatien	0:632c9925f013	1093	else
donatien	0:632c9925f013	1094	{
donatien	0:632c9925f013	1095	/* tree ends here ... */
donatien	0:632c9925f013	1096	LWIP_DEBUGF(SNMP_MIB_DEBUG,("expand failed, tree ends here\n"));
donatien	0:632c9925f013	1097	return NULL;
donatien	0:632c9925f013	1098	}
donatien	0:632c9925f013	1099	}
donatien	0:632c9925f013	1100	}
donatien	0:632c9925f013	1101	/* done, found nothing */
donatien	0:632c9925f013	1102	LWIP_DEBUGF(SNMP_MIB_DEBUG,("expand failed node==%p\n",(void*)node));
donatien	0:632c9925f013	1103	return NULL;
donatien	0:632c9925f013	1104	}
donatien	0:632c9925f013	1105
donatien	0:632c9925f013	1106	/**
donatien	0:632c9925f013	1107	* Test object identifier for the iso.org.dod.internet prefix.
donatien	0:632c9925f013	1108	*
donatien	0:632c9925f013	1109	* @param ident_len the length of the supplied object identifier
donatien	0:632c9925f013	1110	* @param ident points to the array of sub identifiers
donatien	0:632c9925f013	1111	* @return 1 if it matches, 0 otherwise
donatien	0:632c9925f013	1112	*/
donatien	0:632c9925f013	1113	u8_t
donatien	0:632c9925f013	1114	snmp_iso_prefix_tst(u8_t ident_len, s32_t *ident)
donatien	0:632c9925f013	1115	{
donatien	0:632c9925f013	1116	if ((ident_len > 3) &&
donatien	0:632c9925f013	1117	(ident[0] == 1) && (ident[1] == 3) &&
donatien	0:632c9925f013	1118	(ident[2] == 6) && (ident[3] == 1))
donatien	0:632c9925f013	1119	{
donatien	0:632c9925f013	1120	return 1;
donatien	0:632c9925f013	1121	}
donatien	0:632c9925f013	1122	else
donatien	0:632c9925f013	1123	{
donatien	0:632c9925f013	1124	return 0;
donatien	0:632c9925f013	1125	}
donatien	0:632c9925f013	1126	}
donatien	0:632c9925f013	1127
donatien	0:632c9925f013	1128	/**
donatien	0:632c9925f013	1129	* Expands object identifier to the iso.org.dod.internet
donatien	0:632c9925f013	1130	* prefix for use in getnext operation.
donatien	0:632c9925f013	1131	*
donatien	0:632c9925f013	1132	* @param ident_len the length of the supplied object identifier
donatien	0:632c9925f013	1133	* @param ident points to the array of sub identifiers
donatien	0:632c9925f013	1134	* @param oidret points to returned expanded object identifier
donatien	0:632c9925f013	1135	* @return 1 if it matches, 0 otherwise
donatien	0:632c9925f013	1136	*
donatien	0:632c9925f013	1137	* @note ident_len 0 is allowed, expanding to the first known object id!!
donatien	0:632c9925f013	1138	*/
donatien	0:632c9925f013	1139	u8_t
donatien	0:632c9925f013	1140	snmp_iso_prefix_expand(u8_t ident_len, s32_t ident, struct snmp_obj_id oidret)
donatien	0:632c9925f013	1141	{
donatien	0:632c9925f013	1142	const s32_t *prefix_ptr;
donatien	0:632c9925f013	1143	s32_t *ret_ptr;
donatien	0:632c9925f013	1144	u8_t i;
donatien	0:632c9925f013	1145
donatien	0:632c9925f013	1146	i = 0;
donatien	0:632c9925f013	1147	prefix_ptr = &prefix[0];
donatien	0:632c9925f013	1148	ret_ptr = &oidret->id[0];
donatien	0:632c9925f013	1149	ident_len = ((ident_len < 4)?ident_len:4);
donatien	0:632c9925f013	1150	while ((i < ident_len) && ((ident) <= (prefix_ptr)))
donatien	0:632c9925f013	1151	{
donatien	0:632c9925f013	1152	ret_ptr++ = prefix_ptr++;
donatien	0:632c9925f013	1153	ident++;
donatien	0:632c9925f013	1154	i++;
donatien	0:632c9925f013	1155	}
donatien	0:632c9925f013	1156	if (i == ident_len)
donatien	0:632c9925f013	1157	{
donatien	0:632c9925f013	1158	/* match, complete missing bits */
donatien	0:632c9925f013	1159	while (i < 4)
donatien	0:632c9925f013	1160	{
donatien	0:632c9925f013	1161	ret_ptr++ = prefix_ptr++;
donatien	0:632c9925f013	1162	i++;
donatien	0:632c9925f013	1163	}
donatien	0:632c9925f013	1164	oidret->len = i;
donatien	0:632c9925f013	1165	return 1;
donatien	0:632c9925f013	1166	}
donatien	0:632c9925f013	1167	else
donatien	0:632c9925f013	1168	{
donatien	0:632c9925f013	1169	/* i != ident_len */
donatien	0:632c9925f013	1170	return 0;
donatien	0:632c9925f013	1171	}
donatien	0:632c9925f013	1172	}
donatien	0:632c9925f013	1173
donatien	0:632c9925f013	1174	#endif /* LWIP_SNMP */

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Created:	11 Jun 2010
Imports:	2654
Forks:	0
Commits:	12
Dependents:	3
Dependencies:	0
Followers:	13

This repository is Public (Unlisted).

lwip/core/snmp/mib_structs.c@0:632c9925f013, 2010-06-11 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning