#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;
__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))
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);
if (ep_dev->shutdown)
return 0;
err = read_poll_timeout(cfg_read8, val, (!val || val == 0xFF), 20,
EEA_RESET_TIMEOUT_US,
false, ep_dev->reg, device_status);
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);
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);
if (val == 0xFF)
return -EINVAL;
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);
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;
}
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);
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;
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)
dev_err(&ep_dev->pci_dev->dev,
"ha: re-setup failed.\n");
mutex_unlock(&edev->ha_lock);
} else {
dev_warn(&ep_dev->pci_dev->dev,
"ha device reset: trylock failed.\n");
}
return;
}
eea_queues_check_and_reset(&ep_dev->edev);
}
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);
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);
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) {
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;
}
}
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");