StrippedDownNetServices - This library is stripped down version of NetServi…

Users » idinor » Code » StrippedDownNetServices

idinor Launcher / StrippedDownNetServices

This library is stripped down version of NetServices library. HTTP server and client function is NOT supported.

lwip/core/snmp/msg_in.c@0:dcf3c92487ca, 2011-07-20 (annotated)

Committer:: idinor
Date:: Wed Jul 20 11:45:39 2011 +0000
Revision:: 0:dcf3c92487ca

Who changed what in which revision?

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

Repository toolbox

Export to desktop IDE

Repository details

Type:	Library
Created:	20 Jul 2011
Imports:	35
Forks:	0
Commits:	1
Dependents:	1
Dependencies:	0
Followers:	1

lwip/core/snmp/msg_in.c@0:dcf3c92487ca, 2011-07-20 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning