Annotation of embedaddon/strongswan/src/conftest/hooks/set_reserved.c, revision 1.1
1.1 ! misho 1: /*
! 2: * Copyright (C) 2010 Martin Willi
! 3: * Copyright (C) 2010 revosec AG
! 4: *
! 5: * This program is free software; you can redistribute it and/or modify it
! 6: * under the terms of the GNU General Public License as published by the
! 7: * Free Software Foundation; either version 2 of the License, or (at your
! 8: * option) any later version. See <http://www.fsf.org/copyleft/gpl.txt>.
! 9: *
! 10: * This program is distributed in the hope that it will be useful, but
! 11: * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
! 12: * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
! 13: * for more details.
! 14: */
! 15:
! 16: #include "hook.h"
! 17:
! 18: #include <encoding/payloads/sa_payload.h>
! 19:
! 20: typedef struct private_set_reserved_t private_set_reserved_t;
! 21:
! 22: /**
! 23: * Private data of an set_reserved_t object.
! 24: */
! 25: struct private_set_reserved_t {
! 26:
! 27: /**
! 28: * Implements the hook_t interface.
! 29: */
! 30: hook_t hook;
! 31:
! 32: /**
! 33: * Alter requests or responses?
! 34: */
! 35: bool req;
! 36:
! 37: /**
! 38: * ID of message to alter.
! 39: */
! 40: int id;
! 41:
! 42: /**
! 43: * Hook name
! 44: */
! 45: char *name;
! 46: };
! 47:
! 48: /**
! 49: * Set reserved bit of a payload
! 50: */
! 51: static void set_bit(private_set_reserved_t *this, message_t *message,
! 52: payload_type_t type, u_int nr)
! 53: {
! 54: enumerator_t *payloads;
! 55: payload_t *payload;
! 56: bool *bit;
! 57:
! 58: if (type == PL_HEADER)
! 59: {
! 60: message->set_reserved_header_bit(message, nr);
! 61: DBG1(DBG_CFG, "setting reserved bit %d of %N",
! 62: nr, payload_type_short_names, type);
! 63: }
! 64: else
! 65: {
! 66: payloads = message->create_payload_enumerator(message);
! 67: while (payloads->enumerate(payloads, &payload))
! 68: {
! 69: if (payload->get_type(payload) == type)
! 70: {
! 71: bit = payload_get_field(payload, RESERVED_BIT, nr);
! 72: if (bit)
! 73: {
! 74: DBG1(DBG_CFG, "setting reserved bit %d of %N",
! 75: nr, payload_type_short_names, type);
! 76: *bit = TRUE;
! 77: }
! 78: }
! 79: }
! 80: payloads->destroy(payloads);
! 81: }
! 82: }
! 83:
! 84: /**
! 85: * Set reserved byte of a payload
! 86: */
! 87: static void set_byte(private_set_reserved_t *this, message_t *message,
! 88: payload_type_t type, u_int nr, uint8_t byteval)
! 89: {
! 90: enumerator_t *payloads;
! 91: payload_t *payload;
! 92: uint8_t *byte;
! 93:
! 94: if (type == PLV2_TRANSFORM_SUBSTRUCTURE || type == PLV2_PROPOSAL_SUBSTRUCTURE)
! 95: {
! 96: enumerator_t *transforms, *proposals;
! 97: transform_substructure_t *transform;
! 98: proposal_substructure_t *proposal;
! 99: sa_payload_t *sa;
! 100:
! 101: payloads = message->create_payload_enumerator(message);
! 102: while (payloads->enumerate(payloads, &payload))
! 103: {
! 104: if (payload->get_type(payload) == PLV2_SECURITY_ASSOCIATION)
! 105: {
! 106: sa = (sa_payload_t*)payload;
! 107: proposals = sa->create_substructure_enumerator(sa);
! 108: while (proposals->enumerate(proposals, &proposal))
! 109: {
! 110: if (type == PLV2_PROPOSAL_SUBSTRUCTURE)
! 111: {
! 112: byte = payload_get_field(&proposal->payload_interface,
! 113: RESERVED_BYTE, nr);
! 114: if (byte)
! 115: {
! 116: DBG1(DBG_CFG, "setting reserved byte %d of %N to %d",
! 117: nr, payload_type_short_names, type, byteval);
! 118: *byte = byteval;
! 119: }
! 120: }
! 121: else if (type == PLV2_TRANSFORM_SUBSTRUCTURE)
! 122: {
! 123: transforms = proposal->create_substructure_enumerator(
! 124: proposal);
! 125: while (transforms->enumerate(transforms, &transform))
! 126: {
! 127: byte = payload_get_field(&transform->payload_interface,
! 128: RESERVED_BYTE, nr);
! 129: if (byte)
! 130: {
! 131: DBG1(DBG_CFG, "setting reserved byte %d of %N to %d",
! 132: nr, payload_type_short_names, type, byteval);
! 133: *byte = byteval;
! 134: }
! 135: }
! 136: transforms->destroy(transforms);
! 137: }
! 138: }
! 139: proposals->destroy(proposals);
! 140: }
! 141: }
! 142: payloads->destroy(payloads);
! 143: }
! 144: else
! 145: {
! 146: payloads = message->create_payload_enumerator(message);
! 147: while (payloads->enumerate(payloads, &payload))
! 148: {
! 149: if (payload->get_type(payload) == type)
! 150: {
! 151: byte = payload_get_field(payload, RESERVED_BYTE, nr);
! 152: if (byte)
! 153: {
! 154: DBG1(DBG_CFG, "setting reserved byte %d of %N to %d",
! 155: nr, payload_type_short_names, type, byteval);
! 156: *byte = byteval;
! 157: }
! 158: }
! 159: }
! 160: payloads->destroy(payloads);
! 161: }
! 162: }
! 163:
! 164: METHOD(listener_t, message, bool,
! 165: private_set_reserved_t *this, ike_sa_t *ike_sa, message_t *message,
! 166: bool incoming, bool plain)
! 167: {
! 168: if (!incoming && plain &&
! 169: message->get_request(message) == this->req &&
! 170: message->get_message_id(message) == this->id)
! 171: {
! 172: enumerator_t *bits, *bytes, *types;
! 173: payload_type_t type;
! 174: char *nr, *name;
! 175: uint8_t byteval;
! 176:
! 177: types = conftest->test->create_section_enumerator(conftest->test,
! 178: "hooks.%s", this->name);
! 179: while (types->enumerate(types, &name))
! 180: {
! 181: type = atoi(name);
! 182: if (!type)
! 183: {
! 184: if (!enum_from_name(payload_type_short_names, name, &type))
! 185: {
! 186: DBG1(DBG_CFG, "invalid payload name '%s'", name);
! 187: break;
! 188: }
! 189: }
! 190: nr = conftest->test->get_str(conftest->test,
! 191: "hooks.%s.%s.bits", "", this->name, name);
! 192: bits = enumerator_create_token(nr, ",", " ");
! 193: while (bits->enumerate(bits, &nr))
! 194: {
! 195: set_bit(this, message, type, atoi(nr));
! 196: }
! 197: bits->destroy(bits);
! 198:
! 199: nr = conftest->test->get_str(conftest->test,
! 200: "hooks.%s.%s.bytes", "", this->name, name);
! 201: byteval = conftest->test->get_int(conftest->test,
! 202: "hooks.%s.%s.byteval", 255, this->name, name);
! 203: bytes = enumerator_create_token(nr, ",", " ");
! 204: while (bytes->enumerate(bytes, &nr))
! 205: {
! 206: set_byte(this, message, type, atoi(nr), byteval);
! 207: }
! 208: bytes->destroy(bytes);
! 209: }
! 210: types->destroy(types);
! 211: }
! 212: return TRUE;
! 213: }
! 214:
! 215: METHOD(hook_t, destroy, void,
! 216: private_set_reserved_t *this)
! 217: {
! 218: free(this->name);
! 219: free(this);
! 220: }
! 221:
! 222: /**
! 223: * Create the IKE_AUTH fill hook
! 224: */
! 225: hook_t *set_reserved_hook_create(char *name)
! 226: {
! 227: private_set_reserved_t *this;
! 228:
! 229: INIT(this,
! 230: .hook = {
! 231: .listener = {
! 232: .message = _message,
! 233: },
! 234: .destroy = _destroy,
! 235: },
! 236: .req = conftest->test->get_bool(conftest->test,
! 237: "hooks.%s.request", TRUE, name),
! 238: .id = conftest->test->get_int(conftest->test,
! 239: "hooks.%s.id", 0, name),
! 240: .name = strdup(name),
! 241: );
! 242:
! 243: return &this->hook;
! 244: }
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>