Mihail Stoyanov / HTTPServer

My fork of the HTTPServer (working)

Dependents:   DGWWebServer LAN2

Core/lwIP/core/snmp/msg_in.c@0:7a64fbb4069d, 2012-08-06 (annotated)

Committer:
screamer
Date:
Mon Aug 06 09:23:14 2012 +0000
Revision:
0:7a64fbb4069d
[mbed] converted /DGWWebServer/HTTPServer

Who changed what in which revision?

UserRevisionLine numberNew contents of line
screamer 0:7a64fbb4069d 1 /**
screamer 0:7a64fbb4069d 2 * @file
screamer 0:7a64fbb4069d 3 * SNMP input message processing (RFC1157).
screamer 0:7a64fbb4069d 4 */
screamer 0:7a64fbb4069d 5
screamer 0:7a64fbb4069d 6 /*
screamer 0:7a64fbb4069d 7 * Copyright (c) 2006 Axon Digital Design B.V., The Netherlands.
screamer 0:7a64fbb4069d 8 * All rights reserved.
screamer 0:7a64fbb4069d 9 *
screamer 0:7a64fbb4069d 10 * Redistribution and use in source and binary forms, with or without modification,
screamer 0:7a64fbb4069d 11 * are permitted provided that the following conditions are met:
screamer 0:7a64fbb4069d 12 *
screamer 0:7a64fbb4069d 13 * 1. Redistributions of source code must retain the above copyright notice,
screamer 0:7a64fbb4069d 14 * this list of conditions and the following disclaimer.
screamer 0:7a64fbb4069d 15 * 2. Redistributions in binary form must reproduce the above copyright notice,
screamer 0:7a64fbb4069d 16 * this list of conditions and the following disclaimer in the documentation
screamer 0:7a64fbb4069d 17 * and/or other materials provided with the distribution.
screamer 0:7a64fbb4069d 18 * 3. The name of the author may not be used to endorse or promote products
screamer 0:7a64fbb4069d 19 * derived from this software without specific prior written permission.
screamer 0:7a64fbb4069d 20 *
screamer 0:7a64fbb4069d 21 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
screamer 0:7a64fbb4069d 22 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
screamer 0:7a64fbb4069d 23 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT
screamer 0:7a64fbb4069d 24 * SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
screamer 0:7a64fbb4069d 25 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
screamer 0:7a64fbb4069d 26 * OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
screamer 0:7a64fbb4069d 27 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
screamer 0:7a64fbb4069d 28 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
screamer 0:7a64fbb4069d 29 * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
screamer 0:7a64fbb4069d 30 * OF SUCH DAMAGE.
screamer 0:7a64fbb4069d 31 *
screamer 0:7a64fbb4069d 32 * Author: Christiaan Simons <christiaan.simons@axon.tv>
screamer 0:7a64fbb4069d 33 */
screamer 0:7a64fbb4069d 34
screamer 0:7a64fbb4069d 35 #include "lwip/opt.h"
screamer 0:7a64fbb4069d 36
screamer 0:7a64fbb4069d 37 #if LWIP_SNMP /* don't build if not configured for use in lwipopts.h */
screamer 0:7a64fbb4069d 38
screamer 0:7a64fbb4069d 39 #include "lwip/ip_addr.h"
screamer 0:7a64fbb4069d 40 #include "lwip/mem.h"
screamer 0:7a64fbb4069d 41 #include "lwip/udp.h"
screamer 0:7a64fbb4069d 42 #include "lwip/stats.h"
screamer 0:7a64fbb4069d 43 #include "lwip/snmp.h"
screamer 0:7a64fbb4069d 44 #include "lwip/snmp_asn1.h"
screamer 0:7a64fbb4069d 45 #include "lwip/snmp_msg.h"
screamer 0:7a64fbb4069d 46 #include "lwip/snmp_structs.h"
screamer 0:7a64fbb4069d 47
screamer 0:7a64fbb4069d 48 #include <string.h>
screamer 0:7a64fbb4069d 49
screamer 0:7a64fbb4069d 50 /* public (non-static) constants */
screamer 0:7a64fbb4069d 51 /** SNMP v1 == 0 */
screamer 0:7a64fbb4069d 52 const s32_t snmp_version = 0;
screamer 0:7a64fbb4069d 53 /** default SNMP community string */
screamer 0:7a64fbb4069d 54 const char snmp_publiccommunity[7] = "public";
screamer 0:7a64fbb4069d 55
screamer 0:7a64fbb4069d 56 /* statically allocated buffers for SNMP_CONCURRENT_REQUESTS */
screamer 0:7a64fbb4069d 57 struct snmp_msg_pstat msg_input_list[SNMP_CONCURRENT_REQUESTS];
screamer 0:7a64fbb4069d 58 /* UDP Protocol Control Block */
screamer 0:7a64fbb4069d 59 struct udp_pcb *snmp1_pcb;
screamer 0:7a64fbb4069d 60
screamer 0:7a64fbb4069d 61 static void snmp_recv(void *arg, struct udp_pcb *pcb, struct pbuf *p, struct ip_addr *addr, u16_t port);
screamer 0:7a64fbb4069d 62 static err_t snmp_pdu_header_check(struct pbuf *p, u16_t ofs, u16_t pdu_len, u16_t *ofs_ret, struct snmp_msg_pstat *m_stat);
screamer 0:7a64fbb4069d 63 static err_t snmp_pdu_dec_varbindlist(struct pbuf *p, u16_t ofs, u16_t *ofs_ret, struct snmp_msg_pstat *m_stat);
screamer 0:7a64fbb4069d 64
screamer 0:7a64fbb4069d 65
screamer 0:7a64fbb4069d 66 /**
screamer 0:7a64fbb4069d 67 * Starts SNMP Agent.
screamer 0:7a64fbb4069d 68 * Allocates UDP pcb and binds it to IP_ADDR_ANY port 161.
screamer 0:7a64fbb4069d 69 */
screamer 0:7a64fbb4069d 70 void
screamer 0:7a64fbb4069d 71 snmp_init(void)
screamer 0:7a64fbb4069d 72 {
screamer 0:7a64fbb4069d 73 struct snmp_msg_pstat *msg_ps;
screamer 0:7a64fbb4069d 74 u8_t i;
screamer 0:7a64fbb4069d 75
screamer 0:7a64fbb4069d 76 snmp1_pcb = udp_new();
screamer 0:7a64fbb4069d 77 if (snmp1_pcb != NULL)
screamer 0:7a64fbb4069d 78 {
screamer 0:7a64fbb4069d 79 udp_recv(snmp1_pcb, snmp_recv, (void *)SNMP_IN_PORT);
screamer 0:7a64fbb4069d 80 udp_bind(snmp1_pcb, IP_ADDR_ANY, SNMP_IN_PORT);
screamer 0:7a64fbb4069d 81 }
screamer 0:7a64fbb4069d 82 msg_ps = &msg_input_list[0];
screamer 0:7a64fbb4069d 83 for (i=0; i<SNMP_CONCURRENT_REQUESTS; i++)
screamer 0:7a64fbb4069d 84 {
screamer 0:7a64fbb4069d 85 msg_ps->state = SNMP_MSG_EMPTY;
screamer 0:7a64fbb4069d 86 msg_ps->error_index = 0;
screamer 0:7a64fbb4069d 87 msg_ps->error_status = SNMP_ES_NOERROR;
screamer 0:7a64fbb4069d 88 msg_ps++;
screamer 0:7a64fbb4069d 89 }
screamer 0:7a64fbb4069d 90 trap_msg.pcb = snmp1_pcb;
screamer 0:7a64fbb4069d 91 /* The coldstart trap will only be output
screamer 0:7a64fbb4069d 92 if our outgoing interface is up & configured */
screamer 0:7a64fbb4069d 93 snmp_coldstart_trap();
screamer 0:7a64fbb4069d 94 }
screamer 0:7a64fbb4069d 95
screamer 0:7a64fbb4069d 96 static void
screamer 0:7a64fbb4069d 97 snmp_error_response(struct snmp_msg_pstat *msg_ps, u8_t error)
screamer 0:7a64fbb4069d 98 {
screamer 0:7a64fbb4069d 99 snmp_varbind_list_free(&msg_ps->outvb);
screamer 0:7a64fbb4069d 100 msg_ps->outvb = msg_ps->invb;
screamer 0:7a64fbb4069d 101 msg_ps->invb.head = NULL;
screamer 0:7a64fbb4069d 102 msg_ps->invb.tail = NULL;
screamer 0:7a64fbb4069d 103 msg_ps->invb.count = 0;
screamer 0:7a64fbb4069d 104 msg_ps->error_status = error;
screamer 0:7a64fbb4069d 105 msg_ps->error_index = 1 + msg_ps->vb_idx;
screamer 0:7a64fbb4069d 106 snmp_send_response(msg_ps);
screamer 0:7a64fbb4069d 107 snmp_varbind_list_free(&msg_ps->outvb);
screamer 0:7a64fbb4069d 108 msg_ps->state = SNMP_MSG_EMPTY;
screamer 0:7a64fbb4069d 109 }
screamer 0:7a64fbb4069d 110
screamer 0:7a64fbb4069d 111 static void
screamer 0:7a64fbb4069d 112 snmp_ok_response(struct snmp_msg_pstat *msg_ps)
screamer 0:7a64fbb4069d 113 {
screamer 0:7a64fbb4069d 114 err_t err_ret;
screamer 0:7a64fbb4069d 115
screamer 0:7a64fbb4069d 116 err_ret = snmp_send_response(msg_ps);
screamer 0:7a64fbb4069d 117 if (err_ret == ERR_MEM)
screamer 0:7a64fbb4069d 118 {
screamer 0:7a64fbb4069d 119 /* serious memory problem, can't return tooBig */
screamer 0:7a64fbb4069d 120 }
screamer 0:7a64fbb4069d 121 else
screamer 0:7a64fbb4069d 122 {
screamer 0:7a64fbb4069d 123 LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_event = %"S32_F"\n",msg_ps->error_status));
screamer 0:7a64fbb4069d 124 }
screamer 0:7a64fbb4069d 125 /* free varbinds (if available) */
screamer 0:7a64fbb4069d 126 snmp_varbind_list_free(&msg_ps->invb);
screamer 0:7a64fbb4069d 127 snmp_varbind_list_free(&msg_ps->outvb);
screamer 0:7a64fbb4069d 128 msg_ps->state = SNMP_MSG_EMPTY;
screamer 0:7a64fbb4069d 129 }
screamer 0:7a64fbb4069d 130
screamer 0:7a64fbb4069d 131 /**
screamer 0:7a64fbb4069d 132 * Service an internal or external event for SNMP GET.
screamer 0:7a64fbb4069d 133 *
screamer 0:7a64fbb4069d 134 * @param request_id identifies requests from 0 to (SNMP_CONCURRENT_REQUESTS-1)
screamer 0:7a64fbb4069d 135 * @param msg_ps points to the assosicated message process state
screamer 0:7a64fbb4069d 136 */
screamer 0:7a64fbb4069d 137 static void
screamer 0:7a64fbb4069d 138 snmp_msg_get_event(u8_t request_id, struct snmp_msg_pstat *msg_ps)
screamer 0:7a64fbb4069d 139 {
screamer 0:7a64fbb4069d 140 LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_get_event: msg_ps->state==%"U16_F"\n",(u16_t)msg_ps->state));
screamer 0:7a64fbb4069d 141
screamer 0:7a64fbb4069d 142 if (msg_ps->state == SNMP_MSG_EXTERNAL_GET_OBJDEF)
screamer 0:7a64fbb4069d 143 {
screamer 0:7a64fbb4069d 144 struct mib_external_node *en;
screamer 0:7a64fbb4069d 145 struct snmp_name_ptr np;
screamer 0:7a64fbb4069d 146
screamer 0:7a64fbb4069d 147 /* get_object_def() answer*/
screamer 0:7a64fbb4069d 148 en = msg_ps->ext_mib_node;
screamer 0:7a64fbb4069d 149 np = msg_ps->ext_name_ptr;
screamer 0:7a64fbb4069d 150
screamer 0:7a64fbb4069d 151 /* translate answer into a known lifeform */
screamer 0:7a64fbb4069d 152 en->get_object_def_a(request_id, np.ident_len, np.ident, &msg_ps->ext_object_def);
screamer 0:7a64fbb4069d 153 if (msg_ps->ext_object_def.instance != MIB_OBJECT_NONE)
screamer 0:7a64fbb4069d 154 {
screamer 0:7a64fbb4069d 155 msg_ps->state = SNMP_MSG_EXTERNAL_GET_VALUE;
screamer 0:7a64fbb4069d 156 en->get_value_q(request_id, &msg_ps->ext_object_def);
screamer 0:7a64fbb4069d 157 }
screamer 0:7a64fbb4069d 158 else
screamer 0:7a64fbb4069d 159 {
screamer 0:7a64fbb4069d 160 en->get_object_def_pc(request_id, np.ident_len, np.ident);
screamer 0:7a64fbb4069d 161 /* search failed, object id points to unknown object (nosuchname) */
screamer 0:7a64fbb4069d 162 snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
screamer 0:7a64fbb4069d 163 }
screamer 0:7a64fbb4069d 164 }
screamer 0:7a64fbb4069d 165 else if (msg_ps->state == SNMP_MSG_EXTERNAL_GET_VALUE)
screamer 0:7a64fbb4069d 166 {
screamer 0:7a64fbb4069d 167 struct mib_external_node *en;
screamer 0:7a64fbb4069d 168 struct snmp_varbind *vb;
screamer 0:7a64fbb4069d 169
screamer 0:7a64fbb4069d 170 /* get_value() answer */
screamer 0:7a64fbb4069d 171 en = msg_ps->ext_mib_node;
screamer 0:7a64fbb4069d 172
screamer 0:7a64fbb4069d 173 /* allocate output varbind */
screamer 0:7a64fbb4069d 174 vb = (struct snmp_varbind *)mem_malloc(sizeof(struct snmp_varbind));
screamer 0:7a64fbb4069d 175 LWIP_ASSERT("vb != NULL",vb != NULL);
screamer 0:7a64fbb4069d 176 if (vb != NULL)
screamer 0:7a64fbb4069d 177 {
screamer 0:7a64fbb4069d 178 vb->next = NULL;
screamer 0:7a64fbb4069d 179 vb->prev = NULL;
screamer 0:7a64fbb4069d 180
screamer 0:7a64fbb4069d 181 /* move name from invb to outvb */
screamer 0:7a64fbb4069d 182 vb->ident = msg_ps->vb_ptr->ident;
screamer 0:7a64fbb4069d 183 vb->ident_len = msg_ps->vb_ptr->ident_len;
screamer 0:7a64fbb4069d 184 /* ensure this memory is refereced once only */
screamer 0:7a64fbb4069d 185 msg_ps->vb_ptr->ident = NULL;
screamer 0:7a64fbb4069d 186 msg_ps->vb_ptr->ident_len = 0;
screamer 0:7a64fbb4069d 187
screamer 0:7a64fbb4069d 188 vb->value_type = msg_ps->ext_object_def.asn_type;
screamer 0:7a64fbb4069d 189 vb->value_len = msg_ps->ext_object_def.v_len;
screamer 0:7a64fbb4069d 190 if (vb->value_len > 0)
screamer 0:7a64fbb4069d 191 {
screamer 0:7a64fbb4069d 192 vb->value = mem_malloc(vb->value_len);
screamer 0:7a64fbb4069d 193 LWIP_ASSERT("vb->value != NULL",vb->value != NULL);
screamer 0:7a64fbb4069d 194 if (vb->value != NULL)
screamer 0:7a64fbb4069d 195 {
screamer 0:7a64fbb4069d 196 en->get_value_a(request_id, &msg_ps->ext_object_def, vb->value_len, vb->value);
screamer 0:7a64fbb4069d 197 snmp_varbind_tail_add(&msg_ps->outvb, vb);
screamer 0:7a64fbb4069d 198 /* search again (if vb_idx < msg_ps->invb.count) */
screamer 0:7a64fbb4069d 199 msg_ps->state = SNMP_MSG_SEARCH_OBJ;
screamer 0:7a64fbb4069d 200 msg_ps->vb_idx += 1;
screamer 0:7a64fbb4069d 201 }
screamer 0:7a64fbb4069d 202 else
screamer 0:7a64fbb4069d 203 {
screamer 0:7a64fbb4069d 204 en->get_value_pc(request_id, &msg_ps->ext_object_def);
screamer 0:7a64fbb4069d 205 LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_event: no variable space\n"));
screamer 0:7a64fbb4069d 206 msg_ps->vb_ptr->ident = vb->ident;
screamer 0:7a64fbb4069d 207 msg_ps->vb_ptr->ident_len = vb->ident_len;
screamer 0:7a64fbb4069d 208 mem_free(vb);
screamer 0:7a64fbb4069d 209 snmp_error_response(msg_ps,SNMP_ES_TOOBIG);
screamer 0:7a64fbb4069d 210 }
screamer 0:7a64fbb4069d 211 }
screamer 0:7a64fbb4069d 212 else
screamer 0:7a64fbb4069d 213 {
screamer 0:7a64fbb4069d 214 /* vb->value_len == 0, empty value (e.g. empty string) */
screamer 0:7a64fbb4069d 215 en->get_value_a(request_id, &msg_ps->ext_object_def, 0, NULL);
screamer 0:7a64fbb4069d 216 vb->value = NULL;
screamer 0:7a64fbb4069d 217 snmp_varbind_tail_add(&msg_ps->outvb, vb);
screamer 0:7a64fbb4069d 218 /* search again (if vb_idx < msg_ps->invb.count) */
screamer 0:7a64fbb4069d 219 msg_ps->state = SNMP_MSG_SEARCH_OBJ;
screamer 0:7a64fbb4069d 220 msg_ps->vb_idx += 1;
screamer 0:7a64fbb4069d 221 }
screamer 0:7a64fbb4069d 222 }
screamer 0:7a64fbb4069d 223 else
screamer 0:7a64fbb4069d 224 {
screamer 0:7a64fbb4069d 225 en->get_value_pc(request_id, &msg_ps->ext_object_def);
screamer 0:7a64fbb4069d 226 LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_event: no outvb space\n"));
screamer 0:7a64fbb4069d 227 snmp_error_response(msg_ps,SNMP_ES_TOOBIG);
screamer 0:7a64fbb4069d 228 }
screamer 0:7a64fbb4069d 229 }
screamer 0:7a64fbb4069d 230
screamer 0:7a64fbb4069d 231 while ((msg_ps->state == SNMP_MSG_SEARCH_OBJ) &&
screamer 0:7a64fbb4069d 232 (msg_ps->vb_idx < msg_ps->invb.count))
screamer 0:7a64fbb4069d 233 {
screamer 0:7a64fbb4069d 234 struct mib_node *mn;
screamer 0:7a64fbb4069d 235 struct snmp_name_ptr np;
screamer 0:7a64fbb4069d 236
screamer 0:7a64fbb4069d 237 if (msg_ps->vb_idx == 0)
screamer 0:7a64fbb4069d 238 {
screamer 0:7a64fbb4069d 239 msg_ps->vb_ptr = msg_ps->invb.head;
screamer 0:7a64fbb4069d 240 }
screamer 0:7a64fbb4069d 241 else
screamer 0:7a64fbb4069d 242 {
screamer 0:7a64fbb4069d 243 msg_ps->vb_ptr = msg_ps->vb_ptr->next;
screamer 0:7a64fbb4069d 244 }
screamer 0:7a64fbb4069d 245 /** test object identifier for .iso.org.dod.internet prefix */
screamer 0:7a64fbb4069d 246 if (snmp_iso_prefix_tst(msg_ps->vb_ptr->ident_len, msg_ps->vb_ptr->ident))
screamer 0:7a64fbb4069d 247 {
screamer 0:7a64fbb4069d 248 mn = snmp_search_tree((struct mib_node*)&internet, msg_ps->vb_ptr->ident_len - 4,
screamer 0:7a64fbb4069d 249 msg_ps->vb_ptr->ident + 4, &np);
screamer 0:7a64fbb4069d 250 if (mn != NULL)
screamer 0:7a64fbb4069d 251 {
screamer 0:7a64fbb4069d 252 if (mn->node_type == MIB_NODE_EX)
screamer 0:7a64fbb4069d 253 {
screamer 0:7a64fbb4069d 254 /* external object */
screamer 0:7a64fbb4069d 255 struct mib_external_node *en = (struct mib_external_node*)mn;
screamer 0:7a64fbb4069d 256
screamer 0:7a64fbb4069d 257 msg_ps->state = SNMP_MSG_EXTERNAL_GET_OBJDEF;
screamer 0:7a64fbb4069d 258 /* save en && args in msg_ps!! */
screamer 0:7a64fbb4069d 259 msg_ps->ext_mib_node = en;
screamer 0:7a64fbb4069d 260 msg_ps->ext_name_ptr = np;
screamer 0:7a64fbb4069d 261
screamer 0:7a64fbb4069d 262 en->get_object_def_q(en->addr_inf, request_id, np.ident_len, np.ident);
screamer 0:7a64fbb4069d 263 }
screamer 0:7a64fbb4069d 264 else
screamer 0:7a64fbb4069d 265 {
screamer 0:7a64fbb4069d 266 /* internal object */
screamer 0:7a64fbb4069d 267 struct obj_def object_def;
screamer 0:7a64fbb4069d 268
screamer 0:7a64fbb4069d 269 msg_ps->state = SNMP_MSG_INTERNAL_GET_OBJDEF;
screamer 0:7a64fbb4069d 270 mn->get_object_def(np.ident_len, np.ident, &object_def);
screamer 0:7a64fbb4069d 271 if (object_def.instance != MIB_OBJECT_NONE)
screamer 0:7a64fbb4069d 272 {
screamer 0:7a64fbb4069d 273 mn = mn;
screamer 0:7a64fbb4069d 274 }
screamer 0:7a64fbb4069d 275 else
screamer 0:7a64fbb4069d 276 {
screamer 0:7a64fbb4069d 277 /* search failed, object id points to unknown object (nosuchname) */
screamer 0:7a64fbb4069d 278 mn = NULL;
screamer 0:7a64fbb4069d 279 }
screamer 0:7a64fbb4069d 280 if (mn != NULL)
screamer 0:7a64fbb4069d 281 {
screamer 0:7a64fbb4069d 282 struct snmp_varbind *vb;
screamer 0:7a64fbb4069d 283
screamer 0:7a64fbb4069d 284 msg_ps->state = SNMP_MSG_INTERNAL_GET_VALUE;
screamer 0:7a64fbb4069d 285 /* allocate output varbind */
screamer 0:7a64fbb4069d 286 vb = (struct snmp_varbind *)mem_malloc(sizeof(struct snmp_varbind));
screamer 0:7a64fbb4069d 287 LWIP_ASSERT("vb != NULL",vb != NULL);
screamer 0:7a64fbb4069d 288 if (vb != NULL)
screamer 0:7a64fbb4069d 289 {
screamer 0:7a64fbb4069d 290 vb->next = NULL;
screamer 0:7a64fbb4069d 291 vb->prev = NULL;
screamer 0:7a64fbb4069d 292
screamer 0:7a64fbb4069d 293 /* move name from invb to outvb */
screamer 0:7a64fbb4069d 294 vb->ident = msg_ps->vb_ptr->ident;
screamer 0:7a64fbb4069d 295 vb->ident_len = msg_ps->vb_ptr->ident_len;
screamer 0:7a64fbb4069d 296 /* ensure this memory is refereced once only */
screamer 0:7a64fbb4069d 297 msg_ps->vb_ptr->ident = NULL;
screamer 0:7a64fbb4069d 298 msg_ps->vb_ptr->ident_len = 0;
screamer 0:7a64fbb4069d 299
screamer 0:7a64fbb4069d 300 vb->value_type = object_def.asn_type;
screamer 0:7a64fbb4069d 301 vb->value_len = object_def.v_len;
screamer 0:7a64fbb4069d 302 if (vb->value_len > 0)
screamer 0:7a64fbb4069d 303 {
screamer 0:7a64fbb4069d 304 vb->value = mem_malloc(vb->value_len);
screamer 0:7a64fbb4069d 305 LWIP_ASSERT("vb->value != NULL",vb->value != NULL);
screamer 0:7a64fbb4069d 306 if (vb->value != NULL)
screamer 0:7a64fbb4069d 307 {
screamer 0:7a64fbb4069d 308 mn->get_value(&object_def, vb->value_len, vb->value);
screamer 0:7a64fbb4069d 309 snmp_varbind_tail_add(&msg_ps->outvb, vb);
screamer 0:7a64fbb4069d 310 msg_ps->state = SNMP_MSG_SEARCH_OBJ;
screamer 0:7a64fbb4069d 311 msg_ps->vb_idx += 1;
screamer 0:7a64fbb4069d 312 }
screamer 0:7a64fbb4069d 313 else
screamer 0:7a64fbb4069d 314 {
screamer 0:7a64fbb4069d 315 LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_event: couldn't allocate variable space\n"));
screamer 0:7a64fbb4069d 316 msg_ps->vb_ptr->ident = vb->ident;
screamer 0:7a64fbb4069d 317 msg_ps->vb_ptr->ident_len = vb->ident_len;
screamer 0:7a64fbb4069d 318 mem_free(vb);
screamer 0:7a64fbb4069d 319 snmp_error_response(msg_ps,SNMP_ES_TOOBIG);
screamer 0:7a64fbb4069d 320 }
screamer 0:7a64fbb4069d 321 }
screamer 0:7a64fbb4069d 322 else
screamer 0:7a64fbb4069d 323 {
screamer 0:7a64fbb4069d 324 /* vb->value_len == 0, empty value (e.g. empty string) */
screamer 0:7a64fbb4069d 325 vb->value = NULL;
screamer 0:7a64fbb4069d 326 snmp_varbind_tail_add(&msg_ps->outvb, vb);
screamer 0:7a64fbb4069d 327 msg_ps->state = SNMP_MSG_SEARCH_OBJ;
screamer 0:7a64fbb4069d 328 msg_ps->vb_idx += 1;
screamer 0:7a64fbb4069d 329 }
screamer 0:7a64fbb4069d 330 }
screamer 0:7a64fbb4069d 331 else
screamer 0:7a64fbb4069d 332 {
screamer 0:7a64fbb4069d 333 LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_event: couldn't allocate outvb space\n"));
screamer 0:7a64fbb4069d 334 snmp_error_response(msg_ps,SNMP_ES_TOOBIG);
screamer 0:7a64fbb4069d 335 }
screamer 0:7a64fbb4069d 336 }
screamer 0:7a64fbb4069d 337 }
screamer 0:7a64fbb4069d 338 }
screamer 0:7a64fbb4069d 339 }
screamer 0:7a64fbb4069d 340 else
screamer 0:7a64fbb4069d 341 {
screamer 0:7a64fbb4069d 342 mn = NULL;
screamer 0:7a64fbb4069d 343 }
screamer 0:7a64fbb4069d 344 if (mn == NULL)
screamer 0:7a64fbb4069d 345 {
screamer 0:7a64fbb4069d 346 /* mn == NULL, noSuchName */
screamer 0:7a64fbb4069d 347 snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
screamer 0:7a64fbb4069d 348 }
screamer 0:7a64fbb4069d 349 }
screamer 0:7a64fbb4069d 350 if ((msg_ps->state == SNMP_MSG_SEARCH_OBJ) &&
screamer 0:7a64fbb4069d 351 (msg_ps->vb_idx == msg_ps->invb.count))
screamer 0:7a64fbb4069d 352 {
screamer 0:7a64fbb4069d 353 snmp_ok_response(msg_ps);
screamer 0:7a64fbb4069d 354 }
screamer 0:7a64fbb4069d 355 }
screamer 0:7a64fbb4069d 356
screamer 0:7a64fbb4069d 357 /**
screamer 0:7a64fbb4069d 358 * Service an internal or external event for SNMP GETNEXT.
screamer 0:7a64fbb4069d 359 *
screamer 0:7a64fbb4069d 360 * @param request_id identifies requests from 0 to (SNMP_CONCURRENT_REQUESTS-1)
screamer 0:7a64fbb4069d 361 * @param msg_ps points to the assosicated message process state
screamer 0:7a64fbb4069d 362 */
screamer 0:7a64fbb4069d 363 static void
screamer 0:7a64fbb4069d 364 snmp_msg_getnext_event(u8_t request_id, struct snmp_msg_pstat *msg_ps)
screamer 0:7a64fbb4069d 365 {
screamer 0:7a64fbb4069d 366 LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_getnext_event: msg_ps->state==%"U16_F"\n",(u16_t)msg_ps->state));
screamer 0:7a64fbb4069d 367
screamer 0:7a64fbb4069d 368 if (msg_ps->state == SNMP_MSG_EXTERNAL_GET_OBJDEF)
screamer 0:7a64fbb4069d 369 {
screamer 0:7a64fbb4069d 370 struct mib_external_node *en;
screamer 0:7a64fbb4069d 371
screamer 0:7a64fbb4069d 372 /* get_object_def() answer*/
screamer 0:7a64fbb4069d 373 en = msg_ps->ext_mib_node;
screamer 0:7a64fbb4069d 374
screamer 0:7a64fbb4069d 375 /* translate answer into a known lifeform */
screamer 0:7a64fbb4069d 376 en->get_object_def_a(request_id, 1, &msg_ps->ext_oid.id[msg_ps->ext_oid.len - 1], &msg_ps->ext_object_def);
screamer 0:7a64fbb4069d 377 if (msg_ps->ext_object_def.instance != MIB_OBJECT_NONE)
screamer 0:7a64fbb4069d 378 {
screamer 0:7a64fbb4069d 379 msg_ps->state = SNMP_MSG_EXTERNAL_GET_VALUE;
screamer 0:7a64fbb4069d 380 en->get_value_q(request_id, &msg_ps->ext_object_def);
screamer 0:7a64fbb4069d 381 }
screamer 0:7a64fbb4069d 382 else
screamer 0:7a64fbb4069d 383 {
screamer 0:7a64fbb4069d 384 en->get_object_def_pc(request_id, 1, &msg_ps->ext_oid.id[msg_ps->ext_oid.len - 1]);
screamer 0:7a64fbb4069d 385 /* search failed, object id points to unknown object (nosuchname) */
screamer 0:7a64fbb4069d 386 snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
screamer 0:7a64fbb4069d 387 }
screamer 0:7a64fbb4069d 388 }
screamer 0:7a64fbb4069d 389 else if (msg_ps->state == SNMP_MSG_EXTERNAL_GET_VALUE)
screamer 0:7a64fbb4069d 390 {
screamer 0:7a64fbb4069d 391 struct mib_external_node *en;
screamer 0:7a64fbb4069d 392 struct snmp_varbind *vb;
screamer 0:7a64fbb4069d 393
screamer 0:7a64fbb4069d 394 /* get_value() answer */
screamer 0:7a64fbb4069d 395 en = msg_ps->ext_mib_node;
screamer 0:7a64fbb4069d 396
screamer 0:7a64fbb4069d 397 vb = snmp_varbind_alloc(&msg_ps->ext_oid,
screamer 0:7a64fbb4069d 398 msg_ps->ext_object_def.asn_type,
screamer 0:7a64fbb4069d 399 msg_ps->ext_object_def.v_len);
screamer 0:7a64fbb4069d 400 if (vb != NULL)
screamer 0:7a64fbb4069d 401 {
screamer 0:7a64fbb4069d 402 en->get_value_a(request_id, &msg_ps->ext_object_def, vb->value_len, vb->value);
screamer 0:7a64fbb4069d 403 snmp_varbind_tail_add(&msg_ps->outvb, vb);
screamer 0:7a64fbb4069d 404 msg_ps->state = SNMP_MSG_SEARCH_OBJ;
screamer 0:7a64fbb4069d 405 msg_ps->vb_idx += 1;
screamer 0:7a64fbb4069d 406 }
screamer 0:7a64fbb4069d 407 else
screamer 0:7a64fbb4069d 408 {
screamer 0:7a64fbb4069d 409 en->get_value_pc(request_id, &msg_ps->ext_object_def);
screamer 0:7a64fbb4069d 410 LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_getnext_event: couldn't allocate outvb space\n"));
screamer 0:7a64fbb4069d 411 snmp_error_response(msg_ps,SNMP_ES_TOOBIG);
screamer 0:7a64fbb4069d 412 }
screamer 0:7a64fbb4069d 413 }
screamer 0:7a64fbb4069d 414
screamer 0:7a64fbb4069d 415 while ((msg_ps->state == SNMP_MSG_SEARCH_OBJ) &&
screamer 0:7a64fbb4069d 416 (msg_ps->vb_idx < msg_ps->invb.count))
screamer 0:7a64fbb4069d 417 {
screamer 0:7a64fbb4069d 418 struct mib_node *mn;
screamer 0:7a64fbb4069d 419 struct snmp_obj_id oid;
screamer 0:7a64fbb4069d 420
screamer 0:7a64fbb4069d 421 if (msg_ps->vb_idx == 0)
screamer 0:7a64fbb4069d 422 {
screamer 0:7a64fbb4069d 423 msg_ps->vb_ptr = msg_ps->invb.head;
screamer 0:7a64fbb4069d 424 }
screamer 0:7a64fbb4069d 425 else
screamer 0:7a64fbb4069d 426 {
screamer 0:7a64fbb4069d 427 msg_ps->vb_ptr = msg_ps->vb_ptr->next;
screamer 0:7a64fbb4069d 428 }
screamer 0:7a64fbb4069d 429 if (snmp_iso_prefix_expand(msg_ps->vb_ptr->ident_len, msg_ps->vb_ptr->ident, &oid))
screamer 0:7a64fbb4069d 430 {
screamer 0:7a64fbb4069d 431 if (msg_ps->vb_ptr->ident_len > 3)
screamer 0:7a64fbb4069d 432 {
screamer 0:7a64fbb4069d 433 /* can offset ident_len and ident */
screamer 0:7a64fbb4069d 434 mn = snmp_expand_tree((struct mib_node*)&internet,
screamer 0:7a64fbb4069d 435 msg_ps->vb_ptr->ident_len - 4,
screamer 0:7a64fbb4069d 436 msg_ps->vb_ptr->ident + 4, &oid);
screamer 0:7a64fbb4069d 437 }
screamer 0:7a64fbb4069d 438 else
screamer 0:7a64fbb4069d 439 {
screamer 0:7a64fbb4069d 440 /* can't offset ident_len -4, ident + 4 */
screamer 0:7a64fbb4069d 441 mn = snmp_expand_tree((struct mib_node*)&internet, 0, NULL, &oid);
screamer 0:7a64fbb4069d 442 }
screamer 0:7a64fbb4069d 443 }
screamer 0:7a64fbb4069d 444 else
screamer 0:7a64fbb4069d 445 {
screamer 0:7a64fbb4069d 446 mn = NULL;
screamer 0:7a64fbb4069d 447 }
screamer 0:7a64fbb4069d 448 if (mn != NULL)
screamer 0:7a64fbb4069d 449 {
screamer 0:7a64fbb4069d 450 if (mn->node_type == MIB_NODE_EX)
screamer 0:7a64fbb4069d 451 {
screamer 0:7a64fbb4069d 452 /* external object */
screamer 0:7a64fbb4069d 453 struct mib_external_node *en = (struct mib_external_node*)mn;
screamer 0:7a64fbb4069d 454
screamer 0:7a64fbb4069d 455 msg_ps->state = SNMP_MSG_EXTERNAL_GET_OBJDEF;
screamer 0:7a64fbb4069d 456 /* save en && args in msg_ps!! */
screamer 0:7a64fbb4069d 457 msg_ps->ext_mib_node = en;
screamer 0:7a64fbb4069d 458 msg_ps->ext_oid = oid;
screamer 0:7a64fbb4069d 459
screamer 0:7a64fbb4069d 460 en->get_object_def_q(en->addr_inf, request_id, 1, &oid.id[oid.len - 1]);
screamer 0:7a64fbb4069d 461 }
screamer 0:7a64fbb4069d 462 else
screamer 0:7a64fbb4069d 463 {
screamer 0:7a64fbb4069d 464 /* internal object */
screamer 0:7a64fbb4069d 465 struct obj_def object_def;
screamer 0:7a64fbb4069d 466 struct snmp_varbind *vb;
screamer 0:7a64fbb4069d 467
screamer 0:7a64fbb4069d 468 msg_ps->state = SNMP_MSG_INTERNAL_GET_OBJDEF;
screamer 0:7a64fbb4069d 469 mn->get_object_def(1, &oid.id[oid.len - 1], &object_def);
screamer 0:7a64fbb4069d 470
screamer 0:7a64fbb4069d 471 vb = snmp_varbind_alloc(&oid, object_def.asn_type, object_def.v_len);
screamer 0:7a64fbb4069d 472 if (vb != NULL)
screamer 0:7a64fbb4069d 473 {
screamer 0:7a64fbb4069d 474 msg_ps->state = SNMP_MSG_INTERNAL_GET_VALUE;
screamer 0:7a64fbb4069d 475 mn->get_value(&object_def, object_def.v_len, vb->value);
screamer 0:7a64fbb4069d 476 snmp_varbind_tail_add(&msg_ps->outvb, vb);
screamer 0:7a64fbb4069d 477 msg_ps->state = SNMP_MSG_SEARCH_OBJ;
screamer 0:7a64fbb4069d 478 msg_ps->vb_idx += 1;
screamer 0:7a64fbb4069d 479 }
screamer 0:7a64fbb4069d 480 else
screamer 0:7a64fbb4069d 481 {
screamer 0:7a64fbb4069d 482 LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_recv couldn't allocate outvb space\n"));
screamer 0:7a64fbb4069d 483 snmp_error_response(msg_ps,SNMP_ES_TOOBIG);
screamer 0:7a64fbb4069d 484 }
screamer 0:7a64fbb4069d 485 }
screamer 0:7a64fbb4069d 486 }
screamer 0:7a64fbb4069d 487 if (mn == NULL)
screamer 0:7a64fbb4069d 488 {
screamer 0:7a64fbb4069d 489 /* mn == NULL, noSuchName */
screamer 0:7a64fbb4069d 490 snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
screamer 0:7a64fbb4069d 491 }
screamer 0:7a64fbb4069d 492 }
screamer 0:7a64fbb4069d 493 if ((msg_ps->state == SNMP_MSG_SEARCH_OBJ) &&
screamer 0:7a64fbb4069d 494 (msg_ps->vb_idx == msg_ps->invb.count))
screamer 0:7a64fbb4069d 495 {
screamer 0:7a64fbb4069d 496 snmp_ok_response(msg_ps);
screamer 0:7a64fbb4069d 497 }
screamer 0:7a64fbb4069d 498 }
screamer 0:7a64fbb4069d 499
screamer 0:7a64fbb4069d 500 /**
screamer 0:7a64fbb4069d 501 * Service an internal or external event for SNMP SET.
screamer 0:7a64fbb4069d 502 *
screamer 0:7a64fbb4069d 503 * @param request_id identifies requests from 0 to (SNMP_CONCURRENT_REQUESTS-1)
screamer 0:7a64fbb4069d 504 * @param msg_ps points to the assosicated message process state
screamer 0:7a64fbb4069d 505 */
screamer 0:7a64fbb4069d 506 static void
screamer 0:7a64fbb4069d 507 snmp_msg_set_event(u8_t request_id, struct snmp_msg_pstat *msg_ps)
screamer 0:7a64fbb4069d 508 {
screamer 0:7a64fbb4069d 509 LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_msg_set_event: msg_ps->state==%"U16_F"\n",(u16_t)msg_ps->state));
screamer 0:7a64fbb4069d 510
screamer 0:7a64fbb4069d 511 if (msg_ps->state == SNMP_MSG_EXTERNAL_GET_OBJDEF)
screamer 0:7a64fbb4069d 512 {
screamer 0:7a64fbb4069d 513 struct mib_external_node *en;
screamer 0:7a64fbb4069d 514 struct snmp_name_ptr np;
screamer 0:7a64fbb4069d 515
screamer 0:7a64fbb4069d 516 /* get_object_def() answer*/
screamer 0:7a64fbb4069d 517 en = msg_ps->ext_mib_node;
screamer 0:7a64fbb4069d 518 np = msg_ps->ext_name_ptr;
screamer 0:7a64fbb4069d 519
screamer 0:7a64fbb4069d 520 /* translate answer into a known lifeform */
screamer 0:7a64fbb4069d 521 en->get_object_def_a(request_id, np.ident_len, np.ident, &msg_ps->ext_object_def);
screamer 0:7a64fbb4069d 522 if (msg_ps->ext_object_def.instance != MIB_OBJECT_NONE)
screamer 0:7a64fbb4069d 523 {
screamer 0:7a64fbb4069d 524 msg_ps->state = SNMP_MSG_EXTERNAL_SET_TEST;
screamer 0:7a64fbb4069d 525 en->set_test_q(request_id, &msg_ps->ext_object_def);
screamer 0:7a64fbb4069d 526 }
screamer 0:7a64fbb4069d 527 else
screamer 0:7a64fbb4069d 528 {
screamer 0:7a64fbb4069d 529 en->get_object_def_pc(request_id, np.ident_len, np.ident);
screamer 0:7a64fbb4069d 530 /* search failed, object id points to unknown object (nosuchname) */
screamer 0:7a64fbb4069d 531 snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
screamer 0:7a64fbb4069d 532 }
screamer 0:7a64fbb4069d 533 }
screamer 0:7a64fbb4069d 534 else if (msg_ps->state == SNMP_MSG_EXTERNAL_SET_TEST)
screamer 0:7a64fbb4069d 535 {
screamer 0:7a64fbb4069d 536 struct mib_external_node *en;
screamer 0:7a64fbb4069d 537
screamer 0:7a64fbb4069d 538 /* set_test() answer*/
screamer 0:7a64fbb4069d 539 en = msg_ps->ext_mib_node;
screamer 0:7a64fbb4069d 540
screamer 0:7a64fbb4069d 541 if (msg_ps->ext_object_def.access == MIB_OBJECT_READ_WRITE)
screamer 0:7a64fbb4069d 542 {
screamer 0:7a64fbb4069d 543 if ((msg_ps->ext_object_def.asn_type == msg_ps->vb_ptr->value_type) &&
screamer 0:7a64fbb4069d 544 (en->set_test_a(request_id,&msg_ps->ext_object_def,
screamer 0:7a64fbb4069d 545 msg_ps->vb_ptr->value_len,msg_ps->vb_ptr->value) != 0))
screamer 0:7a64fbb4069d 546 {
screamer 0:7a64fbb4069d 547 msg_ps->state = SNMP_MSG_SEARCH_OBJ;
screamer 0:7a64fbb4069d 548 msg_ps->vb_idx += 1;
screamer 0:7a64fbb4069d 549 }
screamer 0:7a64fbb4069d 550 else
screamer 0:7a64fbb4069d 551 {
screamer 0:7a64fbb4069d 552 en->set_test_pc(request_id,&msg_ps->ext_object_def);
screamer 0:7a64fbb4069d 553 /* bad value */
screamer 0:7a64fbb4069d 554 snmp_error_response(msg_ps,SNMP_ES_BADVALUE);
screamer 0:7a64fbb4069d 555 }
screamer 0:7a64fbb4069d 556 }
screamer 0:7a64fbb4069d 557 else
screamer 0:7a64fbb4069d 558 {
screamer 0:7a64fbb4069d 559 en->set_test_pc(request_id,&msg_ps->ext_object_def);
screamer 0:7a64fbb4069d 560 /* object not available for set */
screamer 0:7a64fbb4069d 561 snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
screamer 0:7a64fbb4069d 562 }
screamer 0:7a64fbb4069d 563 }
screamer 0:7a64fbb4069d 564 else if (msg_ps->state == SNMP_MSG_EXTERNAL_GET_OBJDEF_S)
screamer 0:7a64fbb4069d 565 {
screamer 0:7a64fbb4069d 566 struct mib_external_node *en;
screamer 0:7a64fbb4069d 567 struct snmp_name_ptr np;
screamer 0:7a64fbb4069d 568
screamer 0:7a64fbb4069d 569 /* get_object_def() answer*/
screamer 0:7a64fbb4069d 570 en = msg_ps->ext_mib_node;
screamer 0:7a64fbb4069d 571 np = msg_ps->ext_name_ptr;
screamer 0:7a64fbb4069d 572
screamer 0:7a64fbb4069d 573 /* translate answer into a known lifeform */
screamer 0:7a64fbb4069d 574 en->get_object_def_a(request_id, np.ident_len, np.ident, &msg_ps->ext_object_def);
screamer 0:7a64fbb4069d 575 if (msg_ps->ext_object_def.instance != MIB_OBJECT_NONE)
screamer 0:7a64fbb4069d 576 {
screamer 0:7a64fbb4069d 577 msg_ps->state = SNMP_MSG_EXTERNAL_SET_VALUE;
screamer 0:7a64fbb4069d 578 en->set_value_q(request_id, &msg_ps->ext_object_def,
screamer 0:7a64fbb4069d 579 msg_ps->vb_ptr->value_len,msg_ps->vb_ptr->value);
screamer 0:7a64fbb4069d 580 }
screamer 0:7a64fbb4069d 581 else
screamer 0:7a64fbb4069d 582 {
screamer 0:7a64fbb4069d 583 en->get_object_def_pc(request_id, np.ident_len, np.ident);
screamer 0:7a64fbb4069d 584 /* set_value failed, object has disappeared for some odd reason?? */
screamer 0:7a64fbb4069d 585 snmp_error_response(msg_ps,SNMP_ES_GENERROR);
screamer 0:7a64fbb4069d 586 }
screamer 0:7a64fbb4069d 587 }
screamer 0:7a64fbb4069d 588 else if (msg_ps->state == SNMP_MSG_EXTERNAL_SET_VALUE)
screamer 0:7a64fbb4069d 589 {
screamer 0:7a64fbb4069d 590 struct mib_external_node *en;
screamer 0:7a64fbb4069d 591
screamer 0:7a64fbb4069d 592 /** set_value_a() @todo: use reply value?? */
screamer 0:7a64fbb4069d 593 en = msg_ps->ext_mib_node;
screamer 0:7a64fbb4069d 594 en->set_value_a(request_id, &msg_ps->ext_object_def, 0, NULL);
screamer 0:7a64fbb4069d 595
screamer 0:7a64fbb4069d 596 /** @todo use set_value_pc() if toobig */
screamer 0:7a64fbb4069d 597 msg_ps->state = SNMP_MSG_INTERNAL_SET_VALUE;
screamer 0:7a64fbb4069d 598 msg_ps->vb_idx += 1;
screamer 0:7a64fbb4069d 599 }
screamer 0:7a64fbb4069d 600
screamer 0:7a64fbb4069d 601 /* test all values before setting */
screamer 0:7a64fbb4069d 602 while ((msg_ps->state == SNMP_MSG_SEARCH_OBJ) &&
screamer 0:7a64fbb4069d 603 (msg_ps->vb_idx < msg_ps->invb.count))
screamer 0:7a64fbb4069d 604 {
screamer 0:7a64fbb4069d 605 struct mib_node *mn;
screamer 0:7a64fbb4069d 606 struct snmp_name_ptr np;
screamer 0:7a64fbb4069d 607
screamer 0:7a64fbb4069d 608 if (msg_ps->vb_idx == 0)
screamer 0:7a64fbb4069d 609 {
screamer 0:7a64fbb4069d 610 msg_ps->vb_ptr = msg_ps->invb.head;
screamer 0:7a64fbb4069d 611 }
screamer 0:7a64fbb4069d 612 else
screamer 0:7a64fbb4069d 613 {
screamer 0:7a64fbb4069d 614 msg_ps->vb_ptr = msg_ps->vb_ptr->next;
screamer 0:7a64fbb4069d 615 }
screamer 0:7a64fbb4069d 616 /** test object identifier for .iso.org.dod.internet prefix */
screamer 0:7a64fbb4069d 617 if (snmp_iso_prefix_tst(msg_ps->vb_ptr->ident_len, msg_ps->vb_ptr->ident))
screamer 0:7a64fbb4069d 618 {
screamer 0:7a64fbb4069d 619 mn = snmp_search_tree((struct mib_node*)&internet, msg_ps->vb_ptr->ident_len - 4,
screamer 0:7a64fbb4069d 620 msg_ps->vb_ptr->ident + 4, &np);
screamer 0:7a64fbb4069d 621 if (mn != NULL)
screamer 0:7a64fbb4069d 622 {
screamer 0:7a64fbb4069d 623 if (mn->node_type == MIB_NODE_EX)
screamer 0:7a64fbb4069d 624 {
screamer 0:7a64fbb4069d 625 /* external object */
screamer 0:7a64fbb4069d 626 struct mib_external_node *en = (struct mib_external_node*)mn;
screamer 0:7a64fbb4069d 627
screamer 0:7a64fbb4069d 628 msg_ps->state = SNMP_MSG_EXTERNAL_GET_OBJDEF;
screamer 0:7a64fbb4069d 629 /* save en && args in msg_ps!! */
screamer 0:7a64fbb4069d 630 msg_ps->ext_mib_node = en;
screamer 0:7a64fbb4069d 631 msg_ps->ext_name_ptr = np;
screamer 0:7a64fbb4069d 632
screamer 0:7a64fbb4069d 633 en->get_object_def_q(en->addr_inf, request_id, np.ident_len, np.ident);
screamer 0:7a64fbb4069d 634 }
screamer 0:7a64fbb4069d 635 else
screamer 0:7a64fbb4069d 636 {
screamer 0:7a64fbb4069d 637 /* internal object */
screamer 0:7a64fbb4069d 638 struct obj_def object_def;
screamer 0:7a64fbb4069d 639
screamer 0:7a64fbb4069d 640 msg_ps->state = SNMP_MSG_INTERNAL_GET_OBJDEF;
screamer 0:7a64fbb4069d 641 mn->get_object_def(np.ident_len, np.ident, &object_def);
screamer 0:7a64fbb4069d 642 if (object_def.instance != MIB_OBJECT_NONE)
screamer 0:7a64fbb4069d 643 {
screamer 0:7a64fbb4069d 644 mn = mn;
screamer 0:7a64fbb4069d 645 }
screamer 0:7a64fbb4069d 646 else
screamer 0:7a64fbb4069d 647 {
screamer 0:7a64fbb4069d 648 /* search failed, object id points to unknown object (nosuchname) */
screamer 0:7a64fbb4069d 649 mn = NULL;
screamer 0:7a64fbb4069d 650 }
screamer 0:7a64fbb4069d 651 if (mn != NULL)
screamer 0:7a64fbb4069d 652 {
screamer 0:7a64fbb4069d 653 msg_ps->state = SNMP_MSG_INTERNAL_SET_TEST;
screamer 0:7a64fbb4069d 654
screamer 0:7a64fbb4069d 655 if (object_def.access == MIB_OBJECT_READ_WRITE)
screamer 0:7a64fbb4069d 656 {
screamer 0:7a64fbb4069d 657 if ((object_def.asn_type == msg_ps->vb_ptr->value_type) &&
screamer 0:7a64fbb4069d 658 (mn->set_test(&object_def,msg_ps->vb_ptr->value_len,msg_ps->vb_ptr->value) != 0))
screamer 0:7a64fbb4069d 659 {
screamer 0:7a64fbb4069d 660 msg_ps->state = SNMP_MSG_SEARCH_OBJ;
screamer 0:7a64fbb4069d 661 msg_ps->vb_idx += 1;
screamer 0:7a64fbb4069d 662 }
screamer 0:7a64fbb4069d 663 else
screamer 0:7a64fbb4069d 664 {
screamer 0:7a64fbb4069d 665 /* bad value */
screamer 0:7a64fbb4069d 666 snmp_error_response(msg_ps,SNMP_ES_BADVALUE);
screamer 0:7a64fbb4069d 667 }
screamer 0:7a64fbb4069d 668 }
screamer 0:7a64fbb4069d 669 else
screamer 0:7a64fbb4069d 670 {
screamer 0:7a64fbb4069d 671 /* object not available for set */
screamer 0:7a64fbb4069d 672 snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
screamer 0:7a64fbb4069d 673 }
screamer 0:7a64fbb4069d 674 }
screamer 0:7a64fbb4069d 675 }
screamer 0:7a64fbb4069d 676 }
screamer 0:7a64fbb4069d 677 }
screamer 0:7a64fbb4069d 678 else
screamer 0:7a64fbb4069d 679 {
screamer 0:7a64fbb4069d 680 mn = NULL;
screamer 0:7a64fbb4069d 681 }
screamer 0:7a64fbb4069d 682 if (mn == NULL)
screamer 0:7a64fbb4069d 683 {
screamer 0:7a64fbb4069d 684 /* mn == NULL, noSuchName */
screamer 0:7a64fbb4069d 685 snmp_error_response(msg_ps,SNMP_ES_NOSUCHNAME);
screamer 0:7a64fbb4069d 686 }
screamer 0:7a64fbb4069d 687 }
screamer 0:7a64fbb4069d 688
screamer 0:7a64fbb4069d 689 if ((msg_ps->state == SNMP_MSG_SEARCH_OBJ) &&
screamer 0:7a64fbb4069d 690 (msg_ps->vb_idx == msg_ps->invb.count))
screamer 0:7a64fbb4069d 691 {
screamer 0:7a64fbb4069d 692 msg_ps->vb_idx = 0;
screamer 0:7a64fbb4069d 693 msg_ps->state = SNMP_MSG_INTERNAL_SET_VALUE;
screamer 0:7a64fbb4069d 694 }
screamer 0:7a64fbb4069d 695
screamer 0:7a64fbb4069d 696 /* set all values "atomically" (be as "atomic" as possible) */
screamer 0:7a64fbb4069d 697 while ((msg_ps->state == SNMP_MSG_INTERNAL_SET_VALUE) &&
screamer 0:7a64fbb4069d 698 (msg_ps->vb_idx < msg_ps->invb.count))
screamer 0:7a64fbb4069d 699 {
screamer 0:7a64fbb4069d 700 struct mib_node *mn;
screamer 0:7a64fbb4069d 701 struct snmp_name_ptr np;
screamer 0:7a64fbb4069d 702
screamer 0:7a64fbb4069d 703 if (msg_ps->vb_idx == 0)
screamer 0:7a64fbb4069d 704 {
screamer 0:7a64fbb4069d 705 msg_ps->vb_ptr = msg_ps->invb.head;
screamer 0:7a64fbb4069d 706 }
screamer 0:7a64fbb4069d 707 else
screamer 0:7a64fbb4069d 708 {
screamer 0:7a64fbb4069d 709 msg_ps->vb_ptr = msg_ps->vb_ptr->next;
screamer 0:7a64fbb4069d 710 }
screamer 0:7a64fbb4069d 711 /* skip iso prefix test, was done previously while settesting() */
screamer 0:7a64fbb4069d 712 mn = snmp_search_tree((struct mib_node*)&internet, msg_ps->vb_ptr->ident_len - 4,
screamer 0:7a64fbb4069d 713 msg_ps->vb_ptr->ident + 4, &np);
screamer 0:7a64fbb4069d 714 /* check if object is still available
screamer 0:7a64fbb4069d 715 (e.g. external hot-plug thingy present?) */
screamer 0:7a64fbb4069d 716 if (mn != NULL)
screamer 0:7a64fbb4069d 717 {
screamer 0:7a64fbb4069d 718 if (mn->node_type == MIB_NODE_EX)
screamer 0:7a64fbb4069d 719 {
screamer 0:7a64fbb4069d 720 /* external object */
screamer 0:7a64fbb4069d 721 struct mib_external_node *en = (struct mib_external_node*)mn;
screamer 0:7a64fbb4069d 722
screamer 0:7a64fbb4069d 723 msg_ps->state = SNMP_MSG_EXTERNAL_GET_OBJDEF_S;
screamer 0:7a64fbb4069d 724 /* save en && args in msg_ps!! */
screamer 0:7a64fbb4069d 725 msg_ps->ext_mib_node = en;
screamer 0:7a64fbb4069d 726 msg_ps->ext_name_ptr = np;
screamer 0:7a64fbb4069d 727
screamer 0:7a64fbb4069d 728 en->get_object_def_q(en->addr_inf, request_id, np.ident_len, np.ident);
screamer 0:7a64fbb4069d 729 }
screamer 0:7a64fbb4069d 730 else
screamer 0:7a64fbb4069d 731 {
screamer 0:7a64fbb4069d 732 /* internal object */
screamer 0:7a64fbb4069d 733 struct obj_def object_def;
screamer 0:7a64fbb4069d 734
screamer 0:7a64fbb4069d 735 msg_ps->state = SNMP_MSG_INTERNAL_GET_OBJDEF_S;
screamer 0:7a64fbb4069d 736 mn->get_object_def(np.ident_len, np.ident, &object_def);
screamer 0:7a64fbb4069d 737 msg_ps->state = SNMP_MSG_INTERNAL_SET_VALUE;
screamer 0:7a64fbb4069d 738 mn->set_value(&object_def,msg_ps->vb_ptr->value_len,msg_ps->vb_ptr->value);
screamer 0:7a64fbb4069d 739 msg_ps->vb_idx += 1;
screamer 0:7a64fbb4069d 740 }
screamer 0:7a64fbb4069d 741 }
screamer 0:7a64fbb4069d 742 }
screamer 0:7a64fbb4069d 743 if ((msg_ps->state == SNMP_MSG_INTERNAL_SET_VALUE) &&
screamer 0:7a64fbb4069d 744 (msg_ps->vb_idx == msg_ps->invb.count))
screamer 0:7a64fbb4069d 745 {
screamer 0:7a64fbb4069d 746 /* simply echo the input if we can set it
screamer 0:7a64fbb4069d 747 @todo do we need to return the actual value?
screamer 0:7a64fbb4069d 748 e.g. if value is silently modified or behaves sticky? */
screamer 0:7a64fbb4069d 749 msg_ps->outvb = msg_ps->invb;
screamer 0:7a64fbb4069d 750 msg_ps->invb.head = NULL;
screamer 0:7a64fbb4069d 751 msg_ps->invb.tail = NULL;
screamer 0:7a64fbb4069d 752 msg_ps->invb.count = 0;
screamer 0:7a64fbb4069d 753 snmp_ok_response(msg_ps);
screamer 0:7a64fbb4069d 754 }
screamer 0:7a64fbb4069d 755 }
screamer 0:7a64fbb4069d 756
screamer 0:7a64fbb4069d 757
screamer 0:7a64fbb4069d 758 /**
screamer 0:7a64fbb4069d 759 * Handle one internal or external event.
screamer 0:7a64fbb4069d 760 * Called for one async event. (recv external/private answer)
screamer 0:7a64fbb4069d 761 *
screamer 0:7a64fbb4069d 762 * @param request_id identifies requests from 0 to (SNMP_CONCURRENT_REQUESTS-1)
screamer 0:7a64fbb4069d 763 */
screamer 0:7a64fbb4069d 764 void
screamer 0:7a64fbb4069d 765 snmp_msg_event(u8_t request_id)
screamer 0:7a64fbb4069d 766 {
screamer 0:7a64fbb4069d 767 struct snmp_msg_pstat *msg_ps;
screamer 0:7a64fbb4069d 768
screamer 0:7a64fbb4069d 769 if (request_id < SNMP_CONCURRENT_REQUESTS)
screamer 0:7a64fbb4069d 770 {
screamer 0:7a64fbb4069d 771 msg_ps = &msg_input_list[request_id];
screamer 0:7a64fbb4069d 772 if (msg_ps->rt == SNMP_ASN1_PDU_GET_NEXT_REQ)
screamer 0:7a64fbb4069d 773 {
screamer 0:7a64fbb4069d 774 snmp_msg_getnext_event(request_id, msg_ps);
screamer 0:7a64fbb4069d 775 }
screamer 0:7a64fbb4069d 776 else if (msg_ps->rt == SNMP_ASN1_PDU_GET_REQ)
screamer 0:7a64fbb4069d 777 {
screamer 0:7a64fbb4069d 778 snmp_msg_get_event(request_id, msg_ps);
screamer 0:7a64fbb4069d 779 }
screamer 0:7a64fbb4069d 780 else if(msg_ps->rt == SNMP_ASN1_PDU_SET_REQ)
screamer 0:7a64fbb4069d 781 {
screamer 0:7a64fbb4069d 782 snmp_msg_set_event(request_id, msg_ps);
screamer 0:7a64fbb4069d 783 }
screamer 0:7a64fbb4069d 784 }
screamer 0:7a64fbb4069d 785 }
screamer 0:7a64fbb4069d 786
screamer 0:7a64fbb4069d 787
screamer 0:7a64fbb4069d 788 /* lwIP UDP receive callback function */
screamer 0:7a64fbb4069d 789 static void
screamer 0:7a64fbb4069d 790 snmp_recv(void *arg, struct udp_pcb *pcb, struct pbuf *p, struct ip_addr *addr, u16_t port)
screamer 0:7a64fbb4069d 791 {
screamer 0:7a64fbb4069d 792 struct udp_hdr *udphdr;
screamer 0:7a64fbb4069d 793
screamer 0:7a64fbb4069d 794 /* suppress unused argument warning */
screamer 0:7a64fbb4069d 795 LWIP_UNUSED_ARG(arg);
screamer 0:7a64fbb4069d 796 /* peek in the UDP header (goto IP payload) */
screamer 0:7a64fbb4069d 797 if(pbuf_header(p, UDP_HLEN)){
screamer 0:7a64fbb4069d 798 LWIP_ASSERT("Can't move to UDP header", 0);
screamer 0:7a64fbb4069d 799 pbuf_free(p);
screamer 0:7a64fbb4069d 800 return;
screamer 0:7a64fbb4069d 801 }
screamer 0:7a64fbb4069d 802 udphdr = p->payload;
screamer 0:7a64fbb4069d 803
screamer 0:7a64fbb4069d 804 /* check if datagram is really directed at us (including broadcast requests) */
screamer 0:7a64fbb4069d 805 if ((pcb == snmp1_pcb) && (ntohs(udphdr->dest) == SNMP_IN_PORT))
screamer 0:7a64fbb4069d 806 {
screamer 0:7a64fbb4069d 807 struct snmp_msg_pstat *msg_ps;
screamer 0:7a64fbb4069d 808 u8_t req_idx;
screamer 0:7a64fbb4069d 809
screamer 0:7a64fbb4069d 810 /* traverse input message process list, look for SNMP_MSG_EMPTY */
screamer 0:7a64fbb4069d 811 msg_ps = &msg_input_list[0];
screamer 0:7a64fbb4069d 812 req_idx = 0;
screamer 0:7a64fbb4069d 813 while ((req_idx<SNMP_CONCURRENT_REQUESTS) && (msg_ps->state != SNMP_MSG_EMPTY))
screamer 0:7a64fbb4069d 814 {
screamer 0:7a64fbb4069d 815 req_idx++;
screamer 0:7a64fbb4069d 816 msg_ps++;
screamer 0:7a64fbb4069d 817 }
screamer 0:7a64fbb4069d 818 if (req_idx != SNMP_CONCURRENT_REQUESTS)
screamer 0:7a64fbb4069d 819 {
screamer 0:7a64fbb4069d 820 err_t err_ret;
screamer 0:7a64fbb4069d 821 u16_t payload_len;
screamer 0:7a64fbb4069d 822 u16_t payload_ofs;
screamer 0:7a64fbb4069d 823 u16_t varbind_ofs = 0;
screamer 0:7a64fbb4069d 824
screamer 0:7a64fbb4069d 825 /* accepting request */
screamer 0:7a64fbb4069d 826 snmp_inc_snmpinpkts();
screamer 0:7a64fbb4069d 827 /* record used 'protocol control block' */
screamer 0:7a64fbb4069d 828 msg_ps->pcb = pcb;
screamer 0:7a64fbb4069d 829 /* source address (network order) */
screamer 0:7a64fbb4069d 830 msg_ps->sip = *addr;
screamer 0:7a64fbb4069d 831 /* source port (host order (lwIP oddity)) */
screamer 0:7a64fbb4069d 832 msg_ps->sp = port;
screamer 0:7a64fbb4069d 833 /* read UDP payload length from UDP header */
screamer 0:7a64fbb4069d 834 payload_len = ntohs(udphdr->len) - UDP_HLEN;
screamer 0:7a64fbb4069d 835
screamer 0:7a64fbb4069d 836 /* adjust to UDP payload */
screamer 0:7a64fbb4069d 837 payload_ofs = UDP_HLEN;
screamer 0:7a64fbb4069d 838
screamer 0:7a64fbb4069d 839 /* check total length, version, community, pdu type */
screamer 0:7a64fbb4069d 840 err_ret = snmp_pdu_header_check(p, payload_ofs, payload_len, &varbind_ofs, msg_ps);
screamer 0:7a64fbb4069d 841 if (((msg_ps->rt == SNMP_ASN1_PDU_GET_REQ) ||
screamer 0:7a64fbb4069d 842 (msg_ps->rt == SNMP_ASN1_PDU_GET_NEXT_REQ) ||
screamer 0:7a64fbb4069d 843 (msg_ps->rt == SNMP_ASN1_PDU_SET_REQ)) &&
screamer 0:7a64fbb4069d 844 ((msg_ps->error_status == SNMP_ES_NOERROR) &&
screamer 0:7a64fbb4069d 845 (msg_ps->error_index == 0)) )
screamer 0:7a64fbb4069d 846 {
screamer 0:7a64fbb4069d 847 /* Only accept requests and requests without error (be robust) */
screamer 0:7a64fbb4069d 848 err_ret = err_ret;
screamer 0:7a64fbb4069d 849 }
screamer 0:7a64fbb4069d 850 else
screamer 0:7a64fbb4069d 851 {
screamer 0:7a64fbb4069d 852 /* Reject response and trap headers or error requests as input! */
screamer 0:7a64fbb4069d 853 err_ret = ERR_ARG;
screamer 0:7a64fbb4069d 854 }
screamer 0:7a64fbb4069d 855 if (err_ret == ERR_OK)
screamer 0:7a64fbb4069d 856 {
screamer 0:7a64fbb4069d 857 LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_recv ok, community %s\n", msg_ps->community));
screamer 0:7a64fbb4069d 858
screamer 0:7a64fbb4069d 859 /* Builds a list of variable bindings. Copy the varbinds from the pbuf
screamer 0:7a64fbb4069d 860 chain to glue them when these are divided over two or more pbuf's. */
screamer 0:7a64fbb4069d 861 err_ret = snmp_pdu_dec_varbindlist(p, varbind_ofs, &varbind_ofs, msg_ps);
screamer 0:7a64fbb4069d 862 if ((err_ret == ERR_OK) && (msg_ps->invb.count > 0))
screamer 0:7a64fbb4069d 863 {
screamer 0:7a64fbb4069d 864 /* we've decoded the incoming message, release input msg now */
screamer 0:7a64fbb4069d 865 pbuf_free(p);
screamer 0:7a64fbb4069d 866
screamer 0:7a64fbb4069d 867 msg_ps->error_status = SNMP_ES_NOERROR;
screamer 0:7a64fbb4069d 868 msg_ps->error_index = 0;
screamer 0:7a64fbb4069d 869 /* find object for each variable binding */
screamer 0:7a64fbb4069d 870 msg_ps->state = SNMP_MSG_SEARCH_OBJ;
screamer 0:7a64fbb4069d 871 /* first variable binding from list to inspect */
screamer 0:7a64fbb4069d 872 msg_ps->vb_idx = 0;
screamer 0:7a64fbb4069d 873
screamer 0:7a64fbb4069d 874 LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_recv varbind cnt=%"U16_F"\n",(u16_t)msg_ps->invb.count));
screamer 0:7a64fbb4069d 875
screamer 0:7a64fbb4069d 876 /* handle input event and as much objects as possible in one go */
screamer 0:7a64fbb4069d 877 snmp_msg_event(req_idx);
screamer 0:7a64fbb4069d 878 }
screamer 0:7a64fbb4069d 879 else
screamer 0:7a64fbb4069d 880 {
screamer 0:7a64fbb4069d 881 /* varbind-list decode failed, or varbind list empty.
screamer 0:7a64fbb4069d 882 drop request silently, do not return error!
screamer 0:7a64fbb4069d 883 (errors are only returned for a specific varbind failure) */
screamer 0:7a64fbb4069d 884 pbuf_free(p);
screamer 0:7a64fbb4069d 885 LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_pdu_dec_varbindlist() failed\n"));
screamer 0:7a64fbb4069d 886 }
screamer 0:7a64fbb4069d 887 }
screamer 0:7a64fbb4069d 888 else
screamer 0:7a64fbb4069d 889 {
screamer 0:7a64fbb4069d 890 /* header check failed
screamer 0:7a64fbb4069d 891 drop request silently, do not return error! */
screamer 0:7a64fbb4069d 892 pbuf_free(p);
screamer 0:7a64fbb4069d 893 LWIP_DEBUGF(SNMP_MSG_DEBUG, ("snmp_pdu_header_check() failed\n"));
screamer 0:7a64fbb4069d 894 }
screamer 0:7a64fbb4069d 895 }
screamer 0:7a64fbb4069d 896 else
screamer 0:7a64fbb4069d 897 {
screamer 0:7a64fbb4069d 898 /* exceeding number of concurrent requests */
screamer 0:7a64fbb4069d 899 pbuf_free(p);
screamer 0:7a64fbb4069d 900 }
screamer 0:7a64fbb4069d 901 }
screamer 0:7a64fbb4069d 902 else
screamer 0:7a64fbb4069d 903 {
screamer 0:7a64fbb4069d 904 /* datagram not for us */
screamer 0:7a64fbb4069d 905 pbuf_free(p);
screamer 0:7a64fbb4069d 906 }
screamer 0:7a64fbb4069d 907 }
screamer 0:7a64fbb4069d 908
screamer 0:7a64fbb4069d 909 /**
screamer 0:7a64fbb4069d 910 * Checks and decodes incoming SNMP message header, logs header errors.
screamer 0:7a64fbb4069d 911 *
screamer 0:7a64fbb4069d 912 * @param p points to pbuf chain of SNMP message (UDP payload)
screamer 0:7a64fbb4069d 913 * @param ofs points to first octet of SNMP message
screamer 0:7a64fbb4069d 914 * @param pdu_len the length of the UDP payload
screamer 0:7a64fbb4069d 915 * @param ofs_ret returns the ofset of the variable bindings
screamer 0:7a64fbb4069d 916 * @param m_stat points to the current message request state return
screamer 0:7a64fbb4069d 917 * @return
screamer 0:7a64fbb4069d 918 * - ERR_OK SNMP header is sane and accepted
screamer 0:7a64fbb4069d 919 * - ERR_ARG SNMP header is either malformed or rejected
screamer 0:7a64fbb4069d 920 */
screamer 0:7a64fbb4069d 921 static err_t
screamer 0:7a64fbb4069d 922 snmp_pdu_header_check(struct pbuf *p, u16_t ofs, u16_t pdu_len, u16_t *ofs_ret, struct snmp_msg_pstat *m_stat)
screamer 0:7a64fbb4069d 923 {
screamer 0:7a64fbb4069d 924 err_t derr;
screamer 0:7a64fbb4069d 925 u16_t len, ofs_base;
screamer 0:7a64fbb4069d 926 u8_t len_octets;
screamer 0:7a64fbb4069d 927 u8_t type;
screamer 0:7a64fbb4069d 928 s32_t version;
screamer 0:7a64fbb4069d 929
screamer 0:7a64fbb4069d 930 ofs_base = ofs;
screamer 0:7a64fbb4069d 931 snmp_asn1_dec_type(p, ofs, &type);
screamer 0:7a64fbb4069d 932 derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
screamer 0:7a64fbb4069d 933 if ((derr != ERR_OK) ||
screamer 0:7a64fbb4069d 934 (pdu_len != (1 + len_octets + len)) ||
screamer 0:7a64fbb4069d 935 (type != (SNMP_ASN1_UNIV | SNMP_ASN1_CONSTR | SNMP_ASN1_SEQ)))
screamer 0:7a64fbb4069d 936 {
screamer 0:7a64fbb4069d 937 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 938 return ERR_ARG;
screamer 0:7a64fbb4069d 939 }
screamer 0:7a64fbb4069d 940 ofs += (1 + len_octets);
screamer 0:7a64fbb4069d 941 snmp_asn1_dec_type(p, ofs, &type);
screamer 0:7a64fbb4069d 942 derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
screamer 0:7a64fbb4069d 943 if ((derr != ERR_OK) || (type != (SNMP_ASN1_UNIV | SNMP_ASN1_PRIMIT | SNMP_ASN1_INTEG)))
screamer 0:7a64fbb4069d 944 {
screamer 0:7a64fbb4069d 945 /* can't decode or no integer (version) */
screamer 0:7a64fbb4069d 946 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 947 return ERR_ARG;
screamer 0:7a64fbb4069d 948 }
screamer 0:7a64fbb4069d 949 derr = snmp_asn1_dec_s32t(p, ofs + 1 + len_octets, len, &version);
screamer 0:7a64fbb4069d 950 if (derr != ERR_OK)
screamer 0:7a64fbb4069d 951 {
screamer 0:7a64fbb4069d 952 /* can't decode */
screamer 0:7a64fbb4069d 953 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 954 return ERR_ARG;
screamer 0:7a64fbb4069d 955 }
screamer 0:7a64fbb4069d 956 if (version != 0)
screamer 0:7a64fbb4069d 957 {
screamer 0:7a64fbb4069d 958 /* not version 1 */
screamer 0:7a64fbb4069d 959 snmp_inc_snmpinbadversions();
screamer 0:7a64fbb4069d 960 return ERR_ARG;
screamer 0:7a64fbb4069d 961 }
screamer 0:7a64fbb4069d 962 ofs += (1 + len_octets + len);
screamer 0:7a64fbb4069d 963 snmp_asn1_dec_type(p, ofs, &type);
screamer 0:7a64fbb4069d 964 derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
screamer 0:7a64fbb4069d 965 if ((derr != ERR_OK) || (type != (SNMP_ASN1_UNIV | SNMP_ASN1_PRIMIT | SNMP_ASN1_OC_STR)))
screamer 0:7a64fbb4069d 966 {
screamer 0:7a64fbb4069d 967 /* can't decode or no octet string (community) */
screamer 0:7a64fbb4069d 968 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 969 return ERR_ARG;
screamer 0:7a64fbb4069d 970 }
screamer 0:7a64fbb4069d 971 derr = snmp_asn1_dec_raw(p, ofs + 1 + len_octets, len, SNMP_COMMUNITY_STR_LEN, m_stat->community);
screamer 0:7a64fbb4069d 972 if (derr != ERR_OK)
screamer 0:7a64fbb4069d 973 {
screamer 0:7a64fbb4069d 974 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 975 return ERR_ARG;
screamer 0:7a64fbb4069d 976 }
screamer 0:7a64fbb4069d 977 /* add zero terminator */
screamer 0:7a64fbb4069d 978 len = ((len < (SNMP_COMMUNITY_STR_LEN))?(len):(SNMP_COMMUNITY_STR_LEN));
screamer 0:7a64fbb4069d 979 m_stat->community[len] = 0;
screamer 0:7a64fbb4069d 980 m_stat->com_strlen = len;
screamer 0:7a64fbb4069d 981 if (strncmp(snmp_publiccommunity, (const char*)m_stat->community, SNMP_COMMUNITY_STR_LEN) != 0)
screamer 0:7a64fbb4069d 982 {
screamer 0:7a64fbb4069d 983 /** @todo: move this if we need to check more names */
screamer 0:7a64fbb4069d 984 snmp_inc_snmpinbadcommunitynames();
screamer 0:7a64fbb4069d 985 snmp_authfail_trap();
screamer 0:7a64fbb4069d 986 return ERR_ARG;
screamer 0:7a64fbb4069d 987 }
screamer 0:7a64fbb4069d 988 ofs += (1 + len_octets + len);
screamer 0:7a64fbb4069d 989 snmp_asn1_dec_type(p, ofs, &type);
screamer 0:7a64fbb4069d 990 derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
screamer 0:7a64fbb4069d 991 if (derr != ERR_OK)
screamer 0:7a64fbb4069d 992 {
screamer 0:7a64fbb4069d 993 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 994 return ERR_ARG;
screamer 0:7a64fbb4069d 995 }
screamer 0:7a64fbb4069d 996 switch(type)
screamer 0:7a64fbb4069d 997 {
screamer 0:7a64fbb4069d 998 case (SNMP_ASN1_CONTXT | SNMP_ASN1_CONSTR | SNMP_ASN1_PDU_GET_REQ):
screamer 0:7a64fbb4069d 999 /* GetRequest PDU */
screamer 0:7a64fbb4069d 1000 snmp_inc_snmpingetrequests();
screamer 0:7a64fbb4069d 1001 derr = ERR_OK;
screamer 0:7a64fbb4069d 1002 break;
screamer 0:7a64fbb4069d 1003 case (SNMP_ASN1_CONTXT | SNMP_ASN1_CONSTR | SNMP_ASN1_PDU_GET_NEXT_REQ):
screamer 0:7a64fbb4069d 1004 /* GetNextRequest PDU */
screamer 0:7a64fbb4069d 1005 snmp_inc_snmpingetnexts();
screamer 0:7a64fbb4069d 1006 derr = ERR_OK;
screamer 0:7a64fbb4069d 1007 break;
screamer 0:7a64fbb4069d 1008 case (SNMP_ASN1_CONTXT | SNMP_ASN1_CONSTR | SNMP_ASN1_PDU_GET_RESP):
screamer 0:7a64fbb4069d 1009 /* GetResponse PDU */
screamer 0:7a64fbb4069d 1010 snmp_inc_snmpingetresponses();
screamer 0:7a64fbb4069d 1011 derr = ERR_ARG;
screamer 0:7a64fbb4069d 1012 break;
screamer 0:7a64fbb4069d 1013 case (SNMP_ASN1_CONTXT | SNMP_ASN1_CONSTR | SNMP_ASN1_PDU_SET_REQ):
screamer 0:7a64fbb4069d 1014 /* SetRequest PDU */
screamer 0:7a64fbb4069d 1015 snmp_inc_snmpinsetrequests();
screamer 0:7a64fbb4069d 1016 derr = ERR_OK;
screamer 0:7a64fbb4069d 1017 break;
screamer 0:7a64fbb4069d 1018 case (SNMP_ASN1_CONTXT | SNMP_ASN1_CONSTR | SNMP_ASN1_PDU_TRAP):
screamer 0:7a64fbb4069d 1019 /* Trap PDU */
screamer 0:7a64fbb4069d 1020 snmp_inc_snmpintraps();
screamer 0:7a64fbb4069d 1021 derr = ERR_ARG;
screamer 0:7a64fbb4069d 1022 break;
screamer 0:7a64fbb4069d 1023 default:
screamer 0:7a64fbb4069d 1024 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 1025 derr = ERR_ARG;
screamer 0:7a64fbb4069d 1026 break;
screamer 0:7a64fbb4069d 1027 }
screamer 0:7a64fbb4069d 1028 if (derr != ERR_OK)
screamer 0:7a64fbb4069d 1029 {
screamer 0:7a64fbb4069d 1030 /* unsupported input PDU for this agent (no parse error) */
screamer 0:7a64fbb4069d 1031 return ERR_ARG;
screamer 0:7a64fbb4069d 1032 }
screamer 0:7a64fbb4069d 1033 m_stat->rt = type & 0x1F;
screamer 0:7a64fbb4069d 1034 ofs += (1 + len_octets);
screamer 0:7a64fbb4069d 1035 if (len != (pdu_len - (ofs - ofs_base)))
screamer 0:7a64fbb4069d 1036 {
screamer 0:7a64fbb4069d 1037 /* decoded PDU length does not equal actual payload length */
screamer 0:7a64fbb4069d 1038 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 1039 return ERR_ARG;
screamer 0:7a64fbb4069d 1040 }
screamer 0:7a64fbb4069d 1041 snmp_asn1_dec_type(p, ofs, &type);
screamer 0:7a64fbb4069d 1042 derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
screamer 0:7a64fbb4069d 1043 if ((derr != ERR_OK) || (type != (SNMP_ASN1_UNIV | SNMP_ASN1_PRIMIT | SNMP_ASN1_INTEG)))
screamer 0:7a64fbb4069d 1044 {
screamer 0:7a64fbb4069d 1045 /* can't decode or no integer (request ID) */
screamer 0:7a64fbb4069d 1046 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 1047 return ERR_ARG;
screamer 0:7a64fbb4069d 1048 }
screamer 0:7a64fbb4069d 1049 derr = snmp_asn1_dec_s32t(p, ofs + 1 + len_octets, len, &m_stat->rid);
screamer 0:7a64fbb4069d 1050 if (derr != ERR_OK)
screamer 0:7a64fbb4069d 1051 {
screamer 0:7a64fbb4069d 1052 /* can't decode */
screamer 0:7a64fbb4069d 1053 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 1054 return ERR_ARG;
screamer 0:7a64fbb4069d 1055 }
screamer 0:7a64fbb4069d 1056 ofs += (1 + len_octets + len);
screamer 0:7a64fbb4069d 1057 snmp_asn1_dec_type(p, ofs, &type);
screamer 0:7a64fbb4069d 1058 derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
screamer 0:7a64fbb4069d 1059 if ((derr != ERR_OK) || (type != (SNMP_ASN1_UNIV | SNMP_ASN1_PRIMIT | SNMP_ASN1_INTEG)))
screamer 0:7a64fbb4069d 1060 {
screamer 0:7a64fbb4069d 1061 /* can't decode or no integer (error-status) */
screamer 0:7a64fbb4069d 1062 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 1063 return ERR_ARG;
screamer 0:7a64fbb4069d 1064 }
screamer 0:7a64fbb4069d 1065 /* must be noError (0) for incoming requests.
screamer 0:7a64fbb4069d 1066 log errors for mib-2 completeness and for debug purposes */
screamer 0:7a64fbb4069d 1067 derr = snmp_asn1_dec_s32t(p, ofs + 1 + len_octets, len, &m_stat->error_status);
screamer 0:7a64fbb4069d 1068 if (derr != ERR_OK)
screamer 0:7a64fbb4069d 1069 {
screamer 0:7a64fbb4069d 1070 /* can't decode */
screamer 0:7a64fbb4069d 1071 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 1072 return ERR_ARG;
screamer 0:7a64fbb4069d 1073 }
screamer 0:7a64fbb4069d 1074 switch (m_stat->error_status)
screamer 0:7a64fbb4069d 1075 {
screamer 0:7a64fbb4069d 1076 case SNMP_ES_TOOBIG:
screamer 0:7a64fbb4069d 1077 snmp_inc_snmpintoobigs();
screamer 0:7a64fbb4069d 1078 break;
screamer 0:7a64fbb4069d 1079 case SNMP_ES_NOSUCHNAME:
screamer 0:7a64fbb4069d 1080 snmp_inc_snmpinnosuchnames();
screamer 0:7a64fbb4069d 1081 break;
screamer 0:7a64fbb4069d 1082 case SNMP_ES_BADVALUE:
screamer 0:7a64fbb4069d 1083 snmp_inc_snmpinbadvalues();
screamer 0:7a64fbb4069d 1084 break;
screamer 0:7a64fbb4069d 1085 case SNMP_ES_READONLY:
screamer 0:7a64fbb4069d 1086 snmp_inc_snmpinreadonlys();
screamer 0:7a64fbb4069d 1087 break;
screamer 0:7a64fbb4069d 1088 case SNMP_ES_GENERROR:
screamer 0:7a64fbb4069d 1089 snmp_inc_snmpingenerrs();
screamer 0:7a64fbb4069d 1090 break;
screamer 0:7a64fbb4069d 1091 }
screamer 0:7a64fbb4069d 1092 ofs += (1 + len_octets + len);
screamer 0:7a64fbb4069d 1093 snmp_asn1_dec_type(p, ofs, &type);
screamer 0:7a64fbb4069d 1094 derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
screamer 0:7a64fbb4069d 1095 if ((derr != ERR_OK) || (type != (SNMP_ASN1_UNIV | SNMP_ASN1_PRIMIT | SNMP_ASN1_INTEG)))
screamer 0:7a64fbb4069d 1096 {
screamer 0:7a64fbb4069d 1097 /* can't decode or no integer (error-index) */
screamer 0:7a64fbb4069d 1098 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 1099 return ERR_ARG;
screamer 0:7a64fbb4069d 1100 }
screamer 0:7a64fbb4069d 1101 /* must be 0 for incoming requests.
screamer 0:7a64fbb4069d 1102 decode anyway to catch bad integers (and dirty tricks) */
screamer 0:7a64fbb4069d 1103 derr = snmp_asn1_dec_s32t(p, ofs + 1 + len_octets, len, &m_stat->error_index);
screamer 0:7a64fbb4069d 1104 if (derr != ERR_OK)
screamer 0:7a64fbb4069d 1105 {
screamer 0:7a64fbb4069d 1106 /* can't decode */
screamer 0:7a64fbb4069d 1107 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 1108 return ERR_ARG;
screamer 0:7a64fbb4069d 1109 }
screamer 0:7a64fbb4069d 1110 ofs += (1 + len_octets + len);
screamer 0:7a64fbb4069d 1111 *ofs_ret = ofs;
screamer 0:7a64fbb4069d 1112 return ERR_OK;
screamer 0:7a64fbb4069d 1113 }
screamer 0:7a64fbb4069d 1114
screamer 0:7a64fbb4069d 1115 static err_t
screamer 0:7a64fbb4069d 1116 snmp_pdu_dec_varbindlist(struct pbuf *p, u16_t ofs, u16_t *ofs_ret, struct snmp_msg_pstat *m_stat)
screamer 0:7a64fbb4069d 1117 {
screamer 0:7a64fbb4069d 1118 err_t derr;
screamer 0:7a64fbb4069d 1119 u16_t len, vb_len;
screamer 0:7a64fbb4069d 1120 u8_t len_octets;
screamer 0:7a64fbb4069d 1121 u8_t type;
screamer 0:7a64fbb4069d 1122
screamer 0:7a64fbb4069d 1123 /* variable binding list */
screamer 0:7a64fbb4069d 1124 snmp_asn1_dec_type(p, ofs, &type);
screamer 0:7a64fbb4069d 1125 derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &vb_len);
screamer 0:7a64fbb4069d 1126 if ((derr != ERR_OK) ||
screamer 0:7a64fbb4069d 1127 (type != (SNMP_ASN1_UNIV | SNMP_ASN1_CONSTR | SNMP_ASN1_SEQ)))
screamer 0:7a64fbb4069d 1128 {
screamer 0:7a64fbb4069d 1129 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 1130 return ERR_ARG;
screamer 0:7a64fbb4069d 1131 }
screamer 0:7a64fbb4069d 1132 ofs += (1 + len_octets);
screamer 0:7a64fbb4069d 1133
screamer 0:7a64fbb4069d 1134 /* start with empty list */
screamer 0:7a64fbb4069d 1135 m_stat->invb.count = 0;
screamer 0:7a64fbb4069d 1136 m_stat->invb.head = NULL;
screamer 0:7a64fbb4069d 1137 m_stat->invb.tail = NULL;
screamer 0:7a64fbb4069d 1138
screamer 0:7a64fbb4069d 1139 while (vb_len > 0)
screamer 0:7a64fbb4069d 1140 {
screamer 0:7a64fbb4069d 1141 struct snmp_obj_id oid, oid_value;
screamer 0:7a64fbb4069d 1142 struct snmp_varbind *vb;
screamer 0:7a64fbb4069d 1143
screamer 0:7a64fbb4069d 1144 snmp_asn1_dec_type(p, ofs, &type);
screamer 0:7a64fbb4069d 1145 derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
screamer 0:7a64fbb4069d 1146 if ((derr != ERR_OK) ||
screamer 0:7a64fbb4069d 1147 (type != (SNMP_ASN1_UNIV | SNMP_ASN1_CONSTR | SNMP_ASN1_SEQ)) ||
screamer 0:7a64fbb4069d 1148 (len == 0) || (len > vb_len))
screamer 0:7a64fbb4069d 1149 {
screamer 0:7a64fbb4069d 1150 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 1151 /* free varbinds (if available) */
screamer 0:7a64fbb4069d 1152 snmp_varbind_list_free(&m_stat->invb);
screamer 0:7a64fbb4069d 1153 return ERR_ARG;
screamer 0:7a64fbb4069d 1154 }
screamer 0:7a64fbb4069d 1155 ofs += (1 + len_octets);
screamer 0:7a64fbb4069d 1156 vb_len -= (1 + len_octets);
screamer 0:7a64fbb4069d 1157
screamer 0:7a64fbb4069d 1158 snmp_asn1_dec_type(p, ofs, &type);
screamer 0:7a64fbb4069d 1159 derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
screamer 0:7a64fbb4069d 1160 if ((derr != ERR_OK) || (type != (SNMP_ASN1_UNIV | SNMP_ASN1_PRIMIT | SNMP_ASN1_OBJ_ID)))
screamer 0:7a64fbb4069d 1161 {
screamer 0:7a64fbb4069d 1162 /* can't decode object name length */
screamer 0:7a64fbb4069d 1163 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 1164 /* free varbinds (if available) */
screamer 0:7a64fbb4069d 1165 snmp_varbind_list_free(&m_stat->invb);
screamer 0:7a64fbb4069d 1166 return ERR_ARG;
screamer 0:7a64fbb4069d 1167 }
screamer 0:7a64fbb4069d 1168 derr = snmp_asn1_dec_oid(p, ofs + 1 + len_octets, len, &oid);
screamer 0:7a64fbb4069d 1169 if (derr != ERR_OK)
screamer 0:7a64fbb4069d 1170 {
screamer 0:7a64fbb4069d 1171 /* can't decode object name */
screamer 0:7a64fbb4069d 1172 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 1173 /* free varbinds (if available) */
screamer 0:7a64fbb4069d 1174 snmp_varbind_list_free(&m_stat->invb);
screamer 0:7a64fbb4069d 1175 return ERR_ARG;
screamer 0:7a64fbb4069d 1176 }
screamer 0:7a64fbb4069d 1177 ofs += (1 + len_octets + len);
screamer 0:7a64fbb4069d 1178 vb_len -= (1 + len_octets + len);
screamer 0:7a64fbb4069d 1179
screamer 0:7a64fbb4069d 1180 snmp_asn1_dec_type(p, ofs, &type);
screamer 0:7a64fbb4069d 1181 derr = snmp_asn1_dec_length(p, ofs+1, &len_octets, &len);
screamer 0:7a64fbb4069d 1182 if (derr != ERR_OK)
screamer 0:7a64fbb4069d 1183 {
screamer 0:7a64fbb4069d 1184 /* can't decode object value length */
screamer 0:7a64fbb4069d 1185 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 1186 /* free varbinds (if available) */
screamer 0:7a64fbb4069d 1187 snmp_varbind_list_free(&m_stat->invb);
screamer 0:7a64fbb4069d 1188 return ERR_ARG;
screamer 0:7a64fbb4069d 1189 }
screamer 0:7a64fbb4069d 1190
screamer 0:7a64fbb4069d 1191 switch (type)
screamer 0:7a64fbb4069d 1192 {
screamer 0:7a64fbb4069d 1193 case (SNMP_ASN1_UNIV | SNMP_ASN1_PRIMIT | SNMP_ASN1_INTEG):
screamer 0:7a64fbb4069d 1194 vb = snmp_varbind_alloc(&oid, type, sizeof(s32_t));
screamer 0:7a64fbb4069d 1195 if (vb != NULL)
screamer 0:7a64fbb4069d 1196 {
screamer 0:7a64fbb4069d 1197 s32_t *vptr = vb->value;
screamer 0:7a64fbb4069d 1198
screamer 0:7a64fbb4069d 1199 derr = snmp_asn1_dec_s32t(p, ofs + 1 + len_octets, len, vptr);
screamer 0:7a64fbb4069d 1200 snmp_varbind_tail_add(&m_stat->invb, vb);
screamer 0:7a64fbb4069d 1201 }
screamer 0:7a64fbb4069d 1202 else
screamer 0:7a64fbb4069d 1203 {
screamer 0:7a64fbb4069d 1204 derr = ERR_ARG;
screamer 0:7a64fbb4069d 1205 }
screamer 0:7a64fbb4069d 1206 break;
screamer 0:7a64fbb4069d 1207 case (SNMP_ASN1_APPLIC | SNMP_ASN1_PRIMIT | SNMP_ASN1_COUNTER):
screamer 0:7a64fbb4069d 1208 case (SNMP_ASN1_APPLIC | SNMP_ASN1_PRIMIT | SNMP_ASN1_GAUGE):
screamer 0:7a64fbb4069d 1209 case (SNMP_ASN1_APPLIC | SNMP_ASN1_PRIMIT | SNMP_ASN1_TIMETICKS):
screamer 0:7a64fbb4069d 1210 vb = snmp_varbind_alloc(&oid, type, sizeof(u32_t));
screamer 0:7a64fbb4069d 1211 if (vb != NULL)
screamer 0:7a64fbb4069d 1212 {
screamer 0:7a64fbb4069d 1213 u32_t *vptr = vb->value;
screamer 0:7a64fbb4069d 1214
screamer 0:7a64fbb4069d 1215 derr = snmp_asn1_dec_u32t(p, ofs + 1 + len_octets, len, vptr);
screamer 0:7a64fbb4069d 1216 snmp_varbind_tail_add(&m_stat->invb, vb);
screamer 0:7a64fbb4069d 1217 }
screamer 0:7a64fbb4069d 1218 else
screamer 0:7a64fbb4069d 1219 {
screamer 0:7a64fbb4069d 1220 derr = ERR_ARG;
screamer 0:7a64fbb4069d 1221 }
screamer 0:7a64fbb4069d 1222 break;
screamer 0:7a64fbb4069d 1223 case (SNMP_ASN1_UNIV | SNMP_ASN1_PRIMIT | SNMP_ASN1_OC_STR):
screamer 0:7a64fbb4069d 1224 case (SNMP_ASN1_APPLIC | SNMP_ASN1_PRIMIT | SNMP_ASN1_OPAQUE):
screamer 0:7a64fbb4069d 1225 vb = snmp_varbind_alloc(&oid, type, len);
screamer 0:7a64fbb4069d 1226 if (vb != NULL)
screamer 0:7a64fbb4069d 1227 {
screamer 0:7a64fbb4069d 1228 derr = snmp_asn1_dec_raw(p, ofs + 1 + len_octets, len, vb->value_len, vb->value);
screamer 0:7a64fbb4069d 1229 snmp_varbind_tail_add(&m_stat->invb, vb);
screamer 0:7a64fbb4069d 1230 }
screamer 0:7a64fbb4069d 1231 else
screamer 0:7a64fbb4069d 1232 {
screamer 0:7a64fbb4069d 1233 derr = ERR_ARG;
screamer 0:7a64fbb4069d 1234 }
screamer 0:7a64fbb4069d 1235 break;
screamer 0:7a64fbb4069d 1236 case (SNMP_ASN1_UNIV | SNMP_ASN1_PRIMIT | SNMP_ASN1_NUL):
screamer 0:7a64fbb4069d 1237 vb = snmp_varbind_alloc(&oid, type, 0);
screamer 0:7a64fbb4069d 1238 if (vb != NULL)
screamer 0:7a64fbb4069d 1239 {
screamer 0:7a64fbb4069d 1240 snmp_varbind_tail_add(&m_stat->invb, vb);
screamer 0:7a64fbb4069d 1241 derr = ERR_OK;
screamer 0:7a64fbb4069d 1242 }
screamer 0:7a64fbb4069d 1243 else
screamer 0:7a64fbb4069d 1244 {
screamer 0:7a64fbb4069d 1245 derr = ERR_ARG;
screamer 0:7a64fbb4069d 1246 }
screamer 0:7a64fbb4069d 1247 break;
screamer 0:7a64fbb4069d 1248 case (SNMP_ASN1_UNIV | SNMP_ASN1_PRIMIT | SNMP_ASN1_OBJ_ID):
screamer 0:7a64fbb4069d 1249 derr = snmp_asn1_dec_oid(p, ofs + 1 + len_octets, len, &oid_value);
screamer 0:7a64fbb4069d 1250 if (derr == ERR_OK)
screamer 0:7a64fbb4069d 1251 {
screamer 0:7a64fbb4069d 1252 vb = snmp_varbind_alloc(&oid, type, oid_value.len * sizeof(s32_t));
screamer 0:7a64fbb4069d 1253 if (vb != NULL)
screamer 0:7a64fbb4069d 1254 {
screamer 0:7a64fbb4069d 1255 u8_t i = oid_value.len;
screamer 0:7a64fbb4069d 1256 s32_t *vptr = vb->value;
screamer 0:7a64fbb4069d 1257
screamer 0:7a64fbb4069d 1258 while(i > 0)
screamer 0:7a64fbb4069d 1259 {
screamer 0:7a64fbb4069d 1260 i--;
screamer 0:7a64fbb4069d 1261 vptr[i] = oid_value.id[i];
screamer 0:7a64fbb4069d 1262 }
screamer 0:7a64fbb4069d 1263 snmp_varbind_tail_add(&m_stat->invb, vb);
screamer 0:7a64fbb4069d 1264 derr = ERR_OK;
screamer 0:7a64fbb4069d 1265 }
screamer 0:7a64fbb4069d 1266 else
screamer 0:7a64fbb4069d 1267 {
screamer 0:7a64fbb4069d 1268 derr = ERR_ARG;
screamer 0:7a64fbb4069d 1269 }
screamer 0:7a64fbb4069d 1270 }
screamer 0:7a64fbb4069d 1271 break;
screamer 0:7a64fbb4069d 1272 case (SNMP_ASN1_APPLIC | SNMP_ASN1_PRIMIT | SNMP_ASN1_IPADDR):
screamer 0:7a64fbb4069d 1273 if (len == 4)
screamer 0:7a64fbb4069d 1274 {
screamer 0:7a64fbb4069d 1275 /* must be exactly 4 octets! */
screamer 0:7a64fbb4069d 1276 vb = snmp_varbind_alloc(&oid, type, 4);
screamer 0:7a64fbb4069d 1277 if (vb != NULL)
screamer 0:7a64fbb4069d 1278 {
screamer 0:7a64fbb4069d 1279 derr = snmp_asn1_dec_raw(p, ofs + 1 + len_octets, len, vb->value_len, vb->value);
screamer 0:7a64fbb4069d 1280 snmp_varbind_tail_add(&m_stat->invb, vb);
screamer 0:7a64fbb4069d 1281 }
screamer 0:7a64fbb4069d 1282 else
screamer 0:7a64fbb4069d 1283 {
screamer 0:7a64fbb4069d 1284 derr = ERR_ARG;
screamer 0:7a64fbb4069d 1285 }
screamer 0:7a64fbb4069d 1286 }
screamer 0:7a64fbb4069d 1287 else
screamer 0:7a64fbb4069d 1288 {
screamer 0:7a64fbb4069d 1289 derr = ERR_ARG;
screamer 0:7a64fbb4069d 1290 }
screamer 0:7a64fbb4069d 1291 break;
screamer 0:7a64fbb4069d 1292 default:
screamer 0:7a64fbb4069d 1293 derr = ERR_ARG;
screamer 0:7a64fbb4069d 1294 break;
screamer 0:7a64fbb4069d 1295 }
screamer 0:7a64fbb4069d 1296 if (derr != ERR_OK)
screamer 0:7a64fbb4069d 1297 {
screamer 0:7a64fbb4069d 1298 snmp_inc_snmpinasnparseerrs();
screamer 0:7a64fbb4069d 1299 /* free varbinds (if available) */
screamer 0:7a64fbb4069d 1300 snmp_varbind_list_free(&m_stat->invb);
screamer 0:7a64fbb4069d 1301 return ERR_ARG;
screamer 0:7a64fbb4069d 1302 }
screamer 0:7a64fbb4069d 1303 ofs += (1 + len_octets + len);
screamer 0:7a64fbb4069d 1304 vb_len -= (1 + len_octets + len);
screamer 0:7a64fbb4069d 1305 }
screamer 0:7a64fbb4069d 1306
screamer 0:7a64fbb4069d 1307 if (m_stat->rt == SNMP_ASN1_PDU_SET_REQ)
screamer 0:7a64fbb4069d 1308 {
screamer 0:7a64fbb4069d 1309 snmp_add_snmpintotalsetvars(m_stat->invb.count);
screamer 0:7a64fbb4069d 1310 }
screamer 0:7a64fbb4069d 1311 else
screamer 0:7a64fbb4069d 1312 {
screamer 0:7a64fbb4069d 1313 snmp_add_snmpintotalreqvars(m_stat->invb.count);
screamer 0:7a64fbb4069d 1314 }
screamer 0:7a64fbb4069d 1315
screamer 0:7a64fbb4069d 1316 *ofs_ret = ofs;
screamer 0:7a64fbb4069d 1317 return ERR_OK;
screamer 0:7a64fbb4069d 1318 }
screamer 0:7a64fbb4069d 1319
screamer 0:7a64fbb4069d 1320 struct snmp_varbind*
screamer 0:7a64fbb4069d 1321 snmp_varbind_alloc(struct snmp_obj_id *oid, u8_t type, u8_t len)
screamer 0:7a64fbb4069d 1322 {
screamer 0:7a64fbb4069d 1323 struct snmp_varbind *vb;
screamer 0:7a64fbb4069d 1324
screamer 0:7a64fbb4069d 1325 vb = (struct snmp_varbind *)mem_malloc(sizeof(struct snmp_varbind));
screamer 0:7a64fbb4069d 1326 LWIP_ASSERT("vb != NULL",vb != NULL);
screamer 0:7a64fbb4069d 1327 if (vb != NULL)
screamer 0:7a64fbb4069d 1328 {
screamer 0:7a64fbb4069d 1329 u8_t i;
screamer 0:7a64fbb4069d 1330
screamer 0:7a64fbb4069d 1331 vb->next = NULL;
screamer 0:7a64fbb4069d 1332 vb->prev = NULL;
screamer 0:7a64fbb4069d 1333 i = oid->len;
screamer 0:7a64fbb4069d 1334 vb->ident_len = i;
screamer 0:7a64fbb4069d 1335 if (i > 0)
screamer 0:7a64fbb4069d 1336 {
screamer 0:7a64fbb4069d 1337 /* allocate array of s32_t for our object identifier */
screamer 0:7a64fbb4069d 1338 vb->ident = (s32_t*)mem_malloc(sizeof(s32_t) * i);
screamer 0:7a64fbb4069d 1339 LWIP_ASSERT("vb->ident != NULL",vb->ident != NULL);
screamer 0:7a64fbb4069d 1340 if (vb->ident == NULL)
screamer 0:7a64fbb4069d 1341 {
screamer 0:7a64fbb4069d 1342 mem_free(vb);
screamer 0:7a64fbb4069d 1343 return NULL;
screamer 0:7a64fbb4069d 1344 }
screamer 0:7a64fbb4069d 1345 while(i > 0)
screamer 0:7a64fbb4069d 1346 {
screamer 0:7a64fbb4069d 1347 i--;
screamer 0:7a64fbb4069d 1348 vb->ident[i] = oid->id[i];
screamer 0:7a64fbb4069d 1349 }
screamer 0:7a64fbb4069d 1350 }
screamer 0:7a64fbb4069d 1351 else
screamer 0:7a64fbb4069d 1352 {
screamer 0:7a64fbb4069d 1353 /* i == 0, pass zero length object identifier */
screamer 0:7a64fbb4069d 1354 vb->ident = NULL;
screamer 0:7a64fbb4069d 1355 }
screamer 0:7a64fbb4069d 1356 vb->value_type = type;
screamer 0:7a64fbb4069d 1357 vb->value_len = len;
screamer 0:7a64fbb4069d 1358 if (len > 0)
screamer 0:7a64fbb4069d 1359 {
screamer 0:7a64fbb4069d 1360 /* allocate raw bytes for our object value */
screamer 0:7a64fbb4069d 1361 vb->value = mem_malloc(len);
screamer 0:7a64fbb4069d 1362 LWIP_ASSERT("vb->value != NULL",vb->value != NULL);
screamer 0:7a64fbb4069d 1363 if (vb->value == NULL)
screamer 0:7a64fbb4069d 1364 {
screamer 0:7a64fbb4069d 1365 if (vb->ident != NULL)
screamer 0:7a64fbb4069d 1366 {
screamer 0:7a64fbb4069d 1367 mem_free(vb->ident);
screamer 0:7a64fbb4069d 1368 }
screamer 0:7a64fbb4069d 1369 mem_free(vb);
screamer 0:7a64fbb4069d 1370 return NULL;
screamer 0:7a64fbb4069d 1371 }
screamer 0:7a64fbb4069d 1372 }
screamer 0:7a64fbb4069d 1373 else
screamer 0:7a64fbb4069d 1374 {
screamer 0:7a64fbb4069d 1375 /* ASN1_NUL type, or zero length ASN1_OC_STR */
screamer 0:7a64fbb4069d 1376 vb->value = NULL;
screamer 0:7a64fbb4069d 1377 }
screamer 0:7a64fbb4069d 1378 }
screamer 0:7a64fbb4069d 1379 return vb;
screamer 0:7a64fbb4069d 1380 }
screamer 0:7a64fbb4069d 1381
screamer 0:7a64fbb4069d 1382 void
screamer 0:7a64fbb4069d 1383 snmp_varbind_free(struct snmp_varbind *vb)
screamer 0:7a64fbb4069d 1384 {
screamer 0:7a64fbb4069d 1385 if (vb->value != NULL )
screamer 0:7a64fbb4069d 1386 {
screamer 0:7a64fbb4069d 1387 mem_free(vb->value);
screamer 0:7a64fbb4069d 1388 }
screamer 0:7a64fbb4069d 1389 if (vb->ident != NULL )
screamer 0:7a64fbb4069d 1390 {
screamer 0:7a64fbb4069d 1391 mem_free(vb->ident);
screamer 0:7a64fbb4069d 1392 }
screamer 0:7a64fbb4069d 1393 mem_free(vb);
screamer 0:7a64fbb4069d 1394 }
screamer 0:7a64fbb4069d 1395
screamer 0:7a64fbb4069d 1396 void
screamer 0:7a64fbb4069d 1397 snmp_varbind_list_free(struct snmp_varbind_root *root)
screamer 0:7a64fbb4069d 1398 {
screamer 0:7a64fbb4069d 1399 struct snmp_varbind *vb, *prev;
screamer 0:7a64fbb4069d 1400
screamer 0:7a64fbb4069d 1401 vb = root->tail;
screamer 0:7a64fbb4069d 1402 while ( vb != NULL )
screamer 0:7a64fbb4069d 1403 {
screamer 0:7a64fbb4069d 1404 prev = vb->prev;
screamer 0:7a64fbb4069d 1405 snmp_varbind_free(vb);
screamer 0:7a64fbb4069d 1406 vb = prev;
screamer 0:7a64fbb4069d 1407 }
screamer 0:7a64fbb4069d 1408 root->count = 0;
screamer 0:7a64fbb4069d 1409 root->head = NULL;
screamer 0:7a64fbb4069d 1410 root->tail = NULL;
screamer 0:7a64fbb4069d 1411 }
screamer 0:7a64fbb4069d 1412
screamer 0:7a64fbb4069d 1413 void
screamer 0:7a64fbb4069d 1414 snmp_varbind_tail_add(struct snmp_varbind_root *root, struct snmp_varbind *vb)
screamer 0:7a64fbb4069d 1415 {
screamer 0:7a64fbb4069d 1416 if (root->count == 0)
screamer 0:7a64fbb4069d 1417 {
screamer 0:7a64fbb4069d 1418 /* add first varbind to list */
screamer 0:7a64fbb4069d 1419 root->head = vb;
screamer 0:7a64fbb4069d 1420 root->tail = vb;
screamer 0:7a64fbb4069d 1421 }
screamer 0:7a64fbb4069d 1422 else
screamer 0:7a64fbb4069d 1423 {
screamer 0:7a64fbb4069d 1424 /* add nth varbind to list tail */
screamer 0:7a64fbb4069d 1425 root->tail->next = vb;
screamer 0:7a64fbb4069d 1426 vb->prev = root->tail;
screamer 0:7a64fbb4069d 1427 root->tail = vb;
screamer 0:7a64fbb4069d 1428 }
screamer 0:7a64fbb4069d 1429 root->count += 1;
screamer 0:7a64fbb4069d 1430 }
screamer 0:7a64fbb4069d 1431
screamer 0:7a64fbb4069d 1432 struct snmp_varbind*
screamer 0:7a64fbb4069d 1433 snmp_varbind_tail_remove(struct snmp_varbind_root *root)
screamer 0:7a64fbb4069d 1434 {
screamer 0:7a64fbb4069d 1435 struct snmp_varbind* vb;
screamer 0:7a64fbb4069d 1436
screamer 0:7a64fbb4069d 1437 if (root->count > 0)
screamer 0:7a64fbb4069d 1438 {
screamer 0:7a64fbb4069d 1439 /* remove tail varbind */
screamer 0:7a64fbb4069d 1440 vb = root->tail;
screamer 0:7a64fbb4069d 1441 root->tail = vb->prev;
screamer 0:7a64fbb4069d 1442 vb->prev->next = NULL;
screamer 0:7a64fbb4069d 1443 root->count -= 1;
screamer 0:7a64fbb4069d 1444 }
screamer 0:7a64fbb4069d 1445 else
screamer 0:7a64fbb4069d 1446 {
screamer 0:7a64fbb4069d 1447 /* nothing to remove */
screamer 0:7a64fbb4069d 1448 vb = NULL;
screamer 0:7a64fbb4069d 1449 }
screamer 0:7a64fbb4069d 1450 return vb;
screamer 0:7a64fbb4069d 1451 }
screamer 0:7a64fbb4069d 1452
screamer 0:7a64fbb4069d 1453 #endif /* LWIP_SNMP */