7u83/freewtp
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Improve memory administration for tx/rx packet manager

Browse Source
This commit is contained in:
vemax78
2013-05-27 21:33:23 +02:00
parent 9157cc278b
commit 6c55b4d71f
126 changed files with 5383 additions and 7894 deletions
Download Patch File Download Diff File Expand all files Collapse all files

332
src/common/capwap_protocol.h
View File

@ -1,174 +1,17 @@
#ifndef __CAPWAP_PROTOCOL_HEADER__
#define __CAPWAP_PROTOCOL_HEADER__
#include "capwap_rfc.h"
#include "capwap_element.h"
#include "capwap_network.h"
#include "capwap_dtls.h"
#define CAPWAP_PROTOCOL_VERSION 0
#define CAPWAP_RADIOID_NONE 0
#define CAPWAP_MTU_DEFAULT 1400
#define CAPWAP_DONT_FRAGMENT 0
#define CAPWAP_WIRELESS_BINDING_NONE 0
#define CAPWAP_WIRELESS_BINDING_IEEE80211 1
#define CAPWAP_WIRELESS_BINDING_EPCGLOBAL 3
/* Capwap preamble */
#define CAPWAP_PREAMBLE_HEADER 0
#define CAPWAP_PREAMBLE_DTLS_HEADER 1
struct capwap_preamble {
#ifdef CAPWAP_BIG_ENDIAN
unsigned char version : 4;
unsigned char type : 4;
#else
unsigned char type : 4;
unsigned char version : 4;
#endif
} __attribute__((__packed__));
/* Capwap DTLS header */
struct capwap_dtls_header {
struct capwap_preamble preamble;
unsigned char reserved1;
unsigned char reserved2;
unsigned char reserved3;
} __attribute__((__packed__));
/* Capwap header: 8 (header) + 12 (radio mac) + 256 (wireless info) */
#define CAPWAP_HEADER_MAX_SIZE 276
struct capwap_header {
struct capwap_preamble preamble;
#ifdef CAPWAP_BIG_ENDIAN
unsigned short hlen : 5;
unsigned short rid : 5;
unsigned short wbid : 5;
unsigned short flag_t : 1;
unsigned char flag_f : 1;
unsigned char flag_l : 1;
unsigned char flag_w : 1;
unsigned char flag_m : 1;
unsigned char flag_k : 1;
unsigned char flag_res : 3;
#else
unsigned short _rid_hi : 3;
unsigned short hlen : 5;
unsigned short flag_t : 1;
unsigned short wbid : 5;
unsigned short _rid_lo : 2;
unsigned char flag_res : 3;
unsigned char flag_k : 1;
unsigned char flag_m : 1;
unsigned char flag_w : 1;
unsigned char flag_l : 1;
unsigned char flag_f : 1;
#endif
unsigned short frag_id;
unsigned short frag_off; /* Only first 13 bit */
} __attribute__((__packed__));
#define FRAGMENT_OFFSET_MASK 0xfff8
/* Mac Address */
struct capwap_mac_address {
unsigned char length;
char address[0];
} __attribute__((__packed__));
/* Wireless Information */
struct capwap_wireless_information {
unsigned char length;
char data[0];
} __attribute__((__packed__));
/* Control Message Type */
#define CAPWAP_FIRST_MESSAGE_TYPE 1
#define CAPWAP_DISCOVERY_REQUEST 1
#define CAPWAP_DISCOVERY_RESPONSE 2
#define CAPWAP_JOIN_REQUEST 3
#define CAPWAP_JOIN_RESPONSE 4
#define CAPWAP_CONFIGURATION_STATUS_REQUEST 5
#define CAPWAP_CONFIGURATION_STATUS_RESPONSE 6
#define CAPWAP_CONFIGURATION_UPDATE_REQUEST 7
#define CAPWAP_CONFIGURATION_UPDATE_RESPONSE 8
#define CAPWAP_WTP_EVENT_REQUEST 9
#define CAPWAP_WTP_EVENT_RESPONSE 10
#define CAPWAP_CHANGE_STATE_EVENT_REQUEST 11
#define CAPWAP_CHANGE_STATE_EVENT_RESPONSE 12
#define CAPWAP_ECHO_REQUEST 13
#define CAPWAP_ECHO_RESPONSE 14
#define CAPWAP_IMAGE_DATA_REQUEST 15
#define CAPWAP_IMAGE_DATA_RESPONSE 16
#define CAPWAP_RESET_REQUEST 17
#define CAPWAP_RESET_RESPONSE 18
#define CAPWAP_PRIMARY_DISCOVERY_REQUEST 19
#define CAPWAP_PRIMARY_DISCOVERY_RESPONSE 20
#define CAPWAP_DATA_TRANSFER_REQUEST 21
#define CAPWAP_DATA_TRANSFER_RESPONSE 22
#define CAPWAP_CLEAR_CONFIGURATION_REQUEST 23
#define CAPWAP_CLEAR_CONFIGURATION_RESPONSE 24
#define CAPWAP_STATION_CONFIGURATION_REQUEST 25
#define CAPWAP_STATION_CONFIGURATION_RESPONSE 26
#define CAPWAP_LAST_MESSAGE_TYPE 26
/* Control Message */
struct capwap_control_message {
unsigned long type;
unsigned char seq;
unsigned short length;
unsigned char flags;
char elements[0];
} __attribute__((__packed__));
/* Data Message */
struct capwap_data_message {
unsigned short length;
char elements[0];
} __attribute__((__packed__));
/* Capwap dtls header helper */
#define GET_DTLS_BODY(x) (void*)(((char*)(x)) + sizeof(struct capwap_dtls_header))
/* Capwap header helper */
#define GET_VERSION_HEADER(x) ((x)->preamble.version)
#define SET_VERSION_HEADER(x, y) ((x)->preamble.version = (unsigned char)(y))
#define GET_TYPE_HEADER(x) ((x)->preamble.type)
#define SET_TYPE_HEADER(x, y) ((x)->preamble.type = (unsigned char)(y))
#define GET_HLEN_HEADER(x) ((x)->hlen)
#define SET_HLEN_HEADER(x, y) ((x)->hlen = (unsigned short)(y))
#ifdef CAPWAP_BIG_ENDIAN
#define GET_RID_HEADER(x) ((x)->rid)
#define SET_RID_HEADER(x, y) ((x)->rid = (unsigned short)(y))
#else
#define GET_RID_HEADER(x) ((unsigned short)((x)->_rid_hi << 2 | (x)->_rid_lo))
#define SET_RID_HEADER(x, y) ({ (x)->_rid_hi = (unsigned short)((y) >> 2); (x)->_rid_lo = (unsigned short)((y) & 0x0003); })
#endif
#define GET_WBID_HEADER(x) ((x)->wbid)
#define SET_WBID_HEADER(x, y) ((x)->wbid = (unsigned short)(y))
#define IS_FLAG_T_HEADER(x) ((x)->flag_t)
#define SET_FLAG_T_HEADER(x, y) ((x)->flag_t = ((y) ? 1 : 0))
#define IS_FLAG_F_HEADER(x) ((x)->flag_f)
#define SET_FLAG_F_HEADER(x, y) ((x)->flag_f = ((y) ? 1 : 0))
#define IS_FLAG_L_HEADER(x) ((x)->flag_l)
#define SET_FLAG_L_HEADER(x, y) ((x)->flag_l = ((y) ? 1 : 0))
#define IS_FLAG_W_HEADER(x) ((x)->flag_w)
#define SET_FLAG_W_HEADER(x, y) ((x)->flag_w = ((y) ? 1 : 0))
#define IS_FLAG_M_HEADER(x) ((x)->flag_m)
#define SET_FLAG_M_HEADER(x, y) ((x)->flag_m = ((y) ? 1 : 0))
#define IS_FLAG_K_HEADER(x) ((x)->flag_k)
#define SET_FLAG_K_HEADER(x, y) ((x)->flag_k = ((y) ? 1 : 0))
#define GET_FRAGMENT_ID_HEADER(x) (ntohs((x)->frag_id))
#define SET_FRAGMENT_ID_HEADER(x, y) ((x)->frag_id = htons((unsigned short)(y)))
#define GET_FRAGMENT_OFFSET_HEADER(x) (ntohs((x)->frag_off) & FRAGMENT_OFFSET_MASK)
#define SET_FRAGMENT_OFFSET_HEADER(x, y) ((x)->frag_off &= ~FRAGMENT_OFFSET_MASK, (x)->frag_off |= htons((unsigned short)(y) & FRAGMENT_OFFSET_MASK))
#define GET_RADIO_MAC_ADDRESS_STRUCT(x) ((struct capwap_mac_address*)(((char*)(x)) + sizeof(struct capwap_header)))
#define GET_WIRELESS_INFORMATION_STRUCT(x) ((struct capwap_wireless_information*)(((char*)(x)) + sizeof(struct capwap_header) + (IS_FLAG_M_HEADER(x) ? (((GET_RADIO_MAC_ADDRESS_STRUCT(x)->length + sizeof(struct capwap_mac_address)) + 3) / 4) * 4 : 0)))
#define GET_PAYLOAD_HEADER(x) ((void*)(((char*)(x)) + GET_HLEN_HEADER(x) * 4))
#define IS_SEQUENCE_SMALLER(s1, s2) (((((s1) < (s2)) && (((s2) - (s1)) < 128)) || (((s1) > (s2)) && (((s1) - (s2)) > 128))) ? 1 : 0)
/*********************************************************************************************************************/
/* Sanity check packet */
#define CAPWAP_WRONG_PACKET -1
#define CAPWAP_NONE_PACKET 0
@ -176,81 +19,110 @@ struct capwap_data_message {
#define CAPWAP_DTLS_PACKET 2
int capwap_sanity_check(int isctrlsocket, int state, void* buffer, int buffersize, int dtlsctrlenable, int dtlsdataenable);
/* Fragment packet */
struct capwap_fragment_packet {
void* buffer;
int size;
/* Fragment management */
struct capwap_fragment_packet_item {
unsigned short size;
unsigned short offset;
char buffer[0];
};
/* Fragment control list */
struct capwap_fragment_sender {
struct sockaddr_storage sendaddr;
unsigned short fragment_id;
int islastrecv;
/* Packet */
/* Capwap header function */
struct capwap_header_data {
char headerbuffer[CAPWAP_HEADER_MAX_SIZE];
};
void capwap_header_init(struct capwap_header_data* data, unsigned short radioid, unsigned short binding);
void capwap_header_set_radio_macaddress(struct capwap_header_data* data, int radiotype, char* macaddress);
void capwap_header_set_wireless_information(struct capwap_header_data* data, void* buffer, unsigned char length);
void capwap_header_set_keepalive_flag(struct capwap_header_data* data, int enable);
/* Management tx capwap packet */
struct write_block_from_pos {
struct capwap_list_item* item;
unsigned short pos;
};
struct capwap_packet_txmng {
unsigned short mtu;
struct capwap_list* fragmentlist;
/* Capwap header */
struct capwap_header* header;
struct capwap_list* packetlist;
};
typedef struct capwap_list capwap_fragment_list;
/* Packet */
struct capwap_packet {
unsigned short packetsize;
struct capwap_header* header;
void* payload;
struct sockaddr_storage localaddr;
struct sockaddr_storage remoteaddr;
struct capwap_socket socket;
};
#define CAPWAP_WRONG_FRAGMENT -1
#define CAPWAP_REQUEST_MORE_FRAGMENT 0
#define CAPWAP_RECEIVE_COMPLETE_PACKET 1
int capwap_defragment_packets(struct sockaddr_storage* sendaddr, void* buffer, int buffersize, capwap_fragment_list* defraglist, struct capwap_packet* packet);
capwap_fragment_list* capwap_defragment_init_list(void);
void capwap_defragment_flush_list(capwap_fragment_list* defraglist);
void capwap_defragment_free_list(capwap_fragment_list* defraglist);
int capwap_defragment_remove_sender(capwap_fragment_list* defraglist, struct sockaddr_storage* sendaddr);
struct capwap_fragment_sender* capwap_defragment_find_sender(capwap_fragment_list* defraglist, struct sockaddr_storage* sendaddr);
void capwap_free_packet(struct capwap_packet* packet);
/* Build tx packet */
struct capwap_build_packet {
/* Capwap message */
int isctrlpacket;
union {
struct capwap_header header;
char headerbuffer[CAPWAP_HEADER_MAX_SIZE];
struct capwap_control_message* ctrlmsg;
struct capwap_data_message* datamsg;
};
/* Control Packet */
int isctrlmsg;
/* Write functions */
struct capwap_write_message_elements_ops write_ops;
unsigned short writerpacketsize;
};
/* */
struct capwap_packet_txmng* capwap_packet_txmng_create_ctrl_message(struct capwap_header_data* data, unsigned long type, unsigned char seq, unsigned short mtu);
struct capwap_packet_txmng* capwap_packet_txmng_create_data_message(struct capwap_header_data* data, unsigned short mtu);
void capwap_packet_txmng_add_message_element(struct capwap_packet_txmng* txmngpacket, unsigned short type, void* data);
void capwap_packet_txmng_get_fragment_packets(struct capwap_packet_txmng* txmngpacket, struct capwap_list* fragmentlist, unsigned short fragmentid);
void capwap_packet_txmng_free(struct capwap_packet_txmng* txmngpacket);
/* Management rx capwap packet */
struct read_block_from_pos {
struct capwap_list_item* item;
unsigned short pos;
};
struct capwap_packet_rxmng {
struct capwap_list* fragmentlist;
unsigned long packetlength;
/* Capwap header */
struct capwap_header* header;
/* Capwap message */
int isctrlpacket;
union {
struct capwap_control_message ctrlmsg;
struct capwap_data_message datamsg;
};
/* Message element */
struct capwap_list* elementslist;
/* Position of message elements or binding data */
struct read_block_from_pos readbodypos;
/* Read functions */
struct capwap_read_message_elements_ops read_ops;
struct read_block_from_pos readpos;
unsigned short readerpacketallowed;
struct capwap_list_item* readerfragmentitem;
unsigned short readerfragmentoffset;
};
#define CAPWAP_RADIOID_NONE 0
#define CAPWAP_WIRELESS_BINDING_NONE 0
#define CAPWAP_WIRELESS_BINDING_IEEE80211 1
#define CAPWAP_WIRELESS_BINDING_EPCGLOBAL 3
/* */
#define CAPWAP_WRONG_FRAGMENT -1
#define CAPWAP_REQUEST_MORE_FRAGMENT 0
#define CAPWAP_RECEIVE_COMPLETE_PACKET 1
struct capwap_build_packet* capwap_tx_packet_create(unsigned short radioid, unsigned short binding);
struct capwap_build_packet* capwap_rx_packet_create(void* buffer, int buffersize, int isctrlpacket);
void capwap_build_packet_free(struct capwap_build_packet* buildpacket);
void capwap_build_packet_set_radio_macaddress(struct capwap_build_packet* buildpacket, int radiotype, char* macaddress);
void capwap_build_packet_set_wireless_information(struct capwap_build_packet* buildpacket, void* buffer, unsigned char length);
void capwap_build_packet_set_control_message_type(struct capwap_build_packet* buildpacket, unsigned long type, unsigned char seq);
void capwap_build_packet_add_message_element(struct capwap_build_packet* buildpacket, struct capwap_message_element* element);
struct capwap_packet_rxmng* capwap_packet_rxmng_create_message(int isctrlpacket);
int capwap_packet_rxmng_add_recv_packet(struct capwap_packet_rxmng* rxmngpacket, void* data, int length);
void capwap_packet_rxmng_free(struct capwap_packet_rxmng* rxmngpacket);
/* */
int capwap_is_request_type(unsigned long type);
/* Check capwap message type */
#define VALID_MESSAGE_TYPE 0
#define INVALID_MESSAGE_TYPE 1
#define INVALID_REQUEST_MESSAGE_TYPE 2
int capwap_check_message_type(struct capwap_packet_rxmng* rxmngpacket);
/* Retransmission function */
void capwap_get_packet_digest(struct capwap_packet_rxmng* rxmngpacket, struct capwap_connection* connection, unsigned char packetdigest[16]);
int capwap_recv_retrasmitted_request(struct capwap_dtls* dtls, struct capwap_packet_rxmng* rxmngpacket, struct capwap_connection* connection, unsigned char packetdigest[16], struct capwap_list* txfragmentpacket);
/* TODO utile ?
#define CAPWAP_VALID_PACKET 0x00000000
#define CAPWAP_MISSING_MANDATORY_MSG_ELEMENT 0x00000001
#define CAPWAP_UNRECOGNIZED_MSG_ELEMENT 0x00000002
@ -259,20 +131,6 @@ struct unrecognized_info {
unsigned short element;
unsigned char reason;
};
typedef struct capwap_array capwap_unrecognized_element_array;
unsigned long capwap_build_packet_validate(struct capwap_build_packet* buildpacket, capwap_unrecognized_element_array* reasonarray);
typedef struct capwap_array capwap_fragment_packet_array;
int capwap_fragment_build_packet(struct capwap_build_packet* buildpacket, capwap_fragment_packet_array* packets, unsigned short mtu, unsigned short fragmentid);
void capwap_fragment_free(capwap_fragment_packet_array* packets);
int capwap_is_request_type(unsigned long type);
void capwap_get_packet_digest(void* buffer, unsigned long length, unsigned char packetdigest[16]);
int capwap_recv_retrasmitted_request(struct capwap_dtls* dtls, struct capwap_packet* packet, unsigned char lastseqnumber, unsigned char packetdigest[16], struct capwap_socket* sock, capwap_fragment_packet_array* txfragmentpacket, struct sockaddr_storage* sendfromaddr, struct sockaddr_storage* sendtoaddr);
int capwap_check_message_type(struct capwap_dtls* dtls, struct capwap_packet* packet, unsigned short mtu);
int capwap_get_sessionid_from_keepalive(struct capwap_build_packet* buildpacket, struct capwap_sessionid_element* session);
*/
#endif /* __CAPWAP_PROTOCOL_HEADER__ */