#include <string.h>

#include "capwap.h"


static inline int wtpdesc_addsubelem(uint8_t * dst,uint8_t type,uint32_t vendorid,uint8_t * str,int len)  
{
//	printf("add subelem\n");
	int l;
	*((uint32_t*)(dst))=htonl(vendorid);   
//	printf("htonl done\n");
	if (len==-1)
		l=strlen((char*)str);
	else
		l=len;
//	printf("strlne got %d\n",l);
	*((uint32_t*)(dst+4))=htonl((type<<16)|l);
//	printf("memcopy str %d\n",l);
	memcpy(dst+8,str,l);
	return l+8;
}

void cwmsg_addelem_wtp_descriptor(struct cwmsg * cwmsg, struct wtpinfo * wtpinfo)
{
	uint8_t d[1024];
	int len=0;

	/* radios info */
	*(d)= wtpinfo->max_radios;
        *(d+1)=wtpinfo->radios_in_use;
	len=2;

	/* number of encryption elemnts */
//	*(d+len)=1;
//	len+=1;
	*(d+len)=0;
	len+=1;

	/* encryption elements */	


/*	*(d+len)=CWTH_WBID_IEEE80211;
	uint16_t val = 0;
	*((uint16_t*)(d+len+1))=htons(val);
	len+=3;
*/

/*	uint8_t hww[2];
	hww[0]=0x1c;
	hww[1]=0;
*/
	/* software subelem*/
	len+=wtpdesc_addsubelem(d+len,CWMSGSUBELEM_WTP_DESCRIPTOR_SOFTWARE_VERSION,
			wtpinfo->software_vendor_id,wtpinfo->software_version,-1);

	/* hardware subelem*/
//	len+=wtpdesc_addsubelem(d+len,CWMSGSUBELEM_WTP_DESCRIPTOR_HARDWARE_VERSION,
//			wtpinfo->hardware_vendor_id,wtpinfo->hardware_version,2);

/*	len+=wtpdesc_addsubelem(d+len,CWMSGSUBELEM_WTP_DESCRIPTOR_HARDWARE_VERSION,
			wtpinfo->hardware_vendor_id,hww,2);
*/

	/* bootloader subelem*/
/*	len+=wtpdesc_addsubelem(d+len,CWMSGSUBELEM_WTP_DESCRIPTOR_BOOTLOADER_VERSION,
			wtpinfo->bootloader_vendor_id,wtpinfo->bootloader_version,-1);

*/
	cwmsg_addelem(cwmsg,CWMSGELEM_WTP_DESCRIPTOR,d,len);
}