drivers/uwb/address.c

   1 /*
   2  * Ultra Wide Band
   3  * Address management
   4  *
   5  * Copyright (C) 2005-2006 Intel Corporation
   6  * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License version
  10  * 2 as published by the Free Software Foundation.
  11  *
  12  * This program is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  * GNU General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License
  18  * along with this program; if not, write to the Free Software
  19  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  20  * 02110-1301, USA.
  21  *
  22  *
  23  * FIXME: docs
  24  */
  25
  26 #include <linux/slab.h>
  27 #include <linux/errno.h>
  28 #include <linux/module.h>
  29 #include <linux/device.h>
  30 #include <linux/random.h>
  31 #include <linux/etherdevice.h>
  32
  33 #include "uwb-internal.h"
  34
  35
  36 /** Device Address Management command */
  37 struct uwb_rc_cmd_dev_addr_mgmt {
  38         struct uwb_rccb rccb;
  39         u8 bmOperationType;
  40         u8 baAddr[6];
  41 } __attribute__((packed));
  42
  43
  44 /**
  45  * Low level command for setting/getting UWB radio's addresses
  46  *
  47  * @hwarc:      HWA Radio Control interface instance
  48  * @bmOperationType:
  49  *              Set/get, MAC/DEV (see WUSB1.0[8.6.2.2])
  50  * @baAddr:     address buffer--assumed to have enough data to hold
  51  *              the address type requested.
  52  * @reply:      Pointer to reply buffer (can be stack allocated)
  53  * @returns:    0 if ok, < 0 errno code on error.
  54  *
  55  * @cmd has to be allocated because USB cannot grok USB or vmalloc
  56  * buffers depending on your combination of host architecture.
  57  */
  58 static
  59 int uwb_rc_dev_addr_mgmt(struct uwb_rc *rc,
  60                          u8 bmOperationType, const u8 *baAddr,
  61                          struct uwb_rc_evt_dev_addr_mgmt *reply)
  62 {
  63         int result;
  64         struct uwb_rc_cmd_dev_addr_mgmt *cmd;
  65
  66         result = -ENOMEM;
  67         cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
  68         if (cmd == NULL)
  69                 goto error_kzalloc;
  70         cmd->rccb.bCommandType = UWB_RC_CET_GENERAL;
  71         cmd->rccb.wCommand = cpu_to_le16(UWB_RC_CMD_DEV_ADDR_MGMT);
  72         cmd->bmOperationType = bmOperationType;
  73         if (baAddr) {
  74                 size_t size = 0;
  75                 switch (bmOperationType >> 1) {
  76                 case 0: size = 2; break;
  77                 case 1: size = 6; break;
  78                 default: BUG();
  79                 }
  80                 memcpy(cmd->baAddr, baAddr, size);
  81         }
  82         reply->rceb.bEventType = UWB_RC_CET_GENERAL;
  83         reply->rceb.wEvent = UWB_RC_CMD_DEV_ADDR_MGMT;
  84         result = uwb_rc_cmd(rc, "DEV-ADDR-MGMT",
  85                             &cmd->rccb, sizeof(*cmd),
  86                             &reply->rceb, sizeof(*reply));
  87         if (result < 0)
  88                 goto error_cmd;
  89         if (result < sizeof(*reply)) {
  90                 dev_err(&rc->uwb_dev.dev,
  91                         "DEV-ADDR-MGMT: not enough data replied: "
  92                         "%d vs %zu bytes needed\n", result, sizeof(*reply));
  93                 result = -ENOMSG;
  94         } else if (reply->bResultCode != UWB_RC_RES_SUCCESS) {
  95                 dev_err(&rc->uwb_dev.dev,
  96                         "DEV-ADDR-MGMT: command execution failed: %s (%d)\n",
  97                         uwb_rc_strerror(reply->bResultCode),
  98                         reply->bResultCode);
  99                 result = -EIO;
 100         } else
 101                 result = 0;
 102 error_cmd:
 103         kfree(cmd);
 104 error_kzalloc:
 105         return result;
 106 }
 107
 108
 109 /**
 110  * Set the UWB RC MAC or device address.
 111  *
 112  * @rc:      UWB Radio Controller
 113  * @_addr:   Pointer to address to write [assumed to be either a
 114  *           'struct uwb_mac_addr *' or a 'struct uwb_dev_addr *'].
 115  * @type:    Type of address to set (UWB_ADDR_DEV or UWB_ADDR_MAC).
 116  * @returns: 0 if ok, < 0 errno code on error.
 117  *
 118  * Some anal retentivity here: even if both 'struct
 119  * uwb_{dev,mac}_addr' have the actual byte array in the same offset
 120  * and I could just pass _addr to hwarc_cmd_dev_addr_mgmt(), I prefer
 121  * to use some syntatic sugar in case someday we decide to change the
 122  * format of the structs. The compiler will optimize it out anyway.
 123  */
 124 static int uwb_rc_addr_set(struct uwb_rc *rc,
 125                     const void *_addr, enum uwb_addr_type type)
 126 {
 127         int result;
 128         u8 bmOperationType = 0x1;               /* Set address */
 129         const struct uwb_dev_addr *dev_addr = _addr;
 130         const struct uwb_mac_addr *mac_addr = _addr;
 131         struct uwb_rc_evt_dev_addr_mgmt reply;
 132         const u8 *baAddr;
 133
 134         result = -EINVAL;
 135         switch (type) {
 136         case UWB_ADDR_DEV:
 137                 baAddr = dev_addr->data;
 138                 break;
 139         case UWB_ADDR_MAC:
 140                 baAddr = mac_addr->data;
 141                 bmOperationType |= 0x2;
 142                 break;
 143         default:
 144                 return result;
 145         }
 146         return uwb_rc_dev_addr_mgmt(rc, bmOperationType, baAddr, &reply);
 147 }
 148
 149
 150 /**
 151  * Get the UWB radio's MAC or device address.
 152  *
 153  * @rc:      UWB Radio Controller
 154  * @_addr:   Where to write the address data [assumed to be either a
 155  *           'struct uwb_mac_addr *' or a 'struct uwb_dev_addr *'].
 156  * @type:    Type of address to get (UWB_ADDR_DEV or UWB_ADDR_MAC).
 157  * @returns: 0 if ok (and *_addr set), < 0 errno code on error.
 158  *
 159  * See comment in uwb_rc_addr_set() about anal retentivity in the
 160  * type handling of the address variables.
 161  */
 162 static int uwb_rc_addr_get(struct uwb_rc *rc,
 163                     void *_addr, enum uwb_addr_type type)
 164 {
 165         int result;
 166         u8 bmOperationType = 0x0;               /* Get address */
 167         struct uwb_rc_evt_dev_addr_mgmt evt;
 168         struct uwb_dev_addr *dev_addr = _addr;
 169         struct uwb_mac_addr *mac_addr = _addr;
 170         u8 *baAddr;
 171
 172         result = -EINVAL;
 173         switch (type) {
 174         case UWB_ADDR_DEV:
 175                 baAddr = dev_addr->data;
 176                 break;
 177         case UWB_ADDR_MAC:
 178                 bmOperationType |= 0x2;
 179                 baAddr = mac_addr->data;
 180                 break;
 181         default:
 182                 return result;
 183         }
 184         result = uwb_rc_dev_addr_mgmt(rc, bmOperationType, baAddr, &evt);
 185         if (result == 0)
 186                 switch (type) {
 187                 case UWB_ADDR_DEV:
 188                         memcpy(&dev_addr->data, evt.baAddr,
 189                                sizeof(dev_addr->data));
 190                         break;
 191                 case UWB_ADDR_MAC:
 192                         memcpy(&mac_addr->data, evt.baAddr,
 193                                sizeof(mac_addr->data));
 194                         break;
 195                 default:                /* shut gcc up */
 196                         BUG();
 197                 }
 198         return result;
 199 }
 200
 201
 202 /** Get @rc's MAC address to @addr */
 203 int uwb_rc_mac_addr_get(struct uwb_rc *rc,
 204                         struct uwb_mac_addr *addr) {
 205         return uwb_rc_addr_get(rc, addr, UWB_ADDR_MAC);
 206 }
 207 EXPORT_SYMBOL_GPL(uwb_rc_mac_addr_get);
 208
 209
 210 /** Get @rc's device address to @addr */
 211 int uwb_rc_dev_addr_get(struct uwb_rc *rc,
 212                         struct uwb_dev_addr *addr) {
 213         return uwb_rc_addr_get(rc, addr, UWB_ADDR_DEV);
 214 }
 215 EXPORT_SYMBOL_GPL(uwb_rc_dev_addr_get);
 216
 217
 218 /** Set @rc's address to @addr */
 219 int uwb_rc_mac_addr_set(struct uwb_rc *rc,
 220                         const struct uwb_mac_addr *addr)
 221 {
 222         int result = -EINVAL;
 223         mutex_lock(&rc->uwb_dev.mutex);
 224         result = uwb_rc_addr_set(rc, addr, UWB_ADDR_MAC);
 225         mutex_unlock(&rc->uwb_dev.mutex);
 226         return result;
 227 }
 228
 229
 230 /** Set @rc's address to @addr */
 231 int uwb_rc_dev_addr_set(struct uwb_rc *rc,
 232                         const struct uwb_dev_addr *addr)
 233 {
 234         int result = -EINVAL;
 235         mutex_lock(&rc->uwb_dev.mutex);
 236         result = uwb_rc_addr_set(rc, addr, UWB_ADDR_DEV);
 237         rc->uwb_dev.dev_addr = *addr;
 238         mutex_unlock(&rc->uwb_dev.mutex);
 239         return result;
 240 }
 241
 242 /* Returns !0 if given address is already assigned to device. */
 243 int __uwb_mac_addr_assigned_check(struct device *dev, void *_addr)
 244 {
 245         struct uwb_dev *uwb_dev = to_uwb_dev(dev);
 246         struct uwb_mac_addr *addr = _addr;
 247
 248         if (!uwb_mac_addr_cmp(addr, &uwb_dev->mac_addr))
 249                 return !0;
 250         return 0;
 251 }
 252
 253 /* Returns !0 if given address is already assigned to device. */
 254 int __uwb_dev_addr_assigned_check(struct device *dev, void *_addr)
 255 {
 256         struct uwb_dev *uwb_dev = to_uwb_dev(dev);
 257         struct uwb_dev_addr *addr = _addr;
 258         if (!uwb_dev_addr_cmp(addr, &uwb_dev->dev_addr))
 259                 return !0;
 260         return 0;
 261 }
 262
 263 /**
 264  * uwb_dev_addr_assign - assigned a generated DevAddr to a radio controller
 265  * @rc:      the (local) radio controller device requiring a new DevAddr
 266  *
 267  * A new DevAddr is required when:
 268  *    - first setting up a radio controller
 269  *    - if the hardware reports a DevAddr conflict
 270  *
 271  * The DevAddr is randomly generated in the generated DevAddr range
 272  * [0x100, 0xfeff]. The number of devices in a beacon group is limited
 273  * by mMaxBPLength (96) so this address space will never be exhausted.
 274  *
 275  * [ECMA-368] 17.1.1, 17.16.
 276  */
 277 int uwb_rc_dev_addr_assign(struct uwb_rc *rc)
 278 {
 279         struct uwb_dev_addr new_addr;
 280
 281         do {
 282                 get_random_bytes(new_addr.data, sizeof(new_addr.data));
 283         } while (new_addr.data[0] == 0x00 || new_addr.data[0] == 0xff
 284                  || __uwb_dev_addr_assigned(rc, &new_addr));
 285
 286         return uwb_rc_dev_addr_set(rc, &new_addr);
 287 }
 288
 289 /**
 290  * uwbd_evt_handle_rc_dev_addr_conflict - handle a DEV_ADDR_CONFLICT event
 291  * @evt: the DEV_ADDR_CONFLICT notification from the radio controller
 292  *
 293  * A new (non-conflicting) DevAddr is assigned to the radio controller.
 294  *
 295  * [ECMA-368] 17.1.1.1.
 296  */
 297 int uwbd_evt_handle_rc_dev_addr_conflict(struct uwb_event *evt)
 298 {
 299         struct uwb_rc *rc = evt->rc;
 300
 301         return uwb_rc_dev_addr_assign(rc);
 302 }
 303
 304 /*
 305  * Print the 48-bit EUI MAC address of the radio controller when
 306  * reading /sys/class/uwb_rc/XX/mac_address
 307  */
 308 static ssize_t uwb_rc_mac_addr_show(struct device *dev,
 309                                     struct device_attribute *attr, char *buf)
 310 {
 311         struct uwb_dev *uwb_dev = to_uwb_dev(dev);
 312         struct uwb_rc *rc = uwb_dev->rc;
 313         struct uwb_mac_addr addr;
 314         ssize_t result;
 315
 316         mutex_lock(&rc->uwb_dev.mutex);
 317         result = uwb_rc_addr_get(rc, &addr, UWB_ADDR_MAC);
 318         mutex_unlock(&rc->uwb_dev.mutex);
 319         if (result >= 0) {
 320                 result = uwb_mac_addr_print(buf, UWB_ADDR_STRSIZE, &addr);
 321                 buf[result++] = '\n';
 322         }
 323         return result;
 324 }
 325
 326 /*
 327  * Parse a 48 bit address written to /sys/class/uwb_rc/XX/mac_address
 328  * and if correct, set it.
 329  */
 330 static ssize_t uwb_rc_mac_addr_store(struct device *dev,
 331                                      struct device_attribute *attr,
 332                                      const char *buf, size_t size)
 333 {
 334         struct uwb_dev *uwb_dev = to_uwb_dev(dev);
 335         struct uwb_rc *rc = uwb_dev->rc;
 336         struct uwb_mac_addr addr;
 337         ssize_t result;
 338
 339         result = sscanf(buf, "%hhx:%hhx:%hhx:%hhx:%hhx:%hhx\n",
 340                         &addr.data[0], &addr.data[1], &addr.data[2],
 341                         &addr.data[3], &addr.data[4], &addr.data[5]);
 342         if (result != 6) {
 343                 result = -EINVAL;
 344                 goto out;
 345         }
 346         if (is_multicast_ether_addr(addr.data)) {
 347                 dev_err(&rc->uwb_dev.dev, "refusing to set multicast "
 348                         "MAC address %s\n", buf);
 349                 result = -EINVAL;
 350                 goto out;
 351         }
 352         result = uwb_rc_mac_addr_set(rc, &addr);
 353         if (result == 0)
 354                 rc->uwb_dev.mac_addr = addr;
 355 out:
 356         return result < 0 ? result : size;
 357 }
 358 DEVICE_ATTR(mac_address, S_IRUGO | S_IWUSR, uwb_rc_mac_addr_show, uwb_rc_mac_addr_store);
 359
 360 /** Print @addr to @buf, @return bytes written */
 361 size_t __uwb_addr_print(char *buf, size_t buf_size, const unsigned char *addr,
 362                         int type)
 363 {
 364         size_t result;
 365         if (type)
 366                 result = scnprintf(buf, buf_size, "%pM", addr);
 367         else
 368                 result = scnprintf(buf, buf_size, "%02x:%02x",
 369                                   addr[1], addr[0]);
 370         return result;
 371 }
 372 EXPORT_SYMBOL_GPL(__uwb_addr_print);