Sync of_get_mac_address() with kernel 5.8-rc1 do add nvmem cell support

Signed-off-by: Oleksij Rempel <[email protected]>
---
 drivers/of/of_net.c | 63 ++++++++++++++++++++++++++++++++++++---------
 1 file changed, 51 insertions(+), 12 deletions(-)

diff --git a/drivers/of/of_net.c b/drivers/of/of_net.c
index cee4597195..946c4a4352 100644
--- a/drivers/of/of_net.c
+++ b/drivers/of/of_net.c
@@ -67,12 +67,45 @@ int of_get_phy_mode(struct device_node *np)
 }
 EXPORT_SYMBOL_GPL(of_get_phy_mode);
 
+static const void *of_get_mac_addr(struct device_node *np, const char *name)
+{
+       struct property *pp = of_find_property(np, name, NULL);
+
+       if (pp && pp->length == ETH_ALEN && is_valid_ether_addr(pp->value))
+               return pp->value;
+       return NULL;
+}
+
+static const void *of_get_mac_addr_nvmem(struct device_node *np)
+{
+       int ret;
+       const void *mac;
+       u8 nvmem_mac[ETH_ALEN];
+       struct device_d *dev = of_find_device_by_node(np);
+
+       if (!dev)
+               return ERR_PTR(-ENODEV);
+
+       ret = nvmem_get_mac_address(dev, &nvmem_mac);
+       if (ret) {
+               return ERR_PTR(ret);
+       }
+
+       mac = kmemdup(nvmem_mac, ETH_ALEN, GFP_KERNEL);
+       if (!mac)
+               return ERR_PTR(-ENOMEM);
+
+       return mac;
+}
+
 /**
  * Search the device tree for the best MAC address to use.  'mac-address' is
  * checked first, because that is supposed to contain to "most recent" MAC
  * address. If that isn't set, then 'local-mac-address' is checked next,
- * because that is the default address.  If that isn't set, then the obsolete
- * 'address' is checked, just in case we're using an old device tree.
+ * because that is the default address. If that isn't set, then the obsolete
+ * 'address' is checked, just in case we're using an old device tree. If any
+ * of the above isn't set, then try to get MAC address from nvmem cell named
+ * 'mac-address'.
  *
  * Note that the 'address' property is supposed to contain a virtual address of
  * the register set, but some DTS files have redefined that property to be the
@@ -84,19 +117,25 @@ EXPORT_SYMBOL_GPL(of_get_phy_mode);
  * addresses.  Some older U-Boots only initialized 'local-mac-address'.  In
  * this case, the real MAC is in 'local-mac-address', and 'mac-address' exists
  * but is all zeros.
+ *
+ * Return: Will be a valid pointer on success and ERR_PTR in case of error.
 */
 const void *of_get_mac_address(struct device_node *np)
 {
-       const void *p;
-       int len, i;
-       const char *str[] = { "mac-address", "local-mac-address", "address" };
-
-       for (i = 0; i < ARRAY_SIZE(str); i++) {
-               p = of_get_property(np, str[i], &len);
-               if (p && (len == 6) && is_valid_ether_addr(p))
-                       return p;
-       }
+       const void *addr;
 
-       return NULL;
+       addr = of_get_mac_addr(np, "mac-address");
+       if (addr)
+               return addr;
+
+       addr = of_get_mac_addr(np, "local-mac-address");
+       if (addr)
+               return addr;
+
+       addr = of_get_mac_addr(np, "address");
+       if (addr)
+               return addr;
+
+       return of_get_mac_addr_nvmem(np);
 }
 EXPORT_SYMBOL(of_get_mac_address);
-- 
2.28.0


_______________________________________________
barebox mailing list
[email protected]
http://lists.infradead.org/mailman/listinfo/barebox

Reply via email to