2015-07-15 19:52:23 +02:00
|
|
|
/*
|
|
|
|
*
|
|
|
|
* Wireless daemon for Linux
|
|
|
|
*
|
|
|
|
* Copyright (C) 2015 Intel Corporation. All rights reserved.
|
|
|
|
*
|
|
|
|
* This library is free software; you can redistribute it and/or
|
|
|
|
* modify it under the terms of the GNU Lesser General Public
|
|
|
|
* License as published by the Free Software Foundation; either
|
|
|
|
* version 2.1 of the License, or (at your option) any later version.
|
|
|
|
*
|
|
|
|
* This library 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
|
|
|
|
* Lesser General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU Lesser General Public
|
|
|
|
* License along with this library; if not, write to the Free Software
|
|
|
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
|
|
#include <config.h>
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#include <stdbool.h>
|
|
|
|
|
|
|
|
#include <ell/ell.h>
|
|
|
|
|
|
|
|
#include "wsc.h"
|
|
|
|
|
2015-07-15 21:44:28 +02:00
|
|
|
void wsc_wfa_ext_iter_init(struct wsc_wfa_ext_iter *iter,
|
|
|
|
const unsigned char *pdu, unsigned short len)
|
|
|
|
{
|
|
|
|
iter->pdu = pdu;
|
|
|
|
iter->max = len;
|
|
|
|
iter->pos = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
bool wsc_wfa_ext_iter_next(struct wsc_wfa_ext_iter *iter)
|
|
|
|
{
|
|
|
|
const unsigned char *start = iter->pdu + iter->pos;
|
|
|
|
const unsigned char *end = iter->pdu + iter->max;
|
|
|
|
unsigned char type;
|
|
|
|
unsigned char len;
|
|
|
|
|
|
|
|
if (iter->pos + 2 >= iter->max)
|
|
|
|
return false;
|
|
|
|
|
|
|
|
type = *start;
|
|
|
|
start += 1;
|
|
|
|
|
|
|
|
len = *start;
|
|
|
|
start += 1;
|
|
|
|
|
|
|
|
if (start + len > end)
|
|
|
|
return false;
|
|
|
|
|
|
|
|
iter->type = type;
|
|
|
|
iter->len = len;
|
|
|
|
iter->data = start;
|
|
|
|
|
|
|
|
iter->pos = start + len - iter->pdu;
|
|
|
|
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
2015-07-15 19:52:23 +02:00
|
|
|
void wsc_attr_iter_init(struct wsc_attr_iter *iter, const unsigned char *pdu,
|
|
|
|
unsigned int len)
|
|
|
|
{
|
|
|
|
iter->pdu = pdu;
|
|
|
|
iter->max = len;
|
|
|
|
iter->pos = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
bool wsc_attr_iter_next(struct wsc_attr_iter *iter)
|
|
|
|
{
|
|
|
|
const unsigned char *start = iter->pdu + iter->pos;
|
|
|
|
const unsigned char *end = iter->pdu + iter->max;
|
|
|
|
unsigned short type;
|
|
|
|
unsigned short len;
|
|
|
|
|
|
|
|
/* Make sure we have at least type + len fields */
|
|
|
|
if (iter->pos + 4 >= iter->max)
|
|
|
|
return false;
|
|
|
|
|
|
|
|
type = l_get_be16(start);
|
|
|
|
start += 2;
|
|
|
|
|
|
|
|
len = l_get_be16(start);
|
|
|
|
start += 2;
|
|
|
|
|
|
|
|
if (start + len > end)
|
|
|
|
return false;
|
|
|
|
|
|
|
|
iter->type = type;
|
|
|
|
iter->len = len;
|
|
|
|
iter->data = start;
|
|
|
|
|
|
|
|
iter->pos = start + len - iter->pdu;
|
|
|
|
|
|
|
|
return true;
|
|
|
|
}
|
2015-07-15 21:44:28 +02:00
|
|
|
|
|
|
|
bool wsc_attr_iter_recurse_wfa_ext(struct wsc_attr_iter *iter,
|
|
|
|
struct wsc_wfa_ext_iter *wfa_iter)
|
|
|
|
{
|
|
|
|
static const unsigned char wfa_ext[3] = { 0x00, 0x37, 0x2a };
|
|
|
|
|
|
|
|
if (iter->type != WSC_ATTR_VENDOR_EXTENSION)
|
|
|
|
return false;
|
|
|
|
|
|
|
|
if (iter->len < 3)
|
|
|
|
return false;
|
|
|
|
|
|
|
|
if (memcmp(iter->data, wfa_ext, sizeof(wfa_ext)))
|
|
|
|
return false;
|
|
|
|
|
|
|
|
wsc_wfa_ext_iter_init(wfa_iter, iter->data + 3, iter->len - 3);
|
|
|
|
|
|
|
|
return true;
|
|
|
|
}
|