Inital commit.
FossilOrigin-Name: 5ebcac16650a7eb8c6d151a698f83cf04f21327128b57d7ea31da60cb4dee8f5
This commit is contained in:
		
							
								
								
									
										112
									
								
								src/capwap/cw_put_msg.c
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										112
									
								
								src/capwap/cw_put_msg.c
									
									
									
									
									
										Normal file
									
								
							@ -0,0 +1,112 @@
 | 
			
		||||
/*
 | 
			
		||||
    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 <http://www.gnu.org/licenses/>.
 | 
			
		||||
 | 
			
		||||
*/
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @file
 | 
			
		||||
 * @brief implementation of cw_put_msg.
 | 
			
		||||
 */ 
 | 
			
		||||
 | 
			
		||||
#include "capwap.h"
 | 
			
		||||
#include "capwap_items.h"
 | 
			
		||||
#include "conn.h"
 | 
			
		||||
 | 
			
		||||
struct args{
 | 
			
		||||
	struct conn * conn;
 | 
			
		||||
	uint32_t msg_id;
 | 
			
		||||
	uint8_t * dst;
 | 
			
		||||
	int len;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
static int action_cb(void *args_param, void *a_param)
 | 
			
		||||
{
 | 
			
		||||
	struct cw_action_out * a = (struct cw_action_out *)a_param;
 | 
			
		||||
	struct args * args = (struct args *)args_param;
 | 
			
		||||
	
 | 
			
		||||
//printf("ACTION_CB: %d %d %d\n",a->msg_id, a->vendor_id, a->item_id);
 | 
			
		||||
 | 
			
		||||
	if (a->msg_id != args->msg_id) {
 | 
			
		||||
		/* Element is from next msg, close action */
 | 
			
		||||
		return 0;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (a->item_id == CW_ITEM_NONE) {
 | 
			
		||||
		/* Start of message */
 | 
			
		||||
		return 1;		
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
	int l = 0;
 | 
			
		||||
 | 
			
		||||
	uint8_t *dst = args->dst + args->len;
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
	if (a->out) {
 | 
			
		||||
		l = a->out(args->conn, a, dst); 
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	args->len += l;
 | 
			
		||||
	return 1;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * 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_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;
 | 
			
		||||
 | 
			
		||||
	
 | 
			
		||||
	/* setup arguments for callback function */	
 | 
			
		||||
	struct args args;
 | 
			
		||||
 | 
			
		||||
	args.conn = conn;
 | 
			
		||||
	args.msg_id = as.msg_id;
 | 
			
		||||
	args.dst = msgptr+8; 
 | 
			
		||||
	args.len=0;
 | 
			
		||||
 | 
			
		||||
	avltree_foreach_from_asc(conn->actions->out, &as, action_cb, &args);
 | 
			
		||||
 | 
			
		||||
	cw_set_msg_elems_len(msgptr, args.len);
 | 
			
		||||
 | 
			
		||||
/*
 | 
			
		||||
	printf ("Total elems len = %d\n",args.len);
 | 
			
		||||
	printf("Total msg len = %d\n",cw_get_hdr_msg_total_len(rawout)); 	
 | 
			
		||||
*/
 | 
			
		||||
	return args.len;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
		Reference in New Issue
	
	Block a user