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_out.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 output message processing (RFC1157).
idinor	0:dcf3c92487ca	4	*
idinor	0:dcf3c92487ca	5	* Output responses and traps are build in two passes:
idinor	0:dcf3c92487ca	6	*
idinor	0:dcf3c92487ca	7	* Pass 0: iterate over the output message backwards to determine encoding lengths
idinor	0:dcf3c92487ca	8	* Pass 1: the actual forward encoding of internal form into ASN1
idinor	0:dcf3c92487ca	9	*
idinor	0:dcf3c92487ca	10	* The single-pass encoding method described by Comer & Stevens
idinor	0:dcf3c92487ca	11	* requires extra buffer space and copying for reversal of the packet.
idinor	0:dcf3c92487ca	12	* The buffer requirement can be prohibitively large for big payloads
idinor	0:dcf3c92487ca	13	* (>= 484) therefore we use the two encoding passes.
idinor	0:dcf3c92487ca	14	*/
idinor	0:dcf3c92487ca	15
idinor	0:dcf3c92487ca	16	/*
idinor	0:dcf3c92487ca	17	* Copyright (c) 2006 Axon Digital Design B.V., The Netherlands.
idinor	0:dcf3c92487ca	18	* All rights reserved.
idinor	0:dcf3c92487ca	19	*
idinor	0:dcf3c92487ca	20	* Redistribution and use in source and binary forms, with or without modification,
idinor	0:dcf3c92487ca	21	* are permitted provided that the following conditions are met:
idinor	0:dcf3c92487ca	22	*
idinor	0:dcf3c92487ca	23	* 1. Redistributions of source code must retain the above copyright notice,
idinor	0:dcf3c92487ca	24	* this list of conditions and the following disclaimer.
idinor	0:dcf3c92487ca	25	* 2. Redistributions in binary form must reproduce the above copyright notice,
idinor	0:dcf3c92487ca	26	* this list of conditions and the following disclaimer in the documentation
idinor	0:dcf3c92487ca	27	* and/or other materials provided with the distribution.
idinor	0:dcf3c92487ca	28	* 3. The name of the author may not be used to endorse or promote products
idinor	0:dcf3c92487ca	29	* derived from this software without specific prior written permission.
idinor	0:dcf3c92487ca	30	*
idinor	0:dcf3c92487ca	31	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
idinor	0:dcf3c92487ca	32	* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
idinor	0:dcf3c92487ca	33	* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT
idinor	0:dcf3c92487ca	34	* SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
idinor	0:dcf3c92487ca	35	* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
idinor	0:dcf3c92487ca	36	* OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
idinor	0:dcf3c92487ca	37	* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
idinor	0:dcf3c92487ca	38	* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
idinor	0:dcf3c92487ca	39	* IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
idinor	0:dcf3c92487ca	40	* OF SUCH DAMAGE.
idinor	0:dcf3c92487ca	41	*
idinor	0:dcf3c92487ca	42	* Author: Christiaan Simons <christiaan.simons@axon.tv>
idinor	0:dcf3c92487ca	43	*/
idinor	0:dcf3c92487ca	44
idinor	0:dcf3c92487ca	45	#include "lwip/opt.h"
idinor	0:dcf3c92487ca	46
idinor	0:dcf3c92487ca	47	#if LWIP_SNMP /* don't build if not configured for use in lwipopts.h */
idinor	0:dcf3c92487ca	48
idinor	0:dcf3c92487ca	49	#include "lwip/udp.h"
idinor	0:dcf3c92487ca	50	#include "lwip/netif.h"
idinor	0:dcf3c92487ca	51	#include "lwip/snmp.h"
idinor	0:dcf3c92487ca	52	#include "lwip/snmp_asn1.h"
idinor	0:dcf3c92487ca	53	#include "lwip/snmp_msg.h"
idinor	0:dcf3c92487ca	54
idinor	0:dcf3c92487ca	55	struct snmp_trap_dst
idinor	0:dcf3c92487ca	56	{
idinor	0:dcf3c92487ca	57	/* destination IP address in network order */
idinor	0:dcf3c92487ca	58	ip_addr_t dip;
idinor	0:dcf3c92487ca	59	/* set to 0 when disabled, >0 when enabled */
idinor	0:dcf3c92487ca	60	u8_t enable;
idinor	0:dcf3c92487ca	61	};
idinor	0:dcf3c92487ca	62	struct snmp_trap_dst trap_dst[SNMP_TRAP_DESTINATIONS];
idinor	0:dcf3c92487ca	63
idinor	0:dcf3c92487ca	64	/** TRAP message structure */
idinor	0:dcf3c92487ca	65	struct snmp_msg_trap trap_msg;
idinor	0:dcf3c92487ca	66
idinor	0:dcf3c92487ca	67	static u16_t snmp_resp_header_sum(struct snmp_msg_pstat *m_stat, u16_t vb_len);
idinor	0:dcf3c92487ca	68	static u16_t snmp_trap_header_sum(struct snmp_msg_trap *m_trap, u16_t vb_len);
idinor	0:dcf3c92487ca	69	static u16_t snmp_varbind_list_sum(struct snmp_varbind_root *root);
idinor	0:dcf3c92487ca	70
idinor	0:dcf3c92487ca	71	static u16_t snmp_resp_header_enc(struct snmp_msg_pstat m_stat, struct pbuf p);
idinor	0:dcf3c92487ca	72	static u16_t snmp_trap_header_enc(struct snmp_msg_trap m_trap, struct pbuf p);
idinor	0:dcf3c92487ca	73	static u16_t snmp_varbind_list_enc(struct snmp_varbind_root root, struct pbuf p, u16_t ofs);
idinor	0:dcf3c92487ca	74
idinor	0:dcf3c92487ca	75	/**
idinor	0:dcf3c92487ca	76	* Sets enable switch for this trap destination.
idinor	0:dcf3c92487ca	77	* @param dst_idx index in 0 .. SNMP_TRAP_DESTINATIONS-1
idinor	0:dcf3c92487ca	78	* @param enable switch if 0 destination is disabled >0 enabled.
idinor	0:dcf3c92487ca	79	*/
idinor	0:dcf3c92487ca	80	void
idinor	0:dcf3c92487ca	81	snmp_trap_dst_enable(u8_t dst_idx, u8_t enable)
idinor	0:dcf3c92487ca	82	{
idinor	0:dcf3c92487ca	83	if (dst_idx < SNMP_TRAP_DESTINATIONS)
idinor	0:dcf3c92487ca	84	{
idinor	0:dcf3c92487ca	85	trap_dst[dst_idx].enable = enable;
idinor	0:dcf3c92487ca	86	}
idinor	0:dcf3c92487ca	87	}
idinor	0:dcf3c92487ca	88
idinor	0:dcf3c92487ca	89	/**
idinor	0:dcf3c92487ca	90	* Sets IPv4 address for this trap destination.
idinor	0:dcf3c92487ca	91	* @param dst_idx index in 0 .. SNMP_TRAP_DESTINATIONS-1
idinor	0:dcf3c92487ca	92	* @param dst IPv4 address in host order.
idinor	0:dcf3c92487ca	93	*/
idinor	0:dcf3c92487ca	94	void
idinor	0:dcf3c92487ca	95	snmp_trap_dst_ip_set(u8_t dst_idx, ip_addr_t *dst)
idinor	0:dcf3c92487ca	96	{
idinor	0:dcf3c92487ca	97	if (dst_idx < SNMP_TRAP_DESTINATIONS)
idinor	0:dcf3c92487ca	98	{
idinor	0:dcf3c92487ca	99	ip_addr_set(&trap_dst[dst_idx].dip, dst);
idinor	0:dcf3c92487ca	100	}
idinor	0:dcf3c92487ca	101	}
idinor	0:dcf3c92487ca	102
idinor	0:dcf3c92487ca	103	/**
idinor	0:dcf3c92487ca	104	* Sends a 'getresponse' message to the request originator.
idinor	0:dcf3c92487ca	105	*
idinor	0:dcf3c92487ca	106	* @param m_stat points to the current message request state source
idinor	0:dcf3c92487ca	107	* @return ERR_OK when success, ERR_MEM if we're out of memory
idinor	0:dcf3c92487ca	108	*
idinor	0:dcf3c92487ca	109	* @note the caller is responsible for filling in outvb in the m_stat
idinor	0:dcf3c92487ca	110	* and provide error-status and index (except for tooBig errors) ...
idinor	0:dcf3c92487ca	111	*/
idinor	0:dcf3c92487ca	112	err_t
idinor	0:dcf3c92487ca	113	snmp_send_response(struct snmp_msg_pstat *m_stat)
idinor	0:dcf3c92487ca	114	{
idinor	0:dcf3c92487ca	115	struct snmp_varbind_root emptyvb = {NULL, NULL, 0, 0, 0};
idinor	0:dcf3c92487ca	116	struct pbuf *p;
idinor	0:dcf3c92487ca	117	u16_t tot_len;
idinor	0:dcf3c92487ca	118	err_t err;
idinor	0:dcf3c92487ca	119
idinor	0:dcf3c92487ca	120	/* pass 0, calculate length fields */
idinor	0:dcf3c92487ca	121	tot_len = snmp_varbind_list_sum(&m_stat->outvb);
idinor	0:dcf3c92487ca	122	tot_len = snmp_resp_header_sum(m_stat, tot_len);
idinor	0:dcf3c92487ca	123
idinor	0:dcf3c92487ca	124	/* try allocating pbuf(s) for complete response */
idinor	0:dcf3c92487ca	125	p = pbuf_alloc(PBUF_TRANSPORT, tot_len, PBUF_POOL);
idinor	0:dcf3c92487ca	126	if (p == NULL)
idinor	0:dcf3c92487ca	127	{
idinor	0:dcf3c92487ca	128	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_snd_response() tooBig\n"));
idinor	0:dcf3c92487ca	129
idinor	0:dcf3c92487ca	130	/* can't construct reply, return error-status tooBig */
idinor	0:dcf3c92487ca	131	m_stat->error_status = SNMP_ES_TOOBIG;
idinor	0:dcf3c92487ca	132	m_stat->error_index = 0;
idinor	0:dcf3c92487ca	133	/* pass 0, recalculate lengths, for empty varbind-list */
idinor	0:dcf3c92487ca	134	tot_len = snmp_varbind_list_sum(&emptyvb);
idinor	0:dcf3c92487ca	135	tot_len = snmp_resp_header_sum(m_stat, tot_len);
idinor	0:dcf3c92487ca	136	/* retry allocation once for header and empty varbind-list */
idinor	0:dcf3c92487ca	137	p = pbuf_alloc(PBUF_TRANSPORT, tot_len, PBUF_POOL);
idinor	0:dcf3c92487ca	138	}
idinor	0:dcf3c92487ca	139	if (p != NULL)
idinor	0:dcf3c92487ca	140	{
idinor	0:dcf3c92487ca	141	/* first pbuf alloc try or retry alloc success */
idinor	0:dcf3c92487ca	142	u16_t ofs;
idinor	0:dcf3c92487ca	143
idinor	0:dcf3c92487ca	144	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_snd_response() p != NULL\n"));
idinor	0:dcf3c92487ca	145
idinor	0:dcf3c92487ca	146	/* pass 1, size error, encode packet ino the pbuf(s) */
idinor	0:dcf3c92487ca	147	ofs = snmp_resp_header_enc(m_stat, p);
idinor	0:dcf3c92487ca	148	if (m_stat->error_status == SNMP_ES_TOOBIG)
idinor	0:dcf3c92487ca	149	{
idinor	0:dcf3c92487ca	150	snmp_varbind_list_enc(&emptyvb, p, ofs);
idinor	0:dcf3c92487ca	151	}
idinor	0:dcf3c92487ca	152	else
idinor	0:dcf3c92487ca	153	{
idinor	0:dcf3c92487ca	154	snmp_varbind_list_enc(&m_stat->outvb, p, ofs);
idinor	0:dcf3c92487ca	155	}
idinor	0:dcf3c92487ca	156
idinor	0:dcf3c92487ca	157	switch (m_stat->error_status)
idinor	0:dcf3c92487ca	158	{
idinor	0:dcf3c92487ca	159	case SNMP_ES_TOOBIG:
idinor	0:dcf3c92487ca	160	snmp_inc_snmpouttoobigs();
idinor	0:dcf3c92487ca	161	break;
idinor	0:dcf3c92487ca	162	case SNMP_ES_NOSUCHNAME:
idinor	0:dcf3c92487ca	163	snmp_inc_snmpoutnosuchnames();
idinor	0:dcf3c92487ca	164	break;
idinor	0:dcf3c92487ca	165	case SNMP_ES_BADVALUE:
idinor	0:dcf3c92487ca	166	snmp_inc_snmpoutbadvalues();
idinor	0:dcf3c92487ca	167	break;
idinor	0:dcf3c92487ca	168	case SNMP_ES_GENERROR:
idinor	0:dcf3c92487ca	169	snmp_inc_snmpoutgenerrs();
idinor	0:dcf3c92487ca	170	break;
idinor	0:dcf3c92487ca	171	}
idinor	0:dcf3c92487ca	172	snmp_inc_snmpoutgetresponses();
idinor	0:dcf3c92487ca	173	snmp_inc_snmpoutpkts();
idinor	0:dcf3c92487ca	174
idinor	0:dcf3c92487ca	175	/** @todo do we need separate rx and tx pcbs for threaded case? */
idinor	0:dcf3c92487ca	176	/** connect to the originating source */
idinor	0:dcf3c92487ca	177	udp_connect(m_stat->pcb, &m_stat->sip, m_stat->sp);
idinor	0:dcf3c92487ca	178	err = udp_send(m_stat->pcb, p);
idinor	0:dcf3c92487ca	179	if (err == ERR_MEM)
idinor	0:dcf3c92487ca	180	{
idinor	0:dcf3c92487ca	181	/** @todo release some memory, retry and return tooBig? tooMuchHassle? */
idinor	0:dcf3c92487ca	182	err = ERR_MEM;
idinor	0:dcf3c92487ca	183	}
idinor	0:dcf3c92487ca	184	else
idinor	0:dcf3c92487ca	185	{
idinor	0:dcf3c92487ca	186	err = ERR_OK;
idinor	0:dcf3c92487ca	187	}
idinor	0:dcf3c92487ca	188	/** disassociate remote address and port with this pcb */
idinor	0:dcf3c92487ca	189	udp_disconnect(m_stat->pcb);
idinor	0:dcf3c92487ca	190
idinor	0:dcf3c92487ca	191	pbuf_free(p);
idinor	0:dcf3c92487ca	192	LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_snd_response() done\n"));
idinor	0:dcf3c92487ca	193	return err;
idinor	0:dcf3c92487ca	194	}
idinor	0:dcf3c92487ca	195	else
idinor	0:dcf3c92487ca	196	{
idinor	0:dcf3c92487ca	197	/* first pbuf alloc try or retry alloc failed
idinor	0:dcf3c92487ca	198	very low on memory, couldn't return tooBig */
idinor	0:dcf3c92487ca	199	return ERR_MEM;
idinor	0:dcf3c92487ca	200	}
idinor	0:dcf3c92487ca	201	}
idinor	0:dcf3c92487ca	202
idinor	0:dcf3c92487ca	203
idinor	0:dcf3c92487ca	204	/**
idinor	0:dcf3c92487ca	205	* Sends an generic or enterprise specific trap message.
idinor	0:dcf3c92487ca	206	*
idinor	0:dcf3c92487ca	207	* @param generic_trap is the trap code
idinor	0:dcf3c92487ca	208	* @param eoid points to enterprise object identifier
idinor	0:dcf3c92487ca	209	* @param specific_trap used for enterprise traps when generic_trap == 6
idinor	0:dcf3c92487ca	210	* @return ERR_OK when success, ERR_MEM if we're out of memory
idinor	0:dcf3c92487ca	211	*
idinor	0:dcf3c92487ca	212	* @note the caller is responsible for filling in outvb in the trap_msg
idinor	0:dcf3c92487ca	213	* @note the use of the enterpise identifier field
idinor	0:dcf3c92487ca	214	* is per RFC1215.
idinor	0:dcf3c92487ca	215	* Use .iso.org.dod.internet.mgmt.mib-2.snmp for generic traps
idinor	0:dcf3c92487ca	216	* and .iso.org.dod.internet.private.enterprises.yourenterprise
idinor	0:dcf3c92487ca	217	* (sysObjectID) for specific traps.
idinor	0:dcf3c92487ca	218	*/
idinor	0:dcf3c92487ca	219	err_t
idinor	0:dcf3c92487ca	220	snmp_send_trap(s8_t generic_trap, struct snmp_obj_id *eoid, s32_t specific_trap)
idinor	0:dcf3c92487ca	221	{
idinor	0:dcf3c92487ca	222	struct snmp_trap_dst *td;
idinor	0:dcf3c92487ca	223	struct netif *dst_if;
idinor	0:dcf3c92487ca	224	ip_addr_t dst_ip;
idinor	0:dcf3c92487ca	225	struct pbuf *p;
idinor	0:dcf3c92487ca	226	u16_t i,tot_len;
idinor	0:dcf3c92487ca	227
idinor	0:dcf3c92487ca	228	for (i=0, td = &trap_dst[0]; i<SNMP_TRAP_DESTINATIONS; i++, td++)
idinor	0:dcf3c92487ca	229	{
idinor	0:dcf3c92487ca	230	if ((td->enable != 0) && !ip_addr_isany(&td->dip))
idinor	0:dcf3c92487ca	231	{
idinor	0:dcf3c92487ca	232	/* network order trap destination */
idinor	0:dcf3c92487ca	233	ip_addr_copy(trap_msg.dip, td->dip);
idinor	0:dcf3c92487ca	234	/* lookup current source address for this dst */
idinor	0:dcf3c92487ca	235	dst_if = ip_route(&td->dip);
idinor	0:dcf3c92487ca	236	ip_addr_copy(dst_ip, dst_if->ip_addr);
idinor	0:dcf3c92487ca	237	/* @todo: what about IPv6? */
idinor	0:dcf3c92487ca	238	trap_msg.sip_raw[0] = ip4_addr1(&dst_ip);
idinor	0:dcf3c92487ca	239	trap_msg.sip_raw[1] = ip4_addr2(&dst_ip);
idinor	0:dcf3c92487ca	240	trap_msg.sip_raw[2] = ip4_addr3(&dst_ip);
idinor	0:dcf3c92487ca	241	trap_msg.sip_raw[3] = ip4_addr4(&dst_ip);
idinor	0:dcf3c92487ca	242	trap_msg.gen_trap = generic_trap;
idinor	0:dcf3c92487ca	243	trap_msg.spc_trap = specific_trap;
idinor	0:dcf3c92487ca	244	if (generic_trap == SNMP_GENTRAP_ENTERPRISESPC)
idinor	0:dcf3c92487ca	245	{
idinor	0:dcf3c92487ca	246	/* enterprise-Specific trap */
idinor	0:dcf3c92487ca	247	trap_msg.enterprise = eoid;
idinor	0:dcf3c92487ca	248	}
idinor	0:dcf3c92487ca	249	else
idinor	0:dcf3c92487ca	250	{
idinor	0:dcf3c92487ca	251	/* generic (MIB-II) trap */
idinor	0:dcf3c92487ca	252	snmp_get_snmpgrpid_ptr(&trap_msg.enterprise);
idinor	0:dcf3c92487ca	253	}
idinor	0:dcf3c92487ca	254	snmp_get_sysuptime(&trap_msg.ts);
idinor	0:dcf3c92487ca	255
idinor	0:dcf3c92487ca	256	/* pass 0, calculate length fields */
idinor	0:dcf3c92487ca	257	tot_len = snmp_varbind_list_sum(&trap_msg.outvb);
idinor	0:dcf3c92487ca	258	tot_len = snmp_trap_header_sum(&trap_msg, tot_len);
idinor	0:dcf3c92487ca	259
idinor	0:dcf3c92487ca	260	/* allocate pbuf(s) */
idinor	0:dcf3c92487ca	261	p = pbuf_alloc(PBUF_TRANSPORT, tot_len, PBUF_POOL);
idinor	0:dcf3c92487ca	262	if (p != NULL)
idinor	0:dcf3c92487ca	263	{
idinor	0:dcf3c92487ca	264	u16_t ofs;
idinor	0:dcf3c92487ca	265
idinor	0:dcf3c92487ca	266	/* pass 1, encode packet ino the pbuf(s) */
idinor	0:dcf3c92487ca	267	ofs = snmp_trap_header_enc(&trap_msg, p);
idinor	0:dcf3c92487ca	268	snmp_varbind_list_enc(&trap_msg.outvb, p, ofs);
idinor	0:dcf3c92487ca	269
idinor	0:dcf3c92487ca	270	snmp_inc_snmpouttraps();
idinor	0:dcf3c92487ca	271	snmp_inc_snmpoutpkts();
idinor	0:dcf3c92487ca	272
idinor	0:dcf3c92487ca	273	/** send to the TRAP destination */
idinor	0:dcf3c92487ca	274	udp_sendto(trap_msg.pcb, p, &trap_msg.dip, SNMP_TRAP_PORT);
idinor	0:dcf3c92487ca	275
idinor	0:dcf3c92487ca	276	pbuf_free(p);
idinor	0:dcf3c92487ca	277	}
idinor	0:dcf3c92487ca	278	else
idinor	0:dcf3c92487ca	279	{
idinor	0:dcf3c92487ca	280	return ERR_MEM;
idinor	0:dcf3c92487ca	281	}
idinor	0:dcf3c92487ca	282	}
idinor	0:dcf3c92487ca	283	}
idinor	0:dcf3c92487ca	284	return ERR_OK;
idinor	0:dcf3c92487ca	285	}
idinor	0:dcf3c92487ca	286
idinor	0:dcf3c92487ca	287	void
idinor	0:dcf3c92487ca	288	snmp_coldstart_trap(void)
idinor	0:dcf3c92487ca	289	{
idinor	0:dcf3c92487ca	290	trap_msg.outvb.head = NULL;
idinor	0:dcf3c92487ca	291	trap_msg.outvb.tail = NULL;
idinor	0:dcf3c92487ca	292	trap_msg.outvb.count = 0;
idinor	0:dcf3c92487ca	293	snmp_send_trap(SNMP_GENTRAP_COLDSTART, NULL, 0);
idinor	0:dcf3c92487ca	294	}
idinor	0:dcf3c92487ca	295
idinor	0:dcf3c92487ca	296	void
idinor	0:dcf3c92487ca	297	snmp_authfail_trap(void)
idinor	0:dcf3c92487ca	298	{
idinor	0:dcf3c92487ca	299	u8_t enable;
idinor	0:dcf3c92487ca	300	snmp_get_snmpenableauthentraps(&enable);
idinor	0:dcf3c92487ca	301	if (enable == 1)
idinor	0:dcf3c92487ca	302	{
idinor	0:dcf3c92487ca	303	trap_msg.outvb.head = NULL;
idinor	0:dcf3c92487ca	304	trap_msg.outvb.tail = NULL;
idinor	0:dcf3c92487ca	305	trap_msg.outvb.count = 0;
idinor	0:dcf3c92487ca	306	snmp_send_trap(SNMP_GENTRAP_AUTHFAIL, NULL, 0);
idinor	0:dcf3c92487ca	307	}
idinor	0:dcf3c92487ca	308	}
idinor	0:dcf3c92487ca	309
idinor	0:dcf3c92487ca	310	/**
idinor	0:dcf3c92487ca	311	* Sums response header field lengths from tail to head and
idinor	0:dcf3c92487ca	312	* returns resp_header_lengths for second encoding pass.
idinor	0:dcf3c92487ca	313	*
idinor	0:dcf3c92487ca	314	* @param vb_len varbind-list length
idinor	0:dcf3c92487ca	315	* @param rhl points to returned header lengths
idinor	0:dcf3c92487ca	316	* @return the required lenght for encoding the response header
idinor	0:dcf3c92487ca	317	*/
idinor	0:dcf3c92487ca	318	static u16_t
idinor	0:dcf3c92487ca	319	snmp_resp_header_sum(struct snmp_msg_pstat *m_stat, u16_t vb_len)
idinor	0:dcf3c92487ca	320	{
idinor	0:dcf3c92487ca	321	u16_t tot_len;
idinor	0:dcf3c92487ca	322	struct snmp_resp_header_lengths *rhl;
idinor	0:dcf3c92487ca	323
idinor	0:dcf3c92487ca	324	rhl = &m_stat->rhl;
idinor	0:dcf3c92487ca	325	tot_len = vb_len;
idinor	0:dcf3c92487ca	326	snmp_asn1_enc_s32t_cnt(m_stat->error_index, &rhl->erridxlen);
idinor	0:dcf3c92487ca	327	snmp_asn1_enc_length_cnt(rhl->erridxlen, &rhl->erridxlenlen);
idinor	0:dcf3c92487ca	328	tot_len += 1 + rhl->erridxlenlen + rhl->erridxlen;
idinor	0:dcf3c92487ca	329
idinor	0:dcf3c92487ca	330	snmp_asn1_enc_s32t_cnt(m_stat->error_status, &rhl->errstatlen);
idinor	0:dcf3c92487ca	331	snmp_asn1_enc_length_cnt(rhl->errstatlen, &rhl->errstatlenlen);
idinor	0:dcf3c92487ca	332	tot_len += 1 + rhl->errstatlenlen + rhl->errstatlen;
idinor	0:dcf3c92487ca	333
idinor	0:dcf3c92487ca	334	snmp_asn1_enc_s32t_cnt(m_stat->rid, &rhl->ridlen);
idinor	0:dcf3c92487ca	335	snmp_asn1_enc_length_cnt(rhl->ridlen, &rhl->ridlenlen);
idinor	0:dcf3c92487ca	336	tot_len += 1 + rhl->ridlenlen + rhl->ridlen;
idinor	0:dcf3c92487ca	337
idinor	0:dcf3c92487ca	338	rhl->pdulen = tot_len;
idinor	0:dcf3c92487ca	339	snmp_asn1_enc_length_cnt(rhl->pdulen, &rhl->pdulenlen);
idinor	0:dcf3c92487ca	340	tot_len += 1 + rhl->pdulenlen;
idinor	0:dcf3c92487ca	341
idinor	0:dcf3c92487ca	342	rhl->comlen = m_stat->com_strlen;
idinor	0:dcf3c92487ca	343	snmp_asn1_enc_length_cnt(rhl->comlen, &rhl->comlenlen);
idinor	0:dcf3c92487ca	344	tot_len += 1 + rhl->comlenlen + rhl->comlen;
idinor	0:dcf3c92487ca	345
idinor	0:dcf3c92487ca	346	snmp_asn1_enc_s32t_cnt(snmp_version, &rhl->verlen);
idinor	0:dcf3c92487ca	347	snmp_asn1_enc_length_cnt(rhl->verlen, &rhl->verlenlen);
idinor	0:dcf3c92487ca	348	tot_len += 1 + rhl->verlen + rhl->verlenlen;
idinor	0:dcf3c92487ca	349
idinor	0:dcf3c92487ca	350	rhl->seqlen = tot_len;
idinor	0:dcf3c92487ca	351	snmp_asn1_enc_length_cnt(rhl->seqlen, &rhl->seqlenlen);
idinor	0:dcf3c92487ca	352	tot_len += 1 + rhl->seqlenlen;
idinor	0:dcf3c92487ca	353
idinor	0:dcf3c92487ca	354	return tot_len;
idinor	0:dcf3c92487ca	355	}
idinor	0:dcf3c92487ca	356
idinor	0:dcf3c92487ca	357	/**
idinor	0:dcf3c92487ca	358	* Sums trap header field lengths from tail to head and
idinor	0:dcf3c92487ca	359	* returns trap_header_lengths for second encoding pass.
idinor	0:dcf3c92487ca	360	*
idinor	0:dcf3c92487ca	361	* @param vb_len varbind-list length
idinor	0:dcf3c92487ca	362	* @param thl points to returned header lengths
idinor	0:dcf3c92487ca	363	* @return the required lenght for encoding the trap header
idinor	0:dcf3c92487ca	364	*/
idinor	0:dcf3c92487ca	365	static u16_t
idinor	0:dcf3c92487ca	366	snmp_trap_header_sum(struct snmp_msg_trap *m_trap, u16_t vb_len)
idinor	0:dcf3c92487ca	367	{
idinor	0:dcf3c92487ca	368	u16_t tot_len;
idinor	0:dcf3c92487ca	369	struct snmp_trap_header_lengths *thl;
idinor	0:dcf3c92487ca	370
idinor	0:dcf3c92487ca	371	thl = &m_trap->thl;
idinor	0:dcf3c92487ca	372	tot_len = vb_len;
idinor	0:dcf3c92487ca	373
idinor	0:dcf3c92487ca	374	snmp_asn1_enc_u32t_cnt(m_trap->ts, &thl->tslen);
idinor	0:dcf3c92487ca	375	snmp_asn1_enc_length_cnt(thl->tslen, &thl->tslenlen);
idinor	0:dcf3c92487ca	376	tot_len += 1 + thl->tslen + thl->tslenlen;
idinor	0:dcf3c92487ca	377
idinor	0:dcf3c92487ca	378	snmp_asn1_enc_s32t_cnt(m_trap->spc_trap, &thl->strplen);
idinor	0:dcf3c92487ca	379	snmp_asn1_enc_length_cnt(thl->strplen, &thl->strplenlen);
idinor	0:dcf3c92487ca	380	tot_len += 1 + thl->strplen + thl->strplenlen;
idinor	0:dcf3c92487ca	381
idinor	0:dcf3c92487ca	382	snmp_asn1_enc_s32t_cnt(m_trap->gen_trap, &thl->gtrplen);
idinor	0:dcf3c92487ca	383	snmp_asn1_enc_length_cnt(thl->gtrplen, &thl->gtrplenlen);
idinor	0:dcf3c92487ca	384	tot_len += 1 + thl->gtrplen + thl->gtrplenlen;
idinor	0:dcf3c92487ca	385
idinor	0:dcf3c92487ca	386	thl->aaddrlen = 4;
idinor	0:dcf3c92487ca	387	snmp_asn1_enc_length_cnt(thl->aaddrlen, &thl->aaddrlenlen);
idinor	0:dcf3c92487ca	388	tot_len += 1 + thl->aaddrlen + thl->aaddrlenlen;
idinor	0:dcf3c92487ca	389
idinor	0:dcf3c92487ca	390	snmp_asn1_enc_oid_cnt(m_trap->enterprise->len, &m_trap->enterprise->id[0], &thl->eidlen);
idinor	0:dcf3c92487ca	391	snmp_asn1_enc_length_cnt(thl->eidlen, &thl->eidlenlen);
idinor	0:dcf3c92487ca	392	tot_len += 1 + thl->eidlen + thl->eidlenlen;
idinor	0:dcf3c92487ca	393
idinor	0:dcf3c92487ca	394	thl->pdulen = tot_len;
idinor	0:dcf3c92487ca	395	snmp_asn1_enc_length_cnt(thl->pdulen, &thl->pdulenlen);
idinor	0:dcf3c92487ca	396	tot_len += 1 + thl->pdulenlen;
idinor	0:dcf3c92487ca	397
idinor	0:dcf3c92487ca	398	thl->comlen = sizeof(snmp_publiccommunity) - 1;
idinor	0:dcf3c92487ca	399	snmp_asn1_enc_length_cnt(thl->comlen, &thl->comlenlen);
idinor	0:dcf3c92487ca	400	tot_len += 1 + thl->comlenlen + thl->comlen;
idinor	0:dcf3c92487ca	401
idinor	0:dcf3c92487ca	402	snmp_asn1_enc_s32t_cnt(snmp_version, &thl->verlen);
idinor	0:dcf3c92487ca	403	snmp_asn1_enc_length_cnt(thl->verlen, &thl->verlenlen);
idinor	0:dcf3c92487ca	404	tot_len += 1 + thl->verlen + thl->verlenlen;
idinor	0:dcf3c92487ca	405
idinor	0:dcf3c92487ca	406	thl->seqlen = tot_len;
idinor	0:dcf3c92487ca	407	snmp_asn1_enc_length_cnt(thl->seqlen, &thl->seqlenlen);
idinor	0:dcf3c92487ca	408	tot_len += 1 + thl->seqlenlen;
idinor	0:dcf3c92487ca	409
idinor	0:dcf3c92487ca	410	return tot_len;
idinor	0:dcf3c92487ca	411	}
idinor	0:dcf3c92487ca	412
idinor	0:dcf3c92487ca	413	/**
idinor	0:dcf3c92487ca	414	* Sums varbind lengths from tail to head and
idinor	0:dcf3c92487ca	415	* annotates lengths in varbind for second encoding pass.
idinor	0:dcf3c92487ca	416	*
idinor	0:dcf3c92487ca	417	* @param root points to the root of the variable binding list
idinor	0:dcf3c92487ca	418	* @return the required lenght for encoding the variable bindings
idinor	0:dcf3c92487ca	419	*/
idinor	0:dcf3c92487ca	420	static u16_t
idinor	0:dcf3c92487ca	421	snmp_varbind_list_sum(struct snmp_varbind_root *root)
idinor	0:dcf3c92487ca	422	{
idinor	0:dcf3c92487ca	423	struct snmp_varbind *vb;
idinor	0:dcf3c92487ca	424	u32_t *uint_ptr;
idinor	0:dcf3c92487ca	425	s32_t *sint_ptr;
idinor	0:dcf3c92487ca	426	u16_t tot_len;
idinor	0:dcf3c92487ca	427
idinor	0:dcf3c92487ca	428	tot_len = 0;
idinor	0:dcf3c92487ca	429	vb = root->tail;
idinor	0:dcf3c92487ca	430	while ( vb != NULL )
idinor	0:dcf3c92487ca	431	{
idinor	0:dcf3c92487ca	432	/* encoded value lenght depends on type */
idinor	0:dcf3c92487ca	433	switch (vb->value_type)
idinor	0:dcf3c92487ca	434	{
idinor	0:dcf3c92487ca	435	case (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_INTEG):
idinor	0:dcf3c92487ca	436	sint_ptr = (s32_t*)vb->value;
idinor	0:dcf3c92487ca	437	snmp_asn1_enc_s32t_cnt(*sint_ptr, &vb->vlen);
idinor	0:dcf3c92487ca	438	break;
idinor	0:dcf3c92487ca	439	case (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_COUNTER):
idinor	0:dcf3c92487ca	440	case (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_GAUGE):
idinor	0:dcf3c92487ca	441	case (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_TIMETICKS):
idinor	0:dcf3c92487ca	442	uint_ptr = (u32_t*)vb->value;
idinor	0:dcf3c92487ca	443	snmp_asn1_enc_u32t_cnt(*uint_ptr, &vb->vlen);
idinor	0:dcf3c92487ca	444	break;
idinor	0:dcf3c92487ca	445	case (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_OC_STR):
idinor	0:dcf3c92487ca	446	case (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_NUL):
idinor	0:dcf3c92487ca	447	case (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_IPADDR):
idinor	0:dcf3c92487ca	448	case (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_OPAQUE):
idinor	0:dcf3c92487ca	449	vb->vlen = vb->value_len;
idinor	0:dcf3c92487ca	450	break;
idinor	0:dcf3c92487ca	451	case (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_OBJ_ID):
idinor	0:dcf3c92487ca	452	sint_ptr = (s32_t*)vb->value;
idinor	0:dcf3c92487ca	453	snmp_asn1_enc_oid_cnt(vb->value_len / sizeof(s32_t), sint_ptr, &vb->vlen);
idinor	0:dcf3c92487ca	454	break;
idinor	0:dcf3c92487ca	455	default:
idinor	0:dcf3c92487ca	456	/* unsupported type */
idinor	0:dcf3c92487ca	457	vb->vlen = 0;
idinor	0:dcf3c92487ca	458	break;
idinor	0:dcf3c92487ca	459	};
idinor	0:dcf3c92487ca	460	/* encoding length of value length field */
idinor	0:dcf3c92487ca	461	snmp_asn1_enc_length_cnt(vb->vlen, &vb->vlenlen);
idinor	0:dcf3c92487ca	462	snmp_asn1_enc_oid_cnt(vb->ident_len, vb->ident, &vb->olen);
idinor	0:dcf3c92487ca	463	snmp_asn1_enc_length_cnt(vb->olen, &vb->olenlen);
idinor	0:dcf3c92487ca	464
idinor	0:dcf3c92487ca	465	vb->seqlen = 1 + vb->vlenlen + vb->vlen;
idinor	0:dcf3c92487ca	466	vb->seqlen += 1 + vb->olenlen + vb->olen;
idinor	0:dcf3c92487ca	467	snmp_asn1_enc_length_cnt(vb->seqlen, &vb->seqlenlen);
idinor	0:dcf3c92487ca	468
idinor	0:dcf3c92487ca	469	/* varbind seq */
idinor	0:dcf3c92487ca	470	tot_len += 1 + vb->seqlenlen + vb->seqlen;
idinor	0:dcf3c92487ca	471
idinor	0:dcf3c92487ca	472	vb = vb->prev;
idinor	0:dcf3c92487ca	473	}
idinor	0:dcf3c92487ca	474
idinor	0:dcf3c92487ca	475	/* varbind-list seq */
idinor	0:dcf3c92487ca	476	root->seqlen = tot_len;
idinor	0:dcf3c92487ca	477	snmp_asn1_enc_length_cnt(root->seqlen, &root->seqlenlen);
idinor	0:dcf3c92487ca	478	tot_len += 1 + root->seqlenlen;
idinor	0:dcf3c92487ca	479
idinor	0:dcf3c92487ca	480	return tot_len;
idinor	0:dcf3c92487ca	481	}
idinor	0:dcf3c92487ca	482
idinor	0:dcf3c92487ca	483	/**
idinor	0:dcf3c92487ca	484	* Encodes response header from head to tail.
idinor	0:dcf3c92487ca	485	*/
idinor	0:dcf3c92487ca	486	static u16_t
idinor	0:dcf3c92487ca	487	snmp_resp_header_enc(struct snmp_msg_pstat m_stat, struct pbuf p)
idinor	0:dcf3c92487ca	488	{
idinor	0:dcf3c92487ca	489	u16_t ofs;
idinor	0:dcf3c92487ca	490
idinor	0:dcf3c92487ca	491	ofs = 0;
idinor	0:dcf3c92487ca	492	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_UNIV \| SNMP_ASN1_CONSTR \| SNMP_ASN1_SEQ));
idinor	0:dcf3c92487ca	493	ofs += 1;
idinor	0:dcf3c92487ca	494	snmp_asn1_enc_length(p, ofs, m_stat->rhl.seqlen);
idinor	0:dcf3c92487ca	495	ofs += m_stat->rhl.seqlenlen;
idinor	0:dcf3c92487ca	496
idinor	0:dcf3c92487ca	497	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_INTEG));
idinor	0:dcf3c92487ca	498	ofs += 1;
idinor	0:dcf3c92487ca	499	snmp_asn1_enc_length(p, ofs, m_stat->rhl.verlen);
idinor	0:dcf3c92487ca	500	ofs += m_stat->rhl.verlenlen;
idinor	0:dcf3c92487ca	501	snmp_asn1_enc_s32t(p, ofs, m_stat->rhl.verlen, snmp_version);
idinor	0:dcf3c92487ca	502	ofs += m_stat->rhl.verlen;
idinor	0:dcf3c92487ca	503
idinor	0:dcf3c92487ca	504	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_OC_STR));
idinor	0:dcf3c92487ca	505	ofs += 1;
idinor	0:dcf3c92487ca	506	snmp_asn1_enc_length(p, ofs, m_stat->rhl.comlen);
idinor	0:dcf3c92487ca	507	ofs += m_stat->rhl.comlenlen;
idinor	0:dcf3c92487ca	508	snmp_asn1_enc_raw(p, ofs, m_stat->rhl.comlen, m_stat->community);
idinor	0:dcf3c92487ca	509	ofs += m_stat->rhl.comlen;
idinor	0:dcf3c92487ca	510
idinor	0:dcf3c92487ca	511	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_CONTXT \| SNMP_ASN1_CONSTR \| SNMP_ASN1_PDU_GET_RESP));
idinor	0:dcf3c92487ca	512	ofs += 1;
idinor	0:dcf3c92487ca	513	snmp_asn1_enc_length(p, ofs, m_stat->rhl.pdulen);
idinor	0:dcf3c92487ca	514	ofs += m_stat->rhl.pdulenlen;
idinor	0:dcf3c92487ca	515
idinor	0:dcf3c92487ca	516	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_INTEG));
idinor	0:dcf3c92487ca	517	ofs += 1;
idinor	0:dcf3c92487ca	518	snmp_asn1_enc_length(p, ofs, m_stat->rhl.ridlen);
idinor	0:dcf3c92487ca	519	ofs += m_stat->rhl.ridlenlen;
idinor	0:dcf3c92487ca	520	snmp_asn1_enc_s32t(p, ofs, m_stat->rhl.ridlen, m_stat->rid);
idinor	0:dcf3c92487ca	521	ofs += m_stat->rhl.ridlen;
idinor	0:dcf3c92487ca	522
idinor	0:dcf3c92487ca	523	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_INTEG));
idinor	0:dcf3c92487ca	524	ofs += 1;
idinor	0:dcf3c92487ca	525	snmp_asn1_enc_length(p, ofs, m_stat->rhl.errstatlen);
idinor	0:dcf3c92487ca	526	ofs += m_stat->rhl.errstatlenlen;
idinor	0:dcf3c92487ca	527	snmp_asn1_enc_s32t(p, ofs, m_stat->rhl.errstatlen, m_stat->error_status);
idinor	0:dcf3c92487ca	528	ofs += m_stat->rhl.errstatlen;
idinor	0:dcf3c92487ca	529
idinor	0:dcf3c92487ca	530	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_INTEG));
idinor	0:dcf3c92487ca	531	ofs += 1;
idinor	0:dcf3c92487ca	532	snmp_asn1_enc_length(p, ofs, m_stat->rhl.erridxlen);
idinor	0:dcf3c92487ca	533	ofs += m_stat->rhl.erridxlenlen;
idinor	0:dcf3c92487ca	534	snmp_asn1_enc_s32t(p, ofs, m_stat->rhl.erridxlen, m_stat->error_index);
idinor	0:dcf3c92487ca	535	ofs += m_stat->rhl.erridxlen;
idinor	0:dcf3c92487ca	536
idinor	0:dcf3c92487ca	537	return ofs;
idinor	0:dcf3c92487ca	538	}
idinor	0:dcf3c92487ca	539
idinor	0:dcf3c92487ca	540	/**
idinor	0:dcf3c92487ca	541	* Encodes trap header from head to tail.
idinor	0:dcf3c92487ca	542	*/
idinor	0:dcf3c92487ca	543	static u16_t
idinor	0:dcf3c92487ca	544	snmp_trap_header_enc(struct snmp_msg_trap m_trap, struct pbuf p)
idinor	0:dcf3c92487ca	545	{
idinor	0:dcf3c92487ca	546	u16_t ofs;
idinor	0:dcf3c92487ca	547
idinor	0:dcf3c92487ca	548	ofs = 0;
idinor	0:dcf3c92487ca	549	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_UNIV \| SNMP_ASN1_CONSTR \| SNMP_ASN1_SEQ));
idinor	0:dcf3c92487ca	550	ofs += 1;
idinor	0:dcf3c92487ca	551	snmp_asn1_enc_length(p, ofs, m_trap->thl.seqlen);
idinor	0:dcf3c92487ca	552	ofs += m_trap->thl.seqlenlen;
idinor	0:dcf3c92487ca	553
idinor	0:dcf3c92487ca	554	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_INTEG));
idinor	0:dcf3c92487ca	555	ofs += 1;
idinor	0:dcf3c92487ca	556	snmp_asn1_enc_length(p, ofs, m_trap->thl.verlen);
idinor	0:dcf3c92487ca	557	ofs += m_trap->thl.verlenlen;
idinor	0:dcf3c92487ca	558	snmp_asn1_enc_s32t(p, ofs, m_trap->thl.verlen, snmp_version);
idinor	0:dcf3c92487ca	559	ofs += m_trap->thl.verlen;
idinor	0:dcf3c92487ca	560
idinor	0:dcf3c92487ca	561	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_OC_STR));
idinor	0:dcf3c92487ca	562	ofs += 1;
idinor	0:dcf3c92487ca	563	snmp_asn1_enc_length(p, ofs, m_trap->thl.comlen);
idinor	0:dcf3c92487ca	564	ofs += m_trap->thl.comlenlen;
idinor	0:dcf3c92487ca	565	snmp_asn1_enc_raw(p, ofs, m_trap->thl.comlen, (u8_t *)&snmp_publiccommunity[0]);
idinor	0:dcf3c92487ca	566	ofs += m_trap->thl.comlen;
idinor	0:dcf3c92487ca	567
idinor	0:dcf3c92487ca	568	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_CONTXT \| SNMP_ASN1_CONSTR \| SNMP_ASN1_PDU_TRAP));
idinor	0:dcf3c92487ca	569	ofs += 1;
idinor	0:dcf3c92487ca	570	snmp_asn1_enc_length(p, ofs, m_trap->thl.pdulen);
idinor	0:dcf3c92487ca	571	ofs += m_trap->thl.pdulenlen;
idinor	0:dcf3c92487ca	572
idinor	0:dcf3c92487ca	573	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_OBJ_ID));
idinor	0:dcf3c92487ca	574	ofs += 1;
idinor	0:dcf3c92487ca	575	snmp_asn1_enc_length(p, ofs, m_trap->thl.eidlen);
idinor	0:dcf3c92487ca	576	ofs += m_trap->thl.eidlenlen;
idinor	0:dcf3c92487ca	577	snmp_asn1_enc_oid(p, ofs, m_trap->enterprise->len, &m_trap->enterprise->id[0]);
idinor	0:dcf3c92487ca	578	ofs += m_trap->thl.eidlen;
idinor	0:dcf3c92487ca	579
idinor	0:dcf3c92487ca	580	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_IPADDR));
idinor	0:dcf3c92487ca	581	ofs += 1;
idinor	0:dcf3c92487ca	582	snmp_asn1_enc_length(p, ofs, m_trap->thl.aaddrlen);
idinor	0:dcf3c92487ca	583	ofs += m_trap->thl.aaddrlenlen;
idinor	0:dcf3c92487ca	584	snmp_asn1_enc_raw(p, ofs, m_trap->thl.aaddrlen, &m_trap->sip_raw[0]);
idinor	0:dcf3c92487ca	585	ofs += m_trap->thl.aaddrlen;
idinor	0:dcf3c92487ca	586
idinor	0:dcf3c92487ca	587	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_INTEG));
idinor	0:dcf3c92487ca	588	ofs += 1;
idinor	0:dcf3c92487ca	589	snmp_asn1_enc_length(p, ofs, m_trap->thl.gtrplen);
idinor	0:dcf3c92487ca	590	ofs += m_trap->thl.gtrplenlen;
idinor	0:dcf3c92487ca	591	snmp_asn1_enc_u32t(p, ofs, m_trap->thl.gtrplen, m_trap->gen_trap);
idinor	0:dcf3c92487ca	592	ofs += m_trap->thl.gtrplen;
idinor	0:dcf3c92487ca	593
idinor	0:dcf3c92487ca	594	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_INTEG));
idinor	0:dcf3c92487ca	595	ofs += 1;
idinor	0:dcf3c92487ca	596	snmp_asn1_enc_length(p, ofs, m_trap->thl.strplen);
idinor	0:dcf3c92487ca	597	ofs += m_trap->thl.strplenlen;
idinor	0:dcf3c92487ca	598	snmp_asn1_enc_u32t(p, ofs, m_trap->thl.strplen, m_trap->spc_trap);
idinor	0:dcf3c92487ca	599	ofs += m_trap->thl.strplen;
idinor	0:dcf3c92487ca	600
idinor	0:dcf3c92487ca	601	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_TIMETICKS));
idinor	0:dcf3c92487ca	602	ofs += 1;
idinor	0:dcf3c92487ca	603	snmp_asn1_enc_length(p, ofs, m_trap->thl.tslen);
idinor	0:dcf3c92487ca	604	ofs += m_trap->thl.tslenlen;
idinor	0:dcf3c92487ca	605	snmp_asn1_enc_u32t(p, ofs, m_trap->thl.tslen, m_trap->ts);
idinor	0:dcf3c92487ca	606	ofs += m_trap->thl.tslen;
idinor	0:dcf3c92487ca	607
idinor	0:dcf3c92487ca	608	return ofs;
idinor	0:dcf3c92487ca	609	}
idinor	0:dcf3c92487ca	610
idinor	0:dcf3c92487ca	611	/**
idinor	0:dcf3c92487ca	612	* Encodes varbind list from head to tail.
idinor	0:dcf3c92487ca	613	*/
idinor	0:dcf3c92487ca	614	static u16_t
idinor	0:dcf3c92487ca	615	snmp_varbind_list_enc(struct snmp_varbind_root root, struct pbuf p, u16_t ofs)
idinor	0:dcf3c92487ca	616	{
idinor	0:dcf3c92487ca	617	struct snmp_varbind *vb;
idinor	0:dcf3c92487ca	618	s32_t *sint_ptr;
idinor	0:dcf3c92487ca	619	u32_t *uint_ptr;
idinor	0:dcf3c92487ca	620	u8_t *raw_ptr;
idinor	0:dcf3c92487ca	621
idinor	0:dcf3c92487ca	622	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_UNIV \| SNMP_ASN1_CONSTR \| SNMP_ASN1_SEQ));
idinor	0:dcf3c92487ca	623	ofs += 1;
idinor	0:dcf3c92487ca	624	snmp_asn1_enc_length(p, ofs, root->seqlen);
idinor	0:dcf3c92487ca	625	ofs += root->seqlenlen;
idinor	0:dcf3c92487ca	626
idinor	0:dcf3c92487ca	627	vb = root->head;
idinor	0:dcf3c92487ca	628	while ( vb != NULL )
idinor	0:dcf3c92487ca	629	{
idinor	0:dcf3c92487ca	630	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_UNIV \| SNMP_ASN1_CONSTR \| SNMP_ASN1_SEQ));
idinor	0:dcf3c92487ca	631	ofs += 1;
idinor	0:dcf3c92487ca	632	snmp_asn1_enc_length(p, ofs, vb->seqlen);
idinor	0:dcf3c92487ca	633	ofs += vb->seqlenlen;
idinor	0:dcf3c92487ca	634
idinor	0:dcf3c92487ca	635	snmp_asn1_enc_type(p, ofs, (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_OBJ_ID));
idinor	0:dcf3c92487ca	636	ofs += 1;
idinor	0:dcf3c92487ca	637	snmp_asn1_enc_length(p, ofs, vb->olen);
idinor	0:dcf3c92487ca	638	ofs += vb->olenlen;
idinor	0:dcf3c92487ca	639	snmp_asn1_enc_oid(p, ofs, vb->ident_len, &vb->ident[0]);
idinor	0:dcf3c92487ca	640	ofs += vb->olen;
idinor	0:dcf3c92487ca	641
idinor	0:dcf3c92487ca	642	snmp_asn1_enc_type(p, ofs, vb->value_type);
idinor	0:dcf3c92487ca	643	ofs += 1;
idinor	0:dcf3c92487ca	644	snmp_asn1_enc_length(p, ofs, vb->vlen);
idinor	0:dcf3c92487ca	645	ofs += vb->vlenlen;
idinor	0:dcf3c92487ca	646
idinor	0:dcf3c92487ca	647	switch (vb->value_type)
idinor	0:dcf3c92487ca	648	{
idinor	0:dcf3c92487ca	649	case (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_INTEG):
idinor	0:dcf3c92487ca	650	sint_ptr = (s32_t*)vb->value;
idinor	0:dcf3c92487ca	651	snmp_asn1_enc_s32t(p, ofs, vb->vlen, *sint_ptr);
idinor	0:dcf3c92487ca	652	break;
idinor	0:dcf3c92487ca	653	case (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_COUNTER):
idinor	0:dcf3c92487ca	654	case (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_GAUGE):
idinor	0:dcf3c92487ca	655	case (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_TIMETICKS):
idinor	0:dcf3c92487ca	656	uint_ptr = (u32_t*)vb->value;
idinor	0:dcf3c92487ca	657	snmp_asn1_enc_u32t(p, ofs, vb->vlen, *uint_ptr);
idinor	0:dcf3c92487ca	658	break;
idinor	0:dcf3c92487ca	659	case (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_OC_STR):
idinor	0:dcf3c92487ca	660	case (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_IPADDR):
idinor	0:dcf3c92487ca	661	case (SNMP_ASN1_APPLIC \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_OPAQUE):
idinor	0:dcf3c92487ca	662	raw_ptr = (u8_t*)vb->value;
idinor	0:dcf3c92487ca	663	snmp_asn1_enc_raw(p, ofs, vb->vlen, raw_ptr);
idinor	0:dcf3c92487ca	664	break;
idinor	0:dcf3c92487ca	665	case (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_NUL):
idinor	0:dcf3c92487ca	666	break;
idinor	0:dcf3c92487ca	667	case (SNMP_ASN1_UNIV \| SNMP_ASN1_PRIMIT \| SNMP_ASN1_OBJ_ID):
idinor	0:dcf3c92487ca	668	sint_ptr = (s32_t*)vb->value;
idinor	0:dcf3c92487ca	669	snmp_asn1_enc_oid(p, ofs, vb->value_len / sizeof(s32_t), sint_ptr);
idinor	0:dcf3c92487ca	670	break;
idinor	0:dcf3c92487ca	671	default:
idinor	0:dcf3c92487ca	672	/* unsupported type */
idinor	0:dcf3c92487ca	673	break;
idinor	0:dcf3c92487ca	674	};
idinor	0:dcf3c92487ca	675	ofs += vb->vlen;
idinor	0:dcf3c92487ca	676	vb = vb->next;
idinor	0:dcf3c92487ca	677	}
idinor	0:dcf3c92487ca	678	return ofs;
idinor	0:dcf3c92487ca	679	}
idinor	0:dcf3c92487ca	680
idinor	0:dcf3c92487ca	681	#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_out.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