Yasushi TAUCHI / Mbed 2 deprecated giken9_HTMLServer_Sample

ソースの整理中ですが、利用はできます。

Dependencies:   EthernetInterface HttpServer TextLCD mbed-rpc mbed-rtos mbed Socket lwip-eth lwip-sys lwip

EthernetInterface/lwip/core/snmp/msg_out.c@0:7766f6712673, 2014-03-12 (annotated)

Committer:
yueee_yt
Date:
Wed Mar 12 04:19:54 2014 +0000
Revision:
0:7766f6712673
???????????????

Who changed what in which revision?

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