]> git.karo-electronics.de Git - mv-sheeva.git/blob - drivers/uwb/ie-rcv.c
Merge git://git.kernel.org/pub/scm/linux/kernel/git/gregkh/usb-2.6
[mv-sheeva.git] / drivers / uwb / ie-rcv.c
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  */
29 int 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;
53 error:
54         return result;
55 }