/* 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 . */ /** * @file * @brief implementation of cw_put_msg. */ #include "cw.h" #include "capwap_items.h" #include "conn.h" #include "log.h" #include "dbg.h" #include "msgset.h" /** * Put a message to a buffer * This functions assumes, that a message header is * alread initilaized in buffer * Message alements are taken fom actiondef in #conn->action */ int cw_put_msg(struct conn *conn, uint8_t * rawout) { uint8_t *msgptr,*dst; int type; struct cw_MsgData * msg; struct mlistelem * elem; int len,l; \ /* rawout is already initialized, so we can get * msg type from buffer */ msgptr = rawout + cw_get_hdr_msg_offset(rawout); type = cw_get_msg_type(msgptr); msg = cw_msgset_get_msgdata(conn->msgset,type); if (msg == NULL){ cw_log(LOG_ERR,"Error: Can't create message of type %d (%s) - no definition found.", type, cw_strmsg(type)); return CAPWAP_RESULT_MSG_UNRECOGNIZED; } printf("Message to send: %s (elems %d)\n",msg->name, msg->elements_list->count); dst = msgptr+8; len =0; mlist_foreach(elem,msg->elements_list){ struct cw_ElemData * data; struct cw_ElemHandler * handler; struct cw_ElemHandlerParams params; data = mlistelem_dataptr(elem); handler = cw_msgset_get_elemhandler(conn->msgset,data->proto,data->vendor,data->id); printf("Elem: %d %d %d %s\n", data->proto, data->vendor, data->id, handler->name); if (handler->put == NULL){ if (data->mand){ cw_log(LOG_ERR,"Error: Can't add mandatory message element %d - %s, no put method defined", handler->id, handler->name); } continue; } params.conn=conn; params.elemdata = data; l = handler->put(handler,¶ms,dst+len); len += l; cw_dbg_elem(DBG_ELEM,conn,type,handler,dst+len,l); } cw_set_msg_elems_len(msgptr, len); if (type & 1) { /* It's a request, so we have to set seqnum */ int s = conn_get_next_seqnum(conn); cw_set_msg_seqnum(msgptr,s); } return len; printf("Message to send: %s\n",msg->name); /* create search paramaters */ cw_action_out_t as; as.msg_id = cw_get_msg_type(msgptr); as.item_id = CW_ITEM_NONE; as.vendor_id = 0; dst = msgptr+8; printf("Put Message\n"); exit(0); //mlist_t m = cw_actionlist_out_get(conn->actions->out,cw_get_msg_type(msgptr)); mlist_t m =0; if (!m){ cw_log(LOG_ERR,"Error: Can't create message of type %d (%s) - no definition found.", as.msg_id,cw_strmsg(as.msg_id)); /* invalidate the cache */ cw_set_msg_type(msgptr,0); return -1; } struct mlistelem *e; len = 0; for (e=m->first; e; e=e->next) { int l; cw_action_out_t *ae=(cw_action_out_t*)e; //printf("Put %d %i %s\n",ae->msg_id,ae->elem_id,ae->item_id); if ( ae->item_id ) { // DBGX("Item ID: %s %p",ae->item_id,CW_ITEM_NONE); } if (ae->msg_id != as.msg_id) { /* Element is from next msg, close action */ break; } l=0; if (ae->out) { // printf("Out Call with len =%d\n",len); l= ae->out(conn, ae, dst+len); // cw_dbg_elem(DBG_ELEM, conn, ae->msg_id, ae->elem_id, dst+len,l); // printf("Returned len = %d\n",l); len +=l; } } cw_set_msg_elems_len(msgptr, len); if (as.msg_id & 1) { /* It's a request, so we have to set seqnum */ int s = conn_get_next_seqnum(conn); cw_set_msg_seqnum(msgptr,s); } return len; } /** * Put a message to a buffer * This functions assumes, that a message header with is * alread initilaized in buffer * Message alements are taken fom actiondef in #conn->action */ int cw_put_custom_msg(struct conn *conn, uint8_t * rawout, /*mavl_conststr_t elems*/ t) { /* // rawout is already initialized, so we can get //msg type from buffer uint8_t *msgptr = rawout + cw_get_hdr_msg_offset(rawout); int msg_id = cw_get_msg_type(msgptr); MAVLITER_DEFINE(it,elems); mavliter_foreach(&it){ const char *i= mavliter_get(&it); // preapare action search cw_action_out_t as; as.msg_id=msg_id; as.item_id=i; as.vendor_id=0; } cw_action_out_t as; as.item_id = CW_ITEM_NONE; as.vendor_id = 0; uint8_t *dst = msgptr+8; /// TODO XXXX // DEFINE_AVLITER(i,conn->actions->out); MAVLITER_DEFINE(i,0); cw_action_out_t *am; if (! (am=mavliter_seek(&i,&as))){ cw_log(LOG_ERR,"Error: Can't create message of type %d (%s) - no definition found.", as.msg_id,cw_strmsg(as.msg_id)); return -1; } cw_action_out_t *ae; int len = 0; while(NULL != (ae=mavliter_next(&i))) { // DBGX("Put %d %i %p\n",ae->msg_id,ae->elem_id,ae->item_id); // DBGX("Elem ID %s",ae->item_id); if ( ae->item_id ) { // DBGX("Item ID: %s %p",ae->item_id,CW_ITEM_NONE); } if (ae->msg_id != as.msg_id) { // Element is from next msg, close action break; } int l=0; if (ae->out) { l= ae->out(conn, ae, dst+len); len +=l; // cw_dbg_elem_colored(DBG_ELEM, conn, ae->msg_id, ae->elem_id, // dst+len-l,l); } // printf("DEBUGGER\n"); // cw_dbg_elem(DBG_ELEM, conn, ae->msg_id, ae->elem_id, 0,l); //cw_dbg_elem_colored(DBG_ELEM,"Adding element %d to msg %d, len = %d",ae->msg_id,ae->elem_id,l); }; cw_set_msg_elems_len(msgptr, len); if (as.msg_id & 1) { /// It's a request, so we have to set seqnum int s = conn_get_next_seqnum(conn); cw_set_msg_seqnum(msgptr,s); // printf("Set seqnum to : %d\n",s); } */ return 0; //len }