From 55e8af4de946492084cfd4370522fea885e0894e Mon Sep 17 00:00:00 2001 From: "7u83@mail.ru" <7u83@mail.ru@noemail.net> Date: Sun, 5 Apr 2015 00:11:49 +0000 Subject: [PATCH] Inital commit. FossilOrigin-Name: ac07b6350f51326a8ef4af3e18f337b4cbe9aa188a329c03cb615e28f9136b45 --- src/capwap/avltree_foreach_from_lr.c | 28 ++++ src/capwap/avltree_get_node.c | 39 +++++ src/capwap/capwap_actions.h | 76 ++++++++++ src/capwap/capwap_actions_ac.c | 203 +++++++++++++++++++++++++++ src/capwap/conn_resp_init.c | 11 ++ src/capwap/conn_send_msg.c | 98 +++++++++++++ src/capwap/cw_dbg_elem.c | 45 ++++++ src/capwap/cw_in_generic.c | 37 +++++ 8 files changed, 537 insertions(+) create mode 100644 src/capwap/avltree_foreach_from_lr.c create mode 100644 src/capwap/avltree_get_node.c create mode 100644 src/capwap/capwap_actions.h create mode 100644 src/capwap/capwap_actions_ac.c create mode 100644 src/capwap/conn_resp_init.c create mode 100644 src/capwap/conn_send_msg.c create mode 100644 src/capwap/cw_dbg_elem.c create mode 100644 src/capwap/cw_in_generic.c diff --git a/src/capwap/avltree_foreach_from_lr.c b/src/capwap/avltree_foreach_from_lr.c new file mode 100644 index 00000000..e34d567b --- /dev/null +++ b/src/capwap/avltree_foreach_from_lr.c @@ -0,0 +1,28 @@ +#include "avltree.h" + +int avltree_foreach_from_lr(struct avltree *t, struct avlnode *n, void *data,int (*callback)(void *,void *),void *cbpriv) +{ + if (!n) + return 1; + + int rc=t->cmp(data,n->data); + if (rc<0){ + if(!avltree_foreach_from_lr(t,n->left,data,callback,cbpriv)) + return 0; + if (!callback(cbpriv,n->data)) + return 0; + return avltree_foreach_lr(n->right,callback,cbpriv); + } + + if (rc>0) { + avltree_foreach_from_lr(t,n->right,data,callback,cbpriv); + return 0; + } + + if (!callback(cbpriv,n->data)) + return 0; + + return avltree_foreach_lr(n->right,callback,cbpriv); +} + + diff --git a/src/capwap/avltree_get_node.c b/src/capwap/avltree_get_node.c new file mode 100644 index 00000000..8d3d3ff5 --- /dev/null +++ b/src/capwap/avltree_get_node.c @@ -0,0 +1,39 @@ +/* + This file is part of libcapwap. + + libcapwap is free software: you can redistribute it and/or modify + it under the terms of the GNU General Public License as published by + the Free Software Foundation, either version 3 of the License, or + (at your option) any later version. + + libcapwap is distributed in the hope that it will be useful, + but WITHOUT ANY WARRANTY; without even the implied warranty of + MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + GNU General Public License for more details. + + You should have received a copy of the GNU General Public License + along with Foobar. If not, see . + +*/ + + +#include + +#include "avltree.h" + + +struct avlnode * avltree_get_node(struct avltree *t ,void *data) +{ + struct avlnode *n = t->root; + while(n){ + int rc=t->cmp(data,n->data); + if (rc==0) + return n; + if (rc<0) + n=n->left; + else + n=n->right; + } + return NULL; +} + diff --git a/src/capwap/capwap_actions.h b/src/capwap/capwap_actions.h new file mode 100644 index 00000000..fe654be4 --- /dev/null +++ b/src/capwap/capwap_actions.h @@ -0,0 +1,76 @@ +/* + This file is part of libcapwap. + + libcapwap is free software: you can redistribute it and/or modify + it under the terms of the GNU General Public License as published by + the Free Software Foundation, either version 3 of the License, or + (at your option) any later version. + + libcapwap is distributed in the hope that it will be useful, + but WITHOUT ANY WARRANTY; without even the implied warranty of + MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + GNU General Public License for more details. + + You should have received a copy of the GNU General Public License + along with Foobar. If not, see . + +*/ + +#ifndef __CAPWAP_ACTIONS_H +#define __CAPWAP_ACTIONS_H + + +#include "capwap.h" +#include "capwap_items.h" + + +#define CW_ACTION_IN_LOCATION_DATA \ + CW_ELEM_LOCATION_DATA, /* Element ID*/ \ + cw_in_generic, 0, /* start/end callback */ \ + CW_ITEMTYPE_STR, /* Type of element */ \ + CW_ITEM_LOCATION_DATA, /* ID to use store */ \ + 1, 1024 /* min/max length */ + + +#define CW_ACTION_IN_WTP_NAME \ + CW_ELEM_WTP_NAME, /* Element ID*/ \ + cw_in_generic, 0, /* start/end callback */ \ + CW_ITEMTYPE_STR, /* Type of element */ \ + CW_ITEM_WTP_NAME, /* ID to use store */ \ + 1, 1024 /* min/max length */ + +#define CW_ACTION_IN_SESSION_ID \ + CW_ELEM_SESSION_ID, /* Element ID*/ \ + cw_in_generic, 0, /* start/end callback */ \ + CW_ITEMTYPE_BSTR, /* Type of element */ \ + CW_ITEM_SESSION_ID, /* ID to use store */ \ + 16, 16 /* min/max length */ + +#define CW_ACTION_IN_WTP_FRAME_TUNNEL_MODE \ + CW_ELEM_WTP_FRAME_TUNNEL_MODE, /* Element ID*/ \ + cw_in_generic, 0, /* start/end callback */ \ + CW_ITEMTYPE_BYTE, /* Type of element */ \ + CW_ITEM_WTP_FRAME_TUNNEL_MODE, /* ID to use store */ \ + 1, 1 /* min/max length */ + + +#define CW_ACTION_IN_WTP_MAC_TYPE \ + CW_ELEM_WTP_MAC_TYPE, /* Element ID*/ \ + cw_in_generic, 0, /* start/end callback */ \ + CW_ITEMTYPE_BYTE, /* Type of element */ \ + CW_ITEM_WTP_MAC_TYPE, /* ID to use store */ \ + 1, 1 /* min/max length */ + + + + +#define CW_ACTION_IN_WTP_BOARD_DATA \ + CW_ELEM_WTP_BOARD_DATA, /* Element ID */ \ + cw_in_wtp_board_data, 0 /* start/end callback */ \ + +#define CW_ACTION_IN_WTP_DESCRIPTOR \ + CW_ELEM_WTP_DESCRIPTOR, /* Element ID */ \ + cw_in_wtp_descriptor, 0 /* start/end callback */ \ + + +#endif diff --git a/src/capwap/capwap_actions_ac.c b/src/capwap/capwap_actions_ac.c new file mode 100644 index 00000000..266f8a28 --- /dev/null +++ b/src/capwap/capwap_actions_ac.c @@ -0,0 +1,203 @@ +/* + This file is part of libcapwap. + + libcapwap is free software: you can redistribute it and/or modify + it under the terms of the GNU General Public License as published by + the Free Software Foundation, either version 3 of the License, or + (at your option) any later version. + + libcapwap is distributed in the hope that it will be useful, + but WITHOUT ANY WARRANTY; without even the implied warranty of + MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + GNU General Public License for more details. + + You should have received a copy of the GNU General Public License + along with Foobar. If not, see . + +*/ + + +#include "capwap.h" +#include "action.h" +#include "capwap_items.h" +#include "capwap_actions.h" + +int cw_in_set_state_none(struct conn *conn,struct cw_action_in * a,uint8_t *data,int len) +{ + conn->capwap_state=CW_STATE_NONE; + return 1; +} + + + + +cw_action_in_t capwap_actions_ac_in[] = { + + + /* Message Discovery Request */ + + {0, 0, CW_STATE_DISCOVERY, CW_MSG_DISCOVERY_REQUEST, -1, + 0, cw_in_set_state_none} + , + + /* Element Discovery Type */ + {0, 0, CW_STATE_DISCOVERY, CW_MSG_DISCOVERY_REQUEST, CW_ELEM_DISCOVERY_TYPE, + cw_in_generic, 0, CW_ITEMTYPE_BYTE, CW_ITEM_DISCOVERY_TYPE, 1, 1} + , + + /* Element WTP Board Data */ + {0, 0, CW_STATE_DISCOVERY, CW_MSG_DISCOVERY_REQUEST, CW_ACTION_IN_WTP_BOARD_DATA } + , + + /* Element WTP Descriptor */ + {0, 0, CW_STATE_DISCOVERY, CW_MSG_DISCOVERY_REQUEST, CW_ACTION_IN_WTP_DESCRIPTOR } + , + + /* Element Frame Tunnel Mode */ + {0, 0, CW_STATE_DISCOVERY, CW_MSG_DISCOVERY_REQUEST, CW_ACTION_IN_WTP_FRAME_TUNNEL_MODE} + , + +// {0, 0, CW_STATE_DISCOVERY, CW_MSG_DISCOVERY_REQUEST, CW_ELEM_WTP_FRAME_TUNNEL_MODE, +// cw_in_generic, 0, CW_ITEMTYPE_BYTE, CW_ITEM_WTP_FRAME_TUNNEL_MODE, 1, 1} + + /* Element WTP Mac Tpe */ + {0, 0, CW_STATE_DISCOVERY, CW_MSG_DISCOVERY_REQUEST, CW_ACTION_IN_WTP_MAC_TYPE} + , + +// {0, 0, CW_STATE_DISCOVERY, CW_MSG_DISCOVERY_REQUEST, CW_ELEM_WTP_MAC_TYPE, +// cw_in_generic, 0, CW_ITEMTYPE_BYTE, CW_ITEM_WTP_MAC_TYPE, 1, 1} + + /* Vendor Specific Payload */ + {0, 0, CW_STATE_DISCOVERY, CW_MSG_DISCOVERY_REQUEST, CW_ELEM_VENDOR_SPECIFIC_PAYLOAD, + cw_in_vendor_specific_payload, 0} + , + + + /* Message: Join Request */ + {0, 0, CW_STATE_JOIN, CW_MSG_JOIN_REQUEST, -1, + 0, 0} + , + + /* Element Location Data */ + {0, 0, CW_STATE_JOIN, CW_MSG_JOIN_REQUEST, CW_ACTION_IN_LOCATION_DATA} + , + /* Element WTP Board Data */ + {0, 0, CW_STATE_JOIN, CW_MSG_JOIN_REQUEST, CW_ACTION_IN_WTP_BOARD_DATA} + , + /* Element WTP Board Data */ + {0, 0, CW_STATE_JOIN, CW_MSG_JOIN_REQUEST, CW_ACTION_IN_WTP_DESCRIPTOR} + , + /* Element WTP Board Data */ + {0, 0, CW_STATE_JOIN, CW_MSG_JOIN_REQUEST, CW_ACTION_IN_WTP_NAME} + , + /* Element WTP Board Data */ + {0, 0, CW_STATE_JOIN, CW_MSG_JOIN_REQUEST, CW_ACTION_IN_SESSION_ID} + , + /* Element WTP Board Data */ + {0, 0, CW_STATE_JOIN, CW_MSG_JOIN_REQUEST, CW_ACTION_IN_WTP_FRAME_TUNNEL_MODE} + , + {0, 0, CW_STATE_JOIN, CW_MSG_JOIN_REQUEST, CW_ACTION_IN_WTP_MAC_TYPE} + , + + + + + + + + + + +/* + {0, 1, 1, CW_MSG_DISCOVERY_RESPONSE, 0, + 0, 0} + , + + + {0, 1, 1, CW_MSG_DISCOVERY_RESPONSE, CW_ELEM_AC_NAME, + cw_out_generic, 0, CW_ITEMTYPE_DATA,CW_ITEM_AC_NAME} + , + + {0, 1, 2, CW_MSG_DISCOVERY_RESPONSE, 0, + 0, 0} + , + + +*/ + + +/* + {CW_VENDOR_ID_CISCO, 0, CW_STATE_DISCOVERY, CW_MSG_DISCOVERY_REQUEST, CW_CISCO_RAD_NAME, + cw_in_wtp_name, 0} + , +*/ + + {0, 0, 0} +}; + + +int cw_out_ac_name(uint8_t * dst, struct cw_item *item) +{ + + printf("Putting out the AC name %s\n", item->data); + + uint8_t *data = item->data; + int len = cw_put_data(dst + 4, data, strlen((char *) data)); + return len + cw_put_elem_hdr(dst, CW_ELEM_AC_NAME, len); +} + +struct cw_item *cw_get_local(struct conn *conn, uint32_t item_id) +{ + struct cw_item i; + i.id = item_id; + return cw_itemstore_get(conn->local, item_id); +} + + + +cw_action_out_t capwap_actions_ac_out[] = { + {CW_MSG_DISCOVERY_RESPONSE, CW_ITEM_NONE} + , + + /* AC Descriptor */ + {CW_MSG_DISCOVERY_RESPONSE, CW_ITEM_AC_DESCRIPTOR, + CW_ELEM_AC_DESCRIPTOR, cw_out_ac_descriptor, 0} + , + /* AC Name */ + {CW_MSG_DISCOVERY_RESPONSE, CW_ITEM_AC_NAME, + CW_ELEM_AC_NAME, cw_out_generic, cw_get_local} + , + + /* List of CAPWAP Control IPv4 and IPv6 addresses */ + {CW_MSG_DISCOVERY_RESPONSE, CW_ITEM_CAPWAP_CONTROL_IP_LIST, + 0, cw_out_capwap_control_ip_addrs, cw_get_local} + , + + + + + {CW_MSG_JOIN_RESPONSE, CW_ITEM_AC_NAME} + , + {CW_MSG_JOIN_RESPONSE, CW_ITEM_RESULT_CODE} + , + + + {0, 0} + +}; + + + + + + +int cw_register_actions_capwap_ac(struct cw_actiondef *def) +{ + def->in = cw_actionlist_in_create(); + def->out = cw_actionlist_out_create(); + + cw_actionlist_in_register_actions(def->in, capwap_actions_ac_in); + cw_actionlist_out_register_actions(def->out, capwap_actions_ac_out); + + return 1; +} diff --git a/src/capwap/conn_resp_init.c b/src/capwap/conn_resp_init.c new file mode 100644 index 00000000..765cd13e --- /dev/null +++ b/src/capwap/conn_resp_init.c @@ -0,0 +1,11 @@ + +#include "conn.h" + + +void conn_resp_init(strucct conn * conn) +{ + + + + +} diff --git a/src/capwap/conn_send_msg.c b/src/capwap/conn_send_msg.c new file mode 100644 index 00000000..e2346100 --- /dev/null +++ b/src/capwap/conn_send_msg.c @@ -0,0 +1,98 @@ + +#include "conn.h" +#include "capwap.h" +#include "cw_log.h" +#include "sock.h" + + +int conn_send_msg(struct conn * conn, uint8_t *rawmsg) +{ + + int packetlen = cw_get_hdr_msg_total_len(rawmsg); + + uint8_t * msgptr = rawmsg + cw_get_hdr_msg_offset(rawmsg); + + + /* Zyxel doesn't count msg element length from + behind seqnum */ + if (conn->capwap_mode == CWMODE_ZYXEL){ + // XXX val-=3; + } + + + uint8_t * ptr = rawmsg; + + int fragoffset = 0; + + int hlen = cw_get_hdr_hlen(rawmsg)*4; + + + int mtu = conn->mtu; + + while (packetlen>mtu){ + cw_set_hdr_flags(rawmsg,CW_FLAG_HDR_F,1); + cw_put_dword(ptr+4, conn->fragid<<16 | fragoffset<<3 ); + + + { + char h[200]; + hdr_print(h,ptr,mtu); + cw_dbg(DBG_CW_PKT_OUT,"Sending capwap packet to %s:\n%s",sock_addr2str(&conn->addr),h); + } + cw_dbg_dmp(DBG_CW_PKT_DMP,ptr,mtu,"Sending packet ..."); + + + if (conn->write(conn,ptr,mtu)<0) + return -1; + + ptr +=mtu-hlen; + fragoffset+=(mtu-hlen)/8; + + packetlen-=mtu-hlen; + +//XXX if (hlen>8) +// memcpy(ptr+8,cwmsg->ctrlhdr+8,hlen-8); + + } + +// val = (preamble << 24) | ((hlen/4)<<19) | (cwmsg->rid<<14) |(wbid<<9) | + /*CWTH_FLAGS_T|*/ //cwmsg->flags; + + +//printf("VAL = %08x, %08x\n",val,cwmsg->flags); + +//printf("FRag offset :::::::::::::::::::::::::::: %d\n",fragoffset); + + if (fragoffset) + cw_set_hdr_flags(rawmsg,CW_FLAG_HDR_F | CW_FLAG_HDR_L,1); + else + cw_set_hdr_flags(rawmsg,CW_FLAG_HDR_F,0); + + +// printf("Setting first byte %08X\n",val); +// *((uint32_t*)ptr)=htonl(val); + + +// val = conn->fragid<<16 | fragoffset<<3; +// *((uint32_t*)(ptr+4))=htonl(val); + + cw_put_dword(ptr+4, conn->fragid<<16 | fragoffset<<3 ); + + + { + // char h[1024]; + // hdr_print(h,ptr,msglen-fragoffset*8+hlen); + // cw_dbg(DBG_CW_PKT_OUT,"Sending capwap packet to %s:\n%s",sock_addr2str(&conn->addr),h); + } + + + cw_dbg_dmp(DBG_CW_PKT_DMP,ptr,packetlen,"Sending packet ..."); + //return conn->write(conn,ptr,msglen-fragoffset*8+hlen); + + + +printf("Send packet len %p %d\n",ptr,packetlen); + + return conn->write(conn,ptr,packetlen); +} + diff --git a/src/capwap/cw_dbg_elem.c b/src/capwap/cw_dbg_elem.c new file mode 100644 index 00000000..93dbb69d --- /dev/null +++ b/src/capwap/cw_dbg_elem.c @@ -0,0 +1,45 @@ +#include "cw_log.h" +#include "capwap.h" + + + +/** + * print debug info for message elements + */ + +void cw_dbg_elem_(int msg, int msgelem, const uint8_t * msgbuf, int len) +{ + if (!cw_dbg_is_level(DBG_ELEM)) + return; + + const char *elemname; + char vendorname[256]; + char vendor_details[265]; + *vendor_details = 0; + + if (msgelem == CW_ELEM_VENDOR_SPECIFIC_PAYLOAD) { + uint32_t vendor_id = ntohl(*((uint32_t *) msgbuf)); + int type = ntohs(*((uint16_t *) (msgbuf + 4))); + sprintf(vendorname, "%s/%s/%d", + (char *) cw_strelem(msgelem), + (char *) lw_vendor_id_to_str(vendor_id), type); + elemname = vendorname; + cw_format_vendor(vendor_details, vendor_id, type, msgbuf); + + } else { + elemname = cw_strelem(msgelem); + } + + + if (!cw_dbg_is_level(DBG_ELEM_DMP)) + cw_dbg(DBG_ELEM, + "%s, CAWPAP element: %d (%s), len=%d%s", + cw_strmsg(msg), msgelem, elemname, len, vendor_details); + + else + cw_dbg_dmp(DBG_ELEM, msgbuf, len, + "%s, CAPWAP element: %d (%s), len=%d%s\n\tDump ...", + cw_strmsg(msg), msgelem, elemname, len, vendor_details); +} + + diff --git a/src/capwap/cw_in_generic.c b/src/capwap/cw_in_generic.c new file mode 100644 index 00000000..67177acb --- /dev/null +++ b/src/capwap/cw_in_generic.c @@ -0,0 +1,37 @@ + +#include "action.h" +#include "cw_log.h" +#include "itemstore.h" + + + +int cw_itemstore_set(cw_itemstore_t itemstore, uint32_t item_id, int item_type, uint8_t *data, int len) +{ + switch (item_type) { + case CW_ITEMTYPE_BYTE: + cw_itemstore_set_byte(itemstore,item_id,*data); + break; + + case CW_ITEMTYPE_STR: + cw_itemstore_set_strn(itemstore,item_id,(char*)data,len); + break; + case CW_ITEMTYPE_BSTR: + cw_itemstore_set_bstrn(itemstore,item_id,data,len); + break; + + + } + return 0; +} + +int cw_in_generic(struct conn *conn,struct cw_action_in * a,uint8_t *data,int len) +{ + if (lenmin_len) { + cw_dbg(DBG_ELEM_ERR,"Message element too short, %d < %d", len,a->min_len); + return 0; + } + + cw_itemstore_set(conn->itemstore,a->item_id,a->itemtype,data,len); + + return 0; +}