net, thunder, bgx: Add support to get MAC address from ACPI.

Currently there is no way to get the MAC address in a firmware
independent manner, so set the MAC address of the device directly from
the ACPI tables.

The binding agrees with the proposed standard here:

http://www.uefi.org/sites/default/files/resources/nic-request-v2.pdf

Based on code from: Narinder Dhillon <ndhillon@cavium.com>
                    Tomasz Nowicki <tomasz.nowicki@linaro.org>
                    Robert Richter <rrichter@cavium.com>

Signed-off-by: Tomasz Nowicki <tomasz.nowicki@linaro.org>
Signed-off-by: Robert Richter <rrichter@cavium.com>
Signed-off-by: David Daney <david.daney@cavium.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/drivers/net/ethernet/cavium/thunder/thunder_bgx.c b/drivers/net/ethernet/cavium/thunder/thunder_bgx.c
index 615b2af3f3740ce17e26293f54883480349786de..5e541862f65e52a14be8d6e1de95b3eca5efaf2f 100644 (file)
--- a/drivers/net/ethernet/cavium/thunder/thunder_bgx.c
+++ b/drivers/net/ethernet/cavium/thunder/thunder_bgx.c
@@ -6,6 +6,7 @@
  * as published by the Free Software Foundation.
  */
 
+#include <linux/acpi.h>
 #include <linux/module.h>
 #include <linux/interrupt.h>
 #include <linux/pci.h>
@@ -26,7 +27,7 @@
 struct lmac {
        struct bgx              *bgx;
        int                     dmac;
-       unsigned char           mac[ETH_ALEN];
+       u8                      mac[ETH_ALEN];
        bool                    link_up;
        int                     lmacid; /* ID within BGX */
        int                     lmacid_bd; /* ID on board */
@@ -835,6 +836,86 @@ static void bgx_get_qlm_mode(struct bgx *bgx)
        }
 }
 
+#ifdef CONFIG_ACPI
+
+static int acpi_get_mac_address(struct acpi_device *adev, u8 *dst)
+{
+       u8 mac[ETH_ALEN];
+       int ret;
+
+       ret = fwnode_property_read_u8_array(acpi_fwnode_handle(adev),
+                                           "mac-address", mac, ETH_ALEN);
+       if (ret)
+               goto out;
+
+       if (!is_valid_ether_addr(mac)) {
+               ret = -EINVAL;
+               goto out;
+       }
+
+       memcpy(dst, mac, ETH_ALEN);
+out:
+       return ret;
+}
+
+/* Currently only sets the MAC address. */
+static acpi_status bgx_acpi_register_phy(acpi_handle handle,
+                                        u32 lvl, void *context, void **rv)
+{
+       struct bgx *bgx = context;
+       struct acpi_device *adev;
+
+       if (acpi_bus_get_device(handle, &adev))
+               goto out;
+
+       acpi_get_mac_address(adev, bgx->lmac[bgx->lmac_count].mac);
+
+       SET_NETDEV_DEV(&bgx->lmac[bgx->lmac_count].netdev, &bgx->pdev->dev);
+
+       bgx->lmac[bgx->lmac_count].lmacid = bgx->lmac_count;
+out:
+       bgx->lmac_count++;
+       return AE_OK;
+}
+
+static acpi_status bgx_acpi_match_id(acpi_handle handle, u32 lvl,
+                                    void *context, void **ret_val)
+{
+       struct acpi_buffer string = { ACPI_ALLOCATE_BUFFER, NULL };
+       struct bgx *bgx = context;
+       char bgx_sel[5];
+
+       snprintf(bgx_sel, 5, "BGX%d", bgx->bgx_id);
+       if (ACPI_FAILURE(acpi_get_name(handle, ACPI_SINGLE_NAME, &string))) {
+               pr_warn("Invalid link device\n");
+               return AE_OK;
+       }
+
+       if (strncmp(string.pointer, bgx_sel, 4))
+               return AE_OK;
+
+       acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, 1,
+                           bgx_acpi_register_phy, NULL, bgx, NULL);
+
+       kfree(string.pointer);
+       return AE_CTRL_TERMINATE;
+}
+
+static int bgx_init_acpi_phy(struct bgx *bgx)
+{
+       acpi_get_devices(NULL, bgx_acpi_match_id, bgx, (void **)NULL);
+       return 0;
+}
+
+#else
+
+static int bgx_init_acpi_phy(struct bgx *bgx)
+{
+       return -ENODEV;
+}
+
+#endif /* CONFIG_ACPI */
+
 #if IS_ENABLED(CONFIG_OF_MDIO)
 
 static int bgx_init_of_phy(struct bgx *bgx)
@@ -882,6 +963,9 @@ static int bgx_init_of_phy(struct bgx *bgx)
 
 static int bgx_init_phy(struct bgx *bgx)
 {
+       if (!acpi_disabled)
+               return bgx_init_acpi_phy(bgx);
+
        return bgx_init_of_phy(bgx);
 }