58 lines
1.3 KiB
C
58 lines
1.3 KiB
C
|
|
#include <string.h>
|
|
|
|
#include "capwap.h"
|
|
|
|
|
|
static inline int wtpdesc_addsubelem(uint8_t * dst,uint8_t type,uint32_t vendorid,uint8_t * str)
|
|
{
|
|
// printf("add subelem\n");
|
|
int l;
|
|
*((uint32_t*)(dst))=htonl(vendorid);
|
|
// printf("htonl done\n");
|
|
l=strlen((char*)str);
|
|
// 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;
|
|
|
|
/* encryption elements */
|
|
*(d+len)=CWTH_WBID_IEEE80211;
|
|
uint16_t val = 0;
|
|
*((uint16_t*)(d+len+1))=htons(val);
|
|
len+=3;
|
|
|
|
|
|
/* hardware subelem*/
|
|
len+=wtpdesc_addsubelem(d+len,CWMSGSUBELEM_WTP_DESCRIPTOR_HARDWARE_VERSION,
|
|
wtpinfo->hardware_vendor_id,wtpinfo->hardware_version);
|
|
|
|
|
|
/* software subelem*/
|
|
len+=wtpdesc_addsubelem(d+len,CWMSGSUBELEM_WTP_DESCRIPTOR_SOFTWARE_VERSION,
|
|
wtpinfo->software_vendor_id,wtpinfo->software_version);
|
|
|
|
/* bootloader subelem*/
|
|
len+=wtpdesc_addsubelem(d+len,CWMSGSUBELEM_WTP_DESCRIPTOR_BOOTLOADER_VERSION,
|
|
wtpinfo->bootloader_vendor_id,wtpinfo->bootloader_version);
|
|
|
|
|
|
cwmsg_addelem(cwmsg,CWMSGELEM_WTP_DESCRIPTOR,d,len);
|
|
}
|