#include "conn.h"
#include "cw.h"
#include "dbg.h"

#define CW_MODE_ZYXEL 7
extern cw_send_msg(struct conn * conn,uint8_t * msg);

int conn_send_msg(struct conn * conn, uint8_t *rawmsg)
{
	uint8_t * ptr; 
	int packetlen;
	int fragoffset,hlen,mtu;

	packetlen = cw_get_hdr_msg_total_len(rawmsg);

	cw_dbg_msg(DBG_MSG_OUT, conn,rawmsg, packetlen,(struct sockaddr*)&conn->addr);


	/* Zyxel doesn't count msg element length from
	   behind seqnum */
	if (conn->capwap_mode == CW_MODE_ZYXEL){
/*		// XXX val-=3; */
	}


	ptr = rawmsg;

	fragoffset = 0;

	hlen = cw_get_hdr_hlen(rawmsg)*4;

	mtu = conn->mtu;
mtu = 9440;	
	mtu = mtu >> 3;
	mtu = mtu << 3;
	
	printf("packetlenX = %d (%d)\n",packetlen,hlen);
	 int offset = cw_get_hdr_msg_offset(rawmsg);
	return cw_send_msg(conn,rawmsg+offset);


	if (packetlen>mtu){
		cw_set_hdr_flags(ptr,CAPWAP_FLAG_HDR_F,1);
		cw_set_dword(ptr+4, conn->fragid<<16 | fragoffset<<3 );
		cw_dbg_pkt(DBG_PKT_OUT,conn,ptr,mtu,(struct sockaddr*)&conn->addr);
		if (conn->write(conn,ptr,mtu)<0)
			return -1;
		cw_set_hdr_flags(ptr,CAPWAP_FLAG_HDR_M,0);
		cw_set_hdr_flags(ptr,CAPWAP_FLAG_HDR_W,0);

		fragoffset+=(mtu-hlen)/8;
		hlen = 8;
		ptr += mtu-hlen;
		packetlen-=mtu-hlen;
		memcpy(ptr,rawmsg,hlen);

	}

	while (packetlen>mtu){
		
		cw_set_hdr_flags(ptr,CAPWAP_FLAG_HDR_F,1);
		cw_set_dword(ptr+4, conn->fragid<<16 | fragoffset<<3 );

		cw_dbg_pkt(DBG_PKT_OUT,conn,ptr,mtu,(struct sockaddr*)&conn->addr);

		if (conn->write(conn,ptr,mtu)<0)
			return -1;

/*		// XXX Fragmentation stuff.. */
		ptr +=mtu-hlen;
		fragoffset+=(mtu-hlen)/8;

		packetlen-=mtu-hlen;
		memcpy(ptr,rawmsg,hlen);
	}


	if (fragoffset)
		cw_set_hdr_flags(ptr,CAPWAP_FLAG_HDR_F | CAPWAP_FLAG_HDR_L,1);
	else
		cw_set_hdr_flags(ptr,CAPWAP_FLAG_HDR_F,0);

	cw_set_dword(ptr+4, conn->fragid<<16 | fragoffset<<3 );


	cw_dbg_pkt(DBG_PKT_OUT,conn,ptr,packetlen,(struct sockaddr*)&conn->addr);

	return conn->write(conn,ptr,packetlen-0);
}