1/*
 2 * Ultra Wide Band
 3 * IE Received notification handling.
 4 *
 5 * Copyright (C) 2008 Cambridge Silicon Radio Ltd.
 6 *
 7 * This program is free software; you can redistribute it and/or
 8 * modify it under the terms of the GNU General Public License version
 9 * 2 as published by the Free Software Foundation.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
18 */
19
20#include <linux/errno.h>
21#include <linux/module.h>
22#include <linux/device.h>
23#include <linux/bitmap.h>
24#include "uwb-internal.h"
25
26/*
27 * Process an incoming IE Received notification.
28 */
29int uwbd_evt_handle_rc_ie_rcv(struct uwb_event *evt)
30{
31	int result = -EINVAL;
32	struct device *dev = &evt->rc->uwb_dev.dev;
33	struct uwb_rc_evt_ie_rcv *iercv;
34	size_t iesize;
35
36	/* Is there enough data to decode it? */
37	if (evt->notif.size < sizeof(*iercv)) {
38		dev_err(dev, "IE Received notification: Not enough data to "
39			"decode (%zu vs %zu bytes needed)\n",
40			evt->notif.size, sizeof(*iercv));
41		goto error;
42	}
43	iercv = container_of(evt->notif.rceb, struct uwb_rc_evt_ie_rcv, rceb);
44	iesize = le16_to_cpu(iercv->wIELength);
45
46	dev_dbg(dev, "IE received, element ID=%d\n", iercv->IEData[0]);
47
48	if (iercv->IEData[0] == UWB_RELINQUISH_REQUEST_IE) {
49		dev_warn(dev, "unhandled Relinquish Request IE\n");
50	}
51
52	return 0;
53error:
54	return result;
55}