Mihail Stoyanov / HTTPServer

My fork of the HTTPServer (working)

Dependents:   DGWWebServer LAN2

Core/lwIP/core/snmp/msg_out.c@1:284f2df30cf9, 2012-11-20 (annotated)

Committer:
screamer
Date:
Tue Nov 20 12:18:53 2012 +0000
Revision:
1:284f2df30cf9
Parent:
0:7a64fbb4069d 
local changes

Who changed what in which revision?

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