98 lines
2.4 KiB
C
98 lines
2.4 KiB
C
/*
|
|
This file is part of actube.
|
|
|
|
actube 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 "cw.h"
|
|
#include "cw_types.h"
|
|
#include "dbg.h"
|
|
#include "keys.h"
|
|
|
|
int cw_read_descriptor_subelems(mavl_t cfg, const char * parent_key,
|
|
uint8_t * data, int len,
|
|
struct cw_DescriptorSubelemDef *elems)
|
|
{
|
|
uint32_t vendor_id;
|
|
int sublen,subtype;
|
|
int errors = 0;
|
|
int success = 0;
|
|
int sub = 0;
|
|
while (sub < len) {
|
|
int i;
|
|
|
|
if (len - sub < 8) {
|
|
return 0;
|
|
}
|
|
vendor_id = cw_get_dword(data + sub);
|
|
sublen = cw_get_word(data + sub + 6);
|
|
subtype = cw_get_word(data + sub + 4);
|
|
|
|
|
|
/* search sub-element */
|
|
for (i = 0; elems[i].maxlen; i++) {
|
|
if (elems[i].type == subtype && elems[i].vendor_id==vendor_id)
|
|
break;
|
|
}
|
|
|
|
|
|
if (!elems[i].maxlen) {
|
|
cw_dbg_version_subelem(DBG_ELEM_ERR, "Not allowed",
|
|
subtype, vendor_id, data+sub+8, sublen);
|
|
errors++;
|
|
} else {
|
|
int l = sublen;
|
|
mavldata_t mdata, *mdata_result;
|
|
char dbgstr[1048];
|
|
char key[1024];
|
|
|
|
if (elems[i].maxlen < sublen) {
|
|
cw_dbg(DBG_ELEM_ERR,
|
|
"SubType %d Too long (truncating), len = %d,max. len=%d",
|
|
subtype, sublen, elems[i].maxlen);
|
|
l = elems[i].maxlen;
|
|
}
|
|
|
|
|
|
/* vendor */
|
|
sprintf(key,"%s/%s/%s",parent_key,elems[i].key,CW_KEY_VENDOR);
|
|
mdata.kv.key = strdup(key);
|
|
mdata.kv.val.dword = vendor_id;
|
|
mdata.kv.priv=CW_TYPE_DWORD;
|
|
mavl_add(cfg,&mdata);
|
|
|
|
|
|
/* version */
|
|
sprintf(key,"%s/%s/%s",parent_key,elems[i].key,CW_KEY_VERSION);
|
|
mdata_result = cw_type_version.get(&mdata,data+sub+8,l);
|
|
mdata.kv.key = strdup(key);
|
|
mavl_add(cfg,mdata_result);
|
|
|
|
cw_type_version.to_str(mdata_result,dbgstr,90);
|
|
sprintf(dbgstr, "Storing '%s'", elems[i].key);
|
|
cw_dbg_version_subelem(DBG_SUBELEM, dbgstr, subtype, vendor_id, data+sub+8,l);
|
|
success++;
|
|
}
|
|
|
|
if (sub + sublen > len)
|
|
return -1;
|
|
|
|
sub += sublen + 8;
|
|
|
|
}
|
|
|
|
return success;
|
|
}
|