CK Sin / Mbed 2 deprecated Ethernetwebsocket

Ethernetwebsoc

Dependencies:   C12832_lcd LM75B WebSocketClient mbed-rtos mbed Socket lwip-eth lwip-sys lwip

EthernetInterface/lwip/core/snmp/msg_out.c@0:0ed2a7c7190c, 2013-05-31 (annotated)

Committer:
GordonSin
Date:
Fri May 31 04:09:54 2013 +0000
Revision:
0:0ed2a7c7190c
31/5/2013;

Who changed what in which revision?

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