mbed unsupported / lwip

A version of LWIP, provided for backwards compatibility.

Dependents:   AA_DemoBoard DemoBoard HelloServerDemo DemoBoard_RangeIndicator ... more

trunk/Core/lwIP/core/snmp/msg_out.c@0:5e1631496985, 2012-05-08 (annotated)

Committer:
root@mbed.org
Date:
Tue May 08 15:32:10 2012 +0100
Revision:
0:5e1631496985
initial commit

Who changed what in which revision?

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