NetServices - NetTribute library with debug turned on in FShand…

Users » hexley » Code » NetServices

NetTribute library with debug turned on in FShandler Donatien Garner -> Segundo Equipo -> this version

lwip/core/snmp/msg_in.c@0:281d6ff68967, 2010-11-19 (annotated)

Committer:: hexley
Date:: Fri Nov 19 01:54:45 2010 +0000
Revision:: 0:281d6ff68967

Who changed what in which revision?

User	Revision	Line number	New contents of line
hexley	0:281d6ff68967	1	/**
hexley	0:281d6ff68967	2	* @file
hexley	0:281d6ff68967	3	* SNMP input message processing (RFC1157).
hexley	0:281d6ff68967	4	*/
hexley	0:281d6ff68967	5
hexley	0:281d6ff68967	6	/*
hexley	0:281d6ff68967	7	* Copyright (c) 2006 Axon Digital Design B.V., The Netherlands.
hexley	0:281d6ff68967	8	* All rights reserved.
hexley	0:281d6ff68967	9	*
hexley	0:281d6ff68967	10	* Redistribution and use in source and binary forms, with or without modification,
hexley	0:281d6ff68967	11	* are permitted provided that the following conditions are met:
hexley	0:281d6ff68967	12	*
hexley	0:281d6ff68967	13	* 1. Redistributions of source code must retain the above copyright notice,
hexley	0:281d6ff68967	14	* this list of conditions and the following disclaimer.
hexley	0:281d6ff68967	15	* 2. Redistributions in binary form must reproduce the above copyright notice,
hexley	0:281d6ff68967	16	* this list of conditions and the following disclaimer in the documentation
hexley	0:281d6ff68967	17	* and/or other materials provided with the distribution.
hexley	0:281d6ff68967	18	* 3. The name of the author may not be used to endorse or promote products
hexley	0:281d6ff68967	19	* derived from this software without specific prior written permission.
hexley	0:281d6ff68967	20	*
hexley	0:281d6ff68967	21	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
hexley	0:281d6ff68967	22	* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
hexley	0:281d6ff68967	23	* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT
hexley	0:281d6ff68967	24	* SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
hexley	0:281d6ff68967	25	* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
hexley	0:281d6ff68967	26	* OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
hexley	0:281d6ff68967	27	* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
hexley	0:281d6ff68967	28	* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
hexley	0:281d6ff68967	29	* IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
hexley	0:281d6ff68967	30	* OF SUCH DAMAGE.
hexley	0:281d6ff68967	31	*
hexley	0:281d6ff68967	32	* Author: Christiaan Simons <christiaan.simons@axon.tv>
hexley	0:281d6ff68967	33	*/
hexley	0:281d6ff68967	34
hexley	0:281d6ff68967	35	#include "lwip/opt.h"
hexley	0:281d6ff68967	36
hexley	0:281d6ff68967	37	#if LWIP_SNMP /* don't build if not configured for use in lwipopts.h */
hexley	0:281d6ff68967	38
hexley	0:281d6ff68967	39	#include "lwip/snmp.h"
hexley	0:281d6ff68967	40	#include "lwip/snmp_asn1.h"
hexley	0:281d6ff68967	41	#include "lwip/snmp_msg.h"
hexley	0:281d6ff68967	42	#include "lwip/snmp_structs.h"
hexley	0:281d6ff68967	43	#include "lwip/ip_addr.h"
hexley	0:281d6ff68967	44	#include "lwip/memp.h"
hexley	0:281d6ff68967	45	#include "lwip/udp.h"
hexley	0:281d6ff68967	46	#include "lwip/stats.h"
hexley	0:281d6ff68967	47
hexley	0:281d6ff68967	48	#include <string.h>
hexley	0:281d6ff68967	49
hexley	0:281d6ff68967	50	/* public (non-static) constants */
hexley	0:281d6ff68967	51	/** SNMP v1 == 0 */
hexley	0:281d6ff68967	52	const s32_t snmp_version = 0;
hexley	0:281d6ff68967	53	/** default SNMP community string */
hexley	0:281d6ff68967	54	const char snmp_publiccommunity[7] = "public";
hexley	0:281d6ff68967	55
hexley	0:281d6ff68967	56	/* statically allocated buffers for SNMP_CONCURRENT_REQUESTS */
hexley	0:281d6ff68967	57	struct snmp_msg_pstat msg_input_list[SNMP_CONCURRENT_REQUESTS];
hexley	0:281d6ff68967	58	/* UDP Protocol Control Block */
hexley	0:281d6ff68967	59	struct udp_pcb *snmp1_pcb;
hexley	0:281d6ff68967	60
hexley	0:281d6ff68967	61	static void snmp_recv(void arg, struct udp_pcb pcb, struct pbuf p, ip_addr_t addr, u16_t port);
hexley	0:281d6ff68967	62	static err_t snmp_pdu_header_check(struct pbuf p, u16_t ofs, u16_t pdu_len, u16_t ofs_ret, struct snmp_msg_pstat *m_stat);
hexley	0:281d6ff68967	63	static err_t snmp_pdu_dec_varbindlist(struct pbuf p, u16_t ofs, u16_t ofs_ret, struct snmp_msg_pstat *m_stat);
hexley	0:281d6ff68967	64
hexley	0:281d6ff68967	65
hexley	0:281d6ff68967	66	/**
hexley	0:281d6ff68967	67	* Starts SNMP Agent.
hexley	0:281d6ff68967	68	* Allocates UDP pcb and binds it to IP_ADDR_ANY port 161.
hexley	0:281d6ff68967	69	*/
hexley	0:281d6ff68967	70	void
hexley	0:281d6ff68967	71	snmp_init(void)
hexley	0:281d6ff68967	72	{
hexley	0:281d6ff68967	73	struct snmp_msg_pstat *msg_ps;
hexley	0:281d6ff68967	74	u8_t i;
hexley	0:281d6ff68967	75
hexley	0:281d6ff68967	76	snmp1_pcb = udp_new();
hexley	0:281d6ff68967	77	if (snmp1_pcb != NULL)
hexley	0:281d6ff68967	78	{
hexley	0:281d6ff68967	79	udp_recv(snmp1_pcb, snmp_recv, (void *)SNMP_IN_PORT);
hexley	0:281d6ff68967	80	udp_bind(snmp1_pcb, IP_ADDR_ANY, SNMP_IN_PORT);
hexley	0:281d6ff68967	81	}
hexley	0:281d6ff68967	82	msg_ps = &msg_input_list[0];
hexley	0:281d6ff68967	83	for (i=0; i<SNMP_CONCURRENT_REQUESTS; i++)
hexley	0:281d6ff68967	84	{
hexley	0:281d6ff68967	85	msg_ps->state = SNMP_MSG_EMPTY;
hexley	0:281d6ff68967	86	msg_ps->error_index = 0;
hexley	0:281d6ff68967	87	msg_ps->error_status = SNMP_ES_NOERROR;
hexley	0:281d6ff68967	88	msg_ps++;
hexley	0:281d6ff68967	89	}
hexley	0:281d6ff68967	90	trap_msg.pcb = snmp1_pcb;
hexley	0:281d6ff68967	91
hexley	0:281d6ff68967	92	#ifdef SNMP_PRIVATE_MIB_INIT
hexley	0:281d6ff68967	93	/* If defined, rhis must be a function-like define to initialize the
hexley	0:281d6ff68967	94	* private MIB after the stack has been initialized.
hexley	0:281d6ff68967	95	* The private MIB can also be initialized in tcpip_callback (or after
hexley	0:281d6ff68967	96	* the stack is initialized), this define is only for convenience. */
hexley	0:281d6ff68967	97	SNMP_PRIVATE_MIB_INIT();
hexley	0:281d6ff68967	98	#endif /* SNMP_PRIVATE_MIB_INIT */
hexley	0:281d6ff68967	99
hexley	0:281d6ff68967	100	/* The coldstart trap will only be output
hexley	0:281d6ff68967	101	if our outgoing interface is up & configured */
hexley	0:281d6ff68967	102	snmp_coldstart_trap();
hexley	0:281d6ff68967	103	}
hexley	0:281d6ff68967	104
hexley	0:281d6ff68967	105	static void
hexley	0:281d6ff68967	106	snmp_error_response(struct snmp_msg_pstat *msg_ps, u8_t error)
hexley	0:281d6ff68967	107	{
hexley	0:281d6ff68967	108	snmp_varbind_list_free(&msg_ps->outvb);
hexley	0:281d6ff68967	109	msg_ps->outvb = msg_ps->invb;
hexley	0:281d6ff68967	110	msg_ps->invb.head = NULL;
hexley	0:281d6ff68967	111	msg_ps->invb.tail = NULL;
hexley	0:281d6ff68967	112	msg_ps->invb.count = 0;
hexley	0:281d6ff68967	113	msg_ps->error_status = error;
hexley	0:281d6ff68967	114	msg_ps->error_index = 1 + msg_ps->vb_idx;
hexley	0:281d6ff68967	115	snmp_send_response(msg_ps);
hexley	0:281d6ff68967	116	snmp_varbind_list_free(&msg_ps->outvb);
hexley	0:281d6ff68967	117	msg_ps->state = SNMP_MSG_EMPTY;
hexley	0:281d6ff68967	118	}
hexley	0:281d6ff68967	119
hexley	0:281d6ff68967	120	static void
hexley	0:281d6ff68967	121	snmp_ok_response(struct snmp_msg_pstat *msg_ps)
hexley	0:281d6ff68967	122	{
hexley	0:281d6ff68967	123	err_t err_ret;
hexley	0:281d6ff68967	124
hexley	0:281d6ff68967	125	err_ret = snmp_send_response(msg_ps);
hexley	0:281d6ff68967	126	if (err_ret == ERR_MEM)
hexley	0:281d6ff68967	127	{
hexley	0:281d6ff68967	128	/* serious memory problem, can't return tooBig */
hexley	0:281d6ff68967	129	}
hexley	0:281d6ff68967	130	else
hexley	0:281d6ff68967	131	{
hexley	0:281d6ff68967	132	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_event = %"S32_F"\n",msg_ps->error_status));
hexley	0:281d6ff68967	133	}
hexley	0:281d6ff68967	134	/* free varbinds (if available) */
hexley	0:281d6ff68967	135	snmp_varbind_list_free(&msg_ps->invb);
hexley	0:281d6ff68967	136	snmp_varbind_list_free(&msg_ps->outvb);
hexley	0:281d6ff68967	137	msg_ps->state = SNMP_MSG_EMPTY;
hexley	0:281d6ff68967	138	}
hexley	0:281d6ff68967	139
hexley	0:281d6ff68967	140	/**
hexley	0:281d6ff68967	141	* Service an internal or external event for SNMP GET.
hexley	0:281d6ff68967	142	*
hexley	0:281d6ff68967	143	* @param request_id identifies requests from 0 to (SNMP_CONCURRENT_REQUESTS-1)
hexley	0:281d6ff68967	144	* @param msg_ps points to the assosicated message process state
hexley	0:281d6ff68967	145	*/
hexley	0:281d6ff68967	146	static void
hexley	0:281d6ff68967	147	snmp_msg_get_event(u8_t request_id, struct snmp_msg_pstat *msg_ps)
hexley	0:281d6ff68967	148	{
hexley	0:281d6ff68967	149	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_get_event: msg_ps->state==%"U16_F"\n",(u16_t)msg_ps->state));
hexley	0:281d6ff68967	150
hexley	0:281d6ff68967	151	if (msg_ps->state == SNMP_MSG_EXTERNAL_GET_OBJDEF)
hexley	0:281d6ff68967	152	{
hexley	0:281d6ff68967	153	struct mib_external_node *en;
hexley	0:281d6ff68967	154	struct snmp_name_ptr np;
hexley	0:281d6ff68967	155
hexley	0:281d6ff68967	156	/* get_object_def() answer*/
hexley	0:281d6ff68967	157	en = msg_ps->ext_mib_node;
hexley	0:281d6ff68967	158	np = msg_ps->ext_name_ptr;
hexley	0:281d6ff68967	159
hexley	0:281d6ff68967	160	/* translate answer into a known lifeform */
hexley	0:281d6ff68967	161	en->get_object_def_a(request_id, np.ident_len, np.ident, &msg_ps->ext_object_def);
hexley	0:281d6ff68967	162	if ((msg_ps->ext_object_def.instance != MIB_OBJECT_NONE) &&
hexley	0:281d6ff68967	163	(msg_ps->ext_object_def.access & MIB_ACCESS_READ))
hexley	0:281d6ff68967	164	{
hexley	0:281d6ff68967	165	msg_ps->state = SNMP_MSG_EXTERNAL_GET_VALUE;
hexley	0:281d6ff68967	166	en->get_value_q(request_id, &msg_ps->ext_object_def);
hexley	0:281d6ff68967	167	}
hexley	0:281d6ff68967	168	else
hexley	0:281d6ff68967	169	{
hexley	0:281d6ff68967	170	en->get_object_def_pc(request_id, np.ident_len, np.ident);
hexley	0:281d6ff68967	171	/* search failed, object id points to unknown object (nosuchname) */
hexley	0:281d6ff68967	172	snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
hexley	0:281d6ff68967	173	}
hexley	0:281d6ff68967	174	}
hexley	0:281d6ff68967	175	else if (msg_ps->state == SNMP_MSG_EXTERNAL_GET_VALUE)
hexley	0:281d6ff68967	176	{
hexley	0:281d6ff68967	177	struct mib_external_node *en;
hexley	0:281d6ff68967	178	struct snmp_varbind *vb;
hexley	0:281d6ff68967	179
hexley	0:281d6ff68967	180	/* get_value() answer */
hexley	0:281d6ff68967	181	en = msg_ps->ext_mib_node;
hexley	0:281d6ff68967	182
hexley	0:281d6ff68967	183	/* allocate output varbind */
hexley	0:281d6ff68967	184	vb = (struct snmp_varbind *)memp_malloc(MEMP_SNMP_VARBIND);
hexley	0:281d6ff68967	185	LWIP_ASSERT("vb != NULL",vb != NULL);
hexley	0:281d6ff68967	186	if (vb != NULL)
hexley	0:281d6ff68967	187	{
hexley	0:281d6ff68967	188	vb->next = NULL;
hexley	0:281d6ff68967	189	vb->prev = NULL;
hexley	0:281d6ff68967	190
hexley	0:281d6ff68967	191	/* move name from invb to outvb */
hexley	0:281d6ff68967	192	vb->ident = msg_ps->vb_ptr->ident;
hexley	0:281d6ff68967	193	vb->ident_len = msg_ps->vb_ptr->ident_len;
hexley	0:281d6ff68967	194	/* ensure this memory is refereced once only */
hexley	0:281d6ff68967	195	msg_ps->vb_ptr->ident = NULL;
hexley	0:281d6ff68967	196	msg_ps->vb_ptr->ident_len = 0;
hexley	0:281d6ff68967	197
hexley	0:281d6ff68967	198	vb->value_type = msg_ps->ext_object_def.asn_type;
hexley	0:281d6ff68967	199	LWIP_ASSERT("invalid length", msg_ps->ext_object_def.v_len <= 0xff);
hexley	0:281d6ff68967	200	vb->value_len = (u8_t)msg_ps->ext_object_def.v_len;
hexley	0:281d6ff68967	201	if (vb->value_len > 0)
hexley	0:281d6ff68967	202	{
hexley	0:281d6ff68967	203	LWIP_ASSERT("SNMP_MAX_OCTET_STRING_LEN is configured too low", vb->value_len <= SNMP_MAX_VALUE_SIZE);
hexley	0:281d6ff68967	204	vb->value = memp_malloc(MEMP_SNMP_VALUE);
hexley	0:281d6ff68967	205	LWIP_ASSERT("vb->value != NULL",vb->value != NULL);
hexley	0:281d6ff68967	206	if (vb->value != NULL)
hexley	0:281d6ff68967	207	{
hexley	0:281d6ff68967	208	en->get_value_a(request_id, &msg_ps->ext_object_def, vb->value_len, vb->value);
hexley	0:281d6ff68967	209	snmp_varbind_tail_add(&msg_ps->outvb, vb);
hexley	0:281d6ff68967	210	/* search again (if vb_idx < msg_ps->invb.count) */
hexley	0:281d6ff68967	211	msg_ps->state = SNMP_MSG_SEARCH_OBJ;
hexley	0:281d6ff68967	212	msg_ps->vb_idx += 1;
hexley	0:281d6ff68967	213	}
hexley	0:281d6ff68967	214	else
hexley	0:281d6ff68967	215	{
hexley	0:281d6ff68967	216	en->get_value_pc(request_id, &msg_ps->ext_object_def);
hexley	0:281d6ff68967	217	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_event: no variable space\n"));
hexley	0:281d6ff68967	218	msg_ps->vb_ptr->ident = vb->ident;
hexley	0:281d6ff68967	219	msg_ps->vb_ptr->ident_len = vb->ident_len;
hexley	0:281d6ff68967	220	memp_free(MEMP_SNMP_VARBIND, vb);
hexley	0:281d6ff68967	221	snmp_error_response(msg_ps,SNMP_ES_TOOBIG);
hexley	0:281d6ff68967	222	}
hexley	0:281d6ff68967	223	}
hexley	0:281d6ff68967	224	else
hexley	0:281d6ff68967	225	{
hexley	0:281d6ff68967	226	/* vb->value_len == 0, empty value (e.g. empty string) */
hexley	0:281d6ff68967	227	en->get_value_a(request_id, &msg_ps->ext_object_def, 0, NULL);
hexley	0:281d6ff68967	228	vb->value = NULL;
hexley	0:281d6ff68967	229	snmp_varbind_tail_add(&msg_ps->outvb, vb);
hexley	0:281d6ff68967	230	/* search again (if vb_idx < msg_ps->invb.count) */
hexley	0:281d6ff68967	231	msg_ps->state = SNMP_MSG_SEARCH_OBJ;
hexley	0:281d6ff68967	232	msg_ps->vb_idx += 1;
hexley	0:281d6ff68967	233	}
hexley	0:281d6ff68967	234	}
hexley	0:281d6ff68967	235	else
hexley	0:281d6ff68967	236	{
hexley	0:281d6ff68967	237	en->get_value_pc(request_id, &msg_ps->ext_object_def);
hexley	0:281d6ff68967	238	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_event: no outvb space\n"));
hexley	0:281d6ff68967	239	snmp_error_response(msg_ps,SNMP_ES_TOOBIG);
hexley	0:281d6ff68967	240	}
hexley	0:281d6ff68967	241	}
hexley	0:281d6ff68967	242
hexley	0:281d6ff68967	243	while ((msg_ps->state == SNMP_MSG_SEARCH_OBJ) &&
hexley	0:281d6ff68967	244	(msg_ps->vb_idx < msg_ps->invb.count))
hexley	0:281d6ff68967	245	{
hexley	0:281d6ff68967	246	struct mib_node *mn;
hexley	0:281d6ff68967	247	struct snmp_name_ptr np;
hexley	0:281d6ff68967	248
hexley	0:281d6ff68967	249	if (msg_ps->vb_idx == 0)
hexley	0:281d6ff68967	250	{
hexley	0:281d6ff68967	251	msg_ps->vb_ptr = msg_ps->invb.head;
hexley	0:281d6ff68967	252	}
hexley	0:281d6ff68967	253	else
hexley	0:281d6ff68967	254	{
hexley	0:281d6ff68967	255	msg_ps->vb_ptr = msg_ps->vb_ptr->next;
hexley	0:281d6ff68967	256	}
hexley	0:281d6ff68967	257	/** test object identifier for .iso.org.dod.internet prefix */
hexley	0:281d6ff68967	258	if (snmp_iso_prefix_tst(msg_ps->vb_ptr->ident_len, msg_ps->vb_ptr->ident))
hexley	0:281d6ff68967	259	{
hexley	0:281d6ff68967	260	mn = snmp_search_tree((struct mib_node*)&internet, msg_ps->vb_ptr->ident_len - 4,
hexley	0:281d6ff68967	261	msg_ps->vb_ptr->ident + 4, &np);
hexley	0:281d6ff68967	262	if (mn != NULL)
hexley	0:281d6ff68967	263	{
hexley	0:281d6ff68967	264	if (mn->node_type == MIB_NODE_EX)
hexley	0:281d6ff68967	265	{
hexley	0:281d6ff68967	266	/* external object */
hexley	0:281d6ff68967	267	struct mib_external_node en = (struct mib_external_node)mn;
hexley	0:281d6ff68967	268
hexley	0:281d6ff68967	269	msg_ps->state = SNMP_MSG_EXTERNAL_GET_OBJDEF;
hexley	0:281d6ff68967	270	/* save en && args in msg_ps!! */
hexley	0:281d6ff68967	271	msg_ps->ext_mib_node = en;
hexley	0:281d6ff68967	272	msg_ps->ext_name_ptr = np;
hexley	0:281d6ff68967	273
hexley	0:281d6ff68967	274	en->get_object_def_q(en->addr_inf, request_id, np.ident_len, np.ident);
hexley	0:281d6ff68967	275	}
hexley	0:281d6ff68967	276	else
hexley	0:281d6ff68967	277	{
hexley	0:281d6ff68967	278	/* internal object */
hexley	0:281d6ff68967	279	struct obj_def object_def;
hexley	0:281d6ff68967	280
hexley	0:281d6ff68967	281	msg_ps->state = SNMP_MSG_INTERNAL_GET_OBJDEF;
hexley	0:281d6ff68967	282	mn->get_object_def(np.ident_len, np.ident, &object_def);
hexley	0:281d6ff68967	283	if ((object_def.instance != MIB_OBJECT_NONE) &&
hexley	0:281d6ff68967	284	(object_def.access & MIB_ACCESS_READ))
hexley	0:281d6ff68967	285	{
hexley	0:281d6ff68967	286	mn = mn;
hexley	0:281d6ff68967	287	}
hexley	0:281d6ff68967	288	else
hexley	0:281d6ff68967	289	{
hexley	0:281d6ff68967	290	/* search failed, object id points to unknown object (nosuchname) */
hexley	0:281d6ff68967	291	mn = NULL;
hexley	0:281d6ff68967	292	}
hexley	0:281d6ff68967	293	if (mn != NULL)
hexley	0:281d6ff68967	294	{
hexley	0:281d6ff68967	295	struct snmp_varbind *vb;
hexley	0:281d6ff68967	296
hexley	0:281d6ff68967	297	msg_ps->state = SNMP_MSG_INTERNAL_GET_VALUE;
hexley	0:281d6ff68967	298	/* allocate output varbind */
hexley	0:281d6ff68967	299	vb = (struct snmp_varbind *)memp_malloc(MEMP_SNMP_VARBIND);
hexley	0:281d6ff68967	300	LWIP_ASSERT("vb != NULL",vb != NULL);
hexley	0:281d6ff68967	301	if (vb != NULL)
hexley	0:281d6ff68967	302	{
hexley	0:281d6ff68967	303	vb->next = NULL;
hexley	0:281d6ff68967	304	vb->prev = NULL;
hexley	0:281d6ff68967	305
hexley	0:281d6ff68967	306	/* move name from invb to outvb */
hexley	0:281d6ff68967	307	vb->ident = msg_ps->vb_ptr->ident;
hexley	0:281d6ff68967	308	vb->ident_len = msg_ps->vb_ptr->ident_len;
hexley	0:281d6ff68967	309	/* ensure this memory is refereced once only */
hexley	0:281d6ff68967	310	msg_ps->vb_ptr->ident = NULL;
hexley	0:281d6ff68967	311	msg_ps->vb_ptr->ident_len = 0;
hexley	0:281d6ff68967	312
hexley	0:281d6ff68967	313	vb->value_type = object_def.asn_type;
hexley	0:281d6ff68967	314	LWIP_ASSERT("invalid length", object_def.v_len <= 0xff);
hexley	0:281d6ff68967	315	vb->value_len = (u8_t)object_def.v_len;
hexley	0:281d6ff68967	316	if (vb->value_len > 0)
hexley	0:281d6ff68967	317	{
hexley	0:281d6ff68967	318	LWIP_ASSERT("SNMP_MAX_OCTET_STRING_LEN is configured too low",
hexley	0:281d6ff68967	319	vb->value_len <= SNMP_MAX_VALUE_SIZE);
hexley	0:281d6ff68967	320	vb->value = memp_malloc(MEMP_SNMP_VALUE);
hexley	0:281d6ff68967	321	LWIP_ASSERT("vb->value != NULL",vb->value != NULL);
hexley	0:281d6ff68967	322	if (vb->value != NULL)
hexley	0:281d6ff68967	323	{
hexley	0:281d6ff68967	324	mn->get_value(&object_def, vb->value_len, vb->value);
hexley	0:281d6ff68967	325	snmp_varbind_tail_add(&msg_ps->outvb, vb);
hexley	0:281d6ff68967	326	msg_ps->state = SNMP_MSG_SEARCH_OBJ;
hexley	0:281d6ff68967	327	msg_ps->vb_idx += 1;
hexley	0:281d6ff68967	328	}
hexley	0:281d6ff68967	329	else
hexley	0:281d6ff68967	330	{
hexley	0:281d6ff68967	331	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_event: couldn't allocate variable space\n"));
hexley	0:281d6ff68967	332	msg_ps->vb_ptr->ident = vb->ident;
hexley	0:281d6ff68967	333	msg_ps->vb_ptr->ident_len = vb->ident_len;
hexley	0:281d6ff68967	334	memp_free(MEMP_SNMP_VARBIND, vb);
hexley	0:281d6ff68967	335	snmp_error_response(msg_ps,SNMP_ES_TOOBIG);
hexley	0:281d6ff68967	336	}
hexley	0:281d6ff68967	337	}
hexley	0:281d6ff68967	338	else
hexley	0:281d6ff68967	339	{
hexley	0:281d6ff68967	340	/* vb->value_len == 0, empty value (e.g. empty string) */
hexley	0:281d6ff68967	341	vb->value = NULL;
hexley	0:281d6ff68967	342	snmp_varbind_tail_add(&msg_ps->outvb, vb);
hexley	0:281d6ff68967	343	msg_ps->state = SNMP_MSG_SEARCH_OBJ;
hexley	0:281d6ff68967	344	msg_ps->vb_idx += 1;
hexley	0:281d6ff68967	345	}
hexley	0:281d6ff68967	346	}
hexley	0:281d6ff68967	347	else
hexley	0:281d6ff68967	348	{
hexley	0:281d6ff68967	349	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_event: couldn't allocate outvb space\n"));
hexley	0:281d6ff68967	350	snmp_error_response(msg_ps,SNMP_ES_TOOBIG);
hexley	0:281d6ff68967	351	}
hexley	0:281d6ff68967	352	}
hexley	0:281d6ff68967	353	}
hexley	0:281d6ff68967	354	}
hexley	0:281d6ff68967	355	}
hexley	0:281d6ff68967	356	else
hexley	0:281d6ff68967	357	{
hexley	0:281d6ff68967	358	mn = NULL;
hexley	0:281d6ff68967	359	}
hexley	0:281d6ff68967	360	if (mn == NULL)
hexley	0:281d6ff68967	361	{
hexley	0:281d6ff68967	362	/* mn == NULL, noSuchName */
hexley	0:281d6ff68967	363	snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
hexley	0:281d6ff68967	364	}
hexley	0:281d6ff68967	365	}
hexley	0:281d6ff68967	366	if ((msg_ps->state == SNMP_MSG_SEARCH_OBJ) &&
hexley	0:281d6ff68967	367	(msg_ps->vb_idx == msg_ps->invb.count))
hexley	0:281d6ff68967	368	{
hexley	0:281d6ff68967	369	snmp_ok_response(msg_ps);
hexley	0:281d6ff68967	370	}
hexley	0:281d6ff68967	371	}
hexley	0:281d6ff68967	372
hexley	0:281d6ff68967	373	/**
hexley	0:281d6ff68967	374	* Service an internal or external event for SNMP GETNEXT.
hexley	0:281d6ff68967	375	*
hexley	0:281d6ff68967	376	* @param request_id identifies requests from 0 to (SNMP_CONCURRENT_REQUESTS-1)
hexley	0:281d6ff68967	377	* @param msg_ps points to the assosicated message process state
hexley	0:281d6ff68967	378	*/
hexley	0:281d6ff68967	379	static void
hexley	0:281d6ff68967	380	snmp_msg_getnext_event(u8_t request_id, struct snmp_msg_pstat *msg_ps)
hexley	0:281d6ff68967	381	{
hexley	0:281d6ff68967	382	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_getnext_event: msg_ps->state==%"U16_F"\n",(u16_t)msg_ps->state));
hexley	0:281d6ff68967	383
hexley	0:281d6ff68967	384	if (msg_ps->state == SNMP_MSG_EXTERNAL_GET_OBJDEF)
hexley	0:281d6ff68967	385	{
hexley	0:281d6ff68967	386	struct mib_external_node *en;
hexley	0:281d6ff68967	387
hexley	0:281d6ff68967	388	/* get_object_def() answer*/
hexley	0:281d6ff68967	389	en = msg_ps->ext_mib_node;
hexley	0:281d6ff68967	390
hexley	0:281d6ff68967	391	/* translate answer into a known lifeform */
hexley	0:281d6ff68967	392	en->get_object_def_a(request_id, 1, &msg_ps->ext_oid.id[msg_ps->ext_oid.len - 1], &msg_ps->ext_object_def);
hexley	0:281d6ff68967	393	if (msg_ps->ext_object_def.instance != MIB_OBJECT_NONE)
hexley	0:281d6ff68967	394	{
hexley	0:281d6ff68967	395	msg_ps->state = SNMP_MSG_EXTERNAL_GET_VALUE;
hexley	0:281d6ff68967	396	en->get_value_q(request_id, &msg_ps->ext_object_def);
hexley	0:281d6ff68967	397	}
hexley	0:281d6ff68967	398	else
hexley	0:281d6ff68967	399	{
hexley	0:281d6ff68967	400	en->get_object_def_pc(request_id, 1, &msg_ps->ext_oid.id[msg_ps->ext_oid.len - 1]);
hexley	0:281d6ff68967	401	/* search failed, object id points to unknown object (nosuchname) */
hexley	0:281d6ff68967	402	snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
hexley	0:281d6ff68967	403	}
hexley	0:281d6ff68967	404	}
hexley	0:281d6ff68967	405	else if (msg_ps->state == SNMP_MSG_EXTERNAL_GET_VALUE)
hexley	0:281d6ff68967	406	{
hexley	0:281d6ff68967	407	struct mib_external_node *en;
hexley	0:281d6ff68967	408	struct snmp_varbind *vb;
hexley	0:281d6ff68967	409
hexley	0:281d6ff68967	410	/* get_value() answer */
hexley	0:281d6ff68967	411	en = msg_ps->ext_mib_node;
hexley	0:281d6ff68967	412
hexley	0:281d6ff68967	413	LWIP_ASSERT("invalid length", msg_ps->ext_object_def.v_len <= 0xff);
hexley	0:281d6ff68967	414	vb = snmp_varbind_alloc(&msg_ps->ext_oid,
hexley	0:281d6ff68967	415	msg_ps->ext_object_def.asn_type,
hexley	0:281d6ff68967	416	(u8_t)msg_ps->ext_object_def.v_len);
hexley	0:281d6ff68967	417	if (vb != NULL)
hexley	0:281d6ff68967	418	{
hexley	0:281d6ff68967	419	en->get_value_a(request_id, &msg_ps->ext_object_def, vb->value_len, vb->value);
hexley	0:281d6ff68967	420	snmp_varbind_tail_add(&msg_ps->outvb, vb);
hexley	0:281d6ff68967	421	msg_ps->state = SNMP_MSG_SEARCH_OBJ;
hexley	0:281d6ff68967	422	msg_ps->vb_idx += 1;
hexley	0:281d6ff68967	423	}
hexley	0:281d6ff68967	424	else
hexley	0:281d6ff68967	425	{
hexley	0:281d6ff68967	426	en->get_value_pc(request_id, &msg_ps->ext_object_def);
hexley	0:281d6ff68967	427	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_getnext_event: couldn't allocate outvb space\n"));
hexley	0:281d6ff68967	428	snmp_error_response(msg_ps,SNMP_ES_TOOBIG);
hexley	0:281d6ff68967	429	}
hexley	0:281d6ff68967	430	}
hexley	0:281d6ff68967	431
hexley	0:281d6ff68967	432	while ((msg_ps->state == SNMP_MSG_SEARCH_OBJ) &&
hexley	0:281d6ff68967	433	(msg_ps->vb_idx < msg_ps->invb.count))
hexley	0:281d6ff68967	434	{
hexley	0:281d6ff68967	435	struct mib_node *mn;
hexley	0:281d6ff68967	436	struct snmp_obj_id oid;
hexley	0:281d6ff68967	437
hexley	0:281d6ff68967	438	if (msg_ps->vb_idx == 0)
hexley	0:281d6ff68967	439	{
hexley	0:281d6ff68967	440	msg_ps->vb_ptr = msg_ps->invb.head;
hexley	0:281d6ff68967	441	}
hexley	0:281d6ff68967	442	else
hexley	0:281d6ff68967	443	{
hexley	0:281d6ff68967	444	msg_ps->vb_ptr = msg_ps->vb_ptr->next;
hexley	0:281d6ff68967	445	}
hexley	0:281d6ff68967	446	if (snmp_iso_prefix_expand(msg_ps->vb_ptr->ident_len, msg_ps->vb_ptr->ident, &oid))
hexley	0:281d6ff68967	447	{
hexley	0:281d6ff68967	448	if (msg_ps->vb_ptr->ident_len > 3)
hexley	0:281d6ff68967	449	{
hexley	0:281d6ff68967	450	/* can offset ident_len and ident */
hexley	0:281d6ff68967	451	mn = snmp_expand_tree((struct mib_node*)&internet,
hexley	0:281d6ff68967	452	msg_ps->vb_ptr->ident_len - 4,
hexley	0:281d6ff68967	453	msg_ps->vb_ptr->ident + 4, &oid);
hexley	0:281d6ff68967	454	}
hexley	0:281d6ff68967	455	else
hexley	0:281d6ff68967	456	{
hexley	0:281d6ff68967	457	/* can't offset ident_len -4, ident + 4 */
hexley	0:281d6ff68967	458	mn = snmp_expand_tree((struct mib_node*)&internet, 0, NULL, &oid);
hexley	0:281d6ff68967	459	}
hexley	0:281d6ff68967	460	}
hexley	0:281d6ff68967	461	else
hexley	0:281d6ff68967	462	{
hexley	0:281d6ff68967	463	mn = NULL;
hexley	0:281d6ff68967	464	}
hexley	0:281d6ff68967	465	if (mn != NULL)
hexley	0:281d6ff68967	466	{
hexley	0:281d6ff68967	467	if (mn->node_type == MIB_NODE_EX)
hexley	0:281d6ff68967	468	{
hexley	0:281d6ff68967	469	/* external object */
hexley	0:281d6ff68967	470	struct mib_external_node en = (struct mib_external_node)mn;
hexley	0:281d6ff68967	471
hexley	0:281d6ff68967	472	msg_ps->state = SNMP_MSG_EXTERNAL_GET_OBJDEF;
hexley	0:281d6ff68967	473	/* save en && args in msg_ps!! */
hexley	0:281d6ff68967	474	msg_ps->ext_mib_node = en;
hexley	0:281d6ff68967	475	msg_ps->ext_oid = oid;
hexley	0:281d6ff68967	476
hexley	0:281d6ff68967	477	en->get_object_def_q(en->addr_inf, request_id, 1, &oid.id[oid.len - 1]);
hexley	0:281d6ff68967	478	}
hexley	0:281d6ff68967	479	else
hexley	0:281d6ff68967	480	{
hexley	0:281d6ff68967	481	/* internal object */
hexley	0:281d6ff68967	482	struct obj_def object_def;
hexley	0:281d6ff68967	483	struct snmp_varbind *vb;
hexley	0:281d6ff68967	484
hexley	0:281d6ff68967	485	msg_ps->state = SNMP_MSG_INTERNAL_GET_OBJDEF;
hexley	0:281d6ff68967	486	mn->get_object_def(1, &oid.id[oid.len - 1], &object_def);
hexley	0:281d6ff68967	487
hexley	0:281d6ff68967	488	LWIP_ASSERT("invalid length", object_def.v_len <= 0xff);
hexley	0:281d6ff68967	489	vb = snmp_varbind_alloc(&oid, object_def.asn_type, (u8_t)object_def.v_len);
hexley	0:281d6ff68967	490	if (vb != NULL)
hexley	0:281d6ff68967	491	{
hexley	0:281d6ff68967	492	msg_ps->state = SNMP_MSG_INTERNAL_GET_VALUE;
hexley	0:281d6ff68967	493	mn->get_value(&object_def, object_def.v_len, vb->value);
hexley	0:281d6ff68967	494	snmp_varbind_tail_add(&msg_ps->outvb, vb);
hexley	0:281d6ff68967	495	msg_ps->state = SNMP_MSG_SEARCH_OBJ;
hexley	0:281d6ff68967	496	msg_ps->vb_idx += 1;
hexley	0:281d6ff68967	497	}
hexley	0:281d6ff68967	498	else
hexley	0:281d6ff68967	499	{
hexley	0:281d6ff68967	500	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_recv couldn't allocate outvb space\n"));
hexley	0:281d6ff68967	501	snmp_error_response(msg_ps,SNMP_ES_TOOBIG);
hexley	0:281d6ff68967	502	}
hexley	0:281d6ff68967	503	}
hexley	0:281d6ff68967	504	}
hexley	0:281d6ff68967	505	if (mn == NULL)
hexley	0:281d6ff68967	506	{
hexley	0:281d6ff68967	507	/* mn == NULL, noSuchName */
hexley	0:281d6ff68967	508	snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
hexley	0:281d6ff68967	509	}
hexley	0:281d6ff68967	510	}
hexley	0:281d6ff68967	511	if ((msg_ps->state == SNMP_MSG_SEARCH_OBJ) &&
hexley	0:281d6ff68967	512	(msg_ps->vb_idx == msg_ps->invb.count))
hexley	0:281d6ff68967	513	{
hexley	0:281d6ff68967	514	snmp_ok_response(msg_ps);
hexley	0:281d6ff68967	515	}
hexley	0:281d6ff68967	516	}
hexley	0:281d6ff68967	517
hexley	0:281d6ff68967	518	/**
hexley	0:281d6ff68967	519	* Service an internal or external event for SNMP SET.
hexley	0:281d6ff68967	520	*
hexley	0:281d6ff68967	521	* @param request_id identifies requests from 0 to (SNMP_CONCURRENT_REQUESTS-1)
hexley	0:281d6ff68967	522	* @param msg_ps points to the assosicated message process state
hexley	0:281d6ff68967	523	*/
hexley	0:281d6ff68967	524	static void
hexley	0:281d6ff68967	525	snmp_msg_set_event(u8_t request_id, struct snmp_msg_pstat *msg_ps)
hexley	0:281d6ff68967	526	{
hexley	0:281d6ff68967	527	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_set_event: msg_ps->state==%"U16_F"\n",(u16_t)msg_ps->state));
hexley	0:281d6ff68967	528
hexley	0:281d6ff68967	529	if (msg_ps->state == SNMP_MSG_EXTERNAL_GET_OBJDEF)
hexley	0:281d6ff68967	530	{
hexley	0:281d6ff68967	531	struct mib_external_node *en;
hexley	0:281d6ff68967	532	struct snmp_name_ptr np;
hexley	0:281d6ff68967	533
hexley	0:281d6ff68967	534	/* get_object_def() answer*/
hexley	0:281d6ff68967	535	en = msg_ps->ext_mib_node;
hexley	0:281d6ff68967	536	np = msg_ps->ext_name_ptr;
hexley	0:281d6ff68967	537
hexley	0:281d6ff68967	538	/* translate answer into a known lifeform */
hexley	0:281d6ff68967	539	en->get_object_def_a(request_id, np.ident_len, np.ident, &msg_ps->ext_object_def);
hexley	0:281d6ff68967	540	if (msg_ps->ext_object_def.instance != MIB_OBJECT_NONE)
hexley	0:281d6ff68967	541	{
hexley	0:281d6ff68967	542	msg_ps->state = SNMP_MSG_EXTERNAL_SET_TEST;
hexley	0:281d6ff68967	543	en->set_test_q(request_id, &msg_ps->ext_object_def);
hexley	0:281d6ff68967	544	}
hexley	0:281d6ff68967	545	else
hexley	0:281d6ff68967	546	{
hexley	0:281d6ff68967	547	en->get_object_def_pc(request_id, np.ident_len, np.ident);
hexley	0:281d6ff68967	548	/* search failed, object id points to unknown object (nosuchname) */
hexley	0:281d6ff68967	549	snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
hexley	0:281d6ff68967	550	}
hexley	0:281d6ff68967	551	}
hexley	0:281d6ff68967	552	else if (msg_ps->state == SNMP_MSG_EXTERNAL_SET_TEST)
hexley	0:281d6ff68967	553	{
hexley	0:281d6ff68967	554	struct mib_external_node *en;
hexley	0:281d6ff68967	555
hexley	0:281d6ff68967	556	/* set_test() answer*/
hexley	0:281d6ff68967	557	en = msg_ps->ext_mib_node;
hexley	0:281d6ff68967	558
hexley	0:281d6ff68967	559	if (msg_ps->ext_object_def.access & MIB_ACCESS_WRITE)
hexley	0:281d6ff68967	560	{
hexley	0:281d6ff68967	561	if ((msg_ps->ext_object_def.asn_type == msg_ps->vb_ptr->value_type) &&
hexley	0:281d6ff68967	562	(en->set_test_a(request_id,&msg_ps->ext_object_def,
hexley	0:281d6ff68967	563	msg_ps->vb_ptr->value_len,msg_ps->vb_ptr->value) != 0))
hexley	0:281d6ff68967	564	{
hexley	0:281d6ff68967	565	msg_ps->state = SNMP_MSG_SEARCH_OBJ;
hexley	0:281d6ff68967	566	msg_ps->vb_idx += 1;
hexley	0:281d6ff68967	567	}
hexley	0:281d6ff68967	568	else
hexley	0:281d6ff68967	569	{
hexley	0:281d6ff68967	570	en->set_test_pc(request_id,&msg_ps->ext_object_def);
hexley	0:281d6ff68967	571	/* bad value */
hexley	0:281d6ff68967	572	snmp_error_response(msg_ps,SNMP_ES_BADVALUE);
hexley	0:281d6ff68967	573	}
hexley	0:281d6ff68967	574	}
hexley	0:281d6ff68967	575	else
hexley	0:281d6ff68967	576	{
hexley	0:281d6ff68967	577	en->set_test_pc(request_id,&msg_ps->ext_object_def);
hexley	0:281d6ff68967	578	/* object not available for set */
hexley	0:281d6ff68967	579	snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
hexley	0:281d6ff68967	580	}
hexley	0:281d6ff68967	581	}
hexley	0:281d6ff68967	582	else if (msg_ps->state == SNMP_MSG_EXTERNAL_GET_OBJDEF_S)
hexley	0:281d6ff68967	583	{
hexley	0:281d6ff68967	584	struct mib_external_node *en;
hexley	0:281d6ff68967	585	struct snmp_name_ptr np;
hexley	0:281d6ff68967	586
hexley	0:281d6ff68967	587	/* get_object_def() answer*/
hexley	0:281d6ff68967	588	en = msg_ps->ext_mib_node;
hexley	0:281d6ff68967	589	np = msg_ps->ext_name_ptr;
hexley	0:281d6ff68967	590
hexley	0:281d6ff68967	591	/* translate answer into a known lifeform */
hexley	0:281d6ff68967	592	en->get_object_def_a(request_id, np.ident_len, np.ident, &msg_ps->ext_object_def);
hexley	0:281d6ff68967	593	if (msg_ps->ext_object_def.instance != MIB_OBJECT_NONE)
hexley	0:281d6ff68967	594	{
hexley	0:281d6ff68967	595	msg_ps->state = SNMP_MSG_EXTERNAL_SET_VALUE;
hexley	0:281d6ff68967	596	en->set_value_q(request_id, &msg_ps->ext_object_def,
hexley	0:281d6ff68967	597	msg_ps->vb_ptr->value_len,msg_ps->vb_ptr->value);
hexley	0:281d6ff68967	598	}
hexley	0:281d6ff68967	599	else
hexley	0:281d6ff68967	600	{
hexley	0:281d6ff68967	601	en->get_object_def_pc(request_id, np.ident_len, np.ident);
hexley	0:281d6ff68967	602	/* set_value failed, object has disappeared for some odd reason?? */
hexley	0:281d6ff68967	603	snmp_error_response(msg_ps,SNMP_ES_GENERROR);
hexley	0:281d6ff68967	604	}
hexley	0:281d6ff68967	605	}
hexley	0:281d6ff68967	606	else if (msg_ps->state == SNMP_MSG_EXTERNAL_SET_VALUE)
hexley	0:281d6ff68967	607	{
hexley	0:281d6ff68967	608	struct mib_external_node *en;
hexley	0:281d6ff68967	609
hexley	0:281d6ff68967	610	/** set_value_a() */
hexley	0:281d6ff68967	611	en = msg_ps->ext_mib_node;
hexley	0:281d6ff68967	612	en->set_value_a(request_id, &msg_ps->ext_object_def,
hexley	0:281d6ff68967	613	msg_ps->vb_ptr->value_len, msg_ps->vb_ptr->value);
hexley	0:281d6ff68967	614
hexley	0:281d6ff68967	615	/** @todo use set_value_pc() if toobig */
hexley	0:281d6ff68967	616	msg_ps->state = SNMP_MSG_INTERNAL_SET_VALUE;
hexley	0:281d6ff68967	617	msg_ps->vb_idx += 1;
hexley	0:281d6ff68967	618	}
hexley	0:281d6ff68967	619
hexley	0:281d6ff68967	620	/* test all values before setting */
hexley	0:281d6ff68967	621	while ((msg_ps->state == SNMP_MSG_SEARCH_OBJ) &&
hexley	0:281d6ff68967	622	(msg_ps->vb_idx < msg_ps->invb.count))
hexley	0:281d6ff68967	623	{
hexley	0:281d6ff68967	624	struct mib_node *mn;
hexley	0:281d6ff68967	625	struct snmp_name_ptr np;
hexley	0:281d6ff68967	626
hexley	0:281d6ff68967	627	if (msg_ps->vb_idx == 0)
hexley	0:281d6ff68967	628	{
hexley	0:281d6ff68967	629	msg_ps->vb_ptr = msg_ps->invb.head;
hexley	0:281d6ff68967	630	}
hexley	0:281d6ff68967	631	else
hexley	0:281d6ff68967	632	{
hexley	0:281d6ff68967	633	msg_ps->vb_ptr = msg_ps->vb_ptr->next;
hexley	0:281d6ff68967	634	}
hexley	0:281d6ff68967	635	/** test object identifier for .iso.org.dod.internet prefix */
hexley	0:281d6ff68967	636	if (snmp_iso_prefix_tst(msg_ps->vb_ptr->ident_len, msg_ps->vb_ptr->ident))
hexley	0:281d6ff68967	637	{
hexley	0:281d6ff68967	638	mn = snmp_search_tree((struct mib_node*)&internet, msg_ps->vb_ptr->ident_len - 4,
hexley	0:281d6ff68967	639	msg_ps->vb_ptr->ident + 4, &np);
hexley	0:281d6ff68967	640	if (mn != NULL)
hexley	0:281d6ff68967	641	{
hexley	0:281d6ff68967	642	if (mn->node_type == MIB_NODE_EX)
hexley	0:281d6ff68967	643	{
hexley	0:281d6ff68967	644	/* external object */
hexley	0:281d6ff68967	645	struct mib_external_node en = (struct mib_external_node)mn;
hexley	0:281d6ff68967	646
hexley	0:281d6ff68967	647	msg_ps->state = SNMP_MSG_EXTERNAL_GET_OBJDEF;
hexley	0:281d6ff68967	648	/* save en && args in msg_ps!! */
hexley	0:281d6ff68967	649	msg_ps->ext_mib_node = en;
hexley	0:281d6ff68967	650	msg_ps->ext_name_ptr = np;
hexley	0:281d6ff68967	651
hexley	0:281d6ff68967	652	en->get_object_def_q(en->addr_inf, request_id, np.ident_len, np.ident);
hexley	0:281d6ff68967	653	}
hexley	0:281d6ff68967	654	else
hexley	0:281d6ff68967	655	{
hexley	0:281d6ff68967	656	/* internal object */
hexley	0:281d6ff68967	657	struct obj_def object_def;
hexley	0:281d6ff68967	658
hexley	0:281d6ff68967	659	msg_ps->state = SNMP_MSG_INTERNAL_GET_OBJDEF;
hexley	0:281d6ff68967	660	mn->get_object_def(np.ident_len, np.ident, &object_def);
hexley	0:281d6ff68967	661	if (object_def.instance != MIB_OBJECT_NONE)
hexley	0:281d6ff68967	662	{
hexley	0:281d6ff68967	663	mn = mn;
hexley	0:281d6ff68967	664	}
hexley	0:281d6ff68967	665	else
hexley	0:281d6ff68967	666	{
hexley	0:281d6ff68967	667	/* search failed, object id points to unknown object (nosuchname) */
hexley	0:281d6ff68967	668	mn = NULL;
hexley	0:281d6ff68967	669	}
hexley	0:281d6ff68967	670	if (mn != NULL)
hexley	0:281d6ff68967	671	{
hexley	0:281d6ff68967	672	msg_ps->state = SNMP_MSG_INTERNAL_SET_TEST;
hexley	0:281d6ff68967	673
hexley	0:281d6ff68967	674	if (object_def.access & MIB_ACCESS_WRITE)
hexley	0:281d6ff68967	675	{
hexley	0:281d6ff68967	676	if ((object_def.asn_type == msg_ps->vb_ptr->value_type) &&
hexley	0:281d6ff68967	677	(mn->set_test(&object_def,msg_ps->vb_ptr->value_len,msg_ps->vb_ptr->value) != 0))
hexley	0:281d6ff68967	678	{
hexley	0:281d6ff68967	679	msg_ps->state = SNMP_MSG_SEARCH_OBJ;
hexley	0:281d6ff68967	680	msg_ps->vb_idx += 1;
hexley	0:281d6ff68967	681	}
hexley	0:281d6ff68967	682	else
hexley	0:281d6ff68967	683	{
hexley	0:281d6ff68967	684	/* bad value */
hexley	0:281d6ff68967	685	snmp_error_response(msg_ps,SNMP_ES_BADVALUE);
hexley	0:281d6ff68967	686	}
hexley	0:281d6ff68967	687	}
hexley	0:281d6ff68967	688	else
hexley	0:281d6ff68967	689	{
hexley	0:281d6ff68967	690	/* object not available for set */
hexley	0:281d6ff68967	691	snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
hexley	0:281d6ff68967	692	}
hexley	0:281d6ff68967	693	}
hexley	0:281d6ff68967	694	}
hexley	0:281d6ff68967	695	}
hexley	0:281d6ff68967	696	}
hexley	0:281d6ff68967	697	else
hexley	0:281d6ff68967	698	{
hexley	0:281d6ff68967	699	mn = NULL;
hexley	0:281d6ff68967	700	}
hexley	0:281d6ff68967	701	if (mn == NULL)
hexley	0:281d6ff68967	702	{
hexley	0:281d6ff68967	703	/* mn == NULL, noSuchName */
hexley	0:281d6ff68967	704	snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
hexley	0:281d6ff68967	705	}
hexley	0:281d6ff68967	706	}
hexley	0:281d6ff68967	707
hexley	0:281d6ff68967	708	if ((msg_ps->state == SNMP_MSG_SEARCH_OBJ) &&
hexley	0:281d6ff68967	709	(msg_ps->vb_idx == msg_ps->invb.count))
hexley	0:281d6ff68967	710	{
hexley	0:281d6ff68967	711	msg_ps->vb_idx = 0;
hexley	0:281d6ff68967	712	msg_ps->state = SNMP_MSG_INTERNAL_SET_VALUE;
hexley	0:281d6ff68967	713	}
hexley	0:281d6ff68967	714
hexley	0:281d6ff68967	715	/* set all values "atomically" (be as "atomic" as possible) */
hexley	0:281d6ff68967	716	while ((msg_ps->state == SNMP_MSG_INTERNAL_SET_VALUE) &&
hexley	0:281d6ff68967	717	(msg_ps->vb_idx < msg_ps->invb.count))
hexley	0:281d6ff68967	718	{
hexley	0:281d6ff68967	719	struct mib_node *mn;
hexley	0:281d6ff68967	720	struct snmp_name_ptr np;
hexley	0:281d6ff68967	721
hexley	0:281d6ff68967	722	if (msg_ps->vb_idx == 0)
hexley	0:281d6ff68967	723	{
hexley	0:281d6ff68967	724	msg_ps->vb_ptr = msg_ps->invb.head;
hexley	0:281d6ff68967	725	}
hexley	0:281d6ff68967	726	else
hexley	0:281d6ff68967	727	{
hexley	0:281d6ff68967	728	msg_ps->vb_ptr = msg_ps->vb_ptr->next;
hexley	0:281d6ff68967	729	}
hexley	0:281d6ff68967	730	/* skip iso prefix test, was done previously while settesting() */
hexley	0:281d6ff68967	731	mn = snmp_search_tree((struct mib_node*)&internet, msg_ps->vb_ptr->ident_len - 4,
hexley	0:281d6ff68967	732	msg_ps->vb_ptr->ident + 4, &np);
hexley	0:281d6ff68967	733	/* check if object is still available
hexley	0:281d6ff68967	734	(e.g. external hot-plug thingy present?) */
hexley	0:281d6ff68967	735	if (mn != NULL)
hexley	0:281d6ff68967	736	{
hexley	0:281d6ff68967	737	if (mn->node_type == MIB_NODE_EX)
hexley	0:281d6ff68967	738	{
hexley	0:281d6ff68967	739	/* external object */
hexley	0:281d6ff68967	740	struct mib_external_node en = (struct mib_external_node)mn;
hexley	0:281d6ff68967	741
hexley	0:281d6ff68967	742	msg_ps->state = SNMP_MSG_EXTERNAL_GET_OBJDEF_S;
hexley	0:281d6ff68967	743	/* save en && args in msg_ps!! */
hexley	0:281d6ff68967	744	msg_ps->ext_mib_node = en;
hexley	0:281d6ff68967	745	msg_ps->ext_name_ptr = np;
hexley	0:281d6ff68967	746
hexley	0:281d6ff68967	747	en->get_object_def_q(en->addr_inf, request_id, np.ident_len, np.ident);
hexley	0:281d6ff68967	748	}
hexley	0:281d6ff68967	749	else
hexley	0:281d6ff68967	750	{
hexley	0:281d6ff68967	751	/* internal object */
hexley	0:281d6ff68967	752	struct obj_def object_def;
hexley	0:281d6ff68967	753
hexley	0:281d6ff68967	754	msg_ps->state = SNMP_MSG_INTERNAL_GET_OBJDEF_S;
hexley	0:281d6ff68967	755	mn->get_object_def(np.ident_len, np.ident, &object_def);
hexley	0:281d6ff68967	756	msg_ps->state = SNMP_MSG_INTERNAL_SET_VALUE;
hexley	0:281d6ff68967	757	mn->set_value(&object_def,msg_ps->vb_ptr->value_len,msg_ps->vb_ptr->value);
hexley	0:281d6ff68967	758	msg_ps->vb_idx += 1;
hexley	0:281d6ff68967	759	}
hexley	0:281d6ff68967	760	}
hexley	0:281d6ff68967	761	}
hexley	0:281d6ff68967	762	if ((msg_ps->state == SNMP_MSG_INTERNAL_SET_VALUE) &&
hexley	0:281d6ff68967	763	(msg_ps->vb_idx == msg_ps->invb.count))
hexley	0:281d6ff68967	764	{
hexley	0:281d6ff68967	765	/* simply echo the input if we can set it
hexley	0:281d6ff68967	766	@todo do we need to return the actual value?
hexley	0:281d6ff68967	767	e.g. if value is silently modified or behaves sticky? */
hexley	0:281d6ff68967	768	msg_ps->outvb = msg_ps->invb;
hexley	0:281d6ff68967	769	msg_ps->invb.head = NULL;
hexley	0:281d6ff68967	770	msg_ps->invb.tail = NULL;
hexley	0:281d6ff68967	771	msg_ps->invb.count = 0;
hexley	0:281d6ff68967	772	snmp_ok_response(msg_ps);
hexley	0:281d6ff68967	773	}
hexley	0:281d6ff68967	774	}
hexley	0:281d6ff68967	775
hexley	0:281d6ff68967	776
hexley	0:281d6ff68967	777	/**
hexley	0:281d6ff68967	778	* Handle one internal or external event.
hexley	0:281d6ff68967	779	* Called for one async event. (recv external/private answer)
hexley	0:281d6ff68967	780	*
hexley	0:281d6ff68967	781	* @param request_id identifies requests from 0 to (SNMP_CONCURRENT_REQUESTS-1)
hexley	0:281d6ff68967	782	*/
hexley	0:281d6ff68967	783	void
hexley	0:281d6ff68967	784	snmp_msg_event(u8_t request_id)
hexley	0:281d6ff68967	785	{
hexley	0:281d6ff68967	786	struct snmp_msg_pstat *msg_ps;
hexley	0:281d6ff68967	787
hexley	0:281d6ff68967	788	if (request_id < SNMP_CONCURRENT_REQUESTS)
hexley	0:281d6ff68967	789	{
hexley	0:281d6ff68967	790	msg_ps = &msg_input_list[request_id];
hexley	0:281d6ff68967	791	if (msg_ps->rt == SNMP_ASN1_PDU_GET_NEXT_REQ)
hexley	0:281d6ff68967	792	{
hexley	0:281d6ff68967	793	snmp_msg_getnext_event(request_id, msg_ps);
hexley	0:281d6ff68967	794	}
hexley	0:281d6ff68967	795	else if (msg_ps->rt == SNMP_ASN1_PDU_GET_REQ)
hexley	0:281d6ff68967	796	{
hexley	0:281d6ff68967	797	snmp_msg_get_event(request_id, msg_ps);
hexley	0:281d6ff68967	798	}
hexley	0:281d6ff68967	799	else if(msg_ps->rt == SNMP_ASN1_PDU_SET_REQ)
hexley	0:281d6ff68967	800	{
hexley	0:281d6ff68967	801	snmp_msg_set_event(request_id, msg_ps);
hexley	0:281d6ff68967	802	}
hexley	0:281d6ff68967	803	}
hexley	0:281d6ff68967	804	}
hexley	0:281d6ff68967	805
hexley	0:281d6ff68967	806
hexley	0:281d6ff68967	807	/* lwIP UDP receive callback function */
hexley	0:281d6ff68967	808	static void
hexley	0:281d6ff68967	809	snmp_recv(void arg, struct udp_pcb pcb, struct pbuf p, ip_addr_t addr, u16_t port)
hexley	0:281d6ff68967	810	{
hexley	0:281d6ff68967	811	struct snmp_msg_pstat *msg_ps;
hexley	0:281d6ff68967	812	u8_t req_idx;
hexley	0:281d6ff68967	813	err_t err_ret;
hexley	0:281d6ff68967	814	u16_t payload_len = p->tot_len;
hexley	0:281d6ff68967	815	u16_t payload_ofs = 0;
hexley	0:281d6ff68967	816	u16_t varbind_ofs = 0;
hexley	0:281d6ff68967	817
hexley	0:281d6ff68967	818	/* suppress unused argument warning */
hexley	0:281d6ff68967	819	LWIP_UNUSED_ARG(arg);
hexley	0:281d6ff68967	820
hexley	0:281d6ff68967	821	/* traverse input message process list, look for SNMP_MSG_EMPTY */
hexley	0:281d6ff68967	822	msg_ps = &msg_input_list[0];
hexley	0:281d6ff68967	823	req_idx = 0;
hexley	0:281d6ff68967	824	while ((req_idx < SNMP_CONCURRENT_REQUESTS) && (msg_ps->state != SNMP_MSG_EMPTY))
hexley	0:281d6ff68967	825	{
hexley	0:281d6ff68967	826	req_idx++;
hexley	0:281d6ff68967	827	msg_ps++;
hexley	0:281d6ff68967	828	}
hexley	0:281d6ff68967	829	if (req_idx == SNMP_CONCURRENT_REQUESTS)
hexley	0:281d6ff68967	830	{
hexley	0:281d6ff68967	831	/* exceeding number of concurrent requests */
hexley	0:281d6ff68967	832	pbuf_free(p);
hexley	0:281d6ff68967	833	return;
hexley	0:281d6ff68967	834	}
hexley	0:281d6ff68967	835
hexley	0:281d6ff68967	836	/* accepting request */
hexley	0:281d6ff68967	837	snmp_inc_snmpinpkts();
hexley	0:281d6ff68967	838	/* record used 'protocol control block' */
hexley	0:281d6ff68967	839	msg_ps->pcb = pcb;
hexley	0:281d6ff68967	840	/* source address (network order) */
hexley	0:281d6ff68967	841	msg_ps->sip = *addr;
hexley	0:281d6ff68967	842	/* source port (host order (lwIP oddity)) */
hexley	0:281d6ff68967	843	msg_ps->sp = port;
hexley	0:281d6ff68967	844
hexley	0:281d6ff68967	845	/* check total length, version, community, pdu type */
hexley	0:281d6ff68967	846	err_ret = snmp_pdu_header_check(p, payload_ofs, payload_len, &varbind_ofs, msg_ps);
hexley	0:281d6ff68967	847	/* Only accept requests and requests without error (be robust) */
hexley	0:281d6ff68967	848	/* Reject response and trap headers or error requests as input! */
hexley	0:281d6ff68967	849	if ((err_ret != ERR_OK) \|\|
hexley	0:281d6ff68967	850	((msg_ps->rt != SNMP_ASN1_PDU_GET_REQ) &&
hexley	0:281d6ff68967	851	(msg_ps->rt != SNMP_ASN1_PDU_GET_NEXT_REQ) &&
hexley	0:281d6ff68967	852	(msg_ps->rt != SNMP_ASN1_PDU_SET_REQ)) \|\|
hexley	0:281d6ff68967	853	((msg_ps->error_status != SNMP_ES_NOERROR) \|\|
hexley	0:281d6ff68967	854	(msg_ps->error_index != 0)) )
hexley	0:281d6ff68967	855	{
hexley	0:281d6ff68967	856	/* header check failed drop request silently, do not return error! */
hexley	0:281d6ff68967	857	pbuf_free(p);
hexley	0:281d6ff68967	858	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_pdu_header_check() failed\n"));
hexley	0:281d6ff68967	859	return;
hexley	0:281d6ff68967	860	}
hexley	0:281d6ff68967	861	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_recv ok, community %s\n", msg_ps->community));
hexley	0:281d6ff68967	862
hexley	0:281d6ff68967	863	/* Builds a list of variable bindings. Copy the varbinds from the pbuf
hexley	0:281d6ff68967	864	chain to glue them when these are divided over two or more pbuf's. */
hexley	0:281d6ff68967	865	err_ret = snmp_pdu_dec_varbindlist(p, varbind_ofs, &varbind_ofs, msg_ps);
hexley	0:281d6ff68967	866	/* we've decoded the incoming message, release input msg now */
hexley	0:281d6ff68967	867	pbuf_free(p);
hexley	0:281d6ff68967	868	if ((err_ret != ERR_OK) \|\| (msg_ps->invb.count == 0))
hexley	0:281d6ff68967	869	{
hexley	0:281d6ff68967	870	/* varbind-list decode failed, or varbind list empty.
hexley	0:281d6ff68967	871	drop request silently, do not return error!
hexley	0:281d6ff68967	872	(errors are only returned for a specific varbind failure) */
hexley	0:281d6ff68967	873	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_pdu_dec_varbindlist() failed\n"));
hexley	0:281d6ff68967	874	return;
hexley	0:281d6ff68967	875	}
hexley	0:281d6ff68967	876
hexley	0:281d6ff68967	877	msg_ps->error_status = SNMP_ES_NOERROR;
hexley	0:281d6ff68967	878	msg_ps->error_index = 0;
hexley	0:281d6ff68967	879	/* find object for each variable binding */
hexley	0:281d6ff68967	880	msg_ps->state = SNMP_MSG_SEARCH_OBJ;
hexley	0:281d6ff68967	881	/* first variable binding from list to inspect */
hexley	0:281d6ff68967	882	msg_ps->vb_idx = 0;
hexley	0:281d6ff68967	883
hexley	0:281d6ff68967	884	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_recv varbind cnt=%"U16_F"\n",(u16_t)msg_ps->invb.count));
hexley	0:281d6ff68967	885
hexley	0:281d6ff68967	886	/* handle input event and as much objects as possible in one go */
hexley	0:281d6ff68967	887	snmp_msg_event(req_idx);
hexley	0:281d6ff68967	888	}
hexley	0:281d6ff68967	889
hexley	0:281d6ff68967	890	/**
hexley	0:281d6ff68967	891	* Checks and decodes incoming SNMP message header, logs header errors.
hexley	0:281d6ff68967	892	*
hexley	0:281d6ff68967	893	* @param p points to pbuf chain of SNMP message (UDP payload)
hexley	0:281d6ff68967	894	* @param ofs points to first octet of SNMP message
hexley	0:281d6ff68967	895	* @param pdu_len the length of the UDP payload
hexley	0:281d6ff68967	896	* @param ofs_ret returns the ofset of the variable bindings
hexley	0:281d6ff68967	897	* @param m_stat points to the current message request state return
hexley	0:281d6ff68967	898	* @return
hexley	0:281d6ff68967	899	* - ERR_OK SNMP header is sane and accepted
hexley	0:281d6ff68967	900	* - ERR_ARG SNMP header is either malformed or rejected
hexley	0:281d6ff68967	901	*/
hexley	0:281d6ff68967	902	static err_t
hexley	0:281d6ff68967	903	snmp_pdu_header_check(struct pbuf p, u16_t ofs, u16_t pdu_len, u16_t ofs_ret, struct snmp_msg_pstat *m_stat)
hexley	0:281d6ff68967	904	{
hexley	0:281d6ff68967	905	err_t derr;
hexley	0:281d6ff68967	906	u16_t len, ofs_base;
hexley	0:281d6ff68967	907	u8_t len_octets;
hexley	0:281d6ff68967	908	u8_t type;
hexley	0:281d6ff68967	909	s32_t version;
hexley	0:281d6ff68967	910
hexley	0:281d6ff68967	911	ofs_base = ofs;
hexley	0:281d6ff68967	912	snmp_asn1_dec_type(p, ofs, &type);
hexley	0:281d6ff68967	913	derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
hexley	0:281d6ff68967	914	if ((derr != ERR_OK) \|\|
hexley	0:281d6ff68967	915	(pdu_len != (1 + len_octets + len)) \|\|
hexley	0:281d6ff68967	916	(type != (SNMP_ASN1_UNIV \| SNMP_ASN1_CONSTR \| SNMP_ASN1_SEQ)))
hexley	0:281d6ff68967	917	{
hexley	0:281d6ff68967	918	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	919	return ERR_ARG;
hexley	0:281d6ff68967	920	}
hexley	0:281d6ff68967	921	ofs += (1 + len_octets);
hexley	0:281d6ff68967	922	snmp_asn1_dec_type(p, ofs, &type);
hexley	0:281d6ff68967	923	derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
hexley	0:281d6ff68967	924	if ((derr != ERR_OK) \|\| (type != (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_INTEG)))
hexley	0:281d6ff68967	925	{
hexley	0:281d6ff68967	926	/* can't decode or no integer (version) */
hexley	0:281d6ff68967	927	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	928	return ERR_ARG;
hexley	0:281d6ff68967	929	}
hexley	0:281d6ff68967	930	derr = snmp_asn1_dec_s32t(p, ofs + 1 + len_octets, len, &version);
hexley	0:281d6ff68967	931	if (derr != ERR_OK)
hexley	0:281d6ff68967	932	{
hexley	0:281d6ff68967	933	/* can't decode */
hexley	0:281d6ff68967	934	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	935	return ERR_ARG;
hexley	0:281d6ff68967	936	}
hexley	0:281d6ff68967	937	if (version != 0)
hexley	0:281d6ff68967	938	{
hexley	0:281d6ff68967	939	/* not version 1 */
hexley	0:281d6ff68967	940	snmp_inc_snmpinbadversions();
hexley	0:281d6ff68967	941	return ERR_ARG;
hexley	0:281d6ff68967	942	}
hexley	0:281d6ff68967	943	ofs += (1 + len_octets + len);
hexley	0:281d6ff68967	944	snmp_asn1_dec_type(p, ofs, &type);
hexley	0:281d6ff68967	945	derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
hexley	0:281d6ff68967	946	if ((derr != ERR_OK) \|\| (type != (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_OC_STR)))
hexley	0:281d6ff68967	947	{
hexley	0:281d6ff68967	948	/* can't decode or no octet string (community) */
hexley	0:281d6ff68967	949	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	950	return ERR_ARG;
hexley	0:281d6ff68967	951	}
hexley	0:281d6ff68967	952	derr = snmp_asn1_dec_raw(p, ofs + 1 + len_octets, len, SNMP_COMMUNITY_STR_LEN, m_stat->community);
hexley	0:281d6ff68967	953	if (derr != ERR_OK)
hexley	0:281d6ff68967	954	{
hexley	0:281d6ff68967	955	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	956	return ERR_ARG;
hexley	0:281d6ff68967	957	}
hexley	0:281d6ff68967	958	/* add zero terminator */
hexley	0:281d6ff68967	959	len = ((len < (SNMP_COMMUNITY_STR_LEN))?(len):(SNMP_COMMUNITY_STR_LEN));
hexley	0:281d6ff68967	960	m_stat->community[len] = 0;
hexley	0:281d6ff68967	961	m_stat->com_strlen = (u8_t)len;
hexley	0:281d6ff68967	962	if (strncmp(snmp_publiccommunity, (const char*)m_stat->community, SNMP_COMMUNITY_STR_LEN) != 0)
hexley	0:281d6ff68967	963	{
hexley	0:281d6ff68967	964	/** @todo: move this if we need to check more names */
hexley	0:281d6ff68967	965	snmp_inc_snmpinbadcommunitynames();
hexley	0:281d6ff68967	966	snmp_authfail_trap();
hexley	0:281d6ff68967	967	return ERR_ARG;
hexley	0:281d6ff68967	968	}
hexley	0:281d6ff68967	969	ofs += (1 + len_octets + len);
hexley	0:281d6ff68967	970	snmp_asn1_dec_type(p, ofs, &type);
hexley	0:281d6ff68967	971	derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
hexley	0:281d6ff68967	972	if (derr != ERR_OK)
hexley	0:281d6ff68967	973	{
hexley	0:281d6ff68967	974	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	975	return ERR_ARG;
hexley	0:281d6ff68967	976	}
hexley	0:281d6ff68967	977	switch(type)
hexley	0:281d6ff68967	978	{
hexley	0:281d6ff68967	979	case (SNMP_ASN1_CONTXT \| SNMP_ASN1_CONSTR \| SNMP_ASN1_PDU_GET_REQ):
hexley	0:281d6ff68967	980	/* GetRequest PDU */
hexley	0:281d6ff68967	981	snmp_inc_snmpingetrequests();
hexley	0:281d6ff68967	982	derr = ERR_OK;
hexley	0:281d6ff68967	983	break;
hexley	0:281d6ff68967	984	case (SNMP_ASN1_CONTXT \| SNMP_ASN1_CONSTR \| SNMP_ASN1_PDU_GET_NEXT_REQ):
hexley	0:281d6ff68967	985	/* GetNextRequest PDU */
hexley	0:281d6ff68967	986	snmp_inc_snmpingetnexts();
hexley	0:281d6ff68967	987	derr = ERR_OK;
hexley	0:281d6ff68967	988	break;
hexley	0:281d6ff68967	989	case (SNMP_ASN1_CONTXT \| SNMP_ASN1_CONSTR \| SNMP_ASN1_PDU_GET_RESP):
hexley	0:281d6ff68967	990	/* GetResponse PDU */
hexley	0:281d6ff68967	991	snmp_inc_snmpingetresponses();
hexley	0:281d6ff68967	992	derr = ERR_ARG;
hexley	0:281d6ff68967	993	break;
hexley	0:281d6ff68967	994	case (SNMP_ASN1_CONTXT \| SNMP_ASN1_CONSTR \| SNMP_ASN1_PDU_SET_REQ):
hexley	0:281d6ff68967	995	/* SetRequest PDU */
hexley	0:281d6ff68967	996	snmp_inc_snmpinsetrequests();
hexley	0:281d6ff68967	997	derr = ERR_OK;
hexley	0:281d6ff68967	998	break;
hexley	0:281d6ff68967	999	case (SNMP_ASN1_CONTXT \| SNMP_ASN1_CONSTR \| SNMP_ASN1_PDU_TRAP):
hexley	0:281d6ff68967	1000	/* Trap PDU */
hexley	0:281d6ff68967	1001	snmp_inc_snmpintraps();
hexley	0:281d6ff68967	1002	derr = ERR_ARG;
hexley	0:281d6ff68967	1003	break;
hexley	0:281d6ff68967	1004	default:
hexley	0:281d6ff68967	1005	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	1006	derr = ERR_ARG;
hexley	0:281d6ff68967	1007	break;
hexley	0:281d6ff68967	1008	}
hexley	0:281d6ff68967	1009	if (derr != ERR_OK)
hexley	0:281d6ff68967	1010	{
hexley	0:281d6ff68967	1011	/* unsupported input PDU for this agent (no parse error) */
hexley	0:281d6ff68967	1012	return ERR_ARG;
hexley	0:281d6ff68967	1013	}
hexley	0:281d6ff68967	1014	m_stat->rt = type & 0x1F;
hexley	0:281d6ff68967	1015	ofs += (1 + len_octets);
hexley	0:281d6ff68967	1016	if (len != (pdu_len - (ofs - ofs_base)))
hexley	0:281d6ff68967	1017	{
hexley	0:281d6ff68967	1018	/* decoded PDU length does not equal actual payload length */
hexley	0:281d6ff68967	1019	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	1020	return ERR_ARG;
hexley	0:281d6ff68967	1021	}
hexley	0:281d6ff68967	1022	snmp_asn1_dec_type(p, ofs, &type);
hexley	0:281d6ff68967	1023	derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
hexley	0:281d6ff68967	1024	if ((derr != ERR_OK) \|\| (type != (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_INTEG)))
hexley	0:281d6ff68967	1025	{
hexley	0:281d6ff68967	1026	/* can't decode or no integer (request ID) */
hexley	0:281d6ff68967	1027	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	1028	return ERR_ARG;
hexley	0:281d6ff68967	1029	}
hexley	0:281d6ff68967	1030	derr = snmp_asn1_dec_s32t(p, ofs + 1 + len_octets, len, &m_stat->rid);
hexley	0:281d6ff68967	1031	if (derr != ERR_OK)
hexley	0:281d6ff68967	1032	{
hexley	0:281d6ff68967	1033	/* can't decode */
hexley	0:281d6ff68967	1034	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	1035	return ERR_ARG;
hexley	0:281d6ff68967	1036	}
hexley	0:281d6ff68967	1037	ofs += (1 + len_octets + len);
hexley	0:281d6ff68967	1038	snmp_asn1_dec_type(p, ofs, &type);
hexley	0:281d6ff68967	1039	derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
hexley	0:281d6ff68967	1040	if ((derr != ERR_OK) \|\| (type != (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_INTEG)))
hexley	0:281d6ff68967	1041	{
hexley	0:281d6ff68967	1042	/* can't decode or no integer (error-status) */
hexley	0:281d6ff68967	1043	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	1044	return ERR_ARG;
hexley	0:281d6ff68967	1045	}
hexley	0:281d6ff68967	1046	/* must be noError (0) for incoming requests.
hexley	0:281d6ff68967	1047	log errors for mib-2 completeness and for debug purposes */
hexley	0:281d6ff68967	1048	derr = snmp_asn1_dec_s32t(p, ofs + 1 + len_octets, len, &m_stat->error_status);
hexley	0:281d6ff68967	1049	if (derr != ERR_OK)
hexley	0:281d6ff68967	1050	{
hexley	0:281d6ff68967	1051	/* can't decode */
hexley	0:281d6ff68967	1052	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	1053	return ERR_ARG;
hexley	0:281d6ff68967	1054	}
hexley	0:281d6ff68967	1055	switch (m_stat->error_status)
hexley	0:281d6ff68967	1056	{
hexley	0:281d6ff68967	1057	case SNMP_ES_TOOBIG:
hexley	0:281d6ff68967	1058	snmp_inc_snmpintoobigs();
hexley	0:281d6ff68967	1059	break;
hexley	0:281d6ff68967	1060	case SNMP_ES_NOSUCHNAME:
hexley	0:281d6ff68967	1061	snmp_inc_snmpinnosuchnames();
hexley	0:281d6ff68967	1062	break;
hexley	0:281d6ff68967	1063	case SNMP_ES_BADVALUE:
hexley	0:281d6ff68967	1064	snmp_inc_snmpinbadvalues();
hexley	0:281d6ff68967	1065	break;
hexley	0:281d6ff68967	1066	case SNMP_ES_READONLY:
hexley	0:281d6ff68967	1067	snmp_inc_snmpinreadonlys();
hexley	0:281d6ff68967	1068	break;
hexley	0:281d6ff68967	1069	case SNMP_ES_GENERROR:
hexley	0:281d6ff68967	1070	snmp_inc_snmpingenerrs();
hexley	0:281d6ff68967	1071	break;
hexley	0:281d6ff68967	1072	}
hexley	0:281d6ff68967	1073	ofs += (1 + len_octets + len);
hexley	0:281d6ff68967	1074	snmp_asn1_dec_type(p, ofs, &type);
hexley	0:281d6ff68967	1075	derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
hexley	0:281d6ff68967	1076	if ((derr != ERR_OK) \|\| (type != (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_INTEG)))
hexley	0:281d6ff68967	1077	{
hexley	0:281d6ff68967	1078	/* can't decode or no integer (error-index) */
hexley	0:281d6ff68967	1079	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	1080	return ERR_ARG;
hexley	0:281d6ff68967	1081	}
hexley	0:281d6ff68967	1082	/* must be 0 for incoming requests.
hexley	0:281d6ff68967	1083	decode anyway to catch bad integers (and dirty tricks) */
hexley	0:281d6ff68967	1084	derr = snmp_asn1_dec_s32t(p, ofs + 1 + len_octets, len, &m_stat->error_index);
hexley	0:281d6ff68967	1085	if (derr != ERR_OK)
hexley	0:281d6ff68967	1086	{
hexley	0:281d6ff68967	1087	/* can't decode */
hexley	0:281d6ff68967	1088	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	1089	return ERR_ARG;
hexley	0:281d6ff68967	1090	}
hexley	0:281d6ff68967	1091	ofs += (1 + len_octets + len);
hexley	0:281d6ff68967	1092	*ofs_ret = ofs;
hexley	0:281d6ff68967	1093	return ERR_OK;
hexley	0:281d6ff68967	1094	}
hexley	0:281d6ff68967	1095
hexley	0:281d6ff68967	1096	static err_t
hexley	0:281d6ff68967	1097	snmp_pdu_dec_varbindlist(struct pbuf p, u16_t ofs, u16_t ofs_ret, struct snmp_msg_pstat *m_stat)
hexley	0:281d6ff68967	1098	{
hexley	0:281d6ff68967	1099	err_t derr;
hexley	0:281d6ff68967	1100	u16_t len, vb_len;
hexley	0:281d6ff68967	1101	u8_t len_octets;
hexley	0:281d6ff68967	1102	u8_t type;
hexley	0:281d6ff68967	1103
hexley	0:281d6ff68967	1104	/* variable binding list */
hexley	0:281d6ff68967	1105	snmp_asn1_dec_type(p, ofs, &type);
hexley	0:281d6ff68967	1106	derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &vb_len);
hexley	0:281d6ff68967	1107	if ((derr != ERR_OK) \|\|
hexley	0:281d6ff68967	1108	(type != (SNMP_ASN1_UNIV \| SNMP_ASN1_CONSTR \| SNMP_ASN1_SEQ)))
hexley	0:281d6ff68967	1109	{
hexley	0:281d6ff68967	1110	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	1111	return ERR_ARG;
hexley	0:281d6ff68967	1112	}
hexley	0:281d6ff68967	1113	ofs += (1 + len_octets);
hexley	0:281d6ff68967	1114
hexley	0:281d6ff68967	1115	/* start with empty list */
hexley	0:281d6ff68967	1116	m_stat->invb.count = 0;
hexley	0:281d6ff68967	1117	m_stat->invb.head = NULL;
hexley	0:281d6ff68967	1118	m_stat->invb.tail = NULL;
hexley	0:281d6ff68967	1119
hexley	0:281d6ff68967	1120	while (vb_len > 0)
hexley	0:281d6ff68967	1121	{
hexley	0:281d6ff68967	1122	struct snmp_obj_id oid, oid_value;
hexley	0:281d6ff68967	1123	struct snmp_varbind *vb;
hexley	0:281d6ff68967	1124
hexley	0:281d6ff68967	1125	snmp_asn1_dec_type(p, ofs, &type);
hexley	0:281d6ff68967	1126	derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
hexley	0:281d6ff68967	1127	if ((derr != ERR_OK) \|\|
hexley	0:281d6ff68967	1128	(type != (SNMP_ASN1_UNIV \| SNMP_ASN1_CONSTR \| SNMP_ASN1_SEQ)) \|\|
hexley	0:281d6ff68967	1129	(len == 0) \|\| (len > vb_len))
hexley	0:281d6ff68967	1130	{
hexley	0:281d6ff68967	1131	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	1132	/* free varbinds (if available) */
hexley	0:281d6ff68967	1133	snmp_varbind_list_free(&m_stat->invb);
hexley	0:281d6ff68967	1134	return ERR_ARG;
hexley	0:281d6ff68967	1135	}
hexley	0:281d6ff68967	1136	ofs += (1 + len_octets);
hexley	0:281d6ff68967	1137	vb_len -= (1 + len_octets);
hexley	0:281d6ff68967	1138
hexley	0:281d6ff68967	1139	snmp_asn1_dec_type(p, ofs, &type);
hexley	0:281d6ff68967	1140	derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
hexley	0:281d6ff68967	1141	if ((derr != ERR_OK) \|\| (type != (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_OBJ_ID)))
hexley	0:281d6ff68967	1142	{
hexley	0:281d6ff68967	1143	/* can't decode object name length */
hexley	0:281d6ff68967	1144	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	1145	/* free varbinds (if available) */
hexley	0:281d6ff68967	1146	snmp_varbind_list_free(&m_stat->invb);
hexley	0:281d6ff68967	1147	return ERR_ARG;
hexley	0:281d6ff68967	1148	}
hexley	0:281d6ff68967	1149	derr = snmp_asn1_dec_oid(p, ofs + 1 + len_octets, len, &oid);
hexley	0:281d6ff68967	1150	if (derr != ERR_OK)
hexley	0:281d6ff68967	1151	{
hexley	0:281d6ff68967	1152	/* can't decode object name */
hexley	0:281d6ff68967	1153	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	1154	/* free varbinds (if available) */
hexley	0:281d6ff68967	1155	snmp_varbind_list_free(&m_stat->invb);
hexley	0:281d6ff68967	1156	return ERR_ARG;
hexley	0:281d6ff68967	1157	}
hexley	0:281d6ff68967	1158	ofs += (1 + len_octets + len);
hexley	0:281d6ff68967	1159	vb_len -= (1 + len_octets + len);
hexley	0:281d6ff68967	1160
hexley	0:281d6ff68967	1161	snmp_asn1_dec_type(p, ofs, &type);
hexley	0:281d6ff68967	1162	derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
hexley	0:281d6ff68967	1163	if (derr != ERR_OK)
hexley	0:281d6ff68967	1164	{
hexley	0:281d6ff68967	1165	/* can't decode object value length */
hexley	0:281d6ff68967	1166	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	1167	/* free varbinds (if available) */
hexley	0:281d6ff68967	1168	snmp_varbind_list_free(&m_stat->invb);
hexley	0:281d6ff68967	1169	return ERR_ARG;
hexley	0:281d6ff68967	1170	}
hexley	0:281d6ff68967	1171
hexley	0:281d6ff68967	1172	switch (type)
hexley	0:281d6ff68967	1173	{
hexley	0:281d6ff68967	1174	case (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_INTEG):
hexley	0:281d6ff68967	1175	vb = snmp_varbind_alloc(&oid, type, sizeof(s32_t));
hexley	0:281d6ff68967	1176	if (vb != NULL)
hexley	0:281d6ff68967	1177	{
hexley	0:281d6ff68967	1178	s32_t vptr = (s32_t)vb->value;
hexley	0:281d6ff68967	1179
hexley	0:281d6ff68967	1180	derr = snmp_asn1_dec_s32t(p, ofs + 1 + len_octets, len, vptr);
hexley	0:281d6ff68967	1181	snmp_varbind_tail_add(&m_stat->invb, vb);
hexley	0:281d6ff68967	1182	}
hexley	0:281d6ff68967	1183	else
hexley	0:281d6ff68967	1184	{
hexley	0:281d6ff68967	1185	derr = ERR_ARG;
hexley	0:281d6ff68967	1186	}
hexley	0:281d6ff68967	1187	break;
hexley	0:281d6ff68967	1188	case (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_COUNTER):
hexley	0:281d6ff68967	1189	case (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_GAUGE):
hexley	0:281d6ff68967	1190	case (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_TIMETICKS):
hexley	0:281d6ff68967	1191	vb = snmp_varbind_alloc(&oid, type, sizeof(u32_t));
hexley	0:281d6ff68967	1192	if (vb != NULL)
hexley	0:281d6ff68967	1193	{
hexley	0:281d6ff68967	1194	u32_t vptr = (u32_t)vb->value;
hexley	0:281d6ff68967	1195
hexley	0:281d6ff68967	1196	derr = snmp_asn1_dec_u32t(p, ofs + 1 + len_octets, len, vptr);
hexley	0:281d6ff68967	1197	snmp_varbind_tail_add(&m_stat->invb, vb);
hexley	0:281d6ff68967	1198	}
hexley	0:281d6ff68967	1199	else
hexley	0:281d6ff68967	1200	{
hexley	0:281d6ff68967	1201	derr = ERR_ARG;
hexley	0:281d6ff68967	1202	}
hexley	0:281d6ff68967	1203	break;
hexley	0:281d6ff68967	1204	case (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_OC_STR):
hexley	0:281d6ff68967	1205	case (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_OPAQUE):
hexley	0:281d6ff68967	1206	LWIP_ASSERT("invalid length", len <= 0xff);
hexley	0:281d6ff68967	1207	vb = snmp_varbind_alloc(&oid, type, (u8_t)len);
hexley	0:281d6ff68967	1208	if (vb != NULL)
hexley	0:281d6ff68967	1209	{
hexley	0:281d6ff68967	1210	derr = snmp_asn1_dec_raw(p, ofs + 1 + len_octets, len, vb->value_len, (u8_t*)vb->value);
hexley	0:281d6ff68967	1211	snmp_varbind_tail_add(&m_stat->invb, vb);
hexley	0:281d6ff68967	1212	}
hexley	0:281d6ff68967	1213	else
hexley	0:281d6ff68967	1214	{
hexley	0:281d6ff68967	1215	derr = ERR_ARG;
hexley	0:281d6ff68967	1216	}
hexley	0:281d6ff68967	1217	break;
hexley	0:281d6ff68967	1218	case (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_NUL):
hexley	0:281d6ff68967	1219	vb = snmp_varbind_alloc(&oid, type, 0);
hexley	0:281d6ff68967	1220	if (vb != NULL)
hexley	0:281d6ff68967	1221	{
hexley	0:281d6ff68967	1222	snmp_varbind_tail_add(&m_stat->invb, vb);
hexley	0:281d6ff68967	1223	derr = ERR_OK;
hexley	0:281d6ff68967	1224	}
hexley	0:281d6ff68967	1225	else
hexley	0:281d6ff68967	1226	{
hexley	0:281d6ff68967	1227	derr = ERR_ARG;
hexley	0:281d6ff68967	1228	}
hexley	0:281d6ff68967	1229	break;
hexley	0:281d6ff68967	1230	case (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_OBJ_ID):
hexley	0:281d6ff68967	1231	derr = snmp_asn1_dec_oid(p, ofs + 1 + len_octets, len, &oid_value);
hexley	0:281d6ff68967	1232	if (derr == ERR_OK)
hexley	0:281d6ff68967	1233	{
hexley	0:281d6ff68967	1234	vb = snmp_varbind_alloc(&oid, type, oid_value.len * sizeof(s32_t));
hexley	0:281d6ff68967	1235	if (vb != NULL)
hexley	0:281d6ff68967	1236	{
hexley	0:281d6ff68967	1237	u8_t i = oid_value.len;
hexley	0:281d6ff68967	1238	s32_t vptr = (s32_t)vb->value;
hexley	0:281d6ff68967	1239
hexley	0:281d6ff68967	1240	while(i > 0)
hexley	0:281d6ff68967	1241	{
hexley	0:281d6ff68967	1242	i--;
hexley	0:281d6ff68967	1243	vptr[i] = oid_value.id[i];
hexley	0:281d6ff68967	1244	}
hexley	0:281d6ff68967	1245	snmp_varbind_tail_add(&m_stat->invb, vb);
hexley	0:281d6ff68967	1246	derr = ERR_OK;
hexley	0:281d6ff68967	1247	}
hexley	0:281d6ff68967	1248	else
hexley	0:281d6ff68967	1249	{
hexley	0:281d6ff68967	1250	derr = ERR_ARG;
hexley	0:281d6ff68967	1251	}
hexley	0:281d6ff68967	1252	}
hexley	0:281d6ff68967	1253	break;
hexley	0:281d6ff68967	1254	case (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_IPADDR):
hexley	0:281d6ff68967	1255	if (len == 4)
hexley	0:281d6ff68967	1256	{
hexley	0:281d6ff68967	1257	/* must be exactly 4 octets! */
hexley	0:281d6ff68967	1258	vb = snmp_varbind_alloc(&oid, type, 4);
hexley	0:281d6ff68967	1259	if (vb != NULL)
hexley	0:281d6ff68967	1260	{
hexley	0:281d6ff68967	1261	derr = snmp_asn1_dec_raw(p, ofs + 1 + len_octets, len, vb->value_len, (u8_t*)vb->value);
hexley	0:281d6ff68967	1262	snmp_varbind_tail_add(&m_stat->invb, vb);
hexley	0:281d6ff68967	1263	}
hexley	0:281d6ff68967	1264	else
hexley	0:281d6ff68967	1265	{
hexley	0:281d6ff68967	1266	derr = ERR_ARG;
hexley	0:281d6ff68967	1267	}
hexley	0:281d6ff68967	1268	}
hexley	0:281d6ff68967	1269	else
hexley	0:281d6ff68967	1270	{
hexley	0:281d6ff68967	1271	derr = ERR_ARG;
hexley	0:281d6ff68967	1272	}
hexley	0:281d6ff68967	1273	break;
hexley	0:281d6ff68967	1274	default:
hexley	0:281d6ff68967	1275	derr = ERR_ARG;
hexley	0:281d6ff68967	1276	break;
hexley	0:281d6ff68967	1277	}
hexley	0:281d6ff68967	1278	if (derr != ERR_OK)
hexley	0:281d6ff68967	1279	{
hexley	0:281d6ff68967	1280	snmp_inc_snmpinasnparseerrs();
hexley	0:281d6ff68967	1281	/* free varbinds (if available) */
hexley	0:281d6ff68967	1282	snmp_varbind_list_free(&m_stat->invb);
hexley	0:281d6ff68967	1283	return ERR_ARG;
hexley	0:281d6ff68967	1284	}
hexley	0:281d6ff68967	1285	ofs += (1 + len_octets + len);
hexley	0:281d6ff68967	1286	vb_len -= (1 + len_octets + len);
hexley	0:281d6ff68967	1287	}
hexley	0:281d6ff68967	1288
hexley	0:281d6ff68967	1289	if (m_stat->rt == SNMP_ASN1_PDU_SET_REQ)
hexley	0:281d6ff68967	1290	{
hexley	0:281d6ff68967	1291	snmp_add_snmpintotalsetvars(m_stat->invb.count);
hexley	0:281d6ff68967	1292	}
hexley	0:281d6ff68967	1293	else
hexley	0:281d6ff68967	1294	{
hexley	0:281d6ff68967	1295	snmp_add_snmpintotalreqvars(m_stat->invb.count);
hexley	0:281d6ff68967	1296	}
hexley	0:281d6ff68967	1297
hexley	0:281d6ff68967	1298	*ofs_ret = ofs;
hexley	0:281d6ff68967	1299	return ERR_OK;
hexley	0:281d6ff68967	1300	}
hexley	0:281d6ff68967	1301
hexley	0:281d6ff68967	1302	struct snmp_varbind*
hexley	0:281d6ff68967	1303	snmp_varbind_alloc(struct snmp_obj_id *oid, u8_t type, u8_t len)
hexley	0:281d6ff68967	1304	{
hexley	0:281d6ff68967	1305	struct snmp_varbind *vb;
hexley	0:281d6ff68967	1306
hexley	0:281d6ff68967	1307	vb = (struct snmp_varbind *)memp_malloc(MEMP_SNMP_VARBIND);
hexley	0:281d6ff68967	1308	LWIP_ASSERT("vb != NULL",vb != NULL);
hexley	0:281d6ff68967	1309	if (vb != NULL)
hexley	0:281d6ff68967	1310	{
hexley	0:281d6ff68967	1311	u8_t i;
hexley	0:281d6ff68967	1312
hexley	0:281d6ff68967	1313	vb->next = NULL;
hexley	0:281d6ff68967	1314	vb->prev = NULL;
hexley	0:281d6ff68967	1315	i = oid->len;
hexley	0:281d6ff68967	1316	vb->ident_len = i;
hexley	0:281d6ff68967	1317	if (i > 0)
hexley	0:281d6ff68967	1318	{
hexley	0:281d6ff68967	1319	LWIP_ASSERT("SNMP_MAX_TREE_DEPTH is configured too low", i <= SNMP_MAX_TREE_DEPTH);
hexley	0:281d6ff68967	1320	/* allocate array of s32_t for our object identifier */
hexley	0:281d6ff68967	1321	vb->ident = (s32_t*)memp_malloc(MEMP_SNMP_VALUE);
hexley	0:281d6ff68967	1322	LWIP_ASSERT("vb->ident != NULL",vb->ident != NULL);
hexley	0:281d6ff68967	1323	if (vb->ident == NULL)
hexley	0:281d6ff68967	1324	{
hexley	0:281d6ff68967	1325	memp_free(MEMP_SNMP_VARBIND, vb);
hexley	0:281d6ff68967	1326	return NULL;
hexley	0:281d6ff68967	1327	}
hexley	0:281d6ff68967	1328	while(i > 0)
hexley	0:281d6ff68967	1329	{
hexley	0:281d6ff68967	1330	i--;
hexley	0:281d6ff68967	1331	vb->ident[i] = oid->id[i];
hexley	0:281d6ff68967	1332	}
hexley	0:281d6ff68967	1333	}
hexley	0:281d6ff68967	1334	else
hexley	0:281d6ff68967	1335	{
hexley	0:281d6ff68967	1336	/* i == 0, pass zero length object identifier */
hexley	0:281d6ff68967	1337	vb->ident = NULL;
hexley	0:281d6ff68967	1338	}
hexley	0:281d6ff68967	1339	vb->value_type = type;
hexley	0:281d6ff68967	1340	vb->value_len = len;
hexley	0:281d6ff68967	1341	if (len > 0)
hexley	0:281d6ff68967	1342	{
hexley	0:281d6ff68967	1343	LWIP_ASSERT("SNMP_MAX_OCTET_STRING_LEN is configured too low", vb->value_len <= SNMP_MAX_VALUE_SIZE);
hexley	0:281d6ff68967	1344	/* allocate raw bytes for our object value */
hexley	0:281d6ff68967	1345	vb->value = memp_malloc(MEMP_SNMP_VALUE);
hexley	0:281d6ff68967	1346	LWIP_ASSERT("vb->value != NULL",vb->value != NULL);
hexley	0:281d6ff68967	1347	if (vb->value == NULL)
hexley	0:281d6ff68967	1348	{
hexley	0:281d6ff68967	1349	if (vb->ident != NULL)
hexley	0:281d6ff68967	1350	{
hexley	0:281d6ff68967	1351	memp_free(MEMP_SNMP_VALUE, vb->ident);
hexley	0:281d6ff68967	1352	}
hexley	0:281d6ff68967	1353	memp_free(MEMP_SNMP_VARBIND, vb);
hexley	0:281d6ff68967	1354	return NULL;
hexley	0:281d6ff68967	1355	}
hexley	0:281d6ff68967	1356	}
hexley	0:281d6ff68967	1357	else
hexley	0:281d6ff68967	1358	{
hexley	0:281d6ff68967	1359	/* ASN1_NUL type, or zero length ASN1_OC_STR */
hexley	0:281d6ff68967	1360	vb->value = NULL;
hexley	0:281d6ff68967	1361	}
hexley	0:281d6ff68967	1362	}
hexley	0:281d6ff68967	1363	return vb;
hexley	0:281d6ff68967	1364	}
hexley	0:281d6ff68967	1365
hexley	0:281d6ff68967	1366	void
hexley	0:281d6ff68967	1367	snmp_varbind_free(struct snmp_varbind *vb)
hexley	0:281d6ff68967	1368	{
hexley	0:281d6ff68967	1369	if (vb->value != NULL )
hexley	0:281d6ff68967	1370	{
hexley	0:281d6ff68967	1371	memp_free(MEMP_SNMP_VALUE, vb->value);
hexley	0:281d6ff68967	1372	}
hexley	0:281d6ff68967	1373	if (vb->ident != NULL )
hexley	0:281d6ff68967	1374	{
hexley	0:281d6ff68967	1375	memp_free(MEMP_SNMP_VALUE, vb->ident);
hexley	0:281d6ff68967	1376	}
hexley	0:281d6ff68967	1377	memp_free(MEMP_SNMP_VARBIND, vb);
hexley	0:281d6ff68967	1378	}
hexley	0:281d6ff68967	1379
hexley	0:281d6ff68967	1380	void
hexley	0:281d6ff68967	1381	snmp_varbind_list_free(struct snmp_varbind_root *root)
hexley	0:281d6ff68967	1382	{
hexley	0:281d6ff68967	1383	struct snmp_varbind vb, prev;
hexley	0:281d6ff68967	1384
hexley	0:281d6ff68967	1385	vb = root->tail;
hexley	0:281d6ff68967	1386	while ( vb != NULL )
hexley	0:281d6ff68967	1387	{
hexley	0:281d6ff68967	1388	prev = vb->prev;
hexley	0:281d6ff68967	1389	snmp_varbind_free(vb);
hexley	0:281d6ff68967	1390	vb = prev;
hexley	0:281d6ff68967	1391	}
hexley	0:281d6ff68967	1392	root->count = 0;
hexley	0:281d6ff68967	1393	root->head = NULL;
hexley	0:281d6ff68967	1394	root->tail = NULL;
hexley	0:281d6ff68967	1395	}
hexley	0:281d6ff68967	1396
hexley	0:281d6ff68967	1397	void
hexley	0:281d6ff68967	1398	snmp_varbind_tail_add(struct snmp_varbind_root root, struct snmp_varbind vb)
hexley	0:281d6ff68967	1399	{
hexley	0:281d6ff68967	1400	if (root->count == 0)
hexley	0:281d6ff68967	1401	{
hexley	0:281d6ff68967	1402	/* add first varbind to list */
hexley	0:281d6ff68967	1403	root->head = vb;
hexley	0:281d6ff68967	1404	root->tail = vb;
hexley	0:281d6ff68967	1405	}
hexley	0:281d6ff68967	1406	else
hexley	0:281d6ff68967	1407	{
hexley	0:281d6ff68967	1408	/* add nth varbind to list tail */
hexley	0:281d6ff68967	1409	root->tail->next = vb;
hexley	0:281d6ff68967	1410	vb->prev = root->tail;
hexley	0:281d6ff68967	1411	root->tail = vb;
hexley	0:281d6ff68967	1412	}
hexley	0:281d6ff68967	1413	root->count += 1;
hexley	0:281d6ff68967	1414	}
hexley	0:281d6ff68967	1415
hexley	0:281d6ff68967	1416	struct snmp_varbind*
hexley	0:281d6ff68967	1417	snmp_varbind_tail_remove(struct snmp_varbind_root *root)
hexley	0:281d6ff68967	1418	{
hexley	0:281d6ff68967	1419	struct snmp_varbind* vb;
hexley	0:281d6ff68967	1420
hexley	0:281d6ff68967	1421	if (root->count > 0)
hexley	0:281d6ff68967	1422	{
hexley	0:281d6ff68967	1423	/* remove tail varbind */
hexley	0:281d6ff68967	1424	vb = root->tail;
hexley	0:281d6ff68967	1425	root->tail = vb->prev;
hexley	0:281d6ff68967	1426	vb->prev->next = NULL;
hexley	0:281d6ff68967	1427	root->count -= 1;
hexley	0:281d6ff68967	1428	}
hexley	0:281d6ff68967	1429	else
hexley	0:281d6ff68967	1430	{
hexley	0:281d6ff68967	1431	/* nothing to remove */
hexley	0:281d6ff68967	1432	vb = NULL;
hexley	0:281d6ff68967	1433	}
hexley	0:281d6ff68967	1434	return vb;
hexley	0:281d6ff68967	1435	}
hexley	0:281d6ff68967	1436
hexley	0:281d6ff68967	1437	#endif /* LWIP_SNMP */

Repository toolbox

Export to desktop IDE

Repository details

Type:	Library
Created:	19 Nov 2010
Imports:	44
Forks:	0
Commits:	1
Dependents:	0
Dependencies:	0
Followers:	1

lwip/core/snmp/msg_in.c@0:281d6ff68967, 2010-11-19 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning