actube/src/capwap/wtpinfo_readelem_wtp_descri...

63 lines
1.3 KiB
C

#include "capwap.h"
#include "wtpinfo.h"
#include "cw_util.h"
int wtpinfo_readelem_wtp_descriptor(struct wtpinfo * wtpinfo, int type, uint8_t *msgelem, int len)
{
if (type != CWMSGELEM_WTP_DESCRIPTOR)
return 0;
if (len<6)
return -1;
wtpinfo->max_radios=*msgelem;
wtpinfo->radios_in_use=*(msgelem+1);
int ncrypt = *(msgelem+2);
int i=ncrypt*3+3;
do {
if (i+8>=len)
return -1;
uint32_t vendor_id=ntohl(*((uint32_t*)(msgelem+i)));
uint32_t val = ntohl(*((uint32_t*)(msgelem+i+4)));
int subtype= (val>>16)&0xffff;
int sublen = val&0xffff;
i+=8;
if (sublen+i>len){
//printf("Wrong sublen ba %d\n",sublen);
return -1;
}
switch(subtype){
case CWMSGSUBELEM_WTP_DESCRIPTOR_HARDWARE_VERSION:
wtpinfo->hardware_vendor_id=vendor_id;
cw_setstr(&wtpinfo->hardware_version,msgelem+i,sublen);
break;
case CWMSGSUBELEM_WTP_DESCRIPTOR_SOFTWARE_VERSION:
wtpinfo->software_vendor_id=vendor_id;
cw_setstr(&wtpinfo->software_version,msgelem+i,sublen);
break;
case CWMSGSUBELEM_WTP_DESCRIPTOR_BOOTLOADER_VERSION:
wtpinfo->bootloader_vendor_id=vendor_id;
cw_setstr(&wtpinfo->bootloader_version,msgelem+i,sublen);
break;
default:
//printf("unknown !!!\n");
break;
}
i+=sublen;
}while(i<len);
return 1;
}