[PATCH v3 net-next 3/5] net: wwan: t7xx: PCIe reset rescan

Kumar, M Chetan m.chetan.kumar at linux.intel.com
Sun Jan 8 06:14:08 PST 2023


On 1/7/2023 12:12 AM, Jesse Brandeburg wrote:
> On 1/6/2023 8:27 AM, m.chetan.kumar at linux.intel.com wrote:
>> From: M Chetan Kumar <m.chetan.kumar at linux.intel.com>
>>
>> PCI rescan module implements "rescan work queue".
>> In firmware flashing or coredump collection procedure
>> WWAN device is programmed to boot in fastboot mode and
>> a work item is scheduled for removal & detection.
>>
>> The WWAN device is reset using APCI call as part driver
>> removal flow. Work queue rescans pci bus at fixed interval
>> for device detection, later when device is detect work queue
>> exits.
>>
>> Signed-off-by: Haijun Liu <haijun.liu at mediatek.com>
>> Co-developed-by: Madhusmita Sahu <madhusmita.sahu at intel.com>
>> Signed-off-by: Madhusmita Sahu <madhusmita.sahu at intel.com>
>> Signed-off-by: Ricardo Martinez <ricardo.martinez at linux.intel.com>
>> Signed-off-by: M Chetan Kumar <m.chetan.kumar at linux.intel.com>
>> Signed-off-by: Devegowda Chandrashekar 
>> <chandrashekar.devegowda at intel.com>
>> -- 
>> v3:
>>   * No Change.
>> v2:
>>   * Drop empty line inside critical sections.
>>   * Correct log message.
>>   * Correct logic inside t7xx_always_match().
>>   * Drop hp_enable changes.
>>   * Drop g_ prefix from t7xx_rescan_ctx.
>>   * Use tab before comment in struct decl.
>>   * Remove extra white space.
>>   * Drop modem exception state check.
>>   * Crit section newlines.
>>   * Remove unnecessary header files inclusion.
>>   * Drop spinlock around reset and rescan flow.
>> ---
>>   drivers/net/wwan/t7xx/Makefile          |  3 +-
>>   drivers/net/wwan/t7xx/t7xx_modem_ops.c  |  3 +
>>   drivers/net/wwan/t7xx/t7xx_pci.c        | 56 ++++++++++++++-
>>   drivers/net/wwan/t7xx/t7xx_pci_rescan.c | 96 +++++++++++++++++++++++++
>>   drivers/net/wwan/t7xx/t7xx_pci_rescan.h | 28 ++++++++
>>   5 files changed, 184 insertions(+), 2 deletions(-)
>>   create mode 100644 drivers/net/wwan/t7xx/t7xx_pci_rescan.c
>>   create mode 100644 drivers/net/wwan/t7xx/t7xx_pci_rescan.h
>>
>> diff --git a/drivers/net/wwan/t7xx/Makefile 
>> b/drivers/net/wwan/t7xx/Makefile
>> index 268ff9e87e5b..ba5c607404a4 100644
>> --- a/drivers/net/wwan/t7xx/Makefile
>> +++ b/drivers/net/wwan/t7xx/Makefile
>> @@ -17,7 +17,8 @@ mtk_t7xx-y:=    t7xx_pci.o \
>>           t7xx_hif_dpmaif_tx.o \
>>           t7xx_hif_dpmaif_rx.o  \
>>           t7xx_dpmaif.o \
>> -        t7xx_netdev.o
>> +        t7xx_netdev.o \
>> +        t7xx_pci_rescan.o
>>   mtk_t7xx-$(CONFIG_WWAN_DEBUGFS) += \
>>           t7xx_port_trace.o \
>> diff --git a/drivers/net/wwan/t7xx/t7xx_modem_ops.c 
>> b/drivers/net/wwan/t7xx/t7xx_modem_ops.c
>> index cbd65aa48721..2fcaea4694ba 100644
>> --- a/drivers/net/wwan/t7xx/t7xx_modem_ops.c
>> +++ b/drivers/net/wwan/t7xx/t7xx_modem_ops.c
>> @@ -37,6 +37,7 @@
>>   #include "t7xx_modem_ops.h"
>>   #include "t7xx_netdev.h"
>>   #include "t7xx_pci.h"
>> +#include "t7xx_pci_rescan.h"
>>   #include "t7xx_pcie_mac.h"
>>   #include "t7xx_port.h"
>>   #include "t7xx_port_proxy.h"
>> @@ -194,6 +195,8 @@ static irqreturn_t t7xx_rgu_isr_thread(int irq, 
>> void *data)
>>       msleep(RGU_RESET_DELAY_MS);
>>       t7xx_reset_device_via_pmic(t7xx_dev);
>> +    t7xx_rescan_queue_work(t7xx_dev->pdev);
>> +
>>       return IRQ_HANDLED;
>>   }
>> diff --git a/drivers/net/wwan/t7xx/t7xx_pci.c 
>> b/drivers/net/wwan/t7xx/t7xx_pci.c
>> index 871f2a27a398..1e953ec7dd00 100644
>> --- a/drivers/net/wwan/t7xx/t7xx_pci.c
>> +++ b/drivers/net/wwan/t7xx/t7xx_pci.c
>> @@ -38,6 +38,7 @@
>>   #include "t7xx_mhccif.h"
>>   #include "t7xx_modem_ops.h"
>>   #include "t7xx_pci.h"
>> +#include "t7xx_pci_rescan.h"
>>   #include "t7xx_pcie_mac.h"
>>   #include "t7xx_reg.h"
>>   #include "t7xx_state_monitor.h"
>> @@ -715,6 +716,7 @@ static int t7xx_pci_probe(struct pci_dev *pdev, 
>> const struct pci_device_id *id)
>>           return ret;
>>       }
>> +    t7xx_rescan_done();
>>       t7xx_pcie_mac_set_int(t7xx_dev, MHCCIF_INT);
>>       t7xx_pcie_mac_interrupts_en(t7xx_dev);
>> @@ -754,7 +756,59 @@ static struct pci_driver t7xx_pci_driver = {
>>       .shutdown = t7xx_pci_shutdown,
>>   };
>> -module_pci_driver(t7xx_pci_driver);
>> +static int __init t7xx_pci_init(void)
>> +{
>> +    int ret;
>> +
>> +    t7xx_pci_dev_rescan();
>> +    ret = t7xx_rescan_init();
>> +    if (ret) {
>> +        pr_err("Failed to init t7xx rescan work\n");
>> +        return ret;
>> +    }
>> +
>> +    return pci_register_driver(&t7xx_pci_driver);
>> +}
>> +module_init(t7xx_pci_init);
>> +
>> +static int t7xx_always_match(struct device *dev, const void *data)
>> +{
>> +    struct pci_dev *pdev = to_pci_dev(dev);
>> +    const struct pci_device_id *id = data;
>> +
>> +    if (pci_match_id(id, pdev))
>> +        return 1;
>> +
>> +    return 0;
>> +}
>> +
>> +static void __exit t7xx_pci_cleanup(void)
>> +{
>> +    int remove_flag = 0;
>> +    struct device *dev;
>> +
>> +    dev = driver_find_device(&t7xx_pci_driver.driver, NULL, 
>> &t7xx_pci_table[0],
>> +                 t7xx_always_match);
>> +    if (dev) {
>> +        pr_debug("unregister t7xx PCIe driver while device is still 
>> exist.\n");
> 
> nit: s/is still exist/still exists/

Ok, will correct it.

> 
>> +        put_device(dev);
>> +        remove_flag = 1;
>> +    } else {
>> +        pr_debug("no t7xx PCIe driver found.\n");
>> +    }
>> +
>> +    pci_lock_rescan_remove();
>> +    pci_unregister_driver(&t7xx_pci_driver);
>> +    pci_unlock_rescan_remove();
>> +
>> +    t7xx_rescan_deinit();
>> +    if (remove_flag) {
>> +        pr_debug("remove t7xx PCI device\n");
>> +        pci_stop_and_remove_bus_device_locked(to_pci_dev(dev));
>> +    }
>> +}
>> +
>> +module_exit(t7xx_pci_cleanup);
>>   MODULE_AUTHOR("MediaTek Inc");
>>   MODULE_DESCRIPTION("MediaTek PCIe 5G WWAN modem T7xx driver");
>> diff --git a/drivers/net/wwan/t7xx/t7xx_pci_rescan.c 
>> b/drivers/net/wwan/t7xx/t7xx_pci_rescan.c
>> new file mode 100644
>> index 000000000000..67f13c035846
>> --- /dev/null
>> +++ b/drivers/net/wwan/t7xx/t7xx_pci_rescan.c
>> @@ -0,0 +1,96 @@
>> +// SPDX-License-Identifier: GPL-2.0-only
>> +/*
>> + * Copyright (c) 2021, MediaTek Inc.
>> + * Copyright (c) 2021-2023, Intel Corporation.
>> + */
>> +
>> +#define pr_fmt(fmt) KBUILD_MODNAME ":t7xx:%s: " fmt, __func__
>> +#define dev_fmt(fmt) "t7xx: " fmt
>> +
>> +#include <linux/delay.h>
>> +#include <linux/pci.h>
>> +#include <linux/spinlock.h>
>> +#include <linux/workqueue.h>
>> +
>> +#include "t7xx_pci.h"
>> +#include "t7xx_pci_rescan.h"
>> +
>> +static struct remove_rescan_context t7xx_rescan_ctx;
>> +
>> +void t7xx_pci_dev_rescan(void)
>> +{
>> +    struct pci_bus *b = NULL;
>> +
>> +    pci_lock_rescan_remove();
>> +    while ((b = pci_find_next_bus(b)))
>> +        pci_rescan_bus(b);
>> +    pci_unlock_rescan_remove();
>> +}
>> +
>> +void t7xx_rescan_done(void)
>> +{
>> +    if (!atomic_read(&t7xx_rescan_ctx.rescan_done)) {
>> +        atomic_set(&t7xx_rescan_ctx.rescan_done, 1);
>> +        pr_debug("Rescan probe\n");
>> +    } else {
>> +        pr_debug("Init probe\n");
>> +    }
>> +}
>> +
>> +static void t7xx_remove_rescan(struct work_struct *work)
>> +{
>> +    int num_retries = RESCAN_RETRIES;
>> +    struct pci_dev *pdev;
>> +
>> +    atomic_set(&t7xx_rescan_ctx.rescan_done, 0);
>> +    pdev = t7xx_rescan_ctx.dev;
>> +
>> +    if (pdev) {
>> +        pci_stop_and_remove_bus_device_locked(pdev);
>> +        pr_debug("start remove and rescan flow\n");
>> +    }
>> +
>> +    do {
>> +        t7xx_pci_dev_rescan();
>> +
>> +        if (atomic_read(&t7xx_rescan_ctx.rescan_done))
>> +            break;
>> +
>> +        msleep(DELAY_RESCAN_MTIME);
>> +    } while (num_retries--);
>> +}
>> +
>> +void t7xx_rescan_queue_work(struct pci_dev *pdev)
>> +{
>> +    if (!atomic_read(&t7xx_rescan_ctx.rescan_done)) {
>> +        dev_err(&pdev->dev, "Rescan failed\n");
>> +        return;
>> +    }
>> +
>> +    t7xx_rescan_ctx.dev = pdev;
>> +    queue_work(t7xx_rescan_ctx.pcie_rescan_wq, 
>> &t7xx_rescan_ctx.service_task);
>> +}
>> +
>> +int t7xx_rescan_init(void)
>> +{
>> +    atomic_set(&t7xx_rescan_ctx.rescan_done, 1);
>> +    t7xx_rescan_ctx.dev = NULL;
>> +
>> +    t7xx_rescan_ctx.pcie_rescan_wq = 
>> create_singlethread_workqueue(MTK_RESCAN_WQ);
>> +    if (!t7xx_rescan_ctx.pcie_rescan_wq) {
>> +        pr_err("Failed to create workqueue: %s\n", MTK_RESCAN_WQ);
>> +        return -ENOMEM;
>> +    }
>> +
>> +    INIT_WORK(&t7xx_rescan_ctx.service_task, t7xx_remove_rescan);
>> +
>> +    return 0;
>> +}
>> +
>> +void t7xx_rescan_deinit(void)
>> +{
>> +    t7xx_rescan_ctx.dev = NULL;
>> +    atomic_set(&t7xx_rescan_ctx.rescan_done, 0);
>> +    cancel_work_sync(&t7xx_rescan_ctx.service_task);
>> +    destroy_workqueue(t7xx_rescan_ctx.pcie_rescan_wq);
>> +}
>> diff --git a/drivers/net/wwan/t7xx/t7xx_pci_rescan.h 
>> b/drivers/net/wwan/t7xx/t7xx_pci_rescan.h
>> new file mode 100644
>> index 000000000000..80b25c44151c
>> --- /dev/null
>> +++ b/drivers/net/wwan/t7xx/t7xx_pci_rescan.h
>> @@ -0,0 +1,28 @@
>> +/* SPDX-License-Identifier: GPL-2.0-only
>> + *
>> + * Copyright (c) 2021, MediaTek Inc.
>> + * Copyright (c) 2021-2023, Intel Corporation.
>> + */
>> +
>> +#ifndef __T7XX_PCI_RESCAN_H__
>> +#define __T7XX_PCI_RESCAN_H__
>> +
>> +#define MTK_RESCAN_WQ "mtk_rescan_wq"
>> +
>> +#define DELAY_RESCAN_MTIME 1000
>> +#define RESCAN_RETRIES 35
>> +
>> +struct remove_rescan_context {
>> +    struct work_struct service_task;
>> +    struct workqueue_struct *pcie_rescan_wq;
>> +    struct pci_dev *dev;
>> +    atomic_t rescan_done;
>> +};
>> +
>> +void t7xx_pci_dev_rescan(void);
>> +void t7xx_rescan_queue_work(struct pci_dev *pdev);
>> +int t7xx_rescan_init(void);
>> +void t7xx_rescan_deinit(void);
>> +void t7xx_rescan_done(void);
>> +
>> +#endif    /* __T7XX_PCI_RESCAN_H__ */
> 

-- 
Chetan



More information about the Linux-mediatek mailing list