mirror of
https://github.com/outbackdingo/mt76.git
synced 2026-10-24 21:36:52 +00:00
137 lines
2.9 KiB
C
137 lines
2.9 KiB
C
/*
|
|
* Copyright (C) 2014 Felix Fietkau <[email protected]>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2
|
|
* as published by the Free Software Foundation
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/pci.h>
|
|
|
|
#include "mt76.h"
|
|
#include "trace.h"
|
|
|
|
static const struct pci_device_id mt76pci_device_table[] = {
|
|
{ PCI_DEVICE(0x14c3, 0x7662) },
|
|
{ },
|
|
};
|
|
|
|
u32 mt76_rr(struct mt76_dev *dev, u32 offset)
|
|
{
|
|
u32 val;
|
|
|
|
val = ioread32(dev->regs + offset);
|
|
trace_reg_read(dev, offset, val);
|
|
|
|
return val;
|
|
}
|
|
|
|
void mt76_wr(struct mt76_dev *dev, u32 offset, u32 val)
|
|
{
|
|
trace_reg_write(dev, offset, val);
|
|
iowrite32(val, dev->regs + offset);
|
|
}
|
|
|
|
u32 mt76_rmw(struct mt76_dev *dev, u32 offset, u32 mask, u32 val)
|
|
{
|
|
val |= mt76_rr(dev, offset) & ~mask;
|
|
mt76_wr(dev, offset, val);
|
|
return val;
|
|
}
|
|
|
|
void mt76_wr_copy(struct mt76_dev *dev, u32 offset, const void *data, int len)
|
|
{
|
|
__iowrite32_copy(dev->regs + offset, data, len >> 2);
|
|
}
|
|
|
|
static int
|
|
mt76pci_probe(struct pci_dev *pdev, const struct pci_device_id *id)
|
|
{
|
|
struct mt76_dev *dev;
|
|
int ret;
|
|
|
|
ret = pcim_enable_device(pdev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = pcim_iomap_regions(pdev, BIT(0), pci_name(pdev));
|
|
if (ret)
|
|
return ret;
|
|
|
|
pci_set_master(pdev);
|
|
|
|
ret = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
|
|
if (ret)
|
|
return ret;
|
|
|
|
dev = mt76_alloc_device(&pdev->dev);
|
|
if (!dev)
|
|
return -ENOMEM;
|
|
|
|
dev->regs = pcim_iomap_table(pdev)[0];
|
|
|
|
pci_set_drvdata(pdev, dev);
|
|
|
|
dev->rev = mt76_rr(dev, MT_ASIC_VERSION);
|
|
printk("ASIC revision: %08x\n", dev->rev);
|
|
|
|
ret = devm_request_irq(dev->dev, pdev->irq, mt76_irq_handler,
|
|
IRQF_SHARED, KBUILD_MODNAME, dev);
|
|
if (ret)
|
|
goto error;
|
|
|
|
ret = mt76_register_device(dev);
|
|
if (ret)
|
|
goto error;
|
|
|
|
/* Fix up ASPM configuration */
|
|
|
|
/* RG_SSUSB_G1_CDR_BIR_LTR = 0x9 */
|
|
mt76_rmw_field(dev, 0x15a10, 0x1f << 16, 0x9);
|
|
|
|
/* RG_SSUSB_G1_CDR_BIC_LTR = 0xf */
|
|
mt76_rmw_field(dev, 0x15a0c, 0xf << 28, 0xf);
|
|
|
|
/* RG_SSUSB_CDR_BR_PE1D = 0x3 */
|
|
mt76_rmw_field(dev, 0x15c58, 0x3 << 6, 0x3);
|
|
|
|
printk("pci device driver attached\n");
|
|
return 0;
|
|
|
|
error:
|
|
ieee80211_free_hw(dev->hw);
|
|
return ret;
|
|
}
|
|
|
|
static void
|
|
mt76pci_remove(struct pci_dev *pdev)
|
|
{
|
|
struct mt76_dev *dev = pci_get_drvdata(pdev);
|
|
|
|
ieee80211_unregister_hw(dev->hw);
|
|
mt76_cleanup(dev);
|
|
ieee80211_free_hw(dev->hw);
|
|
printk("pci device driver detached\n");
|
|
}
|
|
|
|
MODULE_DEVICE_TABLE(pci, mt76pci_device_table);
|
|
MODULE_FIRMWARE(MT7662_FIRMWARE);
|
|
MODULE_FIRMWARE(MT7662_ROM_PATCH);
|
|
MODULE_LICENSE("GPL");
|
|
|
|
static struct pci_driver mt76pci_driver = {
|
|
.name = KBUILD_MODNAME,
|
|
.id_table = mt76pci_device_table,
|
|
.probe = mt76pci_probe,
|
|
.remove = mt76pci_remove,
|
|
};
|
|
|
|
module_pci_driver(mt76pci_driver);
|