Net - | Mbed

Users » mbed714 » Code » Net

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

Committer:: mbed714
Date:: Sat Sep 18 23:05:49 2010 +0000
Revision:: 0:d616ece2d859

Who changed what in which revision?

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

Repository toolbox

Export to desktop IDE

Repository details

Type:	Library
Created:	18 Sep 2010
Imports:	1
Forks:	0
Commits:	1
Dependents:	0
Dependencies:	0
Followers:	1

This repository is Public (Unlisted).

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

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning