diff --git a/src/capwap/cwmsg_addelem_vendor_specific_payload.c b/src/capwap/cwmsg_addelem_vendor_specific_payload.c new file mode 100644 index 00000000..e8918137 --- /dev/null +++ b/src/capwap/cwmsg_addelem_vendor_specific_payload.c @@ -0,0 +1,43 @@ +/* + 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 . + +*/ + + +#include +#include + +#include "capwap.h" +#include "cw_log.h" + +void cwmsg_addelem_vendor_specific_payload(struct cwmsg *msg,int vendor_id, int type, uint8_t * payload,int len) +{ + uint8_t * buffer = malloc (len + 6); + if (!buffer){ + cw_log(LOG_ERR,"Add message elem vendor specific payload: out of memory"); + return; + } + + *((uint32_t*)buffer) = htonl(vendor_id); + *((uint16_t*)(buffer+4)) = htons(type); + memcpy(buffer+6,payload,len); + + + cwmsg_addelem(msg,CWMSGELEM_VENDOR_SPECIFIC_PAYLOAD,buffer,len+6); + free(buffer); +} + +