--- zzzz-none-000/linux-4.4.271/drivers/of/of_net.c 2021-06-03 06:22:09.000000000 +0000 +++ maple-fsgw-759/linux-4.4.271/drivers/of/of_net.c 2023-12-20 10:37:24.000000000 +0000 @@ -10,6 +10,7 @@ #include #include #include +#include /** * of_get_phy_mode - Get phy mode for given device_node @@ -80,3 +81,45 @@ return of_get_mac_addr(np, "address"); } EXPORT_SYMBOL(of_get_mac_address); + +#ifdef CONFIG_MTD +int of_get_mac_address_mtd(struct device_node *np, unsigned char *mac) +{ + struct device_node *mtd_np = NULL; + size_t retlen; + int size, ret; + struct mtd_info *mtd; + const char *part; + const __be32 *list; + phandle phandle; + u32 mac_inc = 0; + + list = of_get_property(np, "mtd-mac-address", &size); + if (!list || (size != (2 * sizeof(*list)))) + return -ENOENT; + + phandle = be32_to_cpup(list++); + if (phandle) + mtd_np = of_find_node_by_phandle(phandle); + + if (!mtd_np) + return -ENOENT; + + part = of_get_property(mtd_np, "label", NULL); + if (!part) + part = mtd_np->name; + + mtd = get_mtd_device_nm(part); + if (IS_ERR(mtd)) + return PTR_ERR(mtd); + + ret = mtd_read(mtd, be32_to_cpup(list), 6, &retlen, mac); + put_mtd_device(mtd); + + if (!of_property_read_u32(np, "mtd-mac-address-increment", &mac_inc)) + mac[5] += mac_inc; + + return ret; +} +EXPORT_SYMBOL_GPL(of_get_mac_address_mtd); +#endif