target/linux/brcm2708/patches-3.10/006-Allow-mac-address-to-be-set-in-smsc95xx.patch

   1 diff -urN linux-3.10/drivers/net/usb/smsc95xx.c linux-rpi-3.10.y/drivers/net/usb/smsc95xx.c
   2 --- linux-3.10/drivers/net/usb/smsc95xx.c       2013-06-30 23:13:29.000000000 +0100
   3 +++ linux-rpi-3.10.y/drivers/net/usb/smsc95xx.c 2013-07-06 15:25:50.000000000 +0100
   4 @@ -61,6 +61,7 @@
   5  #define SUSPEND_SUSPEND3               (0x08)
   6  #define SUSPEND_ALLMODES               (SUSPEND_SUSPEND0 | SUSPEND_SUSPEND1 | \
   7                                          SUSPEND_SUSPEND2 | SUSPEND_SUSPEND3)
   8 +#define MAC_ADDR_LEN                    (6)
   9
  10  struct smsc95xx_priv {
  11         u32 mac_cr;
  12 @@ -76,6 +77,10 @@
  13  module_param(turbo_mode, bool, 0644);
  14  MODULE_PARM_DESC(turbo_mode, "Enable multiple frames per Rx transaction");
  15
  16 +static char *macaddr = ":";
  17 +module_param(macaddr, charp, 0);
  18 +MODULE_PARM_DESC(macaddr, "MAC address");
  19 +
  20  static int __must_check __smsc95xx_read_reg(struct usbnet *dev, u32 index,
  21                                             u32 *data, int in_pm)
  22  {
  23 @@ -765,8 +770,59 @@
  24         return generic_mii_ioctl(&dev->mii, if_mii(rq), cmd, NULL);
  25  }
  26
  27 +/* Check the macaddr module parameter for a MAC address */
  28 +static int smsc95xx_is_macaddr_param(struct usbnet *dev, u8 *dev_mac)
  29 +{
  30 +       int i, j, got_num, num;
  31 +       u8 mtbl[MAC_ADDR_LEN];
  32 +
  33 +       if (macaddr[0] == ':')
  34 +               return 0;
  35 +
  36 +       i = 0;
  37 +       j = 0;
  38 +       num = 0;
  39 +       got_num = 0;
  40 +       while (j < MAC_ADDR_LEN) {
  41 +               if (macaddr[i] && macaddr[i] != ':') {
  42 +                       got_num++;
  43 +                       if ('0' <= macaddr[i] && macaddr[i] <= '9')
  44 +                               num = num * 16 + macaddr[i] - '0';
  45 +                       else if ('A' <= macaddr[i] && macaddr[i] <= 'F')
  46 +                               num = num * 16 + 10 + macaddr[i] - 'A';
  47 +                       else if ('a' <= macaddr[i] && macaddr[i] <= 'f')
  48 +                               num = num * 16 + 10 + macaddr[i] - 'a';
  49 +                       else
  50 +                               break;
  51 +                       i++;
  52 +               } else if (got_num == 2) {
  53 +                       mtbl[j++] = (u8) num;
  54 +                       num = 0;
  55 +                       got_num = 0;
  56 +                       i++;
  57 +               } else {
  58 +                       break;
  59 +               }
  60 +       }
  61 +
  62 +       if (j == MAC_ADDR_LEN) {
  63 +               netif_dbg(dev, ifup, dev->net, "Overriding MAC address with: "
  64 +               "%02x:%02x:%02x:%02x:%02x:%02x\n", mtbl[0], mtbl[1], mtbl[2],
  65 +                                               mtbl[3], mtbl[4], mtbl[5]);
  66 +               for (i = 0; i < MAC_ADDR_LEN; i++)
  67 +                       dev_mac[i] = mtbl[i];
  68 +               return 1;
  69 +       } else {
  70 +               return 0;
  71 +       }
  72 +}
  73 +
  74  static void smsc95xx_init_mac_address(struct usbnet *dev)
  75  {
  76 +       /* Check module parameters */
  77 +       if (smsc95xx_is_macaddr_param(dev, dev->net->dev_addr))
  78 +               return;
  79 +
  80         /* try reading mac address from EEPROM */
  81         if (smsc95xx_read_eeprom(dev, EEPROM_MAC_OFFSET, ETH_ALEN,
  82                         dev->net->dev_addr) == 0) {