Rik Van Dyck / Mbed 2 deprecated Project_Embedded_C

Dependencies:   mbed DS1307 Servo TextLCD

Committer:
rikvandyck
Date:
Thu Dec 18 10:43:07 2014 +0000
Revision:
2:55b6fd49b738
Parent:
0:e1edd52b1ee2
Project_Embedded_C

Who changed what in which revision?

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