fork allowing use of the latest official mbed networking library

Dependents:   SNMPv1UDPExmaple

Fork of Agentbed by Suga koubou

Committer:
jonecm
Date:
Tue Apr 02 19:53:28 2013 +0000
Revision:
3:81f25e337afc
Parent:
1:b2db0ea96703
Updated to be compatible with the MBED official networking stack

Who changed what in which revision?

UserRevisionLine numberNew contents of line
okini3939 0:bb21da73024a 1 /*
okini3939 0:bb21da73024a 2 Agentbed library
okini3939 0:bb21da73024a 3 Modified for mbed, 2010 Suga.
okini3939 0:bb21da73024a 4
okini3939 0:bb21da73024a 5
okini3939 0:bb21da73024a 6 Agentuino.cpp - An Arduino library for a lightweight SNMP Agent.
okini3939 0:bb21da73024a 7 Copyright (C) 2010 Eric C. Gionet <lavco_eg@hotmail.com>
okini3939 0:bb21da73024a 8 All rights reserved.
okini3939 0:bb21da73024a 9
okini3939 0:bb21da73024a 10 This library is free software; you can redistribute it and/or
okini3939 0:bb21da73024a 11 modify it under the terms of the GNU Lesser General Public
okini3939 0:bb21da73024a 12 License as published by the Free Software Foundation; either
okini3939 0:bb21da73024a 13 version 2.1 of the License, or (at your option) any later version.
okini3939 0:bb21da73024a 14
okini3939 0:bb21da73024a 15 This library is distributed in the hope that it will be useful,
okini3939 0:bb21da73024a 16 but WITHOUT ANY WARRANTY; without even the implied warranty of
okini3939 0:bb21da73024a 17 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
okini3939 0:bb21da73024a 18 Lesser General Public License for more details.
okini3939 0:bb21da73024a 19
okini3939 0:bb21da73024a 20 You should have received a copy of the GNU Lesser General Public
okini3939 0:bb21da73024a 21 License along with this library; if not, write to the Free Software
okini3939 0:bb21da73024a 22 Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
okini3939 0:bb21da73024a 23 */
okini3939 0:bb21da73024a 24
okini3939 0:bb21da73024a 25 #ifndef Agentbed_h
okini3939 0:bb21da73024a 26 #define Agentbed_h
okini3939 0:bb21da73024a 27
okini3939 0:bb21da73024a 28 #define SNMP_DEFAULT_PORT 161
okini3939 0:bb21da73024a 29 #define SNMP_MIN_OID_LEN 2
okini3939 0:bb21da73024a 30 #define SNMP_MAX_OID_LEN 64 // 128
okini3939 0:bb21da73024a 31 #define SNMP_MAX_NAME_LEN 20
okini3939 0:bb21da73024a 32 #define SNMP_MAX_VALUE_LEN 64 // 128 ??? should limit this
okini3939 0:bb21da73024a 33 #define SNMP_MAX_PACKET_LEN SNMP_MAX_VALUE_LEN + SNMP_MAX_OID_LEN + 25 //???
okini3939 0:bb21da73024a 34 #define SNMP_FREE(s) do { if (s) { free((void *)s); s=NULL; } } while(0)
okini3939 0:bb21da73024a 35 //Frees a pointer only if it is !NULL and sets its value to NULL.
okini3939 0:bb21da73024a 36
okini3939 0:bb21da73024a 37 #include "mbed.h"
okini3939 0:bb21da73024a 38 #include "UDPSocket.h"
okini3939 0:bb21da73024a 39 #include <stdlib.h>
okini3939 0:bb21da73024a 40
okini3939 0:bb21da73024a 41 extern "C" {
okini3939 0:bb21da73024a 42 // callback function
okini3939 0:bb21da73024a 43 typedef void (*onPduReceiveCallback)(void);
okini3939 0:bb21da73024a 44 }
okini3939 0:bb21da73024a 45
okini3939 0:bb21da73024a 46 //typedef long long int64_t;
okini3939 0:bb21da73024a 47 typedef unsigned long long uint64_t;
okini3939 0:bb21da73024a 48 //typedef long int32_t;
okini3939 0:bb21da73024a 49 //typedef unsigned long uint32_t;
okini3939 0:bb21da73024a 50 //typedef unsigned char uint8_t;
okini3939 0:bb21da73024a 51 //typedef short int16_t;
okini3939 0:bb21da73024a 52 //typedef unsigned short uint16_t;
okini3939 0:bb21da73024a 53 typedef unsigned char byte;
okini3939 0:bb21da73024a 54
okini3939 0:bb21da73024a 55 typedef union uint64_u {
okini3939 0:bb21da73024a 56 uint64_t uint64;
okini3939 0:bb21da73024a 57 byte data[8];
okini3939 0:bb21da73024a 58 } uint64_u;
okini3939 0:bb21da73024a 59
okini3939 0:bb21da73024a 60 typedef union int32_u {
okini3939 0:bb21da73024a 61 int32_t int32;
okini3939 0:bb21da73024a 62 byte data[4];
okini3939 0:bb21da73024a 63 } int32_u;
okini3939 0:bb21da73024a 64
okini3939 0:bb21da73024a 65 typedef union uint32_u{
okini3939 0:bb21da73024a 66 uint32_t uint32;
okini3939 0:bb21da73024a 67 byte data[4];
okini3939 0:bb21da73024a 68 } uint32_u;
okini3939 0:bb21da73024a 69
okini3939 0:bb21da73024a 70 typedef union int16_u {
okini3939 0:bb21da73024a 71 int16_t int16;
okini3939 0:bb21da73024a 72 byte data[2];
okini3939 0:bb21da73024a 73 } int16_u;
okini3939 0:bb21da73024a 74
okini3939 0:bb21da73024a 75 //typedef union uint16_u {
okini3939 0:bb21da73024a 76 // uint16_t uint16;
okini3939 0:bb21da73024a 77 // byte data[2];
okini3939 0:bb21da73024a 78 //};
okini3939 0:bb21da73024a 79
okini3939 1:b2db0ea96703 80 typedef union float_u{
okini3939 1:b2db0ea96703 81 float float_t;
okini3939 1:b2db0ea96703 82 byte data[4];
okini3939 1:b2db0ea96703 83 } float_u;
okini3939 1:b2db0ea96703 84
okini3939 0:bb21da73024a 85 enum ASN_BER_BASE_TYPES {
okini3939 0:bb21da73024a 86 // ASN/BER base types
okini3939 0:bb21da73024a 87 ASN_BER_BASE_UNIVERSAL = 0x0,
okini3939 0:bb21da73024a 88 ASN_BER_BASE_APPLICATION = 0x40,
okini3939 0:bb21da73024a 89 ASN_BER_BASE_CONTEXT = 0x80,
okini3939 0:bb21da73024a 90 ASN_BER_BASE_PUBLIC = 0xC0,
okini3939 0:bb21da73024a 91 ASN_BER_BASE_PRIMITIVE = 0x0,
okini3939 0:bb21da73024a 92 ASN_BER_BASE_CONSTRUCTOR = 0x20
okini3939 0:bb21da73024a 93 };
okini3939 0:bb21da73024a 94
okini3939 0:bb21da73024a 95 enum SNMP_PDU_TYPES {
okini3939 0:bb21da73024a 96 // PDU choices
okini3939 0:bb21da73024a 97 SNMP_PDU_GET = ASN_BER_BASE_CONTEXT | ASN_BER_BASE_CONSTRUCTOR | 0,
okini3939 0:bb21da73024a 98 SNMP_PDU_GET_NEXT = ASN_BER_BASE_CONTEXT | ASN_BER_BASE_CONSTRUCTOR | 1,
okini3939 0:bb21da73024a 99 SNMP_PDU_RESPONSE = ASN_BER_BASE_CONTEXT | ASN_BER_BASE_CONSTRUCTOR | 2,
okini3939 0:bb21da73024a 100 SNMP_PDU_SET = ASN_BER_BASE_CONTEXT | ASN_BER_BASE_CONSTRUCTOR | 3,
okini3939 0:bb21da73024a 101 SNMP_PDU_TRAP = ASN_BER_BASE_CONTEXT | ASN_BER_BASE_CONSTRUCTOR | 4
okini3939 0:bb21da73024a 102 };
okini3939 0:bb21da73024a 103
okini3939 0:bb21da73024a 104 enum SNMP_TRAP_TYPES {
okini3939 0:bb21da73024a 105 // Trap generic types:
okini3939 0:bb21da73024a 106 SNMP_TRAP_COLD_START = 0,
okini3939 0:bb21da73024a 107 SNMP_TRAP_WARM_START = 1,
okini3939 0:bb21da73024a 108 SNMP_TRAP_LINK_DOWN = 2,
okini3939 0:bb21da73024a 109 SNMP_TRAP_LINK_UP = 3,
okini3939 0:bb21da73024a 110 SNMP_TRAP_AUTHENTICATION_FAIL = 4,
okini3939 0:bb21da73024a 111 SNMP_TRAP_EGP_NEIGHBORLOSS = 5,
okini3939 0:bb21da73024a 112 SNMP_TRAP_ENTERPRISE_SPECIFIC = 6
okini3939 0:bb21da73024a 113 };
okini3939 0:bb21da73024a 114
okini3939 0:bb21da73024a 115 enum SNMP_ERR_CODES {
okini3939 0:bb21da73024a 116 SNMP_ERR_NO_ERROR = 0,
okini3939 0:bb21da73024a 117 SNMP_ERR_TOO_BIG = 1,
okini3939 0:bb21da73024a 118 SNMP_ERR_NO_SUCH_NAME = 2,
okini3939 0:bb21da73024a 119 SNMP_ERR_BAD_VALUE = 3,
okini3939 0:bb21da73024a 120 SNMP_ERR_READ_ONLY = 4,
okini3939 0:bb21da73024a 121 SNMP_ERR_GEN_ERROR = 5,
okini3939 0:bb21da73024a 122
okini3939 0:bb21da73024a 123 SNMP_ERR_NO_ACCESS = 6,
okini3939 0:bb21da73024a 124 SNMP_ERR_WRONG_TYPE = 7,
okini3939 0:bb21da73024a 125 SNMP_ERR_WRONG_LENGTH = 8,
okini3939 0:bb21da73024a 126 SNMP_ERR_WRONG_ENCODING = 9,
okini3939 0:bb21da73024a 127 SNMP_ERR_WRONG_VALUE = 10,
okini3939 0:bb21da73024a 128 SNMP_ERR_NO_CREATION = 11,
okini3939 0:bb21da73024a 129 SNMP_ERR_INCONSISTANT_VALUE = 12,
okini3939 0:bb21da73024a 130 SNMP_ERR_RESOURCE_UNAVAILABLE = 13,
okini3939 0:bb21da73024a 131 SNMP_ERR_COMMIT_FAILED = 14,
okini3939 0:bb21da73024a 132 SNMP_ERR_UNDO_FAILED = 15,
okini3939 0:bb21da73024a 133 SNMP_ERR_AUTHORIZATION_ERROR = 16,
okini3939 0:bb21da73024a 134 SNMP_ERR_NOT_WRITABLE = 17,
okini3939 0:bb21da73024a 135 SNMP_ERR_INCONSISTEN_NAME = 18
okini3939 0:bb21da73024a 136 };
okini3939 0:bb21da73024a 137
okini3939 0:bb21da73024a 138 enum SNMP_API_STAT_CODES {
okini3939 0:bb21da73024a 139 SNMP_API_STAT_SUCCESS = 0,
okini3939 0:bb21da73024a 140 SNMP_API_STAT_MALLOC_ERR = 1,
okini3939 0:bb21da73024a 141 SNMP_API_STAT_NAME_TOO_BIG = 2,
okini3939 0:bb21da73024a 142 SNMP_API_STAT_OID_TOO_BIG = 3,
okini3939 0:bb21da73024a 143 SNMP_API_STAT_VALUE_TOO_BIG = 4,
okini3939 0:bb21da73024a 144 SNMP_API_STAT_PACKET_INVALID = 5,
okini3939 0:bb21da73024a 145 SNMP_API_STAT_PACKET_TOO_BIG = 6
okini3939 0:bb21da73024a 146 };
okini3939 0:bb21da73024a 147
okini3939 0:bb21da73024a 148 //
okini3939 0:bb21da73024a 149 // http://oreilly.com/catalog/esnmp/chapter/ch02.html Table 2-1: SMIv1 Datatypes
okini3939 0:bb21da73024a 150
okini3939 0:bb21da73024a 151 enum SNMP_SYNTAXES {
okini3939 0:bb21da73024a 152 // SNMP ObjectSyntax values
okini3939 0:bb21da73024a 153 SNMP_SYNTAX_SEQUENCE = ASN_BER_BASE_UNIVERSAL | ASN_BER_BASE_CONSTRUCTOR | 0x10,
okini3939 0:bb21da73024a 154 // These values are used in the "syntax" member of VALUEs
okini3939 0:bb21da73024a 155 SNMP_SYNTAX_BOOL = ASN_BER_BASE_UNIVERSAL | ASN_BER_BASE_PRIMITIVE | 1,
okini3939 0:bb21da73024a 156 SNMP_SYNTAX_INT = ASN_BER_BASE_UNIVERSAL | ASN_BER_BASE_PRIMITIVE | 2,
okini3939 0:bb21da73024a 157 SNMP_SYNTAX_BITS = ASN_BER_BASE_UNIVERSAL | ASN_BER_BASE_PRIMITIVE | 3,
okini3939 0:bb21da73024a 158 SNMP_SYNTAX_OCTETS = ASN_BER_BASE_UNIVERSAL | ASN_BER_BASE_PRIMITIVE | 4,
okini3939 0:bb21da73024a 159 SNMP_SYNTAX_NULL = ASN_BER_BASE_UNIVERSAL | ASN_BER_BASE_PRIMITIVE | 5,
okini3939 0:bb21da73024a 160 SNMP_SYNTAX_OID = ASN_BER_BASE_UNIVERSAL | ASN_BER_BASE_PRIMITIVE | 6,
okini3939 0:bb21da73024a 161 SNMP_SYNTAX_INT32 = SNMP_SYNTAX_INT,
okini3939 0:bb21da73024a 162 SNMP_SYNTAX_IP_ADDRESS = ASN_BER_BASE_APPLICATION | ASN_BER_BASE_PRIMITIVE | 0,
okini3939 0:bb21da73024a 163 SNMP_SYNTAX_COUNTER = ASN_BER_BASE_APPLICATION | ASN_BER_BASE_PRIMITIVE | 1,
okini3939 0:bb21da73024a 164 SNMP_SYNTAX_GAUGE = ASN_BER_BASE_APPLICATION | ASN_BER_BASE_PRIMITIVE | 2,
okini3939 0:bb21da73024a 165 SNMP_SYNTAX_TIME_TICKS = ASN_BER_BASE_APPLICATION | ASN_BER_BASE_PRIMITIVE | 3,
okini3939 0:bb21da73024a 166 SNMP_SYNTAX_OPAQUE = ASN_BER_BASE_APPLICATION | ASN_BER_BASE_PRIMITIVE | 4,
okini3939 0:bb21da73024a 167 SNMP_SYNTAX_NSAPADDR = ASN_BER_BASE_APPLICATION | ASN_BER_BASE_PRIMITIVE | 5,
okini3939 0:bb21da73024a 168 SNMP_SYNTAX_COUNTER64 = ASN_BER_BASE_APPLICATION | ASN_BER_BASE_PRIMITIVE | 6,
okini3939 0:bb21da73024a 169 SNMP_SYNTAX_UINT32 = ASN_BER_BASE_APPLICATION | ASN_BER_BASE_PRIMITIVE | 7,
okini3939 1:b2db0ea96703 170 SNMP_SYNTAX_OPAQUE_FLOAT = 0x78,
okini3939 0:bb21da73024a 171 };
okini3939 0:bb21da73024a 172
okini3939 0:bb21da73024a 173 typedef struct SNMP_OID {
okini3939 0:bb21da73024a 174 byte data[SNMP_MAX_OID_LEN]; // ushort array insted??
okini3939 0:bb21da73024a 175 size_t size;
okini3939 0:bb21da73024a 176 //
okini3939 0:bb21da73024a 177 void fromString(const char *buffer) {
okini3939 0:bb21da73024a 178 }
okini3939 0:bb21da73024a 179 //
okini3939 0:bb21da73024a 180 void toString(char *buffer) {
okini3939 0:bb21da73024a 181 buffer[0] = '1';
okini3939 0:bb21da73024a 182 buffer[1] = '.';
okini3939 0:bb21da73024a 183 buffer[2] = '3';
okini3939 0:bb21da73024a 184 buffer[3] = '\0';
okini3939 0:bb21da73024a 185 //
okini3939 0:bb21da73024a 186 // tmp buffer - short (Int16)
okini3939 0:bb21da73024a 187 //char *buff = (char *)malloc(sizeof(char)*16); // I ya ya keeps hanging the MCU
okini3939 0:bb21da73024a 188 char buff[16];
okini3939 0:bb21da73024a 189 byte hsize = size - 1;
okini3939 0:bb21da73024a 190 byte hpos = 1;
okini3939 0:bb21da73024a 191 uint16_t subid;
okini3939 0:bb21da73024a 192 //
okini3939 0:bb21da73024a 193 while ( hsize > 0 ) {
okini3939 0:bb21da73024a 194 subid = 0;
okini3939 0:bb21da73024a 195 uint16_t b = 0;
okini3939 0:bb21da73024a 196 do {
okini3939 0:bb21da73024a 197 uint16_t next = data[hpos++];
okini3939 0:bb21da73024a 198 b = next & 0xFF;
okini3939 0:bb21da73024a 199 subid = (subid << 7) + (b & ~0x80);
okini3939 0:bb21da73024a 200 hsize--;
okini3939 0:bb21da73024a 201 } while ( (hsize > 0) && ((b & 0x80) != 0) );
okini3939 0:bb21da73024a 202 //utoa(subid, buff, 10);
okini3939 0:bb21da73024a 203 sprintf(buff, "%d", subid);
okini3939 0:bb21da73024a 204 strcat(buffer, ".");
okini3939 0:bb21da73024a 205 strcat(buffer, buff);
okini3939 0:bb21da73024a 206 }
okini3939 0:bb21da73024a 207 //
okini3939 0:bb21da73024a 208 // free buff
okini3939 0:bb21da73024a 209 //SNMP_FREE(buff);
okini3939 0:bb21da73024a 210 };
okini3939 0:bb21da73024a 211 } SNMP_OID;
okini3939 0:bb21da73024a 212
okini3939 0:bb21da73024a 213 // union for values?
okini3939 0:bb21da73024a 214 //
okini3939 0:bb21da73024a 215 typedef struct SNMP_VALUE {
okini3939 0:bb21da73024a 216 byte data[SNMP_MAX_VALUE_LEN];
okini3939 0:bb21da73024a 217 size_t size;
okini3939 0:bb21da73024a 218 SNMP_SYNTAXES syntax;
okini3939 0:bb21da73024a 219 //
okini3939 0:bb21da73024a 220 byte i; // for encoding/decoding functions
okini3939 0:bb21da73024a 221 //
okini3939 0:bb21da73024a 222 // clear's buffer and sets size to 0
okini3939 0:bb21da73024a 223 void clear(void) {
okini3939 0:bb21da73024a 224 memset(data, 0, SNMP_MAX_VALUE_LEN);
okini3939 0:bb21da73024a 225 size = 0;
okini3939 0:bb21da73024a 226 }
okini3939 0:bb21da73024a 227 //
okini3939 0:bb21da73024a 228 //
okini3939 0:bb21da73024a 229 // ASN.1 decoding functions
okini3939 0:bb21da73024a 230 //
okini3939 0:bb21da73024a 231 // decode's an octet string, object-identifier, opaque syntax to string
okini3939 0:bb21da73024a 232 SNMP_ERR_CODES decode(char *value, size_t max_size) {
okini3939 0:bb21da73024a 233 if ( syntax == SNMP_SYNTAX_OCTETS || syntax == SNMP_SYNTAX_OID
okini3939 0:bb21da73024a 234 || syntax == SNMP_SYNTAX_OPAQUE ) {
okini3939 0:bb21da73024a 235 if ( strlen(value) - 1 < max_size ) {
okini3939 0:bb21da73024a 236 if ( syntax == SNMP_SYNTAX_OID ) {
okini3939 0:bb21da73024a 237 value[0] = '1';
okini3939 0:bb21da73024a 238 value[1] = '.';
okini3939 0:bb21da73024a 239 value[2] = '3';
okini3939 0:bb21da73024a 240 value[3] = '\0';
okini3939 0:bb21da73024a 241 //
okini3939 0:bb21da73024a 242 // tmp buffer - ushort (UInt16)
okini3939 0:bb21da73024a 243 //char *buff = (char *)malloc(sizeof(char)*16); // I ya ya..keep hanging the MCU
okini3939 0:bb21da73024a 244 char buff[16];
okini3939 0:bb21da73024a 245 byte hsize = size - 1;
okini3939 0:bb21da73024a 246 byte hpos = 1;
okini3939 0:bb21da73024a 247 uint16_t subid;
okini3939 0:bb21da73024a 248 //
okini3939 0:bb21da73024a 249 while ( hsize > 0 ) {
okini3939 0:bb21da73024a 250 subid = 0;
okini3939 0:bb21da73024a 251 uint16_t b = 0;
okini3939 0:bb21da73024a 252 do {
okini3939 0:bb21da73024a 253 uint16_t next = data[hpos++];
okini3939 0:bb21da73024a 254 b = next & 0xFF;
okini3939 0:bb21da73024a 255 subid = (subid << 7) + (b & ~0x80);
okini3939 0:bb21da73024a 256 hsize--;
okini3939 0:bb21da73024a 257 } while ( (hsize > 0) && ((b & 0x80) != 0) );
okini3939 0:bb21da73024a 258 //utoa(subid, buff, 10);
okini3939 0:bb21da73024a 259 sprintf(buff, "%d", subid);
okini3939 0:bb21da73024a 260 strcat(value, ".");
okini3939 0:bb21da73024a 261 strcat(value, buff);
okini3939 0:bb21da73024a 262 }
okini3939 0:bb21da73024a 263 //
okini3939 0:bb21da73024a 264 // free buff
okini3939 0:bb21da73024a 265 //SNMP_FREE(buff);
okini3939 0:bb21da73024a 266 } else {
okini3939 0:bb21da73024a 267 for ( i = 0; i < size; i++ ) {
okini3939 0:bb21da73024a 268 value[i] = (char)data[i];
okini3939 0:bb21da73024a 269 }
okini3939 0:bb21da73024a 270 value[size] = '\0';
okini3939 0:bb21da73024a 271 }
okini3939 0:bb21da73024a 272 return SNMP_ERR_NO_ERROR;
okini3939 0:bb21da73024a 273 } else {
okini3939 0:bb21da73024a 274 clear();
okini3939 0:bb21da73024a 275 return SNMP_ERR_TOO_BIG;
okini3939 0:bb21da73024a 276 }
okini3939 0:bb21da73024a 277 } else {
okini3939 0:bb21da73024a 278 clear();
okini3939 0:bb21da73024a 279 return SNMP_ERR_WRONG_TYPE;
okini3939 0:bb21da73024a 280 }
okini3939 0:bb21da73024a 281 }
okini3939 0:bb21da73024a 282 //
okini3939 0:bb21da73024a 283 // decode's an int syntax to int16 ?? is this applicable
okini3939 0:bb21da73024a 284 SNMP_ERR_CODES decode(int16_t *value) {
okini3939 0:bb21da73024a 285 if ( syntax == SNMP_SYNTAX_INT ) {
okini3939 0:bb21da73024a 286 int16_u tmp;
okini3939 0:bb21da73024a 287 tmp.data[1] = data[0];
okini3939 0:bb21da73024a 288 tmp.data[0] = data[1];
okini3939 0:bb21da73024a 289 *value = tmp.int16;
okini3939 0:bb21da73024a 290 return SNMP_ERR_NO_ERROR;
okini3939 0:bb21da73024a 291 } else {
okini3939 0:bb21da73024a 292 clear();
okini3939 0:bb21da73024a 293 return SNMP_ERR_WRONG_TYPE;
okini3939 0:bb21da73024a 294 }
okini3939 0:bb21da73024a 295 }
okini3939 0:bb21da73024a 296 //
okini3939 0:bb21da73024a 297 // decode's an int32 syntax to int32
okini3939 0:bb21da73024a 298 SNMP_ERR_CODES decode(int32_t *value) {
okini3939 0:bb21da73024a 299 if ( syntax == SNMP_SYNTAX_INT32 ) {
okini3939 0:bb21da73024a 300 int32_u tmp;
okini3939 0:bb21da73024a 301 tmp.data[3] = data[0];
okini3939 0:bb21da73024a 302 tmp.data[2] = data[1];
okini3939 0:bb21da73024a 303 tmp.data[1] = data[2];
okini3939 0:bb21da73024a 304 tmp.data[0] = data[3];
okini3939 0:bb21da73024a 305 *value = tmp.int32;
okini3939 0:bb21da73024a 306 return SNMP_ERR_NO_ERROR;
okini3939 0:bb21da73024a 307 } else {
okini3939 0:bb21da73024a 308 clear();
okini3939 0:bb21da73024a 309 return SNMP_ERR_WRONG_TYPE;
okini3939 0:bb21da73024a 310 }
okini3939 0:bb21da73024a 311 }
okini3939 0:bb21da73024a 312 //
okini3939 0:bb21da73024a 313 // decode's an uint32, counter, time-ticks, gauge syntax to uint32
okini3939 0:bb21da73024a 314 SNMP_ERR_CODES decode(uint32_t *value) {
okini3939 0:bb21da73024a 315 if ( syntax == SNMP_SYNTAX_COUNTER || syntax == SNMP_SYNTAX_TIME_TICKS
okini3939 0:bb21da73024a 316 || syntax == SNMP_SYNTAX_GAUGE || syntax == SNMP_SYNTAX_UINT32 ) {
okini3939 0:bb21da73024a 317 uint32_u tmp;
okini3939 0:bb21da73024a 318 tmp.data[3] = data[0];
okini3939 0:bb21da73024a 319 tmp.data[2] = data[1];
okini3939 0:bb21da73024a 320 tmp.data[1] = data[2];
okini3939 0:bb21da73024a 321 tmp.data[0] = data[3];
okini3939 0:bb21da73024a 322 *value = tmp.uint32;
okini3939 0:bb21da73024a 323 return SNMP_ERR_NO_ERROR;
okini3939 0:bb21da73024a 324 } else {
okini3939 0:bb21da73024a 325 clear();
okini3939 0:bb21da73024a 326 return SNMP_ERR_WRONG_TYPE;
okini3939 0:bb21da73024a 327 }
okini3939 0:bb21da73024a 328 }
okini3939 0:bb21da73024a 329 //
okini3939 0:bb21da73024a 330 // decode's an ip-address, NSAP-address syntax to an ip-address byte array
okini3939 0:bb21da73024a 331 SNMP_ERR_CODES decode(byte *value) {
okini3939 0:bb21da73024a 332 memset(data, 0, SNMP_MAX_VALUE_LEN);
okini3939 0:bb21da73024a 333 if ( syntax == SNMP_SYNTAX_IP_ADDRESS || syntax == SNMP_SYNTAX_NSAPADDR ) {
okini3939 0:bb21da73024a 334 if ( sizeof(value) > 4 ) {
okini3939 0:bb21da73024a 335 clear();
okini3939 0:bb21da73024a 336 return SNMP_ERR_TOO_BIG;
okini3939 0:bb21da73024a 337 } else {
okini3939 0:bb21da73024a 338 size = 4;
okini3939 0:bb21da73024a 339 data[0] = value[3];
okini3939 0:bb21da73024a 340 data[1] = value[2];
okini3939 0:bb21da73024a 341 data[2] = value[1];
okini3939 0:bb21da73024a 342 data[3] = value[0];
okini3939 0:bb21da73024a 343 return SNMP_ERR_NO_ERROR;
okini3939 0:bb21da73024a 344 }
okini3939 0:bb21da73024a 345 } else {
okini3939 0:bb21da73024a 346 clear();
okini3939 0:bb21da73024a 347 return SNMP_ERR_WRONG_TYPE;
okini3939 0:bb21da73024a 348 }
okini3939 0:bb21da73024a 349 }
okini3939 0:bb21da73024a 350 //
okini3939 0:bb21da73024a 351 // decode's a boolean syntax to boolean
okini3939 0:bb21da73024a 352 SNMP_ERR_CODES decode(bool *value) {
okini3939 0:bb21da73024a 353 if ( syntax == SNMP_SYNTAX_BOOL ) {
okini3939 0:bb21da73024a 354 *value = (data[0] != 0);
okini3939 0:bb21da73024a 355 return SNMP_ERR_NO_ERROR;
okini3939 0:bb21da73024a 356 } else {
okini3939 0:bb21da73024a 357 clear();
okini3939 0:bb21da73024a 358 return SNMP_ERR_WRONG_TYPE;
okini3939 0:bb21da73024a 359 }
okini3939 0:bb21da73024a 360 }
okini3939 0:bb21da73024a 361 //
okini3939 0:bb21da73024a 362 //
okini3939 0:bb21da73024a 363 // ASN.1 encoding functions
okini3939 0:bb21da73024a 364 //
okini3939 0:bb21da73024a 365 // encode's a octet string to a string, opaque syntax
okini3939 0:bb21da73024a 366 // encode object-identifier here??
okini3939 0:bb21da73024a 367 SNMP_ERR_CODES encode(SNMP_SYNTAXES syn, const char *value) {
okini3939 0:bb21da73024a 368 memset(data, 0, SNMP_MAX_VALUE_LEN);
okini3939 0:bb21da73024a 369 if ( syn == SNMP_SYNTAX_OCTETS || syn == SNMP_SYNTAX_OPAQUE ) {
okini3939 0:bb21da73024a 370 if ( strlen(value) - 1 < SNMP_MAX_VALUE_LEN ) {
okini3939 0:bb21da73024a 371 syntax = syn;
okini3939 0:bb21da73024a 372 size = strlen(value);
okini3939 0:bb21da73024a 373 for ( i = 0; i < size; i++ ) {
okini3939 0:bb21da73024a 374 data[i] = (byte)value[i];
okini3939 0:bb21da73024a 375 }
okini3939 0:bb21da73024a 376 return SNMP_ERR_NO_ERROR;
okini3939 0:bb21da73024a 377 } else {
okini3939 0:bb21da73024a 378 clear();
okini3939 0:bb21da73024a 379 return SNMP_ERR_TOO_BIG;
okini3939 0:bb21da73024a 380 }
okini3939 0:bb21da73024a 381 } else {
okini3939 0:bb21da73024a 382 clear();
okini3939 0:bb21da73024a 383 return SNMP_ERR_WRONG_TYPE;
okini3939 0:bb21da73024a 384 }
okini3939 0:bb21da73024a 385 }
okini3939 0:bb21da73024a 386 //
okini3939 0:bb21da73024a 387 // encode's an int16 to int, opaque syntax
okini3939 0:bb21da73024a 388 SNMP_ERR_CODES encode(SNMP_SYNTAXES syn, const int16_t value) {
okini3939 0:bb21da73024a 389 memset(data, 0, SNMP_MAX_VALUE_LEN);
okini3939 0:bb21da73024a 390 if ( syn == SNMP_SYNTAX_INT || syn == SNMP_SYNTAX_OPAQUE ) {
okini3939 0:bb21da73024a 391 int16_u tmp;
okini3939 0:bb21da73024a 392 size = 2;
okini3939 0:bb21da73024a 393 syntax = syn;
okini3939 0:bb21da73024a 394 tmp.int16 = value;
okini3939 0:bb21da73024a 395 data[0] = tmp.data[1];
okini3939 0:bb21da73024a 396 data[1] = tmp.data[0];
okini3939 0:bb21da73024a 397 return SNMP_ERR_NO_ERROR;
okini3939 0:bb21da73024a 398 } else {
okini3939 0:bb21da73024a 399 clear();
okini3939 0:bb21da73024a 400 return SNMP_ERR_WRONG_TYPE;
okini3939 0:bb21da73024a 401 }
okini3939 0:bb21da73024a 402 }
okini3939 0:bb21da73024a 403 //
okini3939 0:bb21da73024a 404 // encode's an int32 to int32, opaque syntax
okini3939 0:bb21da73024a 405 SNMP_ERR_CODES encode(SNMP_SYNTAXES syn, const int32_t value) {
okini3939 0:bb21da73024a 406 memset(data, 0, SNMP_MAX_VALUE_LEN);
okini3939 0:bb21da73024a 407 if ( syn == SNMP_SYNTAX_INT32 || syn == SNMP_SYNTAX_OPAQUE ) {
okini3939 0:bb21da73024a 408 int32_u tmp;
okini3939 0:bb21da73024a 409 size = 4;
okini3939 0:bb21da73024a 410 syntax = syn;
okini3939 0:bb21da73024a 411 tmp.int32 = value;
okini3939 0:bb21da73024a 412 data[0] = tmp.data[3];
okini3939 0:bb21da73024a 413 data[1] = tmp.data[2];
okini3939 0:bb21da73024a 414 data[2] = tmp.data[1];
okini3939 0:bb21da73024a 415 data[3] = tmp.data[0];
okini3939 0:bb21da73024a 416 return SNMP_ERR_NO_ERROR;
okini3939 0:bb21da73024a 417 } else {
okini3939 0:bb21da73024a 418 clear();
okini3939 0:bb21da73024a 419 return SNMP_ERR_WRONG_TYPE;
okini3939 0:bb21da73024a 420 }
okini3939 0:bb21da73024a 421 }
okini3939 0:bb21da73024a 422 //
okini3939 0:bb21da73024a 423 // encode's an uint32 to uint32, counter, time-ticks, gauge, opaque syntax
okini3939 0:bb21da73024a 424 SNMP_ERR_CODES encode(SNMP_SYNTAXES syn, const uint32_t value) {
okini3939 0:bb21da73024a 425 memset(data, 0, SNMP_MAX_VALUE_LEN);
okini3939 0:bb21da73024a 426 if ( syn == SNMP_SYNTAX_COUNTER || syn == SNMP_SYNTAX_TIME_TICKS
okini3939 0:bb21da73024a 427 || syn == SNMP_SYNTAX_GAUGE || syn == SNMP_SYNTAX_UINT32
okini3939 0:bb21da73024a 428 || syn == SNMP_SYNTAX_OPAQUE ) {
okini3939 0:bb21da73024a 429 uint32_u tmp;
okini3939 0:bb21da73024a 430 size = 4;
okini3939 0:bb21da73024a 431 syntax = syn;
okini3939 0:bb21da73024a 432 tmp.uint32 = value;
okini3939 0:bb21da73024a 433 data[0] = tmp.data[3];
okini3939 0:bb21da73024a 434 data[1] = tmp.data[2];
okini3939 0:bb21da73024a 435 data[2] = tmp.data[1];
okini3939 0:bb21da73024a 436 data[3] = tmp.data[0];
okini3939 0:bb21da73024a 437 return SNMP_ERR_NO_ERROR;
okini3939 0:bb21da73024a 438 } else {
okini3939 0:bb21da73024a 439 clear();
okini3939 0:bb21da73024a 440 return SNMP_ERR_WRONG_TYPE;
okini3939 0:bb21da73024a 441 }
okini3939 0:bb21da73024a 442 }
okini3939 0:bb21da73024a 443 //
okini3939 0:bb21da73024a 444 // encode's an ip-address byte array to ip-address, NSAP-address, opaque syntax
okini3939 0:bb21da73024a 445 SNMP_ERR_CODES encode(SNMP_SYNTAXES syn, const byte *value) {
okini3939 0:bb21da73024a 446 memset(data, 0, SNMP_MAX_VALUE_LEN);
okini3939 0:bb21da73024a 447 if ( syn == SNMP_SYNTAX_IP_ADDRESS || syn == SNMP_SYNTAX_NSAPADDR
okini3939 0:bb21da73024a 448 || syn == SNMP_SYNTAX_OPAQUE ) {
okini3939 0:bb21da73024a 449 if ( sizeof(value) > 4 ) {
okini3939 0:bb21da73024a 450 clear();
okini3939 0:bb21da73024a 451 return SNMP_ERR_TOO_BIG;
okini3939 0:bb21da73024a 452 } else {
okini3939 0:bb21da73024a 453 size = 4;
okini3939 0:bb21da73024a 454 syntax = syn;
okini3939 0:bb21da73024a 455 data[0] = value[3];
okini3939 0:bb21da73024a 456 data[1] = value[2];
okini3939 0:bb21da73024a 457 data[2] = value[1];
okini3939 0:bb21da73024a 458 data[3] = value[0];
okini3939 0:bb21da73024a 459 return SNMP_ERR_NO_ERROR;
okini3939 0:bb21da73024a 460 }
okini3939 0:bb21da73024a 461 } else {
okini3939 0:bb21da73024a 462 clear();
okini3939 0:bb21da73024a 463 return SNMP_ERR_WRONG_TYPE;
okini3939 0:bb21da73024a 464 }
okini3939 0:bb21da73024a 465 }
okini3939 0:bb21da73024a 466 //
okini3939 0:bb21da73024a 467 // encode's a boolean to boolean, opaque syntax
okini3939 0:bb21da73024a 468 SNMP_ERR_CODES encode(SNMP_SYNTAXES syn, const bool value) {
okini3939 0:bb21da73024a 469 memset(data, 0, SNMP_MAX_VALUE_LEN);
okini3939 0:bb21da73024a 470 if ( syn == SNMP_SYNTAX_BOOL || syn == SNMP_SYNTAX_OPAQUE ) {
okini3939 0:bb21da73024a 471 size = 1;
okini3939 0:bb21da73024a 472 syntax = syn;
okini3939 0:bb21da73024a 473 data[0] = value ? 0xff : 0;
okini3939 0:bb21da73024a 474 return SNMP_ERR_NO_ERROR;
okini3939 0:bb21da73024a 475 } else {
okini3939 0:bb21da73024a 476 clear();
okini3939 0:bb21da73024a 477 return SNMP_ERR_WRONG_TYPE;
okini3939 0:bb21da73024a 478 }
okini3939 0:bb21da73024a 479 }
okini3939 0:bb21da73024a 480 //
okini3939 0:bb21da73024a 481 // encode's an uint64 to counter64, opaque syntax
okini3939 0:bb21da73024a 482 SNMP_ERR_CODES encode(SNMP_SYNTAXES syn, const uint64_t value) {
okini3939 0:bb21da73024a 483 memset(data, 0, SNMP_MAX_VALUE_LEN);
okini3939 0:bb21da73024a 484 if ( syn == SNMP_SYNTAX_COUNTER64 || syn == SNMP_SYNTAX_OPAQUE ) {
okini3939 0:bb21da73024a 485 uint64_u tmp;
okini3939 0:bb21da73024a 486 size = 8;
okini3939 0:bb21da73024a 487 syntax = syn;
okini3939 0:bb21da73024a 488 tmp.uint64 = value;
okini3939 0:bb21da73024a 489 data[0] = tmp.data[7];
okini3939 0:bb21da73024a 490 data[1] = tmp.data[6];
okini3939 0:bb21da73024a 491 data[2] = tmp.data[5];
okini3939 0:bb21da73024a 492 data[3] = tmp.data[4];
okini3939 0:bb21da73024a 493 data[4] = tmp.data[3];
okini3939 0:bb21da73024a 494 data[5] = tmp.data[2];
okini3939 0:bb21da73024a 495 data[6] = tmp.data[1];
okini3939 0:bb21da73024a 496 data[7] = tmp.data[0];
okini3939 0:bb21da73024a 497 return SNMP_ERR_NO_ERROR;
okini3939 0:bb21da73024a 498 } else {
okini3939 0:bb21da73024a 499 clear();
okini3939 0:bb21da73024a 500 return SNMP_ERR_WRONG_TYPE;
okini3939 0:bb21da73024a 501 }
okini3939 0:bb21da73024a 502 }
okini3939 0:bb21da73024a 503 //
okini3939 1:b2db0ea96703 504 // encode's an int32 to int32, opaque syntax
okini3939 1:b2db0ea96703 505 SNMP_ERR_CODES encode(SNMP_SYNTAXES syn, const float value) {
okini3939 1:b2db0ea96703 506 memset(data, 0, SNMP_MAX_VALUE_LEN);
okini3939 1:b2db0ea96703 507 if ( syn == SNMP_SYNTAX_OPAQUE_FLOAT ) {
okini3939 1:b2db0ea96703 508 float_u tmp;
okini3939 1:b2db0ea96703 509 size = 4;
okini3939 1:b2db0ea96703 510 syntax = syn;
okini3939 1:b2db0ea96703 511 tmp.float_t = value;
okini3939 1:b2db0ea96703 512 data[0] = tmp.data[3];
okini3939 1:b2db0ea96703 513 data[1] = tmp.data[2];
okini3939 1:b2db0ea96703 514 data[2] = tmp.data[1];
okini3939 1:b2db0ea96703 515 data[3] = tmp.data[0];
okini3939 1:b2db0ea96703 516 return SNMP_ERR_NO_ERROR;
okini3939 1:b2db0ea96703 517 } else {
okini3939 1:b2db0ea96703 518 clear();
okini3939 1:b2db0ea96703 519 return SNMP_ERR_WRONG_TYPE;
okini3939 1:b2db0ea96703 520 }
okini3939 1:b2db0ea96703 521 }
okini3939 1:b2db0ea96703 522 //
okini3939 0:bb21da73024a 523 // encode's a null to null, opaque syntax
okini3939 0:bb21da73024a 524 SNMP_ERR_CODES encode(SNMP_SYNTAXES syn) {
okini3939 0:bb21da73024a 525 clear();
okini3939 0:bb21da73024a 526 if ( syn == SNMP_SYNTAX_NULL || syn == SNMP_SYNTAX_OPAQUE ) {
okini3939 0:bb21da73024a 527 size = 0;
okini3939 0:bb21da73024a 528 syntax = syn;
okini3939 0:bb21da73024a 529 return SNMP_ERR_NO_ERROR;
okini3939 0:bb21da73024a 530 } else {
okini3939 0:bb21da73024a 531 return SNMP_ERR_WRONG_TYPE;
okini3939 0:bb21da73024a 532 }
okini3939 0:bb21da73024a 533 }
okini3939 0:bb21da73024a 534 } SNMP_VALUE;
okini3939 0:bb21da73024a 535
okini3939 0:bb21da73024a 536 typedef struct SNMP_PDU {
okini3939 0:bb21da73024a 537 SNMP_PDU_TYPES type;
okini3939 0:bb21da73024a 538 int32_t version;
okini3939 0:bb21da73024a 539 int32_t requestId;
okini3939 0:bb21da73024a 540 SNMP_ERR_CODES error;
okini3939 0:bb21da73024a 541 int32_t errorIndex;
okini3939 0:bb21da73024a 542 SNMP_OID OID;
okini3939 0:bb21da73024a 543 SNMP_VALUE VALUE;
okini3939 0:bb21da73024a 544 } SNMP_PDU;
okini3939 0:bb21da73024a 545
jonecm 3:81f25e337afc 546 class SNMP {
okini3939 0:bb21da73024a 547 public:
okini3939 0:bb21da73024a 548 // Agent functions
jonecm 3:81f25e337afc 549 SNMP_API_STAT_CODES init();
jonecm 3:81f25e337afc 550 SNMP_API_STAT_CODES init(char *getCommName, char *setCommName);
jonecm 3:81f25e337afc 551 SNMP_API_STAT_CODES toPdu( SNMP_PDU *pdu,char *_packet,uint16_t _packetSize);
jonecm 3:81f25e337afc 552 uint16_t fromPdu(SNMP_PDU *pdu,char *_packet);
okini3939 0:bb21da73024a 553 void freePdu(SNMP_PDU *pdu);
okini3939 0:bb21da73024a 554
okini3939 0:bb21da73024a 555 // Helper functions
okini3939 0:bb21da73024a 556
okini3939 0:bb21da73024a 557 private:
okini3939 0:bb21da73024a 558 uint16_t _packetPos;
okini3939 0:bb21da73024a 559 SNMP_PDU_TYPES _dstType;
okini3939 0:bb21da73024a 560 char *_getCommName;
okini3939 0:bb21da73024a 561 size_t _getSize;
okini3939 0:bb21da73024a 562 char *_setCommName;
okini3939 0:bb21da73024a 563 size_t _setSize;
okini3939 0:bb21da73024a 564 };
okini3939 0:bb21da73024a 565
jonecm 3:81f25e337afc 566 //extern SNMP Agentbed;
okini3939 0:bb21da73024a 567
okini3939 0:bb21da73024a 568 #endif