0005-net-smsc95xx-Allow-mac-address-to-be-set-as-a-parame.patch 3.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596
  1. From d8d3b7ef35dc992adb33ea8a077e0fff21a4a3e5 Mon Sep 17 00:00:00 2001
  2. From: popcornmix <popcornmix@gmail.com>
  3. Date: Tue, 18 Feb 2014 01:43:50 -0300
  4. Subject: [PATCH 5/9] net/smsc95xx: Allow mac address to be set as a parameter
  5. ---
  6. drivers/net/usb/smsc95xx.c | 56 ++++++++++++++++++++++++++++++++++++++
  7. 1 file changed, 56 insertions(+)
  8. diff --git a/drivers/net/usb/smsc95xx.c b/drivers/net/usb/smsc95xx.c
  9. index 355be77f4241..c94a7193e0b9 100644
  10. --- a/drivers/net/usb/smsc95xx.c
  11. +++ b/drivers/net/usb/smsc95xx.c
  12. @@ -48,6 +48,7 @@
  13. #define SUSPEND_SUSPEND3 (0x08)
  14. #define SUSPEND_ALLMODES (SUSPEND_SUSPEND0 | SUSPEND_SUSPEND1 | \
  15. SUSPEND_SUSPEND2 | SUSPEND_SUSPEND3)
  16. +#define MAC_ADDR_LEN (6)
  17. #define CARRIER_CHECK_DELAY (2 * HZ)
  18. @@ -70,6 +71,10 @@ static bool turbo_mode = true;
  19. module_param(turbo_mode, bool, 0644);
  20. MODULE_PARM_DESC(turbo_mode, "Enable multiple frames per Rx transaction");
  21. +static char *macaddr = ":";
  22. +module_param(macaddr, charp, 0);
  23. +MODULE_PARM_DESC(macaddr, "MAC address");
  24. +
  25. static int __must_check __smsc95xx_read_reg(struct usbnet *dev, u32 index,
  26. u32 *data, int in_pm)
  27. {
  28. @@ -899,8 +904,59 @@ static int smsc95xx_ioctl(struct net_device *netdev, struct ifreq *rq, int cmd)
  29. return generic_mii_ioctl(&dev->mii, if_mii(rq), cmd, NULL);
  30. }
  31. +/* Check the macaddr module parameter for a MAC address */
  32. +static int smsc95xx_is_macaddr_param(struct usbnet *dev, u8 *dev_mac)
  33. +{
  34. + int i, j, got_num, num;
  35. + u8 mtbl[MAC_ADDR_LEN];
  36. +
  37. + if (macaddr[0] == ':')
  38. + return 0;
  39. +
  40. + i = 0;
  41. + j = 0;
  42. + num = 0;
  43. + got_num = 0;
  44. + while (j < MAC_ADDR_LEN) {
  45. + if (macaddr[i] && macaddr[i] != ':') {
  46. + got_num++;
  47. + if ('0' <= macaddr[i] && macaddr[i] <= '9')
  48. + num = num * 16 + macaddr[i] - '0';
  49. + else if ('A' <= macaddr[i] && macaddr[i] <= 'F')
  50. + num = num * 16 + 10 + macaddr[i] - 'A';
  51. + else if ('a' <= macaddr[i] && macaddr[i] <= 'f')
  52. + num = num * 16 + 10 + macaddr[i] - 'a';
  53. + else
  54. + break;
  55. + i++;
  56. + } else if (got_num == 2) {
  57. + mtbl[j++] = (u8) num;
  58. + num = 0;
  59. + got_num = 0;
  60. + i++;
  61. + } else {
  62. + break;
  63. + }
  64. + }
  65. +
  66. + if (j == MAC_ADDR_LEN) {
  67. + netif_dbg(dev, ifup, dev->net, "Overriding MAC address with: "
  68. + "%02x:%02x:%02x:%02x:%02x:%02x\n", mtbl[0], mtbl[1], mtbl[2],
  69. + mtbl[3], mtbl[4], mtbl[5]);
  70. + for (i = 0; i < MAC_ADDR_LEN; i++)
  71. + dev_mac[i] = mtbl[i];
  72. + return 1;
  73. + } else {
  74. + return 0;
  75. + }
  76. +}
  77. +
  78. static void smsc95xx_init_mac_address(struct usbnet *dev)
  79. {
  80. + /* Check module parameters */
  81. + if (smsc95xx_is_macaddr_param(dev, dev->net->dev_addr))
  82. + return;
  83. +
  84. const u8 *mac_addr;
  85. /* maybe the boot loader passed the MAC address in devicetree */
  86. --
  87. 2.23.0