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