mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-26 10:49:33 +00:00
![Kees Cook](/assets/img/avatar_default.png)
The kzalloc() function has a 2-factor argument form, kcalloc(). This patch replaces cases of: kzalloc(a * b, gfp) with: kcalloc(a * b, gfp) as well as handling cases of: kzalloc(a * b * c, gfp) with: kzalloc(array3_size(a, b, c), gfp) as it's slightly less ugly than: kzalloc_array(array_size(a, b), c, gfp) This does, however, attempt to ignore constant size factors like: kzalloc(4 * 1024, gfp) though any constants defined via macros get caught up in the conversion. Any factors with a sizeof() of "unsigned char", "char", and "u8" were dropped, since they're redundant. The Coccinelle script used for this was: // Fix redundant parens around sizeof(). @@ type TYPE; expression THING, E; @@ ( kzalloc( - (sizeof(TYPE)) * E + sizeof(TYPE) * E , ...) | kzalloc( - (sizeof(THING)) * E + sizeof(THING) * E , ...) ) // Drop single-byte sizes and redundant parens. @@ expression COUNT; typedef u8; typedef __u8; @@ ( kzalloc( - sizeof(u8) * (COUNT) + COUNT , ...) | kzalloc( - sizeof(__u8) * (COUNT) + COUNT , ...) | kzalloc( - sizeof(char) * (COUNT) + COUNT , ...) | kzalloc( - sizeof(unsigned char) * (COUNT) + COUNT , ...) | kzalloc( - sizeof(u8) * COUNT + COUNT , ...) | kzalloc( - sizeof(__u8) * COUNT + COUNT , ...) | kzalloc( - sizeof(char) * COUNT + COUNT , ...) | kzalloc( - sizeof(unsigned char) * COUNT + COUNT , ...) ) // 2-factor product with sizeof(type/expression) and identifier or constant. @@ type TYPE; expression THING; identifier COUNT_ID; constant COUNT_CONST; @@ ( - kzalloc + kcalloc ( - sizeof(TYPE) * (COUNT_ID) + COUNT_ID, sizeof(TYPE) , ...) | - kzalloc + kcalloc ( - sizeof(TYPE) * COUNT_ID + COUNT_ID, sizeof(TYPE) , ...) | - kzalloc + kcalloc ( - sizeof(TYPE) * (COUNT_CONST) + COUNT_CONST, sizeof(TYPE) , ...) | - kzalloc + kcalloc ( - sizeof(TYPE) * COUNT_CONST + COUNT_CONST, sizeof(TYPE) , ...) | - kzalloc + kcalloc ( - sizeof(THING) * (COUNT_ID) + COUNT_ID, sizeof(THING) , ...) | - kzalloc + kcalloc ( - sizeof(THING) * COUNT_ID + COUNT_ID, sizeof(THING) , ...) | - kzalloc + kcalloc ( - sizeof(THING) * (COUNT_CONST) + COUNT_CONST, sizeof(THING) , ...) | - kzalloc + kcalloc ( - sizeof(THING) * COUNT_CONST + COUNT_CONST, sizeof(THING) , ...) ) // 2-factor product, only identifiers. @@ identifier SIZE, COUNT; @@ - kzalloc + kcalloc ( - SIZE * COUNT + COUNT, SIZE , ...) // 3-factor product with 1 sizeof(type) or sizeof(expression), with // redundant parens removed. @@ expression THING; identifier STRIDE, COUNT; type TYPE; @@ ( kzalloc( - sizeof(TYPE) * (COUNT) * (STRIDE) + array3_size(COUNT, STRIDE, sizeof(TYPE)) , ...) | kzalloc( - sizeof(TYPE) * (COUNT) * STRIDE + array3_size(COUNT, STRIDE, sizeof(TYPE)) , ...) | kzalloc( - sizeof(TYPE) * COUNT * (STRIDE) + array3_size(COUNT, STRIDE, sizeof(TYPE)) , ...) | kzalloc( - sizeof(TYPE) * COUNT * STRIDE + array3_size(COUNT, STRIDE, sizeof(TYPE)) , ...) | kzalloc( - sizeof(THING) * (COUNT) * (STRIDE) + array3_size(COUNT, STRIDE, sizeof(THING)) , ...) | kzalloc( - sizeof(THING) * (COUNT) * STRIDE + array3_size(COUNT, STRIDE, sizeof(THING)) , ...) | kzalloc( - sizeof(THING) * COUNT * (STRIDE) + array3_size(COUNT, STRIDE, sizeof(THING)) , ...) | kzalloc( - sizeof(THING) * COUNT * STRIDE + array3_size(COUNT, STRIDE, sizeof(THING)) , ...) ) // 3-factor product with 2 sizeof(variable), with redundant parens removed. @@ expression THING1, THING2; identifier COUNT; type TYPE1, TYPE2; @@ ( kzalloc( - sizeof(TYPE1) * sizeof(TYPE2) * COUNT + array3_size(COUNT, sizeof(TYPE1), sizeof(TYPE2)) , ...) | kzalloc( - sizeof(TYPE1) * sizeof(THING2) * (COUNT) + array3_size(COUNT, sizeof(TYPE1), sizeof(TYPE2)) , ...) | kzalloc( - sizeof(THING1) * sizeof(THING2) * COUNT + array3_size(COUNT, sizeof(THING1), sizeof(THING2)) , ...) | kzalloc( - sizeof(THING1) * sizeof(THING2) * (COUNT) + array3_size(COUNT, sizeof(THING1), sizeof(THING2)) , ...) | kzalloc( - sizeof(TYPE1) * sizeof(THING2) * COUNT + array3_size(COUNT, sizeof(TYPE1), sizeof(THING2)) , ...) | kzalloc( - sizeof(TYPE1) * sizeof(THING2) * (COUNT) + array3_size(COUNT, sizeof(TYPE1), sizeof(THING2)) , ...) ) // 3-factor product, only identifiers, with redundant parens removed. @@ identifier STRIDE, SIZE, COUNT; @@ ( kzalloc( - (COUNT) * STRIDE * SIZE + array3_size(COUNT, STRIDE, SIZE) , ...) | kzalloc( - COUNT * (STRIDE) * SIZE + array3_size(COUNT, STRIDE, SIZE) , ...) | kzalloc( - COUNT * STRIDE * (SIZE) + array3_size(COUNT, STRIDE, SIZE) , ...) | kzalloc( - (COUNT) * (STRIDE) * SIZE + array3_size(COUNT, STRIDE, SIZE) , ...) | kzalloc( - COUNT * (STRIDE) * (SIZE) + array3_size(COUNT, STRIDE, SIZE) , ...) | kzalloc( - (COUNT) * STRIDE * (SIZE) + array3_size(COUNT, STRIDE, SIZE) , ...) | kzalloc( - (COUNT) * (STRIDE) * (SIZE) + array3_size(COUNT, STRIDE, SIZE) , ...) | kzalloc( - COUNT * STRIDE * SIZE + array3_size(COUNT, STRIDE, SIZE) , ...) ) // Any remaining multi-factor products, first at least 3-factor products, // when they're not all constants... @@ expression E1, E2, E3; constant C1, C2, C3; @@ ( kzalloc(C1 * C2 * C3, ...) | kzalloc( - (E1) * E2 * E3 + array3_size(E1, E2, E3) , ...) | kzalloc( - (E1) * (E2) * E3 + array3_size(E1, E2, E3) , ...) | kzalloc( - (E1) * (E2) * (E3) + array3_size(E1, E2, E3) , ...) | kzalloc( - E1 * E2 * E3 + array3_size(E1, E2, E3) , ...) ) // And then all remaining 2 factors products when they're not all constants, // keeping sizeof() as the second factor argument. @@ expression THING, E1, E2; type TYPE; constant C1, C2, C3; @@ ( kzalloc(sizeof(THING) * C2, ...) | kzalloc(sizeof(TYPE) * C2, ...) | kzalloc(C1 * C2 * C3, ...) | kzalloc(C1 * C2, ...) | - kzalloc + kcalloc ( - sizeof(TYPE) * (E2) + E2, sizeof(TYPE) , ...) | - kzalloc + kcalloc ( - sizeof(TYPE) * E2 + E2, sizeof(TYPE) , ...) | - kzalloc + kcalloc ( - sizeof(THING) * (E2) + E2, sizeof(THING) , ...) | - kzalloc + kcalloc ( - sizeof(THING) * E2 + E2, sizeof(THING) , ...) | - kzalloc + kcalloc ( - (E1) * E2 + E1, E2 , ...) | - kzalloc + kcalloc ( - (E1) * (E2) + E1, E2 , ...) | - kzalloc + kcalloc ( - E1 * E2 + E1, E2 , ...) ) Signed-off-by: Kees Cook <keescook@chromium.org>
450 lines
12 KiB
C
450 lines
12 KiB
C
/*
|
|
SMBus driver for nVidia nForce2 MCP
|
|
|
|
Added nForce3 Pro 150 Thomas Leibold <thomas@plx.com>,
|
|
Ported to 2.5 Patrick Dreker <patrick@dreker.de>,
|
|
Copyright (c) 2003 Hans-Frieder Vogt <hfvogt@arcor.de>,
|
|
Based on
|
|
SMBus 2.0 driver for AMD-8111 IO-Hub
|
|
Copyright (c) 2002 Vojtech Pavlik
|
|
|
|
This program is free software; you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation; either version 2 of the License, or
|
|
(at your option) any later version.
|
|
|
|
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.
|
|
*/
|
|
|
|
/*
|
|
SUPPORTED DEVICES PCI ID
|
|
nForce2 MCP 0064
|
|
nForce2 Ultra 400 MCP 0084
|
|
nForce3 Pro150 MCP 00D4
|
|
nForce3 250Gb MCP 00E4
|
|
nForce4 MCP 0052
|
|
nForce4 MCP-04 0034
|
|
nForce MCP51 0264
|
|
nForce MCP55 0368
|
|
nForce MCP61 03EB
|
|
nForce MCP65 0446
|
|
nForce MCP67 0542
|
|
nForce MCP73 07D8
|
|
nForce MCP78S 0752
|
|
nForce MCP79 0AA2
|
|
|
|
This driver supports the 2 SMBuses that are included in the MCP of the
|
|
nForce2/3/4/5xx chipsets.
|
|
*/
|
|
|
|
/* Note: we assume there can only be one nForce2, with two SMBus interfaces */
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/stddef.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/dmi.h>
|
|
#include <linux/acpi.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/io.h>
|
|
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_AUTHOR("Hans-Frieder Vogt <hfvogt@gmx.net>");
|
|
MODULE_DESCRIPTION("nForce2/3/4/5xx SMBus driver");
|
|
|
|
|
|
struct nforce2_smbus {
|
|
struct i2c_adapter adapter;
|
|
int base;
|
|
int size;
|
|
int blockops;
|
|
int can_abort;
|
|
};
|
|
|
|
|
|
/*
|
|
* nVidia nForce2 SMBus control register definitions
|
|
* (Newer incarnations use standard BARs 4 and 5 instead)
|
|
*/
|
|
#define NFORCE_PCI_SMB1 0x50
|
|
#define NFORCE_PCI_SMB2 0x54
|
|
|
|
|
|
/*
|
|
* ACPI 2.0 chapter 13 SMBus 2.0 EC register model
|
|
*/
|
|
#define NVIDIA_SMB_PRTCL (smbus->base + 0x00) /* protocol, PEC */
|
|
#define NVIDIA_SMB_STS (smbus->base + 0x01) /* status */
|
|
#define NVIDIA_SMB_ADDR (smbus->base + 0x02) /* address */
|
|
#define NVIDIA_SMB_CMD (smbus->base + 0x03) /* command */
|
|
#define NVIDIA_SMB_DATA (smbus->base + 0x04) /* 32 data registers */
|
|
#define NVIDIA_SMB_BCNT (smbus->base + 0x24) /* number of data
|
|
bytes */
|
|
#define NVIDIA_SMB_STATUS_ABRT (smbus->base + 0x3c) /* register used to
|
|
check the status of
|
|
the abort command */
|
|
#define NVIDIA_SMB_CTRL (smbus->base + 0x3e) /* control register */
|
|
|
|
#define NVIDIA_SMB_STATUS_ABRT_STS 0x01 /* Bit to notify that
|
|
abort succeeded */
|
|
#define NVIDIA_SMB_CTRL_ABORT 0x20
|
|
#define NVIDIA_SMB_STS_DONE 0x80
|
|
#define NVIDIA_SMB_STS_ALRM 0x40
|
|
#define NVIDIA_SMB_STS_RES 0x20
|
|
#define NVIDIA_SMB_STS_STATUS 0x1f
|
|
|
|
#define NVIDIA_SMB_PRTCL_WRITE 0x00
|
|
#define NVIDIA_SMB_PRTCL_READ 0x01
|
|
#define NVIDIA_SMB_PRTCL_QUICK 0x02
|
|
#define NVIDIA_SMB_PRTCL_BYTE 0x04
|
|
#define NVIDIA_SMB_PRTCL_BYTE_DATA 0x06
|
|
#define NVIDIA_SMB_PRTCL_WORD_DATA 0x08
|
|
#define NVIDIA_SMB_PRTCL_BLOCK_DATA 0x0a
|
|
#define NVIDIA_SMB_PRTCL_PEC 0x80
|
|
|
|
/* Misc definitions */
|
|
#define MAX_TIMEOUT 100
|
|
|
|
/* We disable the second SMBus channel on these boards */
|
|
static const struct dmi_system_id nforce2_dmi_blacklist2[] = {
|
|
{
|
|
.ident = "DFI Lanparty NF4 Expert",
|
|
.matches = {
|
|
DMI_MATCH(DMI_BOARD_VENDOR, "DFI Corp,LTD"),
|
|
DMI_MATCH(DMI_BOARD_NAME, "LP UT NF4 Expert"),
|
|
},
|
|
},
|
|
{ }
|
|
};
|
|
|
|
static struct pci_driver nforce2_driver;
|
|
|
|
/* For multiplexing support, we need a global reference to the 1st
|
|
SMBus channel */
|
|
#if IS_ENABLED(CONFIG_I2C_NFORCE2_S4985)
|
|
struct i2c_adapter *nforce2_smbus;
|
|
EXPORT_SYMBOL_GPL(nforce2_smbus);
|
|
|
|
static void nforce2_set_reference(struct i2c_adapter *adap)
|
|
{
|
|
nforce2_smbus = adap;
|
|
}
|
|
#else
|
|
static inline void nforce2_set_reference(struct i2c_adapter *adap) { }
|
|
#endif
|
|
|
|
static void nforce2_abort(struct i2c_adapter *adap)
|
|
{
|
|
struct nforce2_smbus *smbus = adap->algo_data;
|
|
int timeout = 0;
|
|
unsigned char temp;
|
|
|
|
dev_dbg(&adap->dev, "Aborting current transaction\n");
|
|
|
|
outb_p(NVIDIA_SMB_CTRL_ABORT, NVIDIA_SMB_CTRL);
|
|
do {
|
|
msleep(1);
|
|
temp = inb_p(NVIDIA_SMB_STATUS_ABRT);
|
|
} while (!(temp & NVIDIA_SMB_STATUS_ABRT_STS) &&
|
|
(timeout++ < MAX_TIMEOUT));
|
|
if (!(temp & NVIDIA_SMB_STATUS_ABRT_STS))
|
|
dev_err(&adap->dev, "Can't reset the smbus\n");
|
|
outb_p(NVIDIA_SMB_STATUS_ABRT_STS, NVIDIA_SMB_STATUS_ABRT);
|
|
}
|
|
|
|
static int nforce2_check_status(struct i2c_adapter *adap)
|
|
{
|
|
struct nforce2_smbus *smbus = adap->algo_data;
|
|
int timeout = 0;
|
|
unsigned char temp;
|
|
|
|
do {
|
|
msleep(1);
|
|
temp = inb_p(NVIDIA_SMB_STS);
|
|
} while ((!temp) && (timeout++ < MAX_TIMEOUT));
|
|
|
|
if (timeout > MAX_TIMEOUT) {
|
|
dev_dbg(&adap->dev, "SMBus Timeout!\n");
|
|
if (smbus->can_abort)
|
|
nforce2_abort(adap);
|
|
return -ETIMEDOUT;
|
|
}
|
|
if (!(temp & NVIDIA_SMB_STS_DONE) || (temp & NVIDIA_SMB_STS_STATUS)) {
|
|
dev_dbg(&adap->dev, "Transaction failed (0x%02x)!\n", temp);
|
|
return -EIO;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/* Return negative errno on error */
|
|
static s32 nforce2_access(struct i2c_adapter *adap, u16 addr,
|
|
unsigned short flags, char read_write,
|
|
u8 command, int size, union i2c_smbus_data *data)
|
|
{
|
|
struct nforce2_smbus *smbus = adap->algo_data;
|
|
unsigned char protocol, pec;
|
|
u8 len;
|
|
int i, status;
|
|
|
|
protocol = (read_write == I2C_SMBUS_READ) ? NVIDIA_SMB_PRTCL_READ :
|
|
NVIDIA_SMB_PRTCL_WRITE;
|
|
pec = (flags & I2C_CLIENT_PEC) ? NVIDIA_SMB_PRTCL_PEC : 0;
|
|
|
|
switch (size) {
|
|
case I2C_SMBUS_QUICK:
|
|
protocol |= NVIDIA_SMB_PRTCL_QUICK;
|
|
read_write = I2C_SMBUS_WRITE;
|
|
break;
|
|
|
|
case I2C_SMBUS_BYTE:
|
|
if (read_write == I2C_SMBUS_WRITE)
|
|
outb_p(command, NVIDIA_SMB_CMD);
|
|
protocol |= NVIDIA_SMB_PRTCL_BYTE;
|
|
break;
|
|
|
|
case I2C_SMBUS_BYTE_DATA:
|
|
outb_p(command, NVIDIA_SMB_CMD);
|
|
if (read_write == I2C_SMBUS_WRITE)
|
|
outb_p(data->byte, NVIDIA_SMB_DATA);
|
|
protocol |= NVIDIA_SMB_PRTCL_BYTE_DATA;
|
|
break;
|
|
|
|
case I2C_SMBUS_WORD_DATA:
|
|
outb_p(command, NVIDIA_SMB_CMD);
|
|
if (read_write == I2C_SMBUS_WRITE) {
|
|
outb_p(data->word, NVIDIA_SMB_DATA);
|
|
outb_p(data->word >> 8, NVIDIA_SMB_DATA + 1);
|
|
}
|
|
protocol |= NVIDIA_SMB_PRTCL_WORD_DATA | pec;
|
|
break;
|
|
|
|
case I2C_SMBUS_BLOCK_DATA:
|
|
outb_p(command, NVIDIA_SMB_CMD);
|
|
if (read_write == I2C_SMBUS_WRITE) {
|
|
len = data->block[0];
|
|
if ((len == 0) || (len > I2C_SMBUS_BLOCK_MAX)) {
|
|
dev_err(&adap->dev,
|
|
"Transaction failed (requested block size: %d)\n",
|
|
len);
|
|
return -EINVAL;
|
|
}
|
|
outb_p(len, NVIDIA_SMB_BCNT);
|
|
for (i = 0; i < I2C_SMBUS_BLOCK_MAX; i++)
|
|
outb_p(data->block[i + 1],
|
|
NVIDIA_SMB_DATA + i);
|
|
}
|
|
protocol |= NVIDIA_SMB_PRTCL_BLOCK_DATA | pec;
|
|
break;
|
|
|
|
default:
|
|
dev_err(&adap->dev, "Unsupported transaction %d\n", size);
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
outb_p((addr & 0x7f) << 1, NVIDIA_SMB_ADDR);
|
|
outb_p(protocol, NVIDIA_SMB_PRTCL);
|
|
|
|
status = nforce2_check_status(adap);
|
|
if (status)
|
|
return status;
|
|
|
|
if (read_write == I2C_SMBUS_WRITE)
|
|
return 0;
|
|
|
|
switch (size) {
|
|
case I2C_SMBUS_BYTE:
|
|
case I2C_SMBUS_BYTE_DATA:
|
|
data->byte = inb_p(NVIDIA_SMB_DATA);
|
|
break;
|
|
|
|
case I2C_SMBUS_WORD_DATA:
|
|
data->word = inb_p(NVIDIA_SMB_DATA) |
|
|
(inb_p(NVIDIA_SMB_DATA + 1) << 8);
|
|
break;
|
|
|
|
case I2C_SMBUS_BLOCK_DATA:
|
|
len = inb_p(NVIDIA_SMB_BCNT);
|
|
if ((len <= 0) || (len > I2C_SMBUS_BLOCK_MAX)) {
|
|
dev_err(&adap->dev,
|
|
"Transaction failed (received block size: 0x%02x)\n",
|
|
len);
|
|
return -EPROTO;
|
|
}
|
|
for (i = 0; i < len; i++)
|
|
data->block[i + 1] = inb_p(NVIDIA_SMB_DATA + i);
|
|
data->block[0] = len;
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
static u32 nforce2_func(struct i2c_adapter *adapter)
|
|
{
|
|
/* other functionality might be possible, but is not tested */
|
|
return I2C_FUNC_SMBUS_QUICK | I2C_FUNC_SMBUS_BYTE |
|
|
I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WORD_DATA |
|
|
I2C_FUNC_SMBUS_PEC |
|
|
(((struct nforce2_smbus *)adapter->algo_data)->blockops ?
|
|
I2C_FUNC_SMBUS_BLOCK_DATA : 0);
|
|
}
|
|
|
|
static const struct i2c_algorithm smbus_algorithm = {
|
|
.smbus_xfer = nforce2_access,
|
|
.functionality = nforce2_func,
|
|
};
|
|
|
|
|
|
static const struct pci_device_id nforce2_ids[] = {
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE2_SMBUS) },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE2S_SMBUS) },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE3_SMBUS) },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE3S_SMBUS) },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE4_SMBUS) },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP04_SMBUS) },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP51_SMBUS) },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP55_SMBUS) },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP61_SMBUS) },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP65_SMBUS) },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP67_SMBUS) },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP73_SMBUS) },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP78S_SMBUS) },
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP79_SMBUS) },
|
|
{ 0 }
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(pci, nforce2_ids);
|
|
|
|
|
|
static int nforce2_probe_smb(struct pci_dev *dev, int bar, int alt_reg,
|
|
struct nforce2_smbus *smbus, const char *name)
|
|
{
|
|
int error;
|
|
|
|
smbus->base = pci_resource_start(dev, bar);
|
|
if (smbus->base) {
|
|
smbus->size = pci_resource_len(dev, bar);
|
|
} else {
|
|
/* Older incarnations of the device used non-standard BARs */
|
|
u16 iobase;
|
|
|
|
if (pci_read_config_word(dev, alt_reg, &iobase)
|
|
!= PCIBIOS_SUCCESSFUL) {
|
|
dev_err(&dev->dev, "Error reading PCI config for %s\n",
|
|
name);
|
|
return -EIO;
|
|
}
|
|
|
|
smbus->base = iobase & PCI_BASE_ADDRESS_IO_MASK;
|
|
smbus->size = 64;
|
|
}
|
|
|
|
error = acpi_check_region(smbus->base, smbus->size,
|
|
nforce2_driver.name);
|
|
if (error)
|
|
return error;
|
|
|
|
if (!request_region(smbus->base, smbus->size, nforce2_driver.name)) {
|
|
dev_err(&smbus->adapter.dev, "Error requesting region %02x .. %02X for %s\n",
|
|
smbus->base, smbus->base+smbus->size-1, name);
|
|
return -EBUSY;
|
|
}
|
|
smbus->adapter.owner = THIS_MODULE;
|
|
smbus->adapter.class = I2C_CLASS_HWMON | I2C_CLASS_SPD;
|
|
smbus->adapter.algo = &smbus_algorithm;
|
|
smbus->adapter.algo_data = smbus;
|
|
smbus->adapter.dev.parent = &dev->dev;
|
|
snprintf(smbus->adapter.name, sizeof(smbus->adapter.name),
|
|
"SMBus nForce2 adapter at %04x", smbus->base);
|
|
|
|
error = i2c_add_adapter(&smbus->adapter);
|
|
if (error) {
|
|
release_region(smbus->base, smbus->size);
|
|
return error;
|
|
}
|
|
dev_info(&smbus->adapter.dev, "nForce2 SMBus adapter at %#x\n",
|
|
smbus->base);
|
|
return 0;
|
|
}
|
|
|
|
|
|
static int nforce2_probe(struct pci_dev *dev, const struct pci_device_id *id)
|
|
{
|
|
struct nforce2_smbus *smbuses;
|
|
int res1, res2;
|
|
|
|
/* we support 2 SMBus adapters */
|
|
smbuses = kcalloc(2, sizeof(struct nforce2_smbus), GFP_KERNEL);
|
|
if (!smbuses)
|
|
return -ENOMEM;
|
|
pci_set_drvdata(dev, smbuses);
|
|
|
|
switch (dev->device) {
|
|
case PCI_DEVICE_ID_NVIDIA_NFORCE2_SMBUS:
|
|
case PCI_DEVICE_ID_NVIDIA_NFORCE_MCP51_SMBUS:
|
|
case PCI_DEVICE_ID_NVIDIA_NFORCE_MCP55_SMBUS:
|
|
smbuses[0].blockops = 1;
|
|
smbuses[1].blockops = 1;
|
|
smbuses[0].can_abort = 1;
|
|
smbuses[1].can_abort = 1;
|
|
}
|
|
|
|
/* SMBus adapter 1 */
|
|
res1 = nforce2_probe_smb(dev, 4, NFORCE_PCI_SMB1, &smbuses[0], "SMB1");
|
|
if (res1 < 0)
|
|
smbuses[0].base = 0; /* to have a check value */
|
|
|
|
/* SMBus adapter 2 */
|
|
if (dmi_check_system(nforce2_dmi_blacklist2)) {
|
|
dev_err(&dev->dev, "Disabling SMB2 for safety reasons.\n");
|
|
res2 = -EPERM;
|
|
smbuses[1].base = 0;
|
|
} else {
|
|
res2 = nforce2_probe_smb(dev, 5, NFORCE_PCI_SMB2, &smbuses[1],
|
|
"SMB2");
|
|
if (res2 < 0)
|
|
smbuses[1].base = 0; /* to have a check value */
|
|
}
|
|
|
|
if ((res1 < 0) && (res2 < 0)) {
|
|
/* we did not find even one of the SMBuses, so we give up */
|
|
kfree(smbuses);
|
|
return -ENODEV;
|
|
}
|
|
|
|
nforce2_set_reference(&smbuses[0].adapter);
|
|
return 0;
|
|
}
|
|
|
|
|
|
static void nforce2_remove(struct pci_dev *dev)
|
|
{
|
|
struct nforce2_smbus *smbuses = pci_get_drvdata(dev);
|
|
|
|
nforce2_set_reference(NULL);
|
|
if (smbuses[0].base) {
|
|
i2c_del_adapter(&smbuses[0].adapter);
|
|
release_region(smbuses[0].base, smbuses[0].size);
|
|
}
|
|
if (smbuses[1].base) {
|
|
i2c_del_adapter(&smbuses[1].adapter);
|
|
release_region(smbuses[1].base, smbuses[1].size);
|
|
}
|
|
kfree(smbuses);
|
|
}
|
|
|
|
static struct pci_driver nforce2_driver = {
|
|
.name = "nForce2_smbus",
|
|
.id_table = nforce2_ids,
|
|
.probe = nforce2_probe,
|
|
.remove = nforce2_remove,
|
|
};
|
|
|
|
module_pci_driver(nforce2_driver);
|