1 From c025fdfc5970f5d60a381bab953e60825de8500a Mon Sep 17 00:00:00 2001
2 From: popcornmix <popcornmix@gmail.com>
3 Date: Tue, 26 Mar 2013 17:26:38 +0000
4 Subject: [PATCH 16/54] Allow mac address to be set in smsc95xx
6 Signed-off-by: popcornmix <popcornmix@gmail.com>
8 drivers/net/usb/smsc95xx.c | 56 ++++++++++++++++++++++++++++++++++++++++++++++
9 1 file changed, 56 insertions(+)
11 diff --git a/drivers/net/usb/smsc95xx.c b/drivers/net/usb/smsc95xx.c
12 index 424db65e..fc1ef4e 100644
13 --- a/drivers/net/usb/smsc95xx.c
14 +++ b/drivers/net/usb/smsc95xx.c
16 #define SUSPEND_SUSPEND3 (0x08)
17 #define SUSPEND_ALLMODES (SUSPEND_SUSPEND0 | SUSPEND_SUSPEND1 | \
18 SUSPEND_SUSPEND2 | SUSPEND_SUSPEND3)
19 +#define MAC_ADDR_LEN (6)
21 struct smsc95xx_priv {
23 @@ -74,6 +75,10 @@ static bool turbo_mode = true;
24 module_param(turbo_mode, bool, 0644);
25 MODULE_PARM_DESC(turbo_mode, "Enable multiple frames per Rx transaction");
27 +static char *macaddr = ":";
28 +module_param(macaddr, charp, 0);
29 +MODULE_PARM_DESC(macaddr, "MAC address");
31 static int __must_check __smsc95xx_read_reg(struct usbnet *dev, u32 index,
34 @@ -763,8 +768,59 @@ static int smsc95xx_ioctl(struct net_device *netdev, struct ifreq *rq, int cmd)
35 return generic_mii_ioctl(&dev->mii, if_mii(rq), cmd, NULL);
38 +/* Check the macaddr module parameter for a MAC address */
39 +static int smsc95xx_is_macaddr_param(struct usbnet *dev, u8 *dev_mac)
41 + int i, j, got_num, num;
42 + u8 mtbl[MAC_ADDR_LEN];
44 + if (macaddr[0] == ':')
51 + while (j < MAC_ADDR_LEN) {
52 + if (macaddr[i] && macaddr[i] != ':') {
54 + if ('0' <= macaddr[i] && macaddr[i] <= '9')
55 + num = num * 16 + macaddr[i] - '0';
56 + else if ('A' <= macaddr[i] && macaddr[i] <= 'F')
57 + num = num * 16 + 10 + macaddr[i] - 'A';
58 + else if ('a' <= macaddr[i] && macaddr[i] <= 'f')
59 + num = num * 16 + 10 + macaddr[i] - 'a';
63 + } else if (got_num == 2) {
64 + mtbl[j++] = (u8) num;
73 + if (j == MAC_ADDR_LEN) {
74 + netif_dbg(dev, ifup, dev->net, "Overriding MAC address with: "
75 + "%02x:%02x:%02x:%02x:%02x:%02x\n", mtbl[0], mtbl[1], mtbl[2],
76 + mtbl[3], mtbl[4], mtbl[5]);
77 + for (i = 0; i < MAC_ADDR_LEN; i++)
78 + dev_mac[i] = mtbl[i];
85 static void smsc95xx_init_mac_address(struct usbnet *dev)
87 + /* Check module parameters */
88 + if (smsc95xx_is_macaddr_param(dev, dev->net->dev_addr))
91 /* try reading mac address from EEPROM */
92 if (smsc95xx_read_eeprom(dev, EEPROM_MAC_OFFSET, ETH_ALEN,
93 dev->net->dev_addr) == 0) {