wifi: wilc1000: read MAC address from fuse at probe

The default netdev interface exposed by WILC1000 is registered at probe,
but the chip mac address is not known until ndo_open, which will load and
start chip firmware and then retrieve stored MAC address from it. As a
consequence, the interface has uninitialized value (00:00:00:00:00) until a
user brings up the interface.

Fix MAC address at probe by setting the following steps:
- at probe, read MAC address directly from fuse
- whenever a new netdevice is created, apply saved mac address (which can
  be a user-provided address, or the eFuse Mac address if no address has
  been passed by user)
- whenever an interface is brought up for the first time (and so the
  firmware is loaded and started), enforce netdevice mac address to the
  chip (in case user has changed it)

Reported-by: Heiko Thiery <heiko.thiery@gmail.com>
Closes: https://lore.kernel.org/netdev/CAEyMn7aV-B4OEhHR4Ad0LM3sKCz1-nDqSb9uZNmRWR-hMZ=z+A@mail.gmail.com/T/
Signed-off-by: Ajay Singh <ajay.kathat@microchip.com>
Co-developed-by: Alexis Lothoré <alexis.lothore@bootlin.com>
Signed-off-by: Alexis Lothoré <alexis.lothore@bootlin.com>
Tested-by: Heiko Thiery <heiko.thiery@gmail.com>
Signed-off-by: Kalle Valo <kvalo@kernel.org>
Link: https://msgid.link/20240514-mac_addr_at_probe-v2-6-afef09f1cd10@bootlin.com

diff --git a/drivers/net/wireless/microchip/wilc1000/netdev.c b/drivers/net/wireless/microchip/wilc1000/netdev.c
index 2ee3d98278266b7ea5b277502fa4d5fa0bb62275..4e2698528a49a3b10d4cd09a7681ad9999edb8bc 100644 (file)
--- a/drivers/net/wireless/microchip/wilc1000/netdev.c
+++ b/drivers/net/wireless/microchip/wilc1000/netdev.c
@@ -588,7 +588,6 @@ static int wilc_mac_open(struct net_device *ndev)
        struct wilc *wl = vif->wilc;
        int ret = 0;
        struct mgmt_frame_regs mgmt_regs = {};
-       u8 addr[ETH_ALEN] __aligned(2);
 
        if (!wl || !wl->dev) {
                netdev_err(ndev, "device not ready\n");
@@ -607,25 +606,19 @@ static int wilc_mac_open(struct net_device *ndev)
                return ret;
        }
 
-       wilc_set_operation_mode(vif, wilc_get_vif_idx(vif), vif->iftype,
-                               vif->idx);
-
-       if (is_valid_ether_addr(ndev->dev_addr)) {
-               ether_addr_copy(addr, ndev->dev_addr);
-               wilc_set_mac_address(vif, addr);
-       } else {
-               wilc_get_mac_address(vif, addr);
-               eth_hw_addr_set(ndev, addr);
-       }
        netdev_dbg(ndev, "Mac address: %pM\n", ndev->dev_addr);
-
-       if (!is_valid_ether_addr(ndev->dev_addr)) {
-               netdev_err(ndev, "Wrong MAC address\n");
+       ret = wilc_set_mac_address(vif, ndev->dev_addr);
+       if (ret) {
+               netdev_err(ndev, "Failed to enforce MAC address in chip");
                wilc_deinit_host_int(ndev);
-               wilc_wlan_deinitialize(ndev);
-               return -EINVAL;
+               if (!wl->open_ifcs)
+                       wilc_wlan_deinitialize(ndev);
+               return ret;
        }
 
+       wilc_set_operation_mode(vif, wilc_get_vif_idx(vif), vif->iftype,
+                               vif->idx);
+
        mgmt_regs.interface_stypes = vif->mgmt_reg_stypes;
        /* so we detect a change */
        vif->mgmt_reg_stypes = 0;
@@ -941,6 +934,7 @@ struct wilc_vif *wilc_netdev_ifc_init(struct wilc *wl, const char *name,
                                      int vif_type, enum nl80211_iftype type,
                                      bool rtnl_locked)
 {
+       u8 mac_address[ETH_ALEN];
        struct net_device *ndev;
        struct wilc_vif *vif;
        int ret;
@@ -969,6 +963,18 @@ struct wilc_vif *wilc_netdev_ifc_init(struct wilc *wl, const char *name,
        vif->iftype = vif_type;
        vif->idx = wilc_get_available_idx(wl);
        vif->mac_opened = 0;
+
+       memcpy(mac_address, wl->nv_mac_address, ETH_ALEN);
+       /* WILC firmware uses locally administered MAC address for the
+        * second virtual interface (bit 1 of first byte set), but
+        * since it is possibly not loaded/running yet, reproduce this behavior
+        * in the driver during interface creation.
+        */
+       if (vif->idx)
+               mac_address[0] |= 0x2;
+
+       eth_hw_addr_set(vif->ndev, mac_address);
+
        mutex_lock(&wl->vif_mutex);
        list_add_tail_rcu(&vif->list, &wl->vif_list);
        wl->vif_num += 1;

diff --git a/drivers/net/wireless/microchip/wilc1000/sdio.c b/drivers/net/wireless/microchip/wilc1000/sdio.c
index 04d6565df2cb31b88190a7066a34326617bdd01d..e6e20c86b791731ad908c5781dc5518c5a203d17 100644 (file)
--- a/drivers/net/wireless/microchip/wilc1000/sdio.c
+++ b/drivers/net/wireless/microchip/wilc1000/sdio.c
@@ -24,6 +24,9 @@ MODULE_DEVICE_TABLE(sdio, wilc_sdio_ids);
 
 #define WILC_SDIO_BLOCK_SIZE 512
 
+static int wilc_sdio_init(struct wilc *wilc, bool resume);
+static int wilc_sdio_deinit(struct wilc *wilc);
+
 struct wilc_sdio {
        bool irq_gpio;
        u32 block_size;
@@ -178,6 +181,16 @@ static int wilc_sdio_probe(struct sdio_func *func,
        }
        clk_prepare_enable(wilc->rtc_clk);
 
+       wilc_sdio_init(wilc, false);
+
+       ret = wilc_load_mac_from_nv(wilc);
+       if (ret) {
+               pr_err("Can not retrieve MAC address from chip\n");
+               goto clk_disable_unprepare;
+       }
+
+       wilc_sdio_deinit(wilc);
+
        vif = wilc_netdev_ifc_init(wilc, "wlan%d", WILC_STATION_MODE,
                                   NL80211_IFTYPE_STATION, false);
        if (IS_ERR(vif)) {
@@ -187,6 +200,7 @@ static int wilc_sdio_probe(struct sdio_func *func,
 
        dev_info(&func->dev, "Driver Initializing success\n");
        return 0;
+
 clk_disable_unprepare:
        clk_disable_unprepare(wilc->rtc_clk);
 dispose_irq:

diff --git a/drivers/net/wireless/microchip/wilc1000/spi.c b/drivers/net/wireless/microchip/wilc1000/spi.c
index add0e70a09eae1b0d6950a05bba288394b21109e..5ff940c53ad9c06f792137957a82b013dbd5bea7 100644 (file)
--- a/drivers/net/wireless/microchip/wilc1000/spi.c
+++ b/drivers/net/wireless/microchip/wilc1000/spi.c
@@ -250,6 +250,12 @@ static int wilc_bus_probe(struct spi_device *spi)
        if (ret)
                goto power_down;
 
+       ret = wilc_load_mac_from_nv(wilc);
+       if (ret) {
+               pr_err("Can not retrieve MAC address from chip\n");
+               goto power_down;
+       }
+
        wilc_wlan_power(wilc, false);
        vif = wilc_netdev_ifc_init(wilc, "wlan%d", WILC_STATION_MODE,
                                   NL80211_IFTYPE_STATION, false);