123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518 |
- #include <linux/module.h>
- #include <linux/pci.h>
- #include <linux/kernel.h>
- #include <linux/stddef.h>
- #include <linux/ioport.h>
- #include <linux/delay.h>
- #include <linux/i2c.h>
- #include <linux/acpi.h>
- #include <linux/io.h>
- #define SMBHSTSTS (0 + ali15x3_smba)
- #define SMBHSTCNT (1 + ali15x3_smba)
- #define SMBHSTSTART (2 + ali15x3_smba)
- #define SMBHSTCMD (7 + ali15x3_smba)
- #define SMBHSTADD (3 + ali15x3_smba)
- #define SMBHSTDAT0 (4 + ali15x3_smba)
- #define SMBHSTDAT1 (5 + ali15x3_smba)
- #define SMBBLKDAT (6 + ali15x3_smba)
- #define SMBCOM 0x004
- #define SMBBA 0x014
- #define SMBATPC 0x05B
- #define SMBHSTCFG 0x0E0
- #define SMBSLVC 0x0E1
- #define SMBCLK 0x0E2
- #define SMBREV 0x008
- #define MAX_TIMEOUT 200
- #define ALI15X3_SMB_IOSIZE 32
- #define ALI15X3_SMB_DEFAULTBASE 0xE800
- #define ALI15X3_LOCK 0x06
- #define ALI15X3_ABORT 0x02
- #define ALI15X3_T_OUT 0x04
- #define ALI15X3_QUICK 0x00
- #define ALI15X3_BYTE 0x10
- #define ALI15X3_BYTE_DATA 0x20
- #define ALI15X3_WORD_DATA 0x30
- #define ALI15X3_BLOCK_DATA 0x40
- #define ALI15X3_BLOCK_CLR 0x80
- #define ALI15X3_STS_IDLE 0x04
- #define ALI15X3_STS_BUSY 0x08
- #define ALI15X3_STS_DONE 0x10
- #define ALI15X3_STS_DEV 0x20
- #define ALI15X3_STS_COLL 0x40
- #define ALI15X3_STS_TERM 0x80
- #define ALI15X3_STS_ERR 0xE0
- static u16 force_addr;
- module_param(force_addr, ushort, 0);
- MODULE_PARM_DESC(force_addr,
- "Initialize the base address of the i2c controller");
- static struct pci_driver ali15x3_driver;
- static unsigned short ali15x3_smba;
- static int ali15x3_setup(struct pci_dev *ALI15X3_dev)
- {
- u16 a;
- unsigned char temp;
-
-
- pci_read_config_byte(ALI15X3_dev, SMBATPC, &temp);
- if (temp & ALI15X3_LOCK) {
- temp &= ~ALI15X3_LOCK;
- pci_write_config_byte(ALI15X3_dev, SMBATPC, temp);
- }
-
- pci_read_config_word(ALI15X3_dev, SMBBA, &ali15x3_smba);
- ali15x3_smba &= (0xffff & ~(ALI15X3_SMB_IOSIZE - 1));
- if (ali15x3_smba == 0 && force_addr == 0) {
- dev_err(&ALI15X3_dev->dev, "ALI15X3_smb region uninitialized "
- "- upgrade BIOS or use force_addr=0xaddr\n");
- return -ENODEV;
- }
- if(force_addr)
- ali15x3_smba = force_addr & ~(ALI15X3_SMB_IOSIZE - 1);
- if (acpi_check_region(ali15x3_smba, ALI15X3_SMB_IOSIZE,
- ali15x3_driver.name))
- return -EBUSY;
- if (!request_region(ali15x3_smba, ALI15X3_SMB_IOSIZE,
- ali15x3_driver.name)) {
- dev_err(&ALI15X3_dev->dev,
- "ALI15X3_smb region 0x%x already in use!\n",
- ali15x3_smba);
- return -ENODEV;
- }
- if(force_addr) {
- dev_info(&ALI15X3_dev->dev, "forcing ISA address 0x%04X\n",
- ali15x3_smba);
- if (PCIBIOS_SUCCESSFUL != pci_write_config_word(ALI15X3_dev,
- SMBBA,
- ali15x3_smba))
- goto error;
- if (PCIBIOS_SUCCESSFUL != pci_read_config_word(ALI15X3_dev,
- SMBBA, &a))
- goto error;
- if ((a & ~(ALI15X3_SMB_IOSIZE - 1)) != ali15x3_smba) {
-
- dev_err(&ALI15X3_dev->dev,
- "force address failed - not supported?\n");
- goto error;
- }
- }
-
- pci_read_config_byte(ALI15X3_dev, SMBCOM, &temp);
- if ((temp & 1) == 0) {
- dev_info(&ALI15X3_dev->dev, "enabling SMBus device\n");
- pci_write_config_byte(ALI15X3_dev, SMBCOM, temp | 0x01);
- }
-
- pci_read_config_byte(ALI15X3_dev, SMBHSTCFG, &temp);
- if ((temp & 1) == 0) {
- dev_info(&ALI15X3_dev->dev, "enabling SMBus controller\n");
- pci_write_config_byte(ALI15X3_dev, SMBHSTCFG, temp | 0x01);
- }
-
- pci_write_config_byte(ALI15X3_dev, SMBCLK, 0x20);
-
- pci_read_config_byte(ALI15X3_dev, SMBREV, &temp);
- dev_dbg(&ALI15X3_dev->dev, "SMBREV = 0x%X\n", temp);
- dev_dbg(&ALI15X3_dev->dev, "iALI15X3_smba = 0x%X\n", ali15x3_smba);
- return 0;
- error:
- release_region(ali15x3_smba, ALI15X3_SMB_IOSIZE);
- return -ENODEV;
- }
- static int ali15x3_transaction(struct i2c_adapter *adap)
- {
- int temp;
- int result = 0;
- int timeout = 0;
- dev_dbg(&adap->dev, "Transaction (pre): STS=%02x, CNT=%02x, CMD=%02x, "
- "ADD=%02x, DAT0=%02x, DAT1=%02x\n", inb_p(SMBHSTSTS),
- inb_p(SMBHSTCNT), inb_p(SMBHSTCMD), inb_p(SMBHSTADD),
- inb_p(SMBHSTDAT0), inb_p(SMBHSTDAT1));
-
- temp = inb_p(SMBHSTSTS);
-
-
- if (temp & ALI15X3_STS_BUSY) {
-
-
-
- dev_info(&adap->dev, "Resetting entire SMB Bus to "
- "clear busy condition (%02x)\n", temp);
- outb_p(ALI15X3_T_OUT, SMBHSTCNT);
- temp = inb_p(SMBHSTSTS);
- }
-
- if (temp & (ALI15X3_STS_ERR | ALI15X3_STS_BUSY)) {
-
- outb_p(0xFF, SMBHSTSTS);
- if ((temp = inb_p(SMBHSTSTS)) &
- (ALI15X3_STS_ERR | ALI15X3_STS_BUSY)) {
-
-
- dev_err(&adap->dev, "SMBus reset failed! (0x%02x) - "
- "controller or device on bus is probably hung\n",
- temp);
- return -EBUSY;
- }
- } else {
-
- if (temp & ALI15X3_STS_DONE) {
- outb_p(temp, SMBHSTSTS);
- }
- }
-
- outb_p(0xFF, SMBHSTSTART);
-
- timeout = 0;
- do {
- msleep(1);
- temp = inb_p(SMBHSTSTS);
- } while ((!(temp & (ALI15X3_STS_ERR | ALI15X3_STS_DONE)))
- && (timeout++ < MAX_TIMEOUT));
-
- if (timeout > MAX_TIMEOUT) {
- result = -ETIMEDOUT;
- dev_err(&adap->dev, "SMBus Timeout!\n");
- }
- if (temp & ALI15X3_STS_TERM) {
- result = -EIO;
- dev_dbg(&adap->dev, "Error: Failed bus transaction\n");
- }
-
- if (temp & ALI15X3_STS_COLL) {
- result = -ENXIO;
- dev_dbg(&adap->dev,
- "Error: no response or bus collision ADD=%02x\n",
- inb_p(SMBHSTADD));
- }
-
- if (temp & ALI15X3_STS_DEV) {
- result = -EIO;
- dev_err(&adap->dev, "Error: device error\n");
- }
- dev_dbg(&adap->dev, "Transaction (post): STS=%02x, CNT=%02x, CMD=%02x, "
- "ADD=%02x, DAT0=%02x, DAT1=%02x\n", inb_p(SMBHSTSTS),
- inb_p(SMBHSTCNT), inb_p(SMBHSTCMD), inb_p(SMBHSTADD),
- inb_p(SMBHSTDAT0), inb_p(SMBHSTDAT1));
- return result;
- }
- static s32 ali15x3_access(struct i2c_adapter * adap, u16 addr,
- unsigned short flags, char read_write, u8 command,
- int size, union i2c_smbus_data * data)
- {
- int i, len;
- int temp;
- int timeout;
-
- outb_p(0xFF, SMBHSTSTS);
-
- temp = inb_p(SMBHSTSTS);
- for (timeout = 0;
- (timeout < MAX_TIMEOUT) && !(temp & ALI15X3_STS_IDLE);
- timeout++) {
- msleep(1);
- temp = inb_p(SMBHSTSTS);
- }
- if (timeout >= MAX_TIMEOUT) {
- dev_err(&adap->dev, "Idle wait Timeout! STS=0x%02x\n", temp);
- }
- switch (size) {
- case I2C_SMBUS_QUICK:
- outb_p(((addr & 0x7f) << 1) | (read_write & 0x01),
- SMBHSTADD);
- size = ALI15X3_QUICK;
- break;
- case I2C_SMBUS_BYTE:
- outb_p(((addr & 0x7f) << 1) | (read_write & 0x01),
- SMBHSTADD);
- if (read_write == I2C_SMBUS_WRITE)
- outb_p(command, SMBHSTCMD);
- size = ALI15X3_BYTE;
- break;
- case I2C_SMBUS_BYTE_DATA:
- outb_p(((addr & 0x7f) << 1) | (read_write & 0x01),
- SMBHSTADD);
- outb_p(command, SMBHSTCMD);
- if (read_write == I2C_SMBUS_WRITE)
- outb_p(data->byte, SMBHSTDAT0);
- size = ALI15X3_BYTE_DATA;
- break;
- case I2C_SMBUS_WORD_DATA:
- outb_p(((addr & 0x7f) << 1) | (read_write & 0x01),
- SMBHSTADD);
- outb_p(command, SMBHSTCMD);
- if (read_write == I2C_SMBUS_WRITE) {
- outb_p(data->word & 0xff, SMBHSTDAT0);
- outb_p((data->word & 0xff00) >> 8, SMBHSTDAT1);
- }
- size = ALI15X3_WORD_DATA;
- break;
- case I2C_SMBUS_BLOCK_DATA:
- outb_p(((addr & 0x7f) << 1) | (read_write & 0x01),
- SMBHSTADD);
- outb_p(command, SMBHSTCMD);
- if (read_write == I2C_SMBUS_WRITE) {
- len = data->block[0];
- if (len < 0) {
- len = 0;
- data->block[0] = len;
- }
- if (len > 32) {
- len = 32;
- data->block[0] = len;
- }
- outb_p(len, SMBHSTDAT0);
-
- outb_p(inb_p(SMBHSTCNT) | ALI15X3_BLOCK_CLR, SMBHSTCNT);
- for (i = 1; i <= len; i++)
- outb_p(data->block[i], SMBBLKDAT);
- }
- size = ALI15X3_BLOCK_DATA;
- break;
- default:
- dev_warn(&adap->dev, "Unsupported transaction %d\n", size);
- return -EOPNOTSUPP;
- }
- outb_p(size, SMBHSTCNT);
- temp = ali15x3_transaction(adap);
- if (temp)
- return temp;
- if ((read_write == I2C_SMBUS_WRITE) || (size == ALI15X3_QUICK))
- return 0;
- switch (size) {
- case ALI15X3_BYTE:
- data->byte = inb_p(SMBHSTDAT0);
- break;
- case ALI15X3_BYTE_DATA:
- data->byte = inb_p(SMBHSTDAT0);
- break;
- case ALI15X3_WORD_DATA:
- data->word = inb_p(SMBHSTDAT0) + (inb_p(SMBHSTDAT1) << 8);
- break;
- case ALI15X3_BLOCK_DATA:
- len = inb_p(SMBHSTDAT0);
- if (len > 32)
- len = 32;
- data->block[0] = len;
-
- outb_p(inb_p(SMBHSTCNT) | ALI15X3_BLOCK_CLR, SMBHSTCNT);
- for (i = 1; i <= data->block[0]; i++) {
- data->block[i] = inb_p(SMBBLKDAT);
- dev_dbg(&adap->dev, "Blk: len=%d, i=%d, data=%02x\n",
- len, i, data->block[i]);
- }
- break;
- }
- return 0;
- }
- static u32 ali15x3_func(struct i2c_adapter *adapter)
- {
- return I2C_FUNC_SMBUS_QUICK | I2C_FUNC_SMBUS_BYTE |
- I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WORD_DATA |
- I2C_FUNC_SMBUS_BLOCK_DATA;
- }
- static const struct i2c_algorithm smbus_algorithm = {
- .smbus_xfer = ali15x3_access,
- .functionality = ali15x3_func,
- };
- static struct i2c_adapter ali15x3_adapter = {
- .owner = THIS_MODULE,
- .class = I2C_CLASS_HWMON | I2C_CLASS_SPD,
- .algo = &smbus_algorithm,
- };
- static const struct pci_device_id ali15x3_ids[] = {
- { PCI_DEVICE(PCI_VENDOR_ID_AL, PCI_DEVICE_ID_AL_M7101) },
- { 0, }
- };
- MODULE_DEVICE_TABLE (pci, ali15x3_ids);
- static int ali15x3_probe(struct pci_dev *dev, const struct pci_device_id *id)
- {
- if (ali15x3_setup(dev)) {
- dev_err(&dev->dev,
- "ALI15X3 not detected, module not inserted.\n");
- return -ENODEV;
- }
-
- ali15x3_adapter.dev.parent = &dev->dev;
- snprintf(ali15x3_adapter.name, sizeof(ali15x3_adapter.name),
- "SMBus ALI15X3 adapter at %04x", ali15x3_smba);
- return i2c_add_adapter(&ali15x3_adapter);
- }
- static void ali15x3_remove(struct pci_dev *dev)
- {
- i2c_del_adapter(&ali15x3_adapter);
- release_region(ali15x3_smba, ALI15X3_SMB_IOSIZE);
- }
- static struct pci_driver ali15x3_driver = {
- .name = "ali15x3_smbus",
- .id_table = ali15x3_ids,
- .probe = ali15x3_probe,
- .remove = ali15x3_remove,
- };
- module_pci_driver(ali15x3_driver);
- MODULE_AUTHOR ("Frodo Looijaard <frodol@dds.nl>, "
- "Philip Edelbrock <phil@netroedge.com>, "
- "and Mark D. Studebaker <mdsxyz123@yahoo.com>");
- MODULE_DESCRIPTION("ALI15X3 SMBus driver");
- MODULE_LICENSE("GPL");
|