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 }