| .. | .. |
|---|
| 1 | +// SPDX-License-Identifier: GPL-2.0-only |
|---|
| 1 | 2 | /* |
|---|
| 2 | 3 | * OF helpers for network devices. |
|---|
| 3 | | - * |
|---|
| 4 | | - * This file is released under the GPLv2 |
|---|
| 5 | 4 | * |
|---|
| 6 | 5 | * Initially copied out of arch/powerpc/kernel/prom_parse.c |
|---|
| 7 | 6 | */ |
|---|
| 8 | 7 | #include <linux/etherdevice.h> |
|---|
| 9 | 8 | #include <linux/kernel.h> |
|---|
| 10 | | -#include <linux/nvmem-consumer.h> |
|---|
| 11 | 9 | #include <linux/of_net.h> |
|---|
| 10 | +#include <linux/of_platform.h> |
|---|
| 12 | 11 | #include <linux/phy.h> |
|---|
| 13 | 12 | #include <linux/export.h> |
|---|
| 13 | +#include <linux/device.h> |
|---|
| 14 | 14 | |
|---|
| 15 | 15 | /** |
|---|
| 16 | 16 | * of_get_phy_mode - Get phy mode for given device_node |
|---|
| 17 | 17 | * @np: Pointer to the given device_node |
|---|
| 18 | + * @interface: Pointer to the result |
|---|
| 18 | 19 | * |
|---|
| 19 | 20 | * The function gets phy interface string from property 'phy-mode' or |
|---|
| 20 | | - * 'phy-connection-type', and return its index in phy_modes table, or errno in |
|---|
| 21 | | - * error case. |
|---|
| 21 | + * 'phy-connection-type'. The index in phy_modes table is set in |
|---|
| 22 | + * interface and 0 returned. In case of error interface is set to |
|---|
| 23 | + * PHY_INTERFACE_MODE_NA and an errno is returned, e.g. -ENODEV. |
|---|
| 22 | 24 | */ |
|---|
| 23 | | -int of_get_phy_mode(struct device_node *np) |
|---|
| 25 | +int of_get_phy_mode(struct device_node *np, phy_interface_t *interface) |
|---|
| 24 | 26 | { |
|---|
| 25 | 27 | const char *pm; |
|---|
| 26 | 28 | int err, i; |
|---|
| 29 | + |
|---|
| 30 | + *interface = PHY_INTERFACE_MODE_NA; |
|---|
| 27 | 31 | |
|---|
| 28 | 32 | err = of_property_read_string(np, "phy-mode", &pm); |
|---|
| 29 | 33 | if (err < 0) |
|---|
| .. | .. |
|---|
| 32 | 36 | return err; |
|---|
| 33 | 37 | |
|---|
| 34 | 38 | for (i = 0; i < PHY_INTERFACE_MODE_MAX; i++) |
|---|
| 35 | | - if (!strcasecmp(pm, phy_modes(i))) |
|---|
| 36 | | - return i; |
|---|
| 39 | + if (!strcasecmp(pm, phy_modes(i))) { |
|---|
| 40 | + *interface = i; |
|---|
| 41 | + return 0; |
|---|
| 42 | + } |
|---|
| 37 | 43 | |
|---|
| 38 | 44 | return -ENODEV; |
|---|
| 39 | 45 | } |
|---|
| .. | .. |
|---|
| 48 | 54 | return NULL; |
|---|
| 49 | 55 | } |
|---|
| 50 | 56 | |
|---|
| 57 | +static const void *of_get_mac_addr_nvmem(struct device_node *np) |
|---|
| 58 | +{ |
|---|
| 59 | + int ret; |
|---|
| 60 | + const void *mac; |
|---|
| 61 | + u8 nvmem_mac[ETH_ALEN]; |
|---|
| 62 | + struct platform_device *pdev = of_find_device_by_node(np); |
|---|
| 63 | + |
|---|
| 64 | + if (!pdev) |
|---|
| 65 | + return ERR_PTR(-ENODEV); |
|---|
| 66 | + |
|---|
| 67 | + ret = nvmem_get_mac_address(&pdev->dev, &nvmem_mac); |
|---|
| 68 | + if (ret) { |
|---|
| 69 | + put_device(&pdev->dev); |
|---|
| 70 | + return ERR_PTR(ret); |
|---|
| 71 | + } |
|---|
| 72 | + |
|---|
| 73 | + mac = devm_kmemdup(&pdev->dev, nvmem_mac, ETH_ALEN, GFP_KERNEL); |
|---|
| 74 | + put_device(&pdev->dev); |
|---|
| 75 | + if (!mac) |
|---|
| 76 | + return ERR_PTR(-ENOMEM); |
|---|
| 77 | + |
|---|
| 78 | + return mac; |
|---|
| 79 | +} |
|---|
| 80 | + |
|---|
| 51 | 81 | /** |
|---|
| 52 | 82 | * Search the device tree for the best MAC address to use. 'mac-address' is |
|---|
| 53 | 83 | * checked first, because that is supposed to contain to "most recent" MAC |
|---|
| 54 | 84 | * address. If that isn't set, then 'local-mac-address' is checked next, |
|---|
| 55 | | - * because that is the default address. If that isn't set, then the obsolete |
|---|
| 56 | | - * 'address' is checked, just in case we're using an old device tree. |
|---|
| 85 | + * because that is the default address. If that isn't set, then the obsolete |
|---|
| 86 | + * 'address' is checked, just in case we're using an old device tree. If any |
|---|
| 87 | + * of the above isn't set, then try to get MAC address from nvmem cell named |
|---|
| 88 | + * 'mac-address'. |
|---|
| 57 | 89 | * |
|---|
| 58 | 90 | * Note that the 'address' property is supposed to contain a virtual address of |
|---|
| 59 | 91 | * the register set, but some DTS files have redefined that property to be the |
|---|
| .. | .. |
|---|
| 65 | 97 | * addresses. Some older U-Boots only initialized 'local-mac-address'. In |
|---|
| 66 | 98 | * this case, the real MAC is in 'local-mac-address', and 'mac-address' exists |
|---|
| 67 | 99 | * but is all zeros. |
|---|
| 100 | + * |
|---|
| 101 | + * Return: Will be a valid pointer on success and ERR_PTR in case of error. |
|---|
| 68 | 102 | */ |
|---|
| 69 | 103 | const void *of_get_mac_address(struct device_node *np) |
|---|
| 70 | 104 | { |
|---|
| .. | .. |
|---|
| 78 | 112 | if (addr) |
|---|
| 79 | 113 | return addr; |
|---|
| 80 | 114 | |
|---|
| 81 | | - return of_get_mac_addr(np, "address"); |
|---|
| 115 | + addr = of_get_mac_addr(np, "address"); |
|---|
| 116 | + if (addr) |
|---|
| 117 | + return addr; |
|---|
| 118 | + |
|---|
| 119 | + return of_get_mac_addr_nvmem(np); |
|---|
| 82 | 120 | } |
|---|
| 83 | 121 | EXPORT_SYMBOL(of_get_mac_address); |
|---|
| 84 | | - |
|---|
| 85 | | -/** |
|---|
| 86 | | - * Obtain the MAC address from an nvmem provider named 'mac-address' through |
|---|
| 87 | | - * device tree. |
|---|
| 88 | | - * On success, copies the new address into memory pointed to by addr and |
|---|
| 89 | | - * returns 0. Returns a negative error code otherwise. |
|---|
| 90 | | - * @np: Device tree node containing the nvmem-cells phandle |
|---|
| 91 | | - * @addr: Pointer to receive the MAC address using ether_addr_copy() |
|---|
| 92 | | - */ |
|---|
| 93 | | -int of_get_nvmem_mac_address(struct device_node *np, void *addr) |
|---|
| 94 | | -{ |
|---|
| 95 | | - struct nvmem_cell *cell; |
|---|
| 96 | | - const void *mac; |
|---|
| 97 | | - size_t len; |
|---|
| 98 | | - int ret; |
|---|
| 99 | | - |
|---|
| 100 | | - cell = of_nvmem_cell_get(np, "mac-address"); |
|---|
| 101 | | - if (IS_ERR(cell)) |
|---|
| 102 | | - return PTR_ERR(cell); |
|---|
| 103 | | - |
|---|
| 104 | | - mac = nvmem_cell_read(cell, &len); |
|---|
| 105 | | - |
|---|
| 106 | | - nvmem_cell_put(cell); |
|---|
| 107 | | - |
|---|
| 108 | | - if (IS_ERR(mac)) |
|---|
| 109 | | - return PTR_ERR(mac); |
|---|
| 110 | | - |
|---|
| 111 | | - if (len < ETH_ALEN || !is_valid_ether_addr(mac)) { |
|---|
| 112 | | - ret = -EINVAL; |
|---|
| 113 | | - } else { |
|---|
| 114 | | - ether_addr_copy(addr, mac); |
|---|
| 115 | | - ret = 0; |
|---|
| 116 | | - } |
|---|
| 117 | | - |
|---|
| 118 | | - kfree(mac); |
|---|
| 119 | | - |
|---|
| 120 | | - return ret; |
|---|
| 121 | | -} |
|---|
| 122 | | -EXPORT_SYMBOL(of_get_nvmem_mac_address); |
|---|