/*
    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/>.

*/

#include <stdlib.h>
#include <string.h>

#include "capwap.h"
#include "cwmsg.h"

#include "sock.h" //Tube

void cwmsg_init(struct cwmsg * cwmsg, uint8_t *buffer, int type, int seqnum, struct radioinfo * radioinfo)
{
	int hlen=8;
	cwmsg->buffer=buffer;
	cwmsg->trnsprthdr=buffer;


	int rmaclen=0;
	cwmsg->flags=0;

	if (radioinfo){
		if (radioinfo->rmac){
			/* we assume the radio mac is already aligned */
			rmaclen=bstr_len(radioinfo->rmac);
			*(buffer+8)=rmaclen;
			memcpy(buffer+9,bstr_data(radioinfo->rmac),rmaclen);
			cwmsg->flags=CWTH_FLAGS_M;	
			rmaclen++;
		}
	}

	hlen+=rmaclen;
	if (hlen%4){
		int n = hlen;
		hlen = (hlen>>2)*4+4;
		memset(buffer+n,0,hlen-n);
		*(buffer+n)=0xc0;
	}

	
	cwmsg->ctrlhdr=cwmsg->trnsprthdr+hlen; 
	cwmsg->msgelems=cwmsg->ctrlhdr+8;

	*((uint32_t*)(cwmsg->ctrlhdr))=htonl(type); 

	cwmsg->pos=0;
	cwmsg->hlen=hlen/4;
	if (radioinfo)
		cwmsg->rid=radioinfo->rid;
	else	
		cwmsg->rid=0;
	cwmsg->seqnum=seqnum;
	cwmsg->type=type;
}