This patchs contains the SMBus driver for SIS964. Built with Sis datasheets and by forking the SIS630 driver. Signed-off-by: Amaury Decrême <amaury.decreme@xxxxxxxxx> --- drivers/i2c/busses/i2c-sis964.c | 578 +++++++++++++++++++++++++++++++++++++++ 1 files changed, 578 insertions(+), 0 deletions(-) create mode 100644 drivers/i2c/busses/i2c-sis964.c diff --git a/drivers/i2c/busses/i2c-sis964.c b/drivers/i2c/busses/i2c-sis964.c new file mode 100644 index 0000000..91b6ec9 --- /dev/null +++ b/drivers/i2c/busses/i2c-sis964.c @@ -0,0 +1,578 @@ +/* + Copyright (c) 2012 Amaury Decrême <amaury.decreme@xxxxxxxxx> + + 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. + + You should have received a copy of the GNU General Public License + along with this program; if not, write to the Free Software + Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. +*/ + +/* + Changes: + 11.08.2011 + Fork of original i2c-sis630 - Alexander Malysh <amalysh@xxxxxx> + Adapted for SiS964 with datasheets + - Amaury Decrême <amaury.decreme@xxxxxxxxx> +*/ + +/* + Supports: + SIS 964 + + Note: we assume there can only be one device, with one SMBus interface. +*/ + +#include <linux/kernel.h> +#include <linux/module.h> +#include <linux/delay.h> +#include <linux/pci.h> +#include <linux/ioport.h> +#include <linux/init.h> +#include <linux/i2c.h> +#include <linux/acpi.h> +#include <linux/io.h> + +#define PCI_DEVICE_ID_SI_964 0x0964 + + +/* SIS964 SMBus registers */ +#define SMB_STS 0xE0 /* status */ +#define SMB_EN 0xE1 /* status enable */ +#define SMB_CNT 0xE2 /* Control */ +#define SMBHOST_CNT 0xE3 /* Host Control */ +#define SMB_ADDR 0xE4 /* Address */ +#define SMB_CMD 0xE5 /* Command */ +#define SMB_PERRCHK 0xE6 /* Packet Error Check */ +#define SMB_COUNT 0xE7 /* Byte Count */ +#define SMB_BYTE 0xE8 /* ~0x8F data byte field */ +#define SMBDEV_ADDR 0xF0 /* Device Address */ +#define SMB_DB0 0xF1 /* Device byte0 */ +#define SMB_DB1 0xF2 /* Device byte1 */ +#define SMB_SAA 0xF3 /* Host slave alias address */ +#define SMB_PCOUNT 0xF4 /* processed byte count */ + + +/* SMB_STS register */ +#define SMBALT_STS 0x80 /* Slave alert */ +#define BYTE_DONE_STS 0x10 /* Byte Done Status / Block Array */ +#define SMBMAS_STS 0x08 /* Host Master */ +#define SMBCOL_STS 0x04 /* Collision */ +#define SMBERR_STS 0x02 /* Device error */ + +/* SMB_CNT register */ +#define SMBCLK_SEL 0x20 /* Host master clock selection */ +#define SMB_PROBE 0x02 /* Bus Probe */ +#define SMB_HOSTBUSY 0x01 /* Host Busy */ + +/* SMBHOST_CNT register */ +#define SMB_KILL 0x20 /* Kill */ +#define SMB_START 0x10 /* Start */ +#define SMB_PTL 0x07 /* Command Protocol */ + + +/* SMB_ADDR register */ +#define SMB_ADDRESS 0xFE /* Adress */ +#define SMB_RW 0x01 /* Read/Write */ + + +/* SMB_BYTE register */ +#define SMB_BYTE0 0xFF /* Byte 0 */ +#define SMB_BYTE1 0xFF00 /* Byte 1 */ + +/* register count for request_region */ +#define SIS964_SMB_IOREGION 21 + +/* PCI address constants */ +/* acpi base address register */ +#define SIS964_ACPI_BASE_REG 0x74 +/* bios control register */ +#define SIS964_BIOS_CTL_REG 0x40 + +/* Other settings */ +#define MAX_TIMEOUT 500 + +/* SIS964 constants */ +#define SIS964_QUICK 0x00 +#define SIS964_BYTE 0x01 +#define SIS964_BYTE_DATA 0x02 +#define SIS964_WORD_DATA 0x03 +#define SIS964_PCALL 0x04 +#define SIS964_BLOCK_DATA 0x05 + +static struct pci_driver sis964_driver; + +/* insmod parameters */ +static bool low_clock; +static bool force; +module_param(low_clock, bool, 0); +MODULE_PARM_DESC(low_clock, "Set Host Master Clock to 28KHz (default 56KHz)."); +module_param(force, bool, 0); +MODULE_PARM_DESC(force, "Forcibly enable the SIS964. DANGEROUS!"); + +/* acpi base address */ +static unsigned short acpi_base; + +/* supported chips */ +static int supported[] = { + PCI_DEVICE_ID_SI_964, + 0 /* terminates the list */ +}; + +static inline u8 sis964_read(u8 reg) +{ + return inb(acpi_base + reg); +} + +static inline void sis964_write(u8 reg, u8 data) +{ + outb(data, acpi_base + reg); +} + +static int sis964_transaction_start(struct i2c_adapter *adap, + int ptl, u8 *oldclock) +{ + int tmp = 0; + + /* Clear status register */ + sis964_write(SMB_STS, 0xFF); + + /* Make sure the SMBus host is ready to start transmitting. */ + tmp = sis964_read(SMB_CNT); + if (tmp & (SMB_PROBE | SMB_HOSTBUSY)) { + dev_dbg(&adap->dev, + "Bus busy (status 0x%02x). Killing transaction.\n", + tmp); + + sis964_write(SMBHOST_CNT, SMB_KILL); + + return -EBUSY; + } + + /* Set Host Master Clock to 28KHz if requested */ + if (low_clock) { + *oldclock = sis964_read(SMB_CNT); + sis964_write(SMB_CNT, SMBCLK_SEL); + } + + /* start the transaction by setting bit start and protocol */ + sis964_write(SMBHOST_CNT, SMB_START | (ptl & SMB_PTL)); + + return 0; +} + +static int sis964_transaction_wait(struct i2c_adapter *adap, int ptl) +{ + int tmp = 0, timeout = 0; + + /* Wait 30us, valid for 28Khz and 56Khz */ + udelay(30); + + tmp = sis964_read(SMB_STS); + if (!(tmp & SMB_PROBE) && (tmp & SMB_HOSTBUSY)) { + dev_dbg(&adap->dev, + "Host busy (status 0x%02x). Restarting transaction.\n", + tmp); + sis964_write(SMBHOST_CNT, SMB_KILL); + return -EAGAIN; + } + + while (!(ptl == SIS964_BLOCK_DATA && (tmp & BYTE_DONE_STS)) + && !(tmp & (SMBMAS_STS | SMBCOL_STS | SMBERR_STS)) + && (timeout++ < MAX_TIMEOUT)) { + + /* Datasheets: wait 4ms max at 28Khz and + * 2ms max at 56Khz for 8 bytes */ + if (low_clock) + udelay(4000); + else + udelay(2000); + tmp = sis964_read(SMB_STS); + } + + /* If the SMBus is still busy, we give up */ + if (timeout > MAX_TIMEOUT) { + dev_dbg(&adap->dev, + "Bus Timeout (status 0x%02x)!\n", tmp); + return -ETIMEDOUT; + } + + if (tmp & SMBERR_STS) { + dev_dbg(&adap->dev, + "Failed bus transaction (status 0x%02x)!\n", tmp); + return -ENXIO; + } + + if (tmp & SMBCOL_STS) { + dev_err(&adap->dev, + "Bus collision (status 0x%02x)!\n", tmp); + sis964_write(SMB_STS, tmp & ~SMBCOL_STS); + return -EAGAIN; + } + + return 0; +} + +static void sis964_transaction_end(u8 oldclock) +{ + /* clear all status "sticky" bits */ + sis964_write(SMB_STS, 0xFF); + + /* restore old Host Master Clock if low_clock is set */ + if (low_clock) + sis964_write(SMB_CNT, oldclock & SMBCLK_SEL); +} + +static int sis964_transaction(struct i2c_adapter *adap, int ptl) +{ + int tmp = 0, timeout = 0; + u8 oldclock = 0; + + do { + tmp = sis964_transaction_start(adap, ptl, &oldclock); + if (tmp) + return tmp; + + tmp = sis964_transaction_wait(adap, ptl); + sis964_transaction_end(oldclock); + } while (tmp == -EAGAIN && timeout++ < MAX_TIMEOUT); + + if (timeout > MAX_TIMEOUT) { + dev_dbg(&adap->dev, "Bus timeout !\n"); + return -ETIMEDOUT; + } + + return 0; +} + +static int sis964_block_data_read(struct i2c_adapter *adap, + union i2c_smbus_data *data) +{ + int i, len = 0, tmp = 0; + u8 oldclock = 0; + + data->block[0] = len = 0; + + tmp = sis964_transaction_start(adap, SIS964_BLOCK_DATA, &oldclock); + if (tmp) + return tmp; + + do { + tmp = sis964_transaction_wait(adap, SIS964_BLOCK_DATA); + if (tmp) { + dev_dbg(&adap->dev, "Transaction wait failed\n"); + break; + } + + /* if this first transaction then read byte count */ + if (len == 0) + data->block[0] = sis964_read(SMB_COUNT); + + if (data->block[0] > 32) + data->block[0] = 32; + + dev_dbg(&adap->dev, "Block data read len=0x%x\n", + data->block[0]); + + for (i = 0; i < 8 && len < data->block[0]; i++, len++) { + dev_dbg(&adap->dev, "Read i=%d len=%d\n", i, len); + data->block[len+1] = sis964_read(SMB_BYTE+i); + } + + /* clear BYTE_DONE_STS */ + sis964_write(SMB_STS, BYTE_DONE_STS); + } while (len < data->block[0]); + + sis964_transaction_end(oldclock); + + return 0; +} + + +static int sis964_block_data_write(struct i2c_adapter *adap, + union i2c_smbus_data *data) +{ + + int i, len = 0, tmp = 0; + u8 oldclock = 0; + + len = data->block[0]; + if (len < 0) + len = 0; + else if (len > 32) + len = 32; + + sis964_write(SMB_COUNT, len); + + for (i = 1; i <= len; i++) { + dev_dbg(&adap->dev, "Set data 0x%02x\n", data->block[i]); + + /* set data */ + sis964_write(SMB_BYTE+(i-1)%8, data->block[i]); + if (i == 8 || (len < 8 && i == len)) { + + /* first transaction */ + tmp = sis964_transaction_start(adap, SIS964_BLOCK_DATA, + &oldclock); + if (tmp) + return tmp; + + } else if ((i-1)%8 == 7 || i == len) { + if (i > 8) { + dev_dbg(&adap->dev, + "Clear smbary_sts len=%d i=%d\n", len, i); + + /* + If this is not first transaction, + we must clear sticky bit. + clear BYTE_DONE-STS + */ + sis964_write(SMB_STS, BYTE_DONE_STS); + } + tmp = sis964_transaction_wait(adap, + SIS964_BLOCK_DATA); + if (tmp) { + dev_dbg(&adap->dev, + "Transaction wait failed\n"); + break; + } + } + } + + sis964_transaction_end(oldclock); + + return 0; +} + +static int sis964_block_data(struct i2c_adapter *adap, + union i2c_smbus_data *data, int read_write) +{ + if (read_write == I2C_SMBUS_WRITE) + return sis964_block_data_write(adap, data); + else + return sis964_block_data_read(adap, data); +} + +/* Return negative errno on error. */ +static s32 sis964_access(struct i2c_adapter *adap, u16 addr, + unsigned short flags, char read_write, + u8 command, int ptl, union i2c_smbus_data *data) +{ + int tmp = 0; + + switch (ptl) { + case I2C_SMBUS_QUICK: + sis964_write(SMB_ADDR, ((addr << 1) & SMB_ADDRESS) | + (read_write & SMB_RW)); + ptl = SIS964_QUICK; + break; + case I2C_SMBUS_BYTE: + sis964_write(SMB_ADDR, ((addr << 1) & SMB_ADDRESS) | + (read_write & SMB_RW)); + if (read_write == I2C_SMBUS_WRITE) + sis964_write(SMB_CMD, command); + ptl = SIS964_BYTE; + break; + case I2C_SMBUS_BYTE_DATA: + sis964_write(SMB_ADDR, ((addr << 1) & SMB_ADDRESS) | + (read_write & SMB_RW)); + sis964_write(SMB_CMD, command); + if (read_write == I2C_SMBUS_WRITE) + sis964_write(SMB_BYTE, data->byte); + ptl = SIS964_BYTE_DATA; + break; + case I2C_SMBUS_PROC_CALL: + case I2C_SMBUS_WORD_DATA: + sis964_write(SMB_ADDR, ((addr << 1) & SMB_ADDRESS) | + (read_write & SMB_RW)); + sis964_write(SMB_CMD, command); + if (read_write == I2C_SMBUS_WRITE) { + sis964_write(SMB_BYTE, data->word & SMB_BYTE0); + sis964_write(SMB_BYTE + 1, + (data->word & SMB_BYTE1) >> 8); + } + ptl = (ptl == I2C_SMBUS_PROC_CALL ? + SIS964_PCALL : SIS964_WORD_DATA); + break; + case I2C_SMBUS_BLOCK_DATA: + sis964_write(SMB_ADDR, ((addr << 1) & SMB_ADDRESS) | + (read_write & SMB_RW)); + sis964_write(SMB_CMD, command); + ptl = SIS964_BLOCK_DATA; + return sis964_block_data(adap, data, read_write); + default: + dev_warn(&adap->dev, "Unsupported transaction %d\n", + ptl); + return -EOPNOTSUPP; + } + + tmp = sis964_transaction(adap, ptl); + if (tmp) + return tmp; + + if (ptl != SIS964_PCALL && + (read_write == I2C_SMBUS_WRITE || ptl == SIS964_QUICK)) { + return 0; + } + + switch (ptl) { + case SIS964_BYTE: + case SIS964_BYTE_DATA: + data->byte = sis964_read(SMB_BYTE); + break; + case SIS964_PCALL: + case SIS964_WORD_DATA: + data->word = sis964_read(SMB_BYTE) + + (sis964_read(SMB_BYTE + 1) << 8); + break; + } + + return 0; +} + +static u32 sis964_func(struct i2c_adapter *adapter) +{ + /* SMBus Command protocol supported */ + return I2C_FUNC_SMBUS_QUICK | /* Quick command */ + I2C_FUNC_SMBUS_BYTE | /* Send/Receive Byte */ + I2C_FUNC_SMBUS_BYTE_DATA | /* Read/Write Byte Data */ + I2C_FUNC_SMBUS_WORD_DATA | /* Read/Write Word Data */ + I2C_FUNC_SMBUS_PROC_CALL | /* Process Call */ + I2C_FUNC_SMBUS_BLOCK_DATA; /* Read/Write Block Data */ +} + +static int __devinit sis964_setup(struct pci_dev *sis964_dev) +{ + unsigned char b; + struct pci_dev *dummy = NULL; + int tmp = 0, i; + + /* check for supported SiS devices */ + for (i = 0; supported[i] > 0 && dummy == NULL; i++) + dummy = pci_get_device(PCI_VENDOR_ID_SI, supported[i], dummy); + + if (dummy) { + pci_dev_put(dummy); + } else if (force) { + dev_err(&sis964_dev->dev, + "WARNING: Can't detect SIS964 compatible device, but " + "loading because of force option enabled\n"); + } else { + dev_err(&sis964_dev->dev, + "WARNING: Can't detect SIS964 compatible device!\n"); + return -ENODEV; + } + + + /* + Enable ACPI first , so we can accsess reg 74-75 + in acpi io space and read acpi base addr + */ + if (pci_read_config_byte(sis964_dev, SIS964_BIOS_CTL_REG, &b)) { + dev_err(&sis964_dev->dev, "Error: Can't read bios ctl reg\n"); + return -ENODEV; + } + /* if ACPI already enabled , do nothing */ + if (!(b & 0x80) && + pci_write_config_byte(sis964_dev, SIS964_BIOS_CTL_REG, b | 0x80)) { + dev_err(&sis964_dev->dev, "Error: Can't enable ACPI\n"); + return -ENODEV; + } + + /* Determine the ACPI base address */ + if (pci_read_config_word(sis964_dev, SIS964_ACPI_BASE_REG, + &acpi_base)) { + dev_err(&sis964_dev->dev, + "Error: Can't determine ACPI base address\n"); + return -ENODEV; + } + + dev_dbg(&sis964_dev->dev, "ACPI base at 0x%04x\n", acpi_base); + + tmp = acpi_check_region(acpi_base + SMB_STS, SIS964_SMB_IOREGION, + sis964_driver.name); + if (tmp) { + acpi_base = 0; + return -ENODEV; + } + + /* Everything is happy, let's grab the memory and set things up. */ + if (!request_region(acpi_base + SMB_STS, SIS964_SMB_IOREGION, + sis964_driver.name)) { + dev_err(&sis964_dev->dev, + "SMBus registers 0x%04x-0x%04x already in use!\n", + acpi_base + SMB_STS, acpi_base + SMB_SAA); + acpi_base = 0; + return -ENODEV; + } + + return 0; +} + + +static const struct i2c_algorithm smbus_algorithm = { + .smbus_xfer = sis964_access, + .functionality = sis964_func, +}; + +static struct i2c_adapter sis964_adapter = { + .owner = THIS_MODULE, + .class = I2C_CLASS_HWMON | I2C_CLASS_SPD, + .algo = &smbus_algorithm, +}; + +static DEFINE_PCI_DEVICE_TABLE(sis964_ids) = { + { PCI_DEVICE(PCI_VENDOR_ID_SI, PCI_DEVICE_ID_SI_964) }, + { 0 } +}; + +MODULE_DEVICE_TABLE(pci, sis964_ids); + +static int __devinit sis964_probe(struct pci_dev *dev, + const struct pci_device_id *id) +{ + if (sis964_setup(dev)) { + dev_err(&dev->dev, + "SIS964 comp. bus not detected, module not inserted.\n"); + return -ENODEV; + } + + /* set up the sysfs linkage to our parent device */ + sis964_adapter.dev.parent = &dev->dev; + + snprintf(sis964_adapter.name, sizeof(sis964_adapter.name), + "SMBus SIS964 adapter at %04xh", acpi_base + SMB_STS); + + return i2c_add_adapter(&sis964_adapter); +} + +static void __devexit sis964_remove(struct pci_dev *dev) +{ + if (acpi_base) { + i2c_del_adapter(&sis964_adapter); + release_region(acpi_base + SMB_STS, SIS964_SMB_IOREGION); + acpi_base = 0; + } +} + + +static struct pci_driver sis964_driver = { + .name = "sis964_smbus", + .id_table = sis964_ids, + .probe = sis964_probe, + .remove = __devexit_p(sis964_remove), +}; + +module_pci_driver(sis964_driver); + +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Amaury Decrême <amaury.decreme@xxxxxxxxx>"); +MODULE_DESCRIPTION("SiS964 SMBus driver"); -- 1.7.8.6 -- To unsubscribe from this list: send the line "unsubscribe linux-doc" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html