/* 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 "capwap.h" #include "capwap_items.h" #include "conn.h" #include "log.h" #include "dbg.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) { /* rawout is already initialized, so we can get msg type from buffer */ uint8_t *msgptr = rawout + cw_get_hdr_msg_offset(rawout); /* 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; uint8_t *dst = msgptr+8; mlist_t *m = cw_actionlist_out_get(conn->actions->out,cw_get_msg_type(msgptr)); 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 mlist_elem *e; int len = 0; for (e=m->list; e; e=e->next) { cw_action_out_t *ae=(cw_action_out_t*)e->data; 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; } if (ae->out) { int l=0; l= ae->out(conn, ae, dst+len); 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; exit(0); DEFINE_AVLITER(i,conn->actions->out); cw_action_out_t *am; if (! (am=avliter_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; while(NULL != (ae=avliter_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; } if (ae->out) { int l=0; l= ae->out(conn, ae, dst+len); len +=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 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) { /* 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; } /* create search paramaters */ cw_action_out_t as; as.item_id = CW_ITEM_NONE; as.vendor_id = 0; uint8_t *dst = msgptr+8; DEFINE_AVLITER(i,conn->actions->out); cw_action_out_t *am; if (! (am=avliter_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=avliter_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; } if (ae->out) { int l=0; 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); } //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 len; }