ZG2100NetIfSource - ZG2100 Network interface source

Users » donatien » Code » ZG2100NetIfSource

ZG2100 Network interface source

lwip/core/snmp/msg_in.c@0:b802fc31f1db, 2010-07-09 (annotated)

Committer:: donatien
Date:: Fri Jul 09 15:37:23 2010 +0000
Revision:: 0:b802fc31f1db

Who changed what in which revision?

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

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Created:	09 Jul 2010
Imports:	20
Forks:	0
Commits:	5
Dependents:	0
Dependencies:	0
Followers:	3

This repository is Public (Unlisted).

lwip/core/snmp/msg_in.c@0:b802fc31f1db, 2010-07-09 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning