104 lines
2.5 KiB
Diff
104 lines
2.5 KiB
Diff
|
Index: linux-5.15.31/net/ethernet/eth.c
|
||
|
|
===================================================================
|
||
|
|
--- linux-5.15.31.orig/net/ethernet/eth.c
|
||
|
|
+++ linux-5.15.31/net/ethernet/eth.c
|
||
|
|
@@ -544,6 +544,63 @@ int eth_platform_get_mac_address(struct
|
||
|
|
}
|
||
|
|
EXPORT_SYMBOL(eth_platform_get_mac_address);
|
||
|
|
|
||
|
|
+static void *nvmem_cell_get_mac_address(struct nvmem_cell *cell)
|
||
|
|
+{
|
||
|
|
+ size_t len;
|
||
|
|
+ void *mac;
|
||
|
|
+
|
||
|
|
+ mac = nvmem_cell_read(cell, &len);
|
||
|
|
+ if (IS_ERR(mac))
|
||
|
|
+ return PTR_ERR(mac);
|
||
|
|
+ if (len != ETH_ALEN) {
|
||
|
|
+ kfree(mac);
|
||
|
|
+ return ERR_PTR(-EINVAL);
|
||
|
|
+ }
|
||
|
|
+ return mac;
|
||
|
|
+}
|
||
|
|
+
|
||
|
|
+static void *nvmem_cell_get_mac_address_ascii(struct nvmem_cell *cell)
|
||
|
|
+{
|
||
|
|
+ size_t len;
|
||
|
|
+ int ret;
|
||
|
|
+ void *mac_ascii;
|
||
|
|
+ u8 *mac;
|
||
|
|
+
|
||
|
|
+ mac_ascii = nvmem_cell_read(cell, &len);
|
||
|
|
+ if (IS_ERR(mac_ascii))
|
||
|
|
+ return PTR_ERR(mac_ascii);
|
||
|
|
+ if (len != ETH_ALEN*2+5) {
|
||
|
|
+ kfree(mac_ascii);
|
||
|
|
+ return ERR_PTR(-EINVAL);
|
||
|
|
+ }
|
||
|
|
+ mac = kmalloc(ETH_ALEN, GFP_KERNEL);
|
||
|
|
+ if (!mac) {
|
||
|
|
+ kfree(mac_ascii);
|
||
|
|
+ return ERR_PTR(-ENOMEM);
|
||
|
|
+ }
|
||
|
|
+ ret = sscanf(mac_ascii, "%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx",
|
||
|
|
+ &mac[0], &mac[1], &mac[2],
|
||
|
|
+ &mac[3], &mac[4], &mac[5]);
|
||
|
|
+ kfree(mac_ascii);
|
||
|
|
+ if (ret == ETH_ALEN)
|
||
|
|
+ return mac;
|
||
|
|
+ kfree(mac);
|
||
|
|
+ return ERR_PTR(-EINVAL);
|
||
|
|
+}
|
||
|
|
+
|
||
|
|
+static struct nvmem_cell_mac_address_property {
|
||
|
|
+ char *name;
|
||
|
|
+ void *(*read)(struct nvmem_cell *);
|
||
|
|
+} nvmem_cell_mac_address_properties[] = {
|
||
|
|
+ {
|
||
|
|
+ .name = "mac-address",
|
||
|
|
+ .read = nvmem_cell_get_mac_address,
|
||
|
|
+ }, {
|
||
|
|
+ .name = "mac-address-ascii",
|
||
|
|
+ .read = nvmem_cell_get_mac_address_ascii,
|
||
|
|
+ },
|
||
|
|
+};
|
||
|
|
+
|
||
|
|
/**
|
||
|
|
* nvmem_get_mac_address - Obtain the MAC address from an nvmem cell named
|
||
|
|
* 'mac-address' associated with given device.
|
||
|
|
@@ -557,19 +614,23 @@ int nvmem_get_mac_address(struct device
|
||
|
|
{
|
||
|
|
struct nvmem_cell *cell;
|
||
|
|
const void *mac;
|
||
|
|
- size_t len;
|
||
|
|
+ struct nvmem_cell_mac_address_property *property;
|
||
|
|
+ int i;
|
||
|
|
|
||
|
|
- cell = nvmem_cell_get(dev, "mac-address");
|
||
|
|
- if (IS_ERR(cell))
|
||
|
|
- return PTR_ERR(cell);
|
||
|
|
-
|
||
|
|
- mac = nvmem_cell_read(cell, &len);
|
||
|
|
- nvmem_cell_put(cell);
|
||
|
|
-
|
||
|
|
- if (IS_ERR(mac))
|
||
|
|
- return PTR_ERR(mac);
|
||
|
|
+ for (i = 0; i < ARRAY_SIZE(nvmem_cell_mac_address_properties); i++) {
|
||
|
|
+ property = &nvmem_cell_mac_address_properties[i];
|
||
|
|
+ cell = nvmem_cell_get(dev, property->name);
|
||
|
|
+ if (IS_ERR(cell)) {
|
||
|
|
+ if (i == ARRAY_SIZE(nvmem_cell_mac_address_properties) - 1)
|
||
|
|
+ return PTR_ERR(cell);
|
||
|
|
+ continue;
|
||
|
|
+ }
|
||
|
|
+ mac = property->read(cell);
|
||
|
|
+ nvmem_cell_put(cell);
|
||
|
|
+ break;
|
||
|
|
+ }
|
||
|
|
|
||
|
|
- if (len != ETH_ALEN || !is_valid_ether_addr(mac)) {
|
||
|
|
+ if (!is_valid_ether_addr(mac)) {
|
||
|
|
kfree(mac);
|
||
|
|
return -EINVAL;
|
||
|
|
}
|