wifi: mt76: mt7915: mcu: re-init MCU before loading FW patch

[ Upstream commit ac9c50c79eaef5fca0f165e45d0c5880606db53e ]

Restart the MCU and release the patch semaphore before loading the MCU
patch firmware from the host.

This fixes failures upon error recovery in case the semaphore was
previously taken and never released by the host.

This happens from time to time upon triggering a full-chip error
recovery. Under this circumstance, the hardware restart fails and the
radio is rendered inoperational.

Signed-off-by: David Bauer <mail@david-bauer.net>
Link: https://patch.msgid.link/20250402004528.1036715-3-mail@david-bauer.net
Signed-off-by: Felix Fietkau <nbd@nbd.name>
Signed-off-by: Sasha Levin <sashal@kernel.org>

diff --git a/drivers/net/wireless/mediatek/mt76/mt7915/mcu.c b/drivers/net/wireless/mediatek/mt76/mt7915/mcu.c
index c6584d2b7509282e89400aaafd5ad9c1a9c3c2bd..4c7f193a11588e384056a5457167d264e1bc6f47 100644 (file)
--- a/drivers/net/wireless/mediatek/mt76/mt7915/mcu.c
+++ b/drivers/net/wireless/mediatek/mt76/mt7915/mcu.c
@@ -2110,16 +2110,21 @@ static int mt7915_load_firmware(struct mt7915_dev *dev)
 {
        int ret;
 
-       /* make sure fw is download state */
-       if (mt7915_firmware_state(dev, false)) {
-               /* restart firmware once */
-               mt76_connac_mcu_restart(&dev->mt76);
-               ret = mt7915_firmware_state(dev, false);
-               if (ret) {
-                       dev_err(dev->mt76.dev,
-                               "Firmware is not ready for download\n");
-                       return ret;
-               }
+       /* Release Semaphore if taken by previous failed attempt */
+       ret = mt76_connac_mcu_patch_sem_ctrl(&dev->mt76, false);
+       if (ret != PATCH_REL_SEM_SUCCESS) {
+               dev_err(dev->mt76.dev, "Could not release semaphore\n");
+               /* Continue anyways */
+       }
+
+       /* Always restart MCU firmware */
+       mt76_connac_mcu_restart(&dev->mt76);
+
+       /* Check if MCU is ready */
+       ret = mt7915_firmware_state(dev, false);
+       if (ret) {
+               dev_err(dev->mt76.dev, "Firmware did not enter download state\n");
+               return ret;
        }
 
        ret = mt76_connac2_load_patch(&dev->mt76, fw_name_var(dev, ROM_PATCH));