mirror of
https://github.com/outbackdingo/mt76.git
synced 2026-10-24 13:26:48 +00:00
Lorenzo BianconiandFelix Fietkau
22be43e70d
Add mt76x0e_register_device routine in pci.c to initialize the device during hw probe. Signed-off-by: Lorenzo Bianconi <[email protected]>
135 lines
3.0 KiB
C
135 lines
3.0 KiB
C
/*
|
|
* Copyright (C) 2016 Felix Fietkau <[email protected]>
|
|
*
|
|
* Permission to use, copy, modify, and/or distribute this software for any
|
|
* purpose with or without fee is hereby granted, provided that the above
|
|
* copyright notice and this permission notice appear in all copies.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
|
|
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
|
|
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
|
|
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
|
|
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
|
|
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/pci.h>
|
|
|
|
#include "mt76x0.h"
|
|
#include "mcu.h"
|
|
#include "../mt76x02_dma.h"
|
|
|
|
static int mt76x0e_register_device(struct mt76x0_dev *dev)
|
|
{
|
|
int err;
|
|
|
|
mt76x0_chip_onoff(dev, true, false);
|
|
if (!mt76x02_wait_for_mac(&dev->mt76))
|
|
return -ETIMEDOUT;
|
|
|
|
mt76x02_dma_disable(&dev->mt76);
|
|
err = mt76x0e_mcu_init(dev);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
err = mt76x02_dma_init(&dev->mt76);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
err = mt76x0_init_hardware(dev);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
if (mt76_chip(&dev->mt76) == 0x7610) {
|
|
u16 val;
|
|
|
|
mt76_clear(dev, MT_COEXCFG0, BIT(0));
|
|
val = mt76x02_eeprom_get(&dev->mt76, MT_EE_NIC_CONF_0);
|
|
if (val & MT_EE_NIC_CONF_0_PA_IO_CURRENT) {
|
|
u32 data;
|
|
|
|
/* set external external PA I/O
|
|
* current to 16mA
|
|
*/
|
|
data = mt76_rr(dev, 0x11c);
|
|
val |= 0xc03;
|
|
mt76_wr(dev, 0x11c, val);
|
|
}
|
|
}
|
|
|
|
mt76_clear(dev, 0x110, BIT(9));
|
|
mt76_set(dev, MT_MAX_LEN_CFG, BIT(13));
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
mt76x0e_probe(struct pci_dev *pdev, const struct pci_device_id *id)
|
|
{
|
|
struct mt76x0_dev *dev;
|
|
int ret = -ENODEV;
|
|
|
|
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 = mt76x0_alloc_device(&pdev->dev, NULL);
|
|
if (!dev)
|
|
return -ENOMEM;
|
|
|
|
mt76_mmio_init(&dev->mt76, pcim_iomap_table(pdev)[0]);
|
|
|
|
dev->mt76.rev = mt76_rr(dev, MT_ASIC_VERSION);
|
|
dev_info(dev->mt76.dev, "ASIC revision: %08x\n", dev->mt76.rev);
|
|
|
|
ret = mt76x0e_register_device(dev);
|
|
if (ret < 0)
|
|
goto error;
|
|
|
|
return 0;
|
|
|
|
error:
|
|
ieee80211_free_hw(mt76_hw(dev));
|
|
return ret;
|
|
}
|
|
|
|
static void
|
|
mt76x0e_remove(struct pci_dev *pdev)
|
|
{
|
|
struct mt76_dev *mdev = pci_get_drvdata(pdev);
|
|
|
|
mt76_unregister_device(mdev);
|
|
ieee80211_free_hw(mdev->hw);
|
|
}
|
|
|
|
static const struct pci_device_id mt76x0e_device_table[] = {
|
|
{ PCI_DEVICE(0x14c3, 0x7630) },
|
|
{ PCI_DEVICE(0x14c3, 0x7650) },
|
|
{ },
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(pci, mt76x0e_device_table);
|
|
MODULE_LICENSE("Dual BSD/GPL");
|
|
|
|
static struct pci_driver mt76x0e_driver = {
|
|
.name = KBUILD_MODNAME,
|
|
.id_table = mt76x0e_device_table,
|
|
.probe = mt76x0e_probe,
|
|
.remove = mt76x0e_remove,
|
|
};
|
|
|
|
module_pci_driver(mt76x0e_driver);
|