97 lines
2.1 KiB
C
97 lines
2.1 KiB
C
|
// SPDX-License-Identifier: GPL-2.0-only
|
||
|
/*
|
||
|
* Copyright (C) 2006-2007 PA Semi, Inc
|
||
|
*
|
||
|
* SMBus host driver for PA Semi PWRficient
|
||
|
*/
|
||
|
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/pci.h>
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/stddef.h>
|
||
|
#include <linux/sched.h>
|
||
|
#include <linux/i2c.h>
|
||
|
#include <linux/delay.h>
|
||
|
#include <linux/slab.h>
|
||
|
#include <linux/io.h>
|
||
|
|
||
|
#include "i2c-pasemi-core.h"
|
||
|
|
||
|
static struct pci_driver pasemi_smb_pci_driver;
|
||
|
|
||
|
static int pasemi_smb_pci_probe(struct pci_dev *dev,
|
||
|
const struct pci_device_id *id)
|
||
|
{
|
||
|
struct pasemi_smbus *smbus;
|
||
|
int error;
|
||
|
|
||
|
if (!(pci_resource_flags(dev, 0) & IORESOURCE_IO))
|
||
|
return -ENODEV;
|
||
|
|
||
|
smbus = kzalloc(sizeof(struct pasemi_smbus), GFP_KERNEL);
|
||
|
if (!smbus)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
smbus->dev = &dev->dev;
|
||
|
smbus->base = pci_resource_start(dev, 0);
|
||
|
smbus->size = pci_resource_len(dev, 0);
|
||
|
|
||
|
if (!request_region(smbus->base, smbus->size,
|
||
|
pasemi_smb_pci_driver.name)) {
|
||
|
error = -EBUSY;
|
||
|
goto out_kfree;
|
||
|
}
|
||
|
|
||
|
smbus->ioaddr = pci_iomap(dev, 0, 0);
|
||
|
if (!smbus->ioaddr) {
|
||
|
error = -EBUSY;
|
||
|
goto out_release_region;
|
||
|
}
|
||
|
|
||
|
error = pasemi_i2c_common_probe(smbus);
|
||
|
if (error)
|
||
|
goto out_ioport_unmap;
|
||
|
|
||
|
pci_set_drvdata(dev, smbus);
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
out_ioport_unmap:
|
||
|
pci_iounmap(dev, smbus->ioaddr);
|
||
|
out_release_region:
|
||
|
release_region(smbus->base, smbus->size);
|
||
|
out_kfree:
|
||
|
kfree(smbus);
|
||
|
return error;
|
||
|
}
|
||
|
|
||
|
static void pasemi_smb_pci_remove(struct pci_dev *dev)
|
||
|
{
|
||
|
struct pasemi_smbus *smbus = pci_get_drvdata(dev);
|
||
|
|
||
|
i2c_del_adapter(&smbus->adapter);
|
||
|
pci_iounmap(dev, smbus->ioaddr);
|
||
|
release_region(smbus->base, smbus->size);
|
||
|
kfree(smbus);
|
||
|
}
|
||
|
|
||
|
static const struct pci_device_id pasemi_smb_pci_ids[] = {
|
||
|
{ PCI_DEVICE(0x1959, 0xa003) },
|
||
|
{ 0, }
|
||
|
};
|
||
|
|
||
|
MODULE_DEVICE_TABLE(pci, pasemi_smb_pci_ids);
|
||
|
|
||
|
static struct pci_driver pasemi_smb_pci_driver = {
|
||
|
.name = "i2c-pasemi",
|
||
|
.id_table = pasemi_smb_pci_ids,
|
||
|
.probe = pasemi_smb_pci_probe,
|
||
|
.remove = pasemi_smb_pci_remove,
|
||
|
};
|
||
|
|
||
|
module_pci_driver(pasemi_smb_pci_driver);
|
||
|
|
||
|
MODULE_LICENSE("GPL");
|
||
|
MODULE_AUTHOR("Olof Johansson <olof@lixom.net>");
|
||
|
MODULE_DESCRIPTION("PA Semi PWRficient SMBus driver");
|