root/drivers/net/ethernet/alibaba/eea/eea_pci.c
// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Driver for Alibaba Elastic Ethernet Adapter.
 *
 * Copyright (C) 2025 Alibaba Inc.
 */

#include <linux/io-64-nonatomic-lo-hi.h>
#include <linux/iopoll.h>

#include "eea_net.h"
#include "eea_pci.h"

#define EEA_PCI_DB_OFFSET 4096
#define EEA_PCI_DB_MIN_SIZE 8
#define EEA_PCI_DB_MAX_SIZE 512
#define EEA_PCI_Q_MAX_NUM 1000

#define EEA_PCI_CAP_RESET_DEVICE 0xFA
#define EEA_PCI_CAP_RESET_FLAG BIT(1)

struct eea_pci_cfg {
        __le32 reserve0;
        __le32 reserve1;
        __le32 drv_f_idx;
        __le32 drv_f;

#define EEA_S_INIT         (BIT(0) | BIT(1))
#define EEA_S_OK           BIT(2)
#define EEA_S_FEATURE_DONE BIT(3)
#define EEA_S_FAILED       BIT(7)
        u8   device_status;
        u8   reserved[7];

        __le32 rx_num_max;
        __le32 tx_num_max;
        __le32 db_blk_size;

        /* admin queue cfg */
        __le16 aq_size;
        __le16 aq_msix_vector;
        __le32 aq_db_off;

        __le32 aq_sq_addr;
        __le32 aq_sq_addr_hi;
        __le32 aq_cq_addr;
        __le32 aq_cq_addr_hi;

        __le32 reserved1;
        __le64 hw_ts;
};

struct eea_pci_device {
        struct eea_device edev;
        struct pci_dev *pci_dev;

        u32 msix_vec_n;
        u32 db_len;

        void __iomem *reg;
        void __iomem *db_base;
        void __iomem *db_end;

        int ha_irq;

        struct work_struct ha_handle_work;
        char ha_irq_name[32];
        int reset_pos;
        bool ha_ready;

        bool shutdown;
};

#define cfg_pointer(reg, item) \
        ((void __iomem *)((reg) + offsetof(struct eea_pci_cfg, item)))

#define cfg_write8(reg, item, val) iowrite8(val, cfg_pointer(reg, item))
#define cfg_write16(reg, item, val) iowrite16(val, cfg_pointer(reg, item))
#define cfg_write32(reg, item, val) iowrite32(val, cfg_pointer(reg, item))
#define cfg_write64(reg, item, val) iowrite64_lo_hi(val, cfg_pointer(reg, item))

#define cfg_read8(reg, item) ioread8(cfg_pointer(reg, item))
#define cfg_read32(reg, item) ioread32(cfg_pointer(reg, item))
#define cfg_read64(reg, item) ioread64(cfg_pointer(reg, item))

/* Due to circular references, we have to add function definitions here. */
static int __eea_pci_probe(struct pci_dev *pci_dev,
                           struct eea_pci_device *ep_dev, bool pci_probe);
static void __eea_pci_remove(struct pci_dev *pci_dev, bool pci_remove);

const char *eea_pci_name(struct eea_device *edev)
{
        return pci_name(edev->ep_dev->pci_dev);
}

int eea_pci_domain_nr(struct eea_device *edev)
{
        return pci_domain_nr(edev->ep_dev->pci_dev->bus);
}

u16 eea_pci_bdf(struct eea_device *edev)
{
        return pci_dev_id(edev->ep_dev->pci_dev);
}

static void eea_pci_io_set_status(struct eea_device *edev, u8 status)
{
        struct eea_pci_device *ep_dev = edev->ep_dev;

        cfg_write8(ep_dev->reg, device_status, status);
}

static u8 eea_pci_io_get_status(struct eea_device *edev)
{
        struct eea_pci_device *ep_dev = edev->ep_dev;

        return cfg_read8(ep_dev->reg, device_status);
}

static void eea_add_status(struct eea_device *dev, u32 status)
{
        eea_pci_io_set_status(dev, eea_pci_io_get_status(dev) | status);
}

#define EEA_RESET_TIMEOUT_US (60 * 1000 * 1000)

int eea_device_reset(struct eea_device *edev)
{
        struct eea_pci_device *ep_dev = edev->ep_dev;
        int err;
        u8 val;

        eea_pci_io_set_status(edev, 0);

        /* We are no longer waiting for device ack during the shutdown flow. */
        if (ep_dev->shutdown)
                return 0;

        /* A longer timeout is set here to handle edge cases, though it should
         * return promptly in most scenarios.
         *
         * In our case, all replies are handled by the DPU software, so there is
         * no race condition between the hardware processes and the register.
         */
        err = read_poll_timeout(cfg_read8, val, (!val || val == 0xFF), 20,
                                EEA_RESET_TIMEOUT_US,
                                false, ep_dev->reg, device_status);

        /* Surprise PCIe Removal */
        if (val == 0xFF)
                return -EINVAL;

        return err;
}

int eea_pci_set_aq_up(struct eea_device *edev)
{
        struct eea_pci_device *ep_dev = edev->ep_dev;
        u8 status = eea_pci_io_get_status(edev);
        int err;
        u8 val;

        eea_pci_io_set_status(edev, status | EEA_S_OK);

        /* A longer timeout is set here to handle edge cases, though it should
         * return promptly in most scenarios.
         *
         * In our case, all replies are handled by the DPU software, so there is
         * no race condition between the hardware processes and the register.
         */
        err = read_poll_timeout(cfg_read8, val,
                                val & (EEA_S_OK | EEA_S_FAILED),
                                20, EEA_RESET_TIMEOUT_US,
                                false, ep_dev->reg, device_status);

        /* Surprise PCIe Removal */
        if (val == 0xFF)
                return -EINVAL;

        /* device fail */
        if (val & EEA_S_FAILED)
                return -EINVAL;

        return err;
}

static int eea_negotiate(struct eea_device *edev)
{
        struct eea_pci_device *ep_dev;
        u32 status;

        ep_dev = edev->ep_dev;

        edev->features = 0;

        cfg_write32(ep_dev->reg, drv_f_idx, 0);
        cfg_write32(ep_dev->reg, drv_f, lower_32_bits(edev->features));
        cfg_write32(ep_dev->reg, drv_f_idx, 1);
        cfg_write32(ep_dev->reg, drv_f, upper_32_bits(edev->features));

        eea_add_status(edev, EEA_S_FEATURE_DONE);
        status = eea_pci_io_get_status(edev);

        /* Surprise PCIe Removal */
        if (status == 0xFF)
                return -EINVAL;

        if (!(status & EEA_S_FEATURE_DONE))
                return -ENODEV;

        return 0;
}

static void eea_pci_release_resource(struct eea_pci_device *ep_dev)
{
        struct pci_dev *pci_dev = ep_dev->pci_dev;
        struct eea_device *edev;

        edev = &ep_dev->edev;

        if (edev->status < EEA_PCI_STATUS_READY)
                return;

        if (ep_dev->reg) {
                pci_iounmap(pci_dev, ep_dev->reg);
                ep_dev->reg = NULL;
        }

        if (ep_dev->msix_vec_n) {
                ep_dev->msix_vec_n = 0;
                pci_free_irq_vectors(ep_dev->pci_dev);
        }

        pci_clear_master(pci_dev);
        pci_release_regions(pci_dev);
        pci_disable_device(pci_dev);

        edev->status = EEA_PCI_STATUS_NONE;
}

static int eea_pci_setup(struct pci_dev *pci_dev, struct eea_pci_device *ep_dev)
{
        int err, n, ret, len;

        ep_dev->edev.status = EEA_PCI_STATUS_ERR;

        ep_dev->pci_dev = pci_dev;

        err = pci_enable_device(pci_dev);
        if (err)
                return err;

        err = pci_request_regions(pci_dev, "EEA");
        if (err)
                goto err_disable_dev;

        if (pci_resource_len(pci_dev, 0) < EEA_PCI_DB_OFFSET) {
                dev_err(&pci_dev->dev, "Bar 0 is too small %llu\n",
                        (u64)pci_resource_len(pci_dev, 0));
                err = -EINVAL;
                goto err_release_regions;
        }

        ep_dev->reg = pci_iomap(pci_dev, 0, 0);
        if (!ep_dev->reg) {
                dev_err(&pci_dev->dev, "Failed to map pci bar!\n");
                err = -ENOMEM;
                goto err_release_regions;
        }

        err = eea_device_reset(&ep_dev->edev);
        if (err) {
                dev_err(&pci_dev->dev, "Failed to reset device for setup!\n");
                goto err_unmap_reg;
        }

        err = dma_set_mask_and_coherent(&pci_dev->dev, DMA_BIT_MASK(64));
        if (err) {
                dev_warn(&pci_dev->dev, "Failed to enable 64-bit DMA.\n");
                goto err_unmap_reg;
        }

        pci_set_master(pci_dev);

        ep_dev->edev.rx_num = cfg_read32(ep_dev->reg, rx_num_max);
        ep_dev->edev.tx_num = cfg_read32(ep_dev->reg, tx_num_max);

        if (ep_dev->edev.rx_num > EEA_PCI_Q_MAX_NUM ||
            ep_dev->edev.tx_num > EEA_PCI_Q_MAX_NUM) {
                dev_err(&pci_dev->dev, "Invalid queue num %u %u\n",
                        ep_dev->edev.rx_num,
                        ep_dev->edev.tx_num);
                err = -EINVAL;
                goto err_clear_master;
        }

        ep_dev->edev.db_blk_size = cfg_read32(ep_dev->reg, db_blk_size);
        if (!IS_ALIGNED(ep_dev->edev.db_blk_size, 8) ||
            ep_dev->edev.db_blk_size > EEA_PCI_DB_MAX_SIZE ||
            ep_dev->edev.db_blk_size < EEA_PCI_DB_MIN_SIZE) {
                dev_err(&pci_dev->dev, "Invalid db size %u\n",
                        ep_dev->edev.db_blk_size);
                err = -EINVAL;
                goto err_clear_master;
        }

        ep_dev->db_len = ep_dev->edev.db_blk_size * (ep_dev->edev.rx_num +
                                                     ep_dev->edev.tx_num + 1);
        ep_dev->db_base = ep_dev->reg + EEA_PCI_DB_OFFSET;
        ep_dev->db_end = ep_dev->db_base + ep_dev->db_len;

        len = ep_dev->db_end - ep_dev->reg;

        if (pci_resource_len(pci_dev, 0) < len) {
                dev_err(&pci_dev->dev, "Bar 0 is too small %llu\n",
                        (u64)pci_resource_len(pci_dev, 0));
                err = -EINVAL;
                goto err_clear_master;
        }

        /* In our design, the number of hardware interrupts matches the maximum
         * number of queues. If pci_alloc_irq_vectors failed, return directly.
         *
         * 2: adminq, error handle
         */
        n = ep_dev->edev.rx_num + 2;
        ret = pci_alloc_irq_vectors(ep_dev->pci_dev, n, n, PCI_IRQ_MSIX);
        if (ret != n) {
                err = ret;
                goto err_clear_master;
        }

        ep_dev->msix_vec_n = ret;

        ep_dev->edev.status = EEA_PCI_STATUS_READY;

        return 0;

err_clear_master:
        pci_clear_master(pci_dev);

err_unmap_reg:
        pci_iounmap(pci_dev, ep_dev->reg);
        ep_dev->reg = NULL;

err_release_regions:
        pci_release_regions(pci_dev);

err_disable_dev:
        pci_disable_device(pci_dev);

        return err;
}

void __iomem *eea_pci_db_addr(struct eea_device *edev, u32 off)
{
        u32 max_off;

        if (!IS_ALIGNED(off, 8))
                return NULL;

        max_off = edev->ep_dev->db_len - edev->db_blk_size;

        if (off > max_off)
                return NULL;

        return edev->ep_dev->db_base + off;
}

int eea_pci_active_aq(struct eea_ring *ering, int msix_vec)
{
        struct eea_pci_device *ep_dev = ering->edev->ep_dev;

        cfg_write16(ep_dev->reg, aq_size, ering->num);
        cfg_write16(ep_dev->reg, aq_msix_vector, msix_vec);

        cfg_write64(ep_dev->reg, aq_sq_addr, ering->sq.dma_addr);
        cfg_write64(ep_dev->reg, aq_cq_addr, ering->cq.dma_addr);

        ering->db = eea_pci_db_addr(ering->edev,
                                    cfg_read32(ep_dev->reg, aq_db_off));

        if (!ering->db)
                return -EIO;

        return 0;
}

void eea_pci_free_irq(struct eea_irq_blk *blk)
{
        irq_update_affinity_hint(blk->irq, NULL);
        free_irq(blk->irq, blk);
}

int eea_pci_request_irq(struct eea_device *edev, struct eea_irq_blk *blk,
                        irqreturn_t (*callback)(int irq, void *data))
{
        struct eea_pci_device *ep_dev = edev->ep_dev;
        int irq;

        snprintf(blk->irq_name, sizeof(blk->irq_name), "eea-q%d@%s", blk->idx,
                 pci_name(ep_dev->pci_dev));

        irq = pci_irq_vector(ep_dev->pci_dev, blk->msix_vec);

        blk->irq = irq;

        return request_irq(irq, callback, IRQF_NO_AUTOEN, blk->irq_name, blk);
}

static void eea_ha_handle_reset(struct eea_pci_device *ep_dev)
{
        struct eea_device *edev;
        struct pci_dev *pci_dev;
        u16 reset;
        int err;

        if (!ep_dev->reset_pos) {
                eea_queues_check_and_reset(&ep_dev->edev);
                return;
        }

        edev = &ep_dev->edev;

        pci_read_config_word(ep_dev->pci_dev, ep_dev->reset_pos, &reset);

        /* Clear bits using 0xFFFF and ignore all previous messages. */
        pci_write_config_word(ep_dev->pci_dev, ep_dev->reset_pos, 0xFFFF);

        if (reset & EEA_PCI_CAP_RESET_FLAG) {
                dev_warn(&ep_dev->pci_dev->dev, "recv device reset request.\n");

                pci_dev = ep_dev->pci_dev;

                /* The pci remove callback may hold this lock. If the
                 * pci remove callback is called, then we can ignore the
                 * ha interrupt.
                 */
                if (mutex_trylock(&edev->ha_lock)) {
                        if (edev->status != EEA_PCI_STATUS_DONE) {
                                dev_err(&ep_dev->pci_dev->dev, "ha: reset device: pci status is %d. skip it.\n",
                                        edev->status);

                                mutex_unlock(&edev->ha_lock);
                                return;
                        }

                        __eea_pci_remove(pci_dev, false);
                        err = __eea_pci_probe(pci_dev, ep_dev, false);
                        if (err)
                                /* Currently, for some reason, PCI
                                 * initialization or network device re-probing
                                 * has failed. Waiting for the PCI subsystem to
                                 * call the remove callback to release the
                                 * remaining resources.
                                 */
                                dev_err(&ep_dev->pci_dev->dev,
                                        "ha: re-setup failed.\n");

                        mutex_unlock(&edev->ha_lock);
                } else {
                        /* Device removal is in progress, so return directly. */
                        dev_warn(&ep_dev->pci_dev->dev,
                                 "ha device reset: trylock failed.\n");
                }
                return;
        }

        eea_queues_check_and_reset(&ep_dev->edev);
}

/* ha handle code */
static void eea_ha_handle_work(struct work_struct *work)
{
        struct eea_pci_device *ep_dev;

        ep_dev = container_of(work, struct eea_pci_device, ha_handle_work);

        /* Ha interrupt is triggered, so there maybe some error, we may need to
         * reset the device or reset some queues.
         */
        dev_warn(&ep_dev->pci_dev->dev, "recv ha interrupt.\n");

        eea_ha_handle_reset(ep_dev);
}

static irqreturn_t eea_pci_ha_handle(int irq, void *data)
{
        struct eea_device *edev = data;

        schedule_work(&edev->ep_dev->ha_handle_work);

        return IRQ_HANDLED;
}

static void eea_pci_free_ha_irq(struct eea_device *edev)
{
        struct eea_pci_device *ep_dev = edev->ep_dev;
        int irq;

        if (ep_dev->ha_ready) {
                irq = pci_irq_vector(ep_dev->pci_dev, 0);
                free_irq(irq, edev);
                ep_dev->ha_ready = false;
        }
}

static int eea_pci_ha_init(struct eea_device *edev, struct pci_dev *pci_dev,
                           bool pci_probe)
{
        int pos, cfg_type_off, cfg_drv_off, cfg_dev_off;
        struct eea_pci_device *ep_dev = edev->ep_dev;
        int irq, err;
        u8 type;

        snprintf(ep_dev->ha_irq_name, sizeof(ep_dev->ha_irq_name), "eea-ha@%s",
                 pci_name(ep_dev->pci_dev));

        irq = pci_irq_vector(ep_dev->pci_dev, 0);

        if (pci_probe)
                INIT_WORK(&ep_dev->ha_handle_work, eea_ha_handle_work);

        /* This irq is not only work for ha, so request it always. */
        err = request_irq(irq, eea_pci_ha_handle, IRQF_NO_AUTOEN,
                          ep_dev->ha_irq_name, edev);
        if (err)
                return err;

        ep_dev->ha_irq = irq;

        ep_dev->ha_ready = true;
        ep_dev->reset_pos = 0;

        cfg_type_off = offsetof(struct eea_pci_cap, cfg_type);
        cfg_drv_off = offsetof(struct eea_pci_reset_reg, driver);
        cfg_dev_off = offsetof(struct eea_pci_reset_reg, device);

        for (pos = pci_find_capability(pci_dev, PCI_CAP_ID_VNDR);
             pos > 0;
             pos = pci_find_next_capability(pci_dev, pos, PCI_CAP_ID_VNDR)) {
                pci_read_config_byte(pci_dev, pos + cfg_type_off, &type);

                if (type == EEA_PCI_CAP_RESET_DEVICE) {
                        /* notify device, driver support this feature. */
                        pci_write_config_word(pci_dev, pos + cfg_drv_off,
                                              EEA_PCI_CAP_RESET_FLAG);
                        pci_write_config_word(pci_dev, pos + cfg_dev_off,
                                              0xFFFF);

                        edev->ep_dev->reset_pos = pos + cfg_dev_off;
                        return 0;
                }
        }

        /* irq just for event notify */
        dev_warn(&edev->ep_dev->pci_dev->dev, "Not Found reset cap.\n");
        return 0;
}

u64 eea_pci_device_ts(struct eea_device *edev)
{
        struct eea_pci_device *ep_dev = edev->ep_dev;

        return cfg_read64(ep_dev->reg, hw_ts);
}

static int eea_init_device(struct eea_device *edev)
{
        int err;

        err = eea_device_reset(edev);
        if (err)
                return err;

        eea_pci_io_set_status(edev, EEA_S_INIT);

        err = eea_negotiate(edev);
        if (err)
                goto err;

        err = eea_net_probe(edev);
        if (err)
                goto err;

        return 0;
err:
        eea_add_status(edev, EEA_S_FAILED);
        return err;
}

static int __eea_pci_probe(struct pci_dev *pci_dev,
                           struct eea_pci_device *ep_dev,
                           bool pci_probe)
{
        struct eea_device *edev;
        int err;

        pci_set_drvdata(pci_dev, ep_dev);

        edev = &ep_dev->edev;

        err = eea_pci_setup(pci_dev, ep_dev);
        if (err)
                return err;

        err = eea_init_device(&ep_dev->edev);
        if (err)
                goto err_pci_rel;

        err = eea_pci_ha_init(edev, pci_dev, pci_probe);
        if (err)
                goto err_net_rm;

        edev->status = EEA_PCI_STATUS_DONE;

        enable_irq(ep_dev->ha_irq);

        return 0;

err_net_rm:
        eea_net_remove(edev, !pci_probe);

err_pci_rel:
        eea_pci_release_resource(ep_dev);
        return err;
}

static void __eea_pci_remove(struct pci_dev *pci_dev, bool pci_remove)
{
        struct eea_pci_device *ep_dev = pci_get_drvdata(pci_dev);
        struct device *dev = get_device(&ep_dev->pci_dev->dev);
        struct eea_device *edev = &ep_dev->edev;

        eea_pci_free_ha_irq(edev);

        if (pci_remove)
                flush_work(&ep_dev->ha_handle_work);

        eea_net_remove(edev, !pci_remove);

        eea_pci_release_resource(ep_dev);

        put_device(dev);
}

static int eea_pci_probe(struct pci_dev *pci_dev,
                         const struct pci_device_id *id)
{
        struct eea_pci_device *ep_dev;
        struct eea_device *edev;
        int err;

        ep_dev = kzalloc(sizeof(*ep_dev), GFP_KERNEL);
        if (!ep_dev)
                return -ENOMEM;

        edev = &ep_dev->edev;

        edev->ep_dev = ep_dev;
        edev->dma_dev = &pci_dev->dev;

        ep_dev->pci_dev = pci_dev;

        mutex_init(&edev->ha_lock);

        err = __eea_pci_probe(pci_dev, ep_dev, true);
        if (err) {
                mutex_destroy(&edev->ha_lock);
                pci_set_drvdata(pci_dev, NULL);
                kfree(ep_dev);
        }

        return err;
}

static void eea_pci_remove(struct pci_dev *pci_dev)
{
        struct eea_pci_device *ep_dev = pci_get_drvdata(pci_dev);
        struct eea_device *edev;

        edev = &ep_dev->edev;

        mutex_lock(&edev->ha_lock);
        __eea_pci_remove(pci_dev, true);
        mutex_unlock(&edev->ha_lock);

        pci_set_drvdata(pci_dev, NULL);

        mutex_destroy(&edev->ha_lock);
        kfree(ep_dev);
}

static void eea_pci_shutdown(struct pci_dev *pci_dev)
{
        struct eea_pci_device *ep_dev = pci_get_drvdata(pci_dev);
        struct eea_device *edev;

        edev = &ep_dev->edev;

        ep_dev->shutdown = true;

        mutex_lock(&edev->ha_lock);
        eea_pci_free_ha_irq(edev);
        flush_work(&ep_dev->ha_handle_work);
        mutex_unlock(&edev->ha_lock);

        eea_net_shutdown(edev);

        pci_clear_master(pci_dev);
}

static const struct pci_device_id eea_pci_id_table[] = {
        { PCI_DEVICE(PCI_VENDOR_ID_ALIBABA, 0x500B) },
        { 0 }
};

MODULE_DEVICE_TABLE(pci, eea_pci_id_table);

static struct pci_driver eea_pci_driver = {
        .name            = "alibaba_eea",
        .id_table        = eea_pci_id_table,
        .probe           = eea_pci_probe,
        .remove          = eea_pci_remove,
        .shutdown        = eea_pci_shutdown,
        .sriov_configure = pci_sriov_configure_simple,
};

static __init int eea_pci_init(void)
{
        return pci_register_driver(&eea_pci_driver);
}

static __exit void eea_pci_exit(void)
{
        pci_unregister_driver(&eea_pci_driver);
}

module_init(eea_pci_init);
module_exit(eea_pci_exit);

MODULE_DESCRIPTION("Driver for Alibaba Elastic Ethernet Adapter");
MODULE_AUTHOR("Xuan Zhuo <xuanzhuo@linux.alibaba.com>");
MODULE_LICENSE("GPL");