|  | // SPDX-License-Identifier: GPL-2.0-only | 
|  | /* | 
|  | *   Copyright (C) 2016 T-Platforms. All Rights Reserved. | 
|  | * | 
|  | * IDT PCIe-switch NTB Linux driver | 
|  | * | 
|  | * Contact Information: | 
|  | * Serge Semin <fancer.lancer@gmail.com>, <Sergey.Semin@t-platforms.ru> | 
|  | */ | 
|  | /* | 
|  | *           NOTE of the IDT 89HPESx SMBus-slave interface driver | 
|  | *    This driver primarily is developed to have an access to EEPROM device of | 
|  | * IDT PCIe-switches. IDT provides a simple SMBus interface to perform IO- | 
|  | * operations from/to EEPROM, which is located at private (so called Master) | 
|  | * SMBus of switches. Using that interface this the driver creates a simple | 
|  | * binary sysfs-file in the device directory: | 
|  | * /sys/bus/i2c/devices/<bus>-<devaddr>/eeprom | 
|  | * In case if read-only flag is specified in the dts-node of device desription, | 
|  | * User-space applications won't be able to write to the EEPROM sysfs-node. | 
|  | *    Additionally IDT 89HPESx SMBus interface has an ability to write/read | 
|  | * data of device CSRs. This driver exposes debugf-file to perform simple IO | 
|  | * operations using that ability for just basic debug purpose. Particularly | 
|  | * next file is created in the specific debugfs-directory: | 
|  | * /sys/kernel/debug/idt_csr/ | 
|  | * Format of the debugfs-node is: | 
|  | * $ cat /sys/kernel/debug/idt_csr/<bus>-<devaddr>/<devname>; | 
|  | * <CSR address>:<CSR value> | 
|  | * So reading the content of the file gives current CSR address and it value. | 
|  | * If User-space application wishes to change current CSR address, | 
|  | * it can just write a proper value to the sysfs-file: | 
|  | * $ echo "<CSR address>" > /sys/kernel/debug/idt_csr/<bus>-<devaddr>/<devname> | 
|  | * If it wants to change the CSR value as well, the format of the write | 
|  | * operation is: | 
|  | * $ echo "<CSR address>:<CSR value>" > \ | 
|  | *        /sys/kernel/debug/idt_csr/<bus>-<devaddr>/<devname>; | 
|  | * CSR address and value can be any of hexadecimal, decimal or octal format. | 
|  | */ | 
|  |  | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/init.h> | 
|  | #include <linux/module.h> | 
|  | #include <linux/types.h> | 
|  | #include <linux/sizes.h> | 
|  | #include <linux/slab.h> | 
|  | #include <linux/mutex.h> | 
|  | #include <linux/sysfs.h> | 
|  | #include <linux/debugfs.h> | 
|  | #include <linux/mod_devicetable.h> | 
|  | #include <linux/property.h> | 
|  | #include <linux/i2c.h> | 
|  | #include <linux/pci_ids.h> | 
|  | #include <linux/delay.h> | 
|  |  | 
|  | #define IDT_NAME		"89hpesx" | 
|  | #define IDT_89HPESX_DESC	"IDT 89HPESx SMBus-slave interface driver" | 
|  | #define IDT_89HPESX_VER		"1.0" | 
|  |  | 
|  | MODULE_DESCRIPTION(IDT_89HPESX_DESC); | 
|  | MODULE_VERSION(IDT_89HPESX_VER); | 
|  | MODULE_LICENSE("GPL v2"); | 
|  | MODULE_AUTHOR("T-platforms"); | 
|  |  | 
|  | /* | 
|  | * csr_dbgdir - CSR read/write operations Debugfs directory | 
|  | */ | 
|  | static struct dentry *csr_dbgdir; | 
|  |  | 
|  | /* | 
|  | * struct idt_89hpesx_dev - IDT 89HPESx device data structure | 
|  | * @eesize:	Size of EEPROM in bytes (calculated from "idt,eecompatible") | 
|  | * @eero:	EEPROM Read-only flag | 
|  | * @eeaddr:	EEPROM custom address | 
|  | * | 
|  | * @inieecmd:	Initial cmd value for EEPROM read/write operations | 
|  | * @inicsrcmd:	Initial cmd value for CSR read/write operations | 
|  | * @iniccode:	Initialial command code value for IO-operations | 
|  | * | 
|  | * @csr:	CSR address to perform read operation | 
|  | * | 
|  | * @smb_write:	SMBus write method | 
|  | * @smb_read:	SMBus read method | 
|  | * @smb_mtx:	SMBus mutex | 
|  | * | 
|  | * @client:	i2c client used to perform IO operations | 
|  | * | 
|  | * @ee_file:	EEPROM read/write sysfs-file | 
|  | */ | 
|  | struct idt_smb_seq; | 
|  | struct idt_89hpesx_dev { | 
|  | u32 eesize; | 
|  | bool eero; | 
|  | u8 eeaddr; | 
|  |  | 
|  | u8 inieecmd; | 
|  | u8 inicsrcmd; | 
|  | u8 iniccode; | 
|  |  | 
|  | u16 csr; | 
|  |  | 
|  | int (*smb_write)(struct idt_89hpesx_dev *, const struct idt_smb_seq *); | 
|  | int (*smb_read)(struct idt_89hpesx_dev *, struct idt_smb_seq *); | 
|  | struct mutex smb_mtx; | 
|  |  | 
|  | struct i2c_client *client; | 
|  |  | 
|  | struct bin_attribute *ee_file; | 
|  | struct dentry *csr_dir; | 
|  | }; | 
|  |  | 
|  | /* | 
|  | * struct idt_smb_seq - sequence of data to be read/written from/to IDT 89HPESx | 
|  | * @ccode:	SMBus command code | 
|  | * @bytecnt:	Byte count of operation | 
|  | * @data:	Data to by written | 
|  | */ | 
|  | struct idt_smb_seq { | 
|  | u8 ccode; | 
|  | u8 bytecnt; | 
|  | u8 *data; | 
|  | }; | 
|  |  | 
|  | /* | 
|  | * struct idt_eeprom_seq - sequence of data to be read/written from/to EEPROM | 
|  | * @cmd:	Transaction CMD | 
|  | * @eeaddr:	EEPROM custom address | 
|  | * @memaddr:	Internal memory address of EEPROM | 
|  | * @data:	Data to be written at the memory address | 
|  | */ | 
|  | struct idt_eeprom_seq { | 
|  | u8 cmd; | 
|  | u8 eeaddr; | 
|  | u16 memaddr; | 
|  | u8 data; | 
|  | } __packed; | 
|  |  | 
|  | /* | 
|  | * struct idt_csr_seq - sequence of data to be read/written from/to CSR | 
|  | * @cmd:	Transaction CMD | 
|  | * @csraddr:	Internal IDT device CSR address | 
|  | * @data:	Data to be read/written from/to the CSR address | 
|  | */ | 
|  | struct idt_csr_seq { | 
|  | u8 cmd; | 
|  | u16 csraddr; | 
|  | u32 data; | 
|  | } __packed; | 
|  |  | 
|  | /* | 
|  | * SMBus command code macros | 
|  | * @CCODE_END:		Indicates the end of transaction | 
|  | * @CCODE_START:	Indicates the start of transaction | 
|  | * @CCODE_CSR:		CSR read/write transaction | 
|  | * @CCODE_EEPROM:	EEPROM read/write transaction | 
|  | * @CCODE_BYTE:		Supplied data has BYTE length | 
|  | * @CCODE_WORD:		Supplied data has WORD length | 
|  | * @CCODE_BLOCK:	Supplied data has variable length passed in bytecnt | 
|  | *			byte right following CCODE byte | 
|  | */ | 
|  | #define CCODE_END	((u8)0x01) | 
|  | #define CCODE_START	((u8)0x02) | 
|  | #define CCODE_CSR	((u8)0x00) | 
|  | #define CCODE_EEPROM	((u8)0x04) | 
|  | #define CCODE_BYTE	((u8)0x00) | 
|  | #define CCODE_WORD	((u8)0x20) | 
|  | #define CCODE_BLOCK	((u8)0x40) | 
|  | #define CCODE_PEC	((u8)0x80) | 
|  |  | 
|  | /* | 
|  | * EEPROM command macros | 
|  | * @EEPROM_OP_WRITE:	EEPROM write operation | 
|  | * @EEPROM_OP_READ:	EEPROM read operation | 
|  | * @EEPROM_USA:		Use specified address of EEPROM | 
|  | * @EEPROM_NAERR:	EEPROM device is not ready to respond | 
|  | * @EEPROM_LAERR:	EEPROM arbitration loss error | 
|  | * @EEPROM_MSS:		EEPROM misplace start & stop bits error | 
|  | * @EEPROM_WR_CNT:	Bytes count to perform write operation | 
|  | * @EEPROM_WRRD_CNT:	Bytes count to write before reading | 
|  | * @EEPROM_RD_CNT:	Bytes count to perform read operation | 
|  | * @EEPROM_DEF_SIZE:	Fall back size of EEPROM | 
|  | * @EEPROM_DEF_ADDR:	Defatul EEPROM address | 
|  | * @EEPROM_TOUT:	Timeout before retry read operation if eeprom is busy | 
|  | */ | 
|  | #define EEPROM_OP_WRITE	((u8)0x00) | 
|  | #define EEPROM_OP_READ	((u8)0x01) | 
|  | #define EEPROM_USA	((u8)0x02) | 
|  | #define EEPROM_NAERR	((u8)0x08) | 
|  | #define EEPROM_LAERR    ((u8)0x10) | 
|  | #define EEPROM_MSS	((u8)0x20) | 
|  | #define EEPROM_WR_CNT	((u8)5) | 
|  | #define EEPROM_WRRD_CNT	((u8)4) | 
|  | #define EEPROM_RD_CNT	((u8)5) | 
|  | #define EEPROM_DEF_SIZE	((u16)4096) | 
|  | #define EEPROM_DEF_ADDR	((u8)0x50) | 
|  | #define EEPROM_TOUT	(100) | 
|  |  | 
|  | /* | 
|  | * CSR command macros | 
|  | * @CSR_DWE:		Enable all four bytes of the operation | 
|  | * @CSR_OP_WRITE:	CSR write operation | 
|  | * @CSR_OP_READ:	CSR read operation | 
|  | * @CSR_RERR:		Read operation error | 
|  | * @CSR_WERR:		Write operation error | 
|  | * @CSR_WR_CNT:		Bytes count to perform write operation | 
|  | * @CSR_WRRD_CNT:	Bytes count to write before reading | 
|  | * @CSR_RD_CNT:		Bytes count to perform read operation | 
|  | * @CSR_MAX:		Maximum CSR address | 
|  | * @CSR_DEF:		Default CSR address | 
|  | * @CSR_REAL_ADDR:	CSR real unshifted address | 
|  | */ | 
|  | #define CSR_DWE			((u8)0x0F) | 
|  | #define CSR_OP_WRITE		((u8)0x00) | 
|  | #define CSR_OP_READ		((u8)0x10) | 
|  | #define CSR_RERR		((u8)0x40) | 
|  | #define CSR_WERR		((u8)0x80) | 
|  | #define CSR_WR_CNT		((u8)7) | 
|  | #define CSR_WRRD_CNT		((u8)3) | 
|  | #define CSR_RD_CNT		((u8)7) | 
|  | #define CSR_MAX			((u32)0x3FFFF) | 
|  | #define CSR_DEF			((u16)0x0000) | 
|  | #define CSR_REAL_ADDR(val)	((unsigned int)val << 2) | 
|  |  | 
|  | /* | 
|  | * IDT 89HPESx basic register | 
|  | * @IDT_VIDDID_CSR:	PCIe VID and DID of IDT 89HPESx | 
|  | * @IDT_VID_MASK:	Mask of VID | 
|  | */ | 
|  | #define IDT_VIDDID_CSR	((u32)0x0000) | 
|  | #define IDT_VID_MASK	((u32)0xFFFF) | 
|  |  | 
|  | /* | 
|  | * IDT 89HPESx can send NACK when new command is sent before previous one | 
|  | * fininshed execution. In this case driver retries operation | 
|  | * certain times. | 
|  | * @RETRY_CNT:		Number of retries before giving up and fail | 
|  | * @idt_smb_safe:	Generate a retry loop on corresponding SMBus method | 
|  | */ | 
|  | #define RETRY_CNT (128) | 
|  | #define idt_smb_safe(ops, args...) ({ \ | 
|  | int __retry = RETRY_CNT; \ | 
|  | s32 __sts; \ | 
|  | do { \ | 
|  | __sts = i2c_smbus_ ## ops ## _data(args); \ | 
|  | } while (__retry-- && __sts < 0); \ | 
|  | __sts; \ | 
|  | }) | 
|  |  | 
|  | /*=========================================================================== | 
|  | *                         i2c bus level IO-operations | 
|  | *=========================================================================== | 
|  | */ | 
|  |  | 
|  | /* | 
|  | * idt_smb_write_byte() - SMBus write method when I2C_SMBUS_BYTE_DATA operation | 
|  | *                        is only available | 
|  | * @pdev:	Pointer to the driver data | 
|  | * @seq:	Sequence of data to be written | 
|  | */ | 
|  | static int idt_smb_write_byte(struct idt_89hpesx_dev *pdev, | 
|  | const struct idt_smb_seq *seq) | 
|  | { | 
|  | s32 sts; | 
|  | u8 ccode; | 
|  | int idx; | 
|  |  | 
|  | /* Loop over the supplied data sending byte one-by-one */ | 
|  | for (idx = 0; idx < seq->bytecnt; idx++) { | 
|  | /* Collect the command code byte */ | 
|  | ccode = seq->ccode | CCODE_BYTE; | 
|  | if (idx == 0) | 
|  | ccode |= CCODE_START; | 
|  | if (idx == seq->bytecnt - 1) | 
|  | ccode |= CCODE_END; | 
|  |  | 
|  | /* Send data to the device */ | 
|  | sts = idt_smb_safe(write_byte, pdev->client, ccode, | 
|  | seq->data[idx]); | 
|  | if (sts != 0) | 
|  | return (int)sts; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_smb_read_byte() - SMBus read method when I2C_SMBUS_BYTE_DATA operation | 
|  | *                        is only available | 
|  | * @pdev:	Pointer to the driver data | 
|  | * @seq:	Buffer to read data to | 
|  | */ | 
|  | static int idt_smb_read_byte(struct idt_89hpesx_dev *pdev, | 
|  | struct idt_smb_seq *seq) | 
|  | { | 
|  | s32 sts; | 
|  | u8 ccode; | 
|  | int idx; | 
|  |  | 
|  | /* Loop over the supplied buffer receiving byte one-by-one */ | 
|  | for (idx = 0; idx < seq->bytecnt; idx++) { | 
|  | /* Collect the command code byte */ | 
|  | ccode = seq->ccode | CCODE_BYTE; | 
|  | if (idx == 0) | 
|  | ccode |= CCODE_START; | 
|  | if (idx == seq->bytecnt - 1) | 
|  | ccode |= CCODE_END; | 
|  |  | 
|  | /* Read data from the device */ | 
|  | sts = idt_smb_safe(read_byte, pdev->client, ccode); | 
|  | if (sts < 0) | 
|  | return (int)sts; | 
|  |  | 
|  | seq->data[idx] = (u8)sts; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_smb_write_word() - SMBus write method when I2C_SMBUS_BYTE_DATA and | 
|  | *                        I2C_FUNC_SMBUS_WORD_DATA operations are available | 
|  | * @pdev:	Pointer to the driver data | 
|  | * @seq:	Sequence of data to be written | 
|  | */ | 
|  | static int idt_smb_write_word(struct idt_89hpesx_dev *pdev, | 
|  | const struct idt_smb_seq *seq) | 
|  | { | 
|  | s32 sts; | 
|  | u8 ccode; | 
|  | int idx, evencnt; | 
|  |  | 
|  | /* Calculate the even count of data to send */ | 
|  | evencnt = seq->bytecnt - (seq->bytecnt % 2); | 
|  |  | 
|  | /* Loop over the supplied data sending two bytes at a time */ | 
|  | for (idx = 0; idx < evencnt; idx += 2) { | 
|  | /* Collect the command code byte */ | 
|  | ccode = seq->ccode | CCODE_WORD; | 
|  | if (idx == 0) | 
|  | ccode |= CCODE_START; | 
|  | if (idx == evencnt - 2) | 
|  | ccode |= CCODE_END; | 
|  |  | 
|  | /* Send word data to the device */ | 
|  | sts = idt_smb_safe(write_word, pdev->client, ccode, | 
|  | *(u16 *)&seq->data[idx]); | 
|  | if (sts != 0) | 
|  | return (int)sts; | 
|  | } | 
|  |  | 
|  | /* If there is odd number of bytes then send just one last byte */ | 
|  | if (seq->bytecnt != evencnt) { | 
|  | /* Collect the command code byte */ | 
|  | ccode = seq->ccode | CCODE_BYTE | CCODE_END; | 
|  | if (idx == 0) | 
|  | ccode |= CCODE_START; | 
|  |  | 
|  | /* Send byte data to the device */ | 
|  | sts = idt_smb_safe(write_byte, pdev->client, ccode, | 
|  | seq->data[idx]); | 
|  | if (sts != 0) | 
|  | return (int)sts; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_smb_read_word() - SMBus read method when I2C_SMBUS_BYTE_DATA and | 
|  | *                       I2C_FUNC_SMBUS_WORD_DATA operations are available | 
|  | * @pdev:	Pointer to the driver data | 
|  | * @seq:	Buffer to read data to | 
|  | */ | 
|  | static int idt_smb_read_word(struct idt_89hpesx_dev *pdev, | 
|  | struct idt_smb_seq *seq) | 
|  | { | 
|  | s32 sts; | 
|  | u8 ccode; | 
|  | int idx, evencnt; | 
|  |  | 
|  | /* Calculate the even count of data to send */ | 
|  | evencnt = seq->bytecnt - (seq->bytecnt % 2); | 
|  |  | 
|  | /* Loop over the supplied data reading two bytes at a time */ | 
|  | for (idx = 0; idx < evencnt; idx += 2) { | 
|  | /* Collect the command code byte */ | 
|  | ccode = seq->ccode | CCODE_WORD; | 
|  | if (idx == 0) | 
|  | ccode |= CCODE_START; | 
|  | if (idx == evencnt - 2) | 
|  | ccode |= CCODE_END; | 
|  |  | 
|  | /* Read word data from the device */ | 
|  | sts = idt_smb_safe(read_word, pdev->client, ccode); | 
|  | if (sts < 0) | 
|  | return (int)sts; | 
|  |  | 
|  | *(u16 *)&seq->data[idx] = (u16)sts; | 
|  | } | 
|  |  | 
|  | /* If there is odd number of bytes then receive just one last byte */ | 
|  | if (seq->bytecnt != evencnt) { | 
|  | /* Collect the command code byte */ | 
|  | ccode = seq->ccode | CCODE_BYTE | CCODE_END; | 
|  | if (idx == 0) | 
|  | ccode |= CCODE_START; | 
|  |  | 
|  | /* Read last data byte from the device */ | 
|  | sts = idt_smb_safe(read_byte, pdev->client, ccode); | 
|  | if (sts < 0) | 
|  | return (int)sts; | 
|  |  | 
|  | seq->data[idx] = (u8)sts; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_smb_write_block() - SMBus write method when I2C_SMBUS_BLOCK_DATA | 
|  | *                         operation is available | 
|  | * @pdev:	Pointer to the driver data | 
|  | * @seq:	Sequence of data to be written | 
|  | */ | 
|  | static int idt_smb_write_block(struct idt_89hpesx_dev *pdev, | 
|  | const struct idt_smb_seq *seq) | 
|  | { | 
|  | u8 ccode; | 
|  |  | 
|  | /* Return error if too much data passed to send */ | 
|  | if (seq->bytecnt > I2C_SMBUS_BLOCK_MAX) | 
|  | return -EINVAL; | 
|  |  | 
|  | /* Collect the command code byte */ | 
|  | ccode = seq->ccode | CCODE_BLOCK | CCODE_START | CCODE_END; | 
|  |  | 
|  | /* Send block of data to the device */ | 
|  | return idt_smb_safe(write_block, pdev->client, ccode, seq->bytecnt, | 
|  | seq->data); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_smb_read_block() - SMBus read method when I2C_SMBUS_BLOCK_DATA | 
|  | *                        operation is available | 
|  | * @pdev:	Pointer to the driver data | 
|  | * @seq:	Buffer to read data to | 
|  | */ | 
|  | static int idt_smb_read_block(struct idt_89hpesx_dev *pdev, | 
|  | struct idt_smb_seq *seq) | 
|  | { | 
|  | s32 sts; | 
|  | u8 ccode; | 
|  |  | 
|  | /* Return error if too much data passed to send */ | 
|  | if (seq->bytecnt > I2C_SMBUS_BLOCK_MAX) | 
|  | return -EINVAL; | 
|  |  | 
|  | /* Collect the command code byte */ | 
|  | ccode = seq->ccode | CCODE_BLOCK | CCODE_START | CCODE_END; | 
|  |  | 
|  | /* Read block of data from the device */ | 
|  | sts = idt_smb_safe(read_block, pdev->client, ccode, seq->data); | 
|  | if (sts != seq->bytecnt) | 
|  | return (sts < 0 ? sts : -ENODATA); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_smb_write_i2c_block() - SMBus write method when I2C_SMBUS_I2C_BLOCK_DATA | 
|  | *                             operation is available | 
|  | * @pdev:	Pointer to the driver data | 
|  | * @seq:	Sequence of data to be written | 
|  | * | 
|  | * NOTE It's usual SMBus write block operation, except the actual data length is | 
|  | * sent as first byte of data | 
|  | */ | 
|  | static int idt_smb_write_i2c_block(struct idt_89hpesx_dev *pdev, | 
|  | const struct idt_smb_seq *seq) | 
|  | { | 
|  | u8 ccode, buf[I2C_SMBUS_BLOCK_MAX + 1]; | 
|  |  | 
|  | /* Return error if too much data passed to send */ | 
|  | if (seq->bytecnt > I2C_SMBUS_BLOCK_MAX) | 
|  | return -EINVAL; | 
|  |  | 
|  | /* Collect the data to send. Length byte must be added prior the data */ | 
|  | buf[0] = seq->bytecnt; | 
|  | memcpy(&buf[1], seq->data, seq->bytecnt); | 
|  |  | 
|  | /* Collect the command code byte */ | 
|  | ccode = seq->ccode | CCODE_BLOCK | CCODE_START | CCODE_END; | 
|  |  | 
|  | /* Send length and block of data to the device */ | 
|  | return idt_smb_safe(write_i2c_block, pdev->client, ccode, | 
|  | seq->bytecnt + 1, buf); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_smb_read_i2c_block() - SMBus read method when I2C_SMBUS_I2C_BLOCK_DATA | 
|  | *                            operation is available | 
|  | * @pdev:	Pointer to the driver data | 
|  | * @seq:	Buffer to read data to | 
|  | * | 
|  | * NOTE It's usual SMBus read block operation, except the actual data length is | 
|  | * retrieved as first byte of data | 
|  | */ | 
|  | static int idt_smb_read_i2c_block(struct idt_89hpesx_dev *pdev, | 
|  | struct idt_smb_seq *seq) | 
|  | { | 
|  | u8 ccode, buf[I2C_SMBUS_BLOCK_MAX + 1]; | 
|  | s32 sts; | 
|  |  | 
|  | /* Return error if too much data passed to send */ | 
|  | if (seq->bytecnt > I2C_SMBUS_BLOCK_MAX) | 
|  | return -EINVAL; | 
|  |  | 
|  | /* Collect the command code byte */ | 
|  | ccode = seq->ccode | CCODE_BLOCK | CCODE_START | CCODE_END; | 
|  |  | 
|  | /* Read length and block of data from the device */ | 
|  | sts = idt_smb_safe(read_i2c_block, pdev->client, ccode, | 
|  | seq->bytecnt + 1, buf); | 
|  | if (sts != seq->bytecnt + 1) | 
|  | return (sts < 0 ? sts : -ENODATA); | 
|  | if (buf[0] != seq->bytecnt) | 
|  | return -ENODATA; | 
|  |  | 
|  | /* Copy retrieved data to the output data buffer */ | 
|  | memcpy(seq->data, &buf[1], seq->bytecnt); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /*=========================================================================== | 
|  | *                          EEPROM IO-operations | 
|  | *=========================================================================== | 
|  | */ | 
|  |  | 
|  | /* | 
|  | * idt_eeprom_read_byte() - read just one byte from EEPROM | 
|  | * @pdev:	Pointer to the driver data | 
|  | * @memaddr:	Start EEPROM memory address | 
|  | * @data:	Data to be written to EEPROM | 
|  | */ | 
|  | static int idt_eeprom_read_byte(struct idt_89hpesx_dev *pdev, u16 memaddr, | 
|  | u8 *data) | 
|  | { | 
|  | struct device *dev = &pdev->client->dev; | 
|  | struct idt_eeprom_seq eeseq; | 
|  | struct idt_smb_seq smbseq; | 
|  | int ret, retry; | 
|  |  | 
|  | /* Initialize SMBus sequence fields */ | 
|  | smbseq.ccode = pdev->iniccode | CCODE_EEPROM; | 
|  | smbseq.data = (u8 *)&eeseq; | 
|  |  | 
|  | /* | 
|  | * Sometimes EEPROM may respond with NACK if it's busy with previous | 
|  | * operation, so we need to perform a few attempts of read cycle | 
|  | */ | 
|  | retry = RETRY_CNT; | 
|  | do { | 
|  | /* Send EEPROM memory address to read data from */ | 
|  | smbseq.bytecnt = EEPROM_WRRD_CNT; | 
|  | eeseq.cmd = pdev->inieecmd | EEPROM_OP_READ; | 
|  | eeseq.eeaddr = pdev->eeaddr; | 
|  | eeseq.memaddr = cpu_to_le16(memaddr); | 
|  | ret = pdev->smb_write(pdev, &smbseq); | 
|  | if (ret != 0) { | 
|  | dev_err(dev, "Failed to init eeprom addr 0x%02hhx", | 
|  | memaddr); | 
|  | break; | 
|  | } | 
|  |  | 
|  | /* Perform read operation */ | 
|  | smbseq.bytecnt = EEPROM_RD_CNT; | 
|  | ret = pdev->smb_read(pdev, &smbseq); | 
|  | if (ret != 0) { | 
|  | dev_err(dev, "Failed to read eeprom data 0x%02hhx", | 
|  | memaddr); | 
|  | break; | 
|  | } | 
|  |  | 
|  | /* Restart read operation if the device is busy */ | 
|  | if (retry && (eeseq.cmd & EEPROM_NAERR)) { | 
|  | dev_dbg(dev, "EEPROM busy, retry reading after %d ms", | 
|  | EEPROM_TOUT); | 
|  | msleep(EEPROM_TOUT); | 
|  | continue; | 
|  | } | 
|  |  | 
|  | /* Check whether IDT successfully read data from EEPROM */ | 
|  | if (eeseq.cmd & (EEPROM_NAERR | EEPROM_LAERR | EEPROM_MSS)) { | 
|  | dev_err(dev, | 
|  | "Communication with eeprom failed, cmd 0x%hhx", | 
|  | eeseq.cmd); | 
|  | ret = -EREMOTEIO; | 
|  | break; | 
|  | } | 
|  |  | 
|  | /* Save retrieved data and exit the loop */ | 
|  | *data = eeseq.data; | 
|  | break; | 
|  | } while (retry--); | 
|  |  | 
|  | /* Return the status of operation */ | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_eeprom_write() - EEPROM write operation | 
|  | * @pdev:	Pointer to the driver data | 
|  | * @memaddr:	Start EEPROM memory address | 
|  | * @len:	Length of data to be written | 
|  | * @data:	Data to be written to EEPROM | 
|  | */ | 
|  | static int idt_eeprom_write(struct idt_89hpesx_dev *pdev, u16 memaddr, u16 len, | 
|  | const u8 *data) | 
|  | { | 
|  | struct device *dev = &pdev->client->dev; | 
|  | struct idt_eeprom_seq eeseq; | 
|  | struct idt_smb_seq smbseq; | 
|  | int ret; | 
|  | u16 idx; | 
|  |  | 
|  | /* Initialize SMBus sequence fields */ | 
|  | smbseq.ccode = pdev->iniccode | CCODE_EEPROM; | 
|  | smbseq.data = (u8 *)&eeseq; | 
|  |  | 
|  | /* Send data byte-by-byte, checking if it is successfully written */ | 
|  | for (idx = 0; idx < len; idx++, memaddr++) { | 
|  | /* Lock IDT SMBus device */ | 
|  | mutex_lock(&pdev->smb_mtx); | 
|  |  | 
|  | /* Perform write operation */ | 
|  | smbseq.bytecnt = EEPROM_WR_CNT; | 
|  | eeseq.cmd = pdev->inieecmd | EEPROM_OP_WRITE; | 
|  | eeseq.eeaddr = pdev->eeaddr; | 
|  | eeseq.memaddr = cpu_to_le16(memaddr); | 
|  | eeseq.data = data[idx]; | 
|  | ret = pdev->smb_write(pdev, &smbseq); | 
|  | if (ret != 0) { | 
|  | dev_err(dev, | 
|  | "Failed to write 0x%04hx:0x%02hhx to eeprom", | 
|  | memaddr, data[idx]); | 
|  | goto err_mutex_unlock; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Check whether the data is successfully written by reading | 
|  | * from the same EEPROM memory address. | 
|  | */ | 
|  | eeseq.data = ~data[idx]; | 
|  | ret = idt_eeprom_read_byte(pdev, memaddr, &eeseq.data); | 
|  | if (ret != 0) | 
|  | goto err_mutex_unlock; | 
|  |  | 
|  | /* Check whether the read byte is the same as written one */ | 
|  | if (eeseq.data != data[idx]) { | 
|  | dev_err(dev, "Values don't match 0x%02hhx != 0x%02hhx", | 
|  | eeseq.data, data[idx]); | 
|  | ret = -EREMOTEIO; | 
|  | goto err_mutex_unlock; | 
|  | } | 
|  |  | 
|  | /* Unlock IDT SMBus device */ | 
|  | err_mutex_unlock: | 
|  | mutex_unlock(&pdev->smb_mtx); | 
|  | if (ret != 0) | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_eeprom_read() - EEPROM read operation | 
|  | * @pdev:	Pointer to the driver data | 
|  | * @memaddr:	Start EEPROM memory address | 
|  | * @len:	Length of data to read | 
|  | * @buf:	Buffer to read data to | 
|  | */ | 
|  | static int idt_eeprom_read(struct idt_89hpesx_dev *pdev, u16 memaddr, u16 len, | 
|  | u8 *buf) | 
|  | { | 
|  | int ret; | 
|  | u16 idx; | 
|  |  | 
|  | /* Read data byte-by-byte, retrying if it wasn't successful */ | 
|  | for (idx = 0; idx < len; idx++, memaddr++) { | 
|  | /* Lock IDT SMBus device */ | 
|  | mutex_lock(&pdev->smb_mtx); | 
|  |  | 
|  | /* Just read the byte to the buffer */ | 
|  | ret = idt_eeprom_read_byte(pdev, memaddr, &buf[idx]); | 
|  |  | 
|  | /* Unlock IDT SMBus device */ | 
|  | mutex_unlock(&pdev->smb_mtx); | 
|  |  | 
|  | /* Return error if read operation failed */ | 
|  | if (ret != 0) | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /*=========================================================================== | 
|  | *                          CSR IO-operations | 
|  | *=========================================================================== | 
|  | */ | 
|  |  | 
|  | /* | 
|  | * idt_csr_write() - CSR write operation | 
|  | * @pdev:	Pointer to the driver data | 
|  | * @csraddr:	CSR address (with no two LS bits) | 
|  | * @data:	Data to be written to CSR | 
|  | */ | 
|  | static int idt_csr_write(struct idt_89hpesx_dev *pdev, u16 csraddr, | 
|  | const u32 data) | 
|  | { | 
|  | struct device *dev = &pdev->client->dev; | 
|  | struct idt_csr_seq csrseq; | 
|  | struct idt_smb_seq smbseq; | 
|  | int ret; | 
|  |  | 
|  | /* Initialize SMBus sequence fields */ | 
|  | smbseq.ccode = pdev->iniccode | CCODE_CSR; | 
|  | smbseq.data = (u8 *)&csrseq; | 
|  |  | 
|  | /* Lock IDT SMBus device */ | 
|  | mutex_lock(&pdev->smb_mtx); | 
|  |  | 
|  | /* Perform write operation */ | 
|  | smbseq.bytecnt = CSR_WR_CNT; | 
|  | csrseq.cmd = pdev->inicsrcmd | CSR_OP_WRITE; | 
|  | csrseq.csraddr = cpu_to_le16(csraddr); | 
|  | csrseq.data = cpu_to_le32(data); | 
|  | ret = pdev->smb_write(pdev, &smbseq); | 
|  | if (ret != 0) { | 
|  | dev_err(dev, "Failed to write 0x%04x: 0x%04x to csr", | 
|  | CSR_REAL_ADDR(csraddr), data); | 
|  | goto err_mutex_unlock; | 
|  | } | 
|  |  | 
|  | /* Send CSR address to read data from */ | 
|  | smbseq.bytecnt = CSR_WRRD_CNT; | 
|  | csrseq.cmd = pdev->inicsrcmd | CSR_OP_READ; | 
|  | ret = pdev->smb_write(pdev, &smbseq); | 
|  | if (ret != 0) { | 
|  | dev_err(dev, "Failed to init csr address 0x%04x", | 
|  | CSR_REAL_ADDR(csraddr)); | 
|  | goto err_mutex_unlock; | 
|  | } | 
|  |  | 
|  | /* Perform read operation */ | 
|  | smbseq.bytecnt = CSR_RD_CNT; | 
|  | ret = pdev->smb_read(pdev, &smbseq); | 
|  | if (ret != 0) { | 
|  | dev_err(dev, "Failed to read csr 0x%04x", | 
|  | CSR_REAL_ADDR(csraddr)); | 
|  | goto err_mutex_unlock; | 
|  | } | 
|  |  | 
|  | /* Check whether IDT successfully retrieved CSR data */ | 
|  | if (csrseq.cmd & (CSR_RERR | CSR_WERR)) { | 
|  | dev_err(dev, "IDT failed to perform CSR r/w"); | 
|  | ret = -EREMOTEIO; | 
|  | goto err_mutex_unlock; | 
|  | } | 
|  |  | 
|  | /* Unlock IDT SMBus device */ | 
|  | err_mutex_unlock: | 
|  | mutex_unlock(&pdev->smb_mtx); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_csr_read() - CSR read operation | 
|  | * @pdev:	Pointer to the driver data | 
|  | * @csraddr:	CSR address (with no two LS bits) | 
|  | * @data:	Data to be written to CSR | 
|  | */ | 
|  | static int idt_csr_read(struct idt_89hpesx_dev *pdev, u16 csraddr, u32 *data) | 
|  | { | 
|  | struct device *dev = &pdev->client->dev; | 
|  | struct idt_csr_seq csrseq; | 
|  | struct idt_smb_seq smbseq; | 
|  | int ret; | 
|  |  | 
|  | /* Initialize SMBus sequence fields */ | 
|  | smbseq.ccode = pdev->iniccode | CCODE_CSR; | 
|  | smbseq.data = (u8 *)&csrseq; | 
|  |  | 
|  | /* Lock IDT SMBus device */ | 
|  | mutex_lock(&pdev->smb_mtx); | 
|  |  | 
|  | /* Send CSR register address before reading it */ | 
|  | smbseq.bytecnt = CSR_WRRD_CNT; | 
|  | csrseq.cmd = pdev->inicsrcmd | CSR_OP_READ; | 
|  | csrseq.csraddr = cpu_to_le16(csraddr); | 
|  | ret = pdev->smb_write(pdev, &smbseq); | 
|  | if (ret != 0) { | 
|  | dev_err(dev, "Failed to init csr address 0x%04x", | 
|  | CSR_REAL_ADDR(csraddr)); | 
|  | goto err_mutex_unlock; | 
|  | } | 
|  |  | 
|  | /* Perform read operation */ | 
|  | smbseq.bytecnt = CSR_RD_CNT; | 
|  | ret = pdev->smb_read(pdev, &smbseq); | 
|  | if (ret != 0) { | 
|  | dev_err(dev, "Failed to read csr 0x%04hx", | 
|  | CSR_REAL_ADDR(csraddr)); | 
|  | goto err_mutex_unlock; | 
|  | } | 
|  |  | 
|  | /* Check whether IDT successfully retrieved CSR data */ | 
|  | if (csrseq.cmd & (CSR_RERR | CSR_WERR)) { | 
|  | dev_err(dev, "IDT failed to perform CSR r/w"); | 
|  | ret = -EREMOTEIO; | 
|  | goto err_mutex_unlock; | 
|  | } | 
|  |  | 
|  | /* Save data retrieved from IDT */ | 
|  | *data = le32_to_cpu(csrseq.data); | 
|  |  | 
|  | /* Unlock IDT SMBus device */ | 
|  | err_mutex_unlock: | 
|  | mutex_unlock(&pdev->smb_mtx); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /*=========================================================================== | 
|  | *                          Sysfs/debugfs-nodes IO-operations | 
|  | *=========================================================================== | 
|  | */ | 
|  |  | 
|  | /* | 
|  | * eeprom_write() - EEPROM sysfs-node write callback | 
|  | * @filep:	Pointer to the file system node | 
|  | * @kobj:	Pointer to the kernel object related to the sysfs-node | 
|  | * @attr:	Attributes of the file | 
|  | * @buf:	Buffer to write data to | 
|  | * @off:	Offset at which data should be written to | 
|  | * @count:	Number of bytes to write | 
|  | */ | 
|  | static ssize_t eeprom_write(struct file *filp, struct kobject *kobj, | 
|  | struct bin_attribute *attr, | 
|  | char *buf, loff_t off, size_t count) | 
|  | { | 
|  | struct idt_89hpesx_dev *pdev; | 
|  | int ret; | 
|  |  | 
|  | /* Retrieve driver data */ | 
|  | pdev = dev_get_drvdata(kobj_to_dev(kobj)); | 
|  |  | 
|  | /* Perform EEPROM write operation */ | 
|  | ret = idt_eeprom_write(pdev, (u16)off, (u16)count, (u8 *)buf); | 
|  | return (ret != 0 ? ret : count); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * eeprom_read() - EEPROM sysfs-node read callback | 
|  | * @filep:	Pointer to the file system node | 
|  | * @kobj:	Pointer to the kernel object related to the sysfs-node | 
|  | * @attr:	Attributes of the file | 
|  | * @buf:	Buffer to write data to | 
|  | * @off:	Offset at which data should be written to | 
|  | * @count:	Number of bytes to write | 
|  | */ | 
|  | static ssize_t eeprom_read(struct file *filp, struct kobject *kobj, | 
|  | struct bin_attribute *attr, | 
|  | char *buf, loff_t off, size_t count) | 
|  | { | 
|  | struct idt_89hpesx_dev *pdev; | 
|  | int ret; | 
|  |  | 
|  | /* Retrieve driver data */ | 
|  | pdev = dev_get_drvdata(kobj_to_dev(kobj)); | 
|  |  | 
|  | /* Perform EEPROM read operation */ | 
|  | ret = idt_eeprom_read(pdev, (u16)off, (u16)count, (u8 *)buf); | 
|  | return (ret != 0 ? ret : count); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_dbgfs_csr_write() - CSR debugfs-node write callback | 
|  | * @filep:	Pointer to the file system file descriptor | 
|  | * @buf:	Buffer to read data from | 
|  | * @count:	Size of the buffer | 
|  | * @offp:	Offset within the file | 
|  | * | 
|  | * It accepts either "0x<reg addr>:0x<value>" for saving register address | 
|  | * and writing value to specified DWORD register or "0x<reg addr>" for | 
|  | * just saving register address in order to perform next read operation. | 
|  | * | 
|  | * WARNING No spaces are allowed. Incoming string must be strictly formated as: | 
|  | * "<reg addr>:<value>". Register address must be aligned within 4 bytes | 
|  | * (one DWORD). | 
|  | */ | 
|  | static ssize_t idt_dbgfs_csr_write(struct file *filep, const char __user *ubuf, | 
|  | size_t count, loff_t *offp) | 
|  | { | 
|  | struct idt_89hpesx_dev *pdev = filep->private_data; | 
|  | char *colon_ch, *csraddr_str, *csrval_str; | 
|  | int ret, csraddr_len; | 
|  | u32 csraddr, csrval; | 
|  | char *buf; | 
|  |  | 
|  | /* Copy data from User-space */ | 
|  | buf = kmalloc(count + 1, GFP_KERNEL); | 
|  | if (!buf) | 
|  | return -ENOMEM; | 
|  |  | 
|  | ret = simple_write_to_buffer(buf, count, offp, ubuf, count); | 
|  | if (ret < 0) | 
|  | goto free_buf; | 
|  | buf[count] = 0; | 
|  |  | 
|  | /* Find position of colon in the buffer */ | 
|  | colon_ch = strnchr(buf, count, ':'); | 
|  |  | 
|  | /* | 
|  | * If there is colon passed then new CSR value should be parsed as | 
|  | * well, so allocate buffer for CSR address substring. | 
|  | * If no colon is found, then string must have just one number with | 
|  | * no new CSR value | 
|  | */ | 
|  | if (colon_ch != NULL) { | 
|  | csraddr_len = colon_ch - buf; | 
|  | csraddr_str = | 
|  | kmalloc(csraddr_len + 1, GFP_KERNEL); | 
|  | if (csraddr_str == NULL) { | 
|  | ret = -ENOMEM; | 
|  | goto free_buf; | 
|  | } | 
|  | /* Copy the register address to the substring buffer */ | 
|  | strncpy(csraddr_str, buf, csraddr_len); | 
|  | csraddr_str[csraddr_len] = '\0'; | 
|  | /* Register value must follow the colon */ | 
|  | csrval_str = colon_ch + 1; | 
|  | } else /* if (str_colon == NULL) */ { | 
|  | csraddr_str = (char *)buf; /* Just to shut warning up */ | 
|  | csraddr_len = strnlen(csraddr_str, count); | 
|  | csrval_str = NULL; | 
|  | } | 
|  |  | 
|  | /* Convert CSR address to u32 value */ | 
|  | ret = kstrtou32(csraddr_str, 0, &csraddr); | 
|  | if (ret != 0) | 
|  | goto free_csraddr_str; | 
|  |  | 
|  | /* Check whether passed register address is valid */ | 
|  | if (csraddr > CSR_MAX || !IS_ALIGNED(csraddr, SZ_4)) { | 
|  | ret = -EINVAL; | 
|  | goto free_csraddr_str; | 
|  | } | 
|  |  | 
|  | /* Shift register address to the right so to have u16 address */ | 
|  | pdev->csr = (csraddr >> 2); | 
|  |  | 
|  | /* Parse new CSR value and send it to IDT, if colon has been found */ | 
|  | if (colon_ch != NULL) { | 
|  | ret = kstrtou32(csrval_str, 0, &csrval); | 
|  | if (ret != 0) | 
|  | goto free_csraddr_str; | 
|  |  | 
|  | ret = idt_csr_write(pdev, pdev->csr, csrval); | 
|  | if (ret != 0) | 
|  | goto free_csraddr_str; | 
|  | } | 
|  |  | 
|  | /* Free memory only if colon has been found */ | 
|  | free_csraddr_str: | 
|  | if (colon_ch != NULL) | 
|  | kfree(csraddr_str); | 
|  |  | 
|  | /* Free buffer allocated for data retrieved from User-space */ | 
|  | free_buf: | 
|  | kfree(buf); | 
|  |  | 
|  | return (ret != 0 ? ret : count); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_dbgfs_csr_read() - CSR debugfs-node read callback | 
|  | * @filep:	Pointer to the file system file descriptor | 
|  | * @buf:	Buffer to write data to | 
|  | * @count:	Size of the buffer | 
|  | * @offp:	Offset within the file | 
|  | * | 
|  | * It just prints the pair "0x<reg addr>:0x<value>" to passed buffer. | 
|  | */ | 
|  | #define CSRBUF_SIZE	((size_t)32) | 
|  | static ssize_t idt_dbgfs_csr_read(struct file *filep, char __user *ubuf, | 
|  | size_t count, loff_t *offp) | 
|  | { | 
|  | struct idt_89hpesx_dev *pdev = filep->private_data; | 
|  | u32 csraddr, csrval; | 
|  | char buf[CSRBUF_SIZE]; | 
|  | int ret, size; | 
|  |  | 
|  | /* Perform CSR read operation */ | 
|  | ret = idt_csr_read(pdev, pdev->csr, &csrval); | 
|  | if (ret != 0) | 
|  | return ret; | 
|  |  | 
|  | /* Shift register address to the left so to have real address */ | 
|  | csraddr = ((u32)pdev->csr << 2); | 
|  |  | 
|  | /* Print the "0x<reg addr>:0x<value>" to buffer */ | 
|  | size = snprintf(buf, CSRBUF_SIZE, "0x%05x:0x%08x\n", | 
|  | (unsigned int)csraddr, (unsigned int)csrval); | 
|  |  | 
|  | /* Copy data to User-space */ | 
|  | return simple_read_from_buffer(ubuf, count, offp, buf, size); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * eeprom_attribute - EEPROM sysfs-node attributes | 
|  | * | 
|  | * NOTE Size will be changed in compliance with OF node. EEPROM attribute will | 
|  | * be read-only as well if the corresponding flag is specified in OF node. | 
|  | */ | 
|  | static BIN_ATTR_RW(eeprom, EEPROM_DEF_SIZE); | 
|  |  | 
|  | /* | 
|  | * csr_dbgfs_ops - CSR debugfs-node read/write operations | 
|  | */ | 
|  | static const struct file_operations csr_dbgfs_ops = { | 
|  | .owner = THIS_MODULE, | 
|  | .open = simple_open, | 
|  | .write = idt_dbgfs_csr_write, | 
|  | .read = idt_dbgfs_csr_read | 
|  | }; | 
|  |  | 
|  | /*=========================================================================== | 
|  | *                       Driver init/deinit methods | 
|  | *=========================================================================== | 
|  | */ | 
|  |  | 
|  | /* | 
|  | * idt_set_defval() - disable EEPROM access by default | 
|  | * @pdev:	Pointer to the driver data | 
|  | */ | 
|  | static void idt_set_defval(struct idt_89hpesx_dev *pdev) | 
|  | { | 
|  | /* If OF info is missing then use next values */ | 
|  | pdev->eesize = 0; | 
|  | pdev->eero = true; | 
|  | pdev->inieecmd = 0; | 
|  | pdev->eeaddr = 0; | 
|  | } | 
|  |  | 
|  | static const struct i2c_device_id ee_ids[]; | 
|  |  | 
|  | /* | 
|  | * idt_ee_match_id() - check whether the node belongs to compatible EEPROMs | 
|  | */ | 
|  | static const struct i2c_device_id *idt_ee_match_id(struct fwnode_handle *fwnode) | 
|  | { | 
|  | const struct i2c_device_id *id = ee_ids; | 
|  | const char *compatible, *p; | 
|  | char devname[I2C_NAME_SIZE]; | 
|  | int ret; | 
|  |  | 
|  | ret = fwnode_property_read_string(fwnode, "compatible", &compatible); | 
|  | if (ret) | 
|  | return NULL; | 
|  |  | 
|  | p = strchr(compatible, ','); | 
|  | strlcpy(devname, p ? p + 1 : compatible, sizeof(devname)); | 
|  | /* Search through the device name */ | 
|  | while (id->name[0]) { | 
|  | if (strcmp(devname, id->name) == 0) | 
|  | return id; | 
|  | id++; | 
|  | } | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_get_fw_data() - get IDT i2c-device parameters from device tree | 
|  | * @pdev:	Pointer to the driver data | 
|  | */ | 
|  | static void idt_get_fw_data(struct idt_89hpesx_dev *pdev) | 
|  | { | 
|  | struct device *dev = &pdev->client->dev; | 
|  | struct fwnode_handle *fwnode; | 
|  | const struct i2c_device_id *ee_id = NULL; | 
|  | u32 eeprom_addr; | 
|  | int ret; | 
|  |  | 
|  | device_for_each_child_node(dev, fwnode) { | 
|  | ee_id = idt_ee_match_id(fwnode); | 
|  | if (ee_id) | 
|  | break; | 
|  |  | 
|  | dev_warn(dev, "Skip unsupported EEPROM device %pfw\n", fwnode); | 
|  | } | 
|  |  | 
|  | /* If there is no fwnode EEPROM device, then set zero size */ | 
|  | if (!ee_id) { | 
|  | dev_warn(dev, "No fwnode, EEPROM access disabled"); | 
|  | idt_set_defval(pdev); | 
|  | return; | 
|  | } | 
|  |  | 
|  | /* Retrieve EEPROM size */ | 
|  | pdev->eesize = (u32)ee_id->driver_data; | 
|  |  | 
|  | /* Get custom EEPROM address from 'reg' attribute */ | 
|  | ret = fwnode_property_read_u32(fwnode, "reg", &eeprom_addr); | 
|  | if (ret || (eeprom_addr == 0)) { | 
|  | dev_warn(dev, "No EEPROM reg found, use default address 0x%x", | 
|  | EEPROM_DEF_ADDR); | 
|  | pdev->inieecmd = 0; | 
|  | pdev->eeaddr = EEPROM_DEF_ADDR << 1; | 
|  | } else { | 
|  | pdev->inieecmd = EEPROM_USA; | 
|  | pdev->eeaddr = eeprom_addr << 1; | 
|  | } | 
|  |  | 
|  | /* Check EEPROM 'read-only' flag */ | 
|  | if (fwnode_property_read_bool(fwnode, "read-only")) | 
|  | pdev->eero = true; | 
|  | else /* if (!fwnode_property_read_bool(node, "read-only")) */ | 
|  | pdev->eero = false; | 
|  |  | 
|  | fwnode_handle_put(fwnode); | 
|  | dev_info(dev, "EEPROM of %d bytes found by 0x%x", | 
|  | pdev->eesize, pdev->eeaddr); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_create_pdev() - create and init data structure of the driver | 
|  | * @client:	i2c client of IDT PCIe-switch device | 
|  | */ | 
|  | static struct idt_89hpesx_dev *idt_create_pdev(struct i2c_client *client) | 
|  | { | 
|  | struct idt_89hpesx_dev *pdev; | 
|  |  | 
|  | /* Allocate memory for driver data */ | 
|  | pdev = devm_kmalloc(&client->dev, sizeof(struct idt_89hpesx_dev), | 
|  | GFP_KERNEL); | 
|  | if (pdev == NULL) | 
|  | return ERR_PTR(-ENOMEM); | 
|  |  | 
|  | /* Initialize basic fields of the data */ | 
|  | pdev->client = client; | 
|  | i2c_set_clientdata(client, pdev); | 
|  |  | 
|  | /* Read firmware nodes information */ | 
|  | idt_get_fw_data(pdev); | 
|  |  | 
|  | /* Initialize basic CSR CMD field - use full DWORD-sized r/w ops */ | 
|  | pdev->inicsrcmd = CSR_DWE; | 
|  | pdev->csr = CSR_DEF; | 
|  |  | 
|  | /* Enable Packet Error Checking if it's supported by adapter */ | 
|  | if (i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_PEC)) { | 
|  | pdev->iniccode = CCODE_PEC; | 
|  | client->flags |= I2C_CLIENT_PEC; | 
|  | } else /* PEC is unsupported */ { | 
|  | pdev->iniccode = 0; | 
|  | } | 
|  |  | 
|  | return pdev; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_free_pdev() - free data structure of the driver | 
|  | * @pdev:	Pointer to the driver data | 
|  | */ | 
|  | static void idt_free_pdev(struct idt_89hpesx_dev *pdev) | 
|  | { | 
|  | /* Clear driver data from device private field */ | 
|  | i2c_set_clientdata(pdev->client, NULL); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_set_smbus_ops() - set supported SMBus operations | 
|  | * @pdev:	Pointer to the driver data | 
|  | * Return status of smbus check operations | 
|  | */ | 
|  | static int idt_set_smbus_ops(struct idt_89hpesx_dev *pdev) | 
|  | { | 
|  | struct i2c_adapter *adapter = pdev->client->adapter; | 
|  | struct device *dev = &pdev->client->dev; | 
|  |  | 
|  | /* Check i2c adapter read functionality */ | 
|  | if (i2c_check_functionality(adapter, | 
|  | I2C_FUNC_SMBUS_READ_BLOCK_DATA)) { | 
|  | pdev->smb_read = idt_smb_read_block; | 
|  | dev_dbg(dev, "SMBus block-read op chosen"); | 
|  | } else if (i2c_check_functionality(adapter, | 
|  | I2C_FUNC_SMBUS_READ_I2C_BLOCK)) { | 
|  | pdev->smb_read = idt_smb_read_i2c_block; | 
|  | dev_dbg(dev, "SMBus i2c-block-read op chosen"); | 
|  | } else if (i2c_check_functionality(adapter, | 
|  | I2C_FUNC_SMBUS_READ_WORD_DATA) && | 
|  | i2c_check_functionality(adapter, | 
|  | I2C_FUNC_SMBUS_READ_BYTE_DATA)) { | 
|  | pdev->smb_read = idt_smb_read_word; | 
|  | dev_warn(dev, "Use slow word/byte SMBus read ops"); | 
|  | } else if (i2c_check_functionality(adapter, | 
|  | I2C_FUNC_SMBUS_READ_BYTE_DATA)) { | 
|  | pdev->smb_read = idt_smb_read_byte; | 
|  | dev_warn(dev, "Use slow byte SMBus read op"); | 
|  | } else /* no supported smbus read operations */ { | 
|  | dev_err(dev, "No supported SMBus read op"); | 
|  | return -EPFNOSUPPORT; | 
|  | } | 
|  |  | 
|  | /* Check i2c adapter write functionality */ | 
|  | if (i2c_check_functionality(adapter, | 
|  | I2C_FUNC_SMBUS_WRITE_BLOCK_DATA)) { | 
|  | pdev->smb_write = idt_smb_write_block; | 
|  | dev_dbg(dev, "SMBus block-write op chosen"); | 
|  | } else if (i2c_check_functionality(adapter, | 
|  | I2C_FUNC_SMBUS_WRITE_I2C_BLOCK)) { | 
|  | pdev->smb_write = idt_smb_write_i2c_block; | 
|  | dev_dbg(dev, "SMBus i2c-block-write op chosen"); | 
|  | } else if (i2c_check_functionality(adapter, | 
|  | I2C_FUNC_SMBUS_WRITE_WORD_DATA) && | 
|  | i2c_check_functionality(adapter, | 
|  | I2C_FUNC_SMBUS_WRITE_BYTE_DATA)) { | 
|  | pdev->smb_write = idt_smb_write_word; | 
|  | dev_warn(dev, "Use slow word/byte SMBus write op"); | 
|  | } else if (i2c_check_functionality(adapter, | 
|  | I2C_FUNC_SMBUS_WRITE_BYTE_DATA)) { | 
|  | pdev->smb_write = idt_smb_write_byte; | 
|  | dev_warn(dev, "Use slow byte SMBus write op"); | 
|  | } else /* no supported smbus write operations */ { | 
|  | dev_err(dev, "No supported SMBus write op"); | 
|  | return -EPFNOSUPPORT; | 
|  | } | 
|  |  | 
|  | /* Initialize IDT SMBus slave interface mutex */ | 
|  | mutex_init(&pdev->smb_mtx); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_check_dev() - check whether it's really IDT 89HPESx device | 
|  | * @pdev:	Pointer to the driver data | 
|  | * Return status of i2c adapter check operation | 
|  | */ | 
|  | static int idt_check_dev(struct idt_89hpesx_dev *pdev) | 
|  | { | 
|  | struct device *dev = &pdev->client->dev; | 
|  | u32 viddid; | 
|  | int ret; | 
|  |  | 
|  | /* Read VID and DID directly from IDT memory space */ | 
|  | ret = idt_csr_read(pdev, IDT_VIDDID_CSR, &viddid); | 
|  | if (ret != 0) { | 
|  | dev_err(dev, "Failed to read VID/DID"); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /* Check whether it's IDT device */ | 
|  | if ((viddid & IDT_VID_MASK) != PCI_VENDOR_ID_IDT) { | 
|  | dev_err(dev, "Got unsupported VID/DID: 0x%08x", viddid); | 
|  | return -ENODEV; | 
|  | } | 
|  |  | 
|  | dev_info(dev, "Found IDT 89HPES device VID:0x%04x, DID:0x%04x", | 
|  | (viddid & IDT_VID_MASK), (viddid >> 16)); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_create_sysfs_files() - create sysfs attribute files | 
|  | * @pdev:	Pointer to the driver data | 
|  | * Return status of operation | 
|  | */ | 
|  | static int idt_create_sysfs_files(struct idt_89hpesx_dev *pdev) | 
|  | { | 
|  | struct device *dev = &pdev->client->dev; | 
|  | int ret; | 
|  |  | 
|  | /* Don't do anything if EEPROM isn't accessible */ | 
|  | if (pdev->eesize == 0) { | 
|  | dev_dbg(dev, "Skip creating sysfs-files"); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* Allocate memory for attribute file */ | 
|  | pdev->ee_file = devm_kmalloc(dev, sizeof(*pdev->ee_file), GFP_KERNEL); | 
|  | if (!pdev->ee_file) | 
|  | return -ENOMEM; | 
|  |  | 
|  | /* Copy the declared EEPROM attr structure to change some of fields */ | 
|  | memcpy(pdev->ee_file, &bin_attr_eeprom, sizeof(*pdev->ee_file)); | 
|  |  | 
|  | /* In case of read-only EEPROM get rid of write ability */ | 
|  | if (pdev->eero) { | 
|  | pdev->ee_file->attr.mode &= ~0200; | 
|  | pdev->ee_file->write = NULL; | 
|  | } | 
|  | /* Create EEPROM sysfs file */ | 
|  | pdev->ee_file->size = pdev->eesize; | 
|  | ret = sysfs_create_bin_file(&dev->kobj, pdev->ee_file); | 
|  | if (ret != 0) { | 
|  | dev_err(dev, "Failed to create EEPROM sysfs-node"); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_remove_sysfs_files() - remove sysfs attribute files | 
|  | * @pdev:	Pointer to the driver data | 
|  | */ | 
|  | static void idt_remove_sysfs_files(struct idt_89hpesx_dev *pdev) | 
|  | { | 
|  | struct device *dev = &pdev->client->dev; | 
|  |  | 
|  | /* Don't do anything if EEPROM wasn't accessible */ | 
|  | if (pdev->eesize == 0) | 
|  | return; | 
|  |  | 
|  | /* Remove EEPROM sysfs file */ | 
|  | sysfs_remove_bin_file(&dev->kobj, pdev->ee_file); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_create_dbgfs_files() - create debugfs files | 
|  | * @pdev:	Pointer to the driver data | 
|  | */ | 
|  | #define CSRNAME_LEN	((size_t)32) | 
|  | static void idt_create_dbgfs_files(struct idt_89hpesx_dev *pdev) | 
|  | { | 
|  | struct i2c_client *cli = pdev->client; | 
|  | char fname[CSRNAME_LEN]; | 
|  |  | 
|  | /* Create Debugfs directory for CSR file */ | 
|  | snprintf(fname, CSRNAME_LEN, "%d-%04hx", cli->adapter->nr, cli->addr); | 
|  | pdev->csr_dir = debugfs_create_dir(fname, csr_dbgdir); | 
|  |  | 
|  | /* Create Debugfs file for CSR read/write operations */ | 
|  | debugfs_create_file(cli->name, 0600, pdev->csr_dir, pdev, | 
|  | &csr_dbgfs_ops); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_remove_dbgfs_files() - remove debugfs files | 
|  | * @pdev:	Pointer to the driver data | 
|  | */ | 
|  | static void idt_remove_dbgfs_files(struct idt_89hpesx_dev *pdev) | 
|  | { | 
|  | /* Remove CSR directory and it sysfs-node */ | 
|  | debugfs_remove_recursive(pdev->csr_dir); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_probe() - IDT 89HPESx driver probe() callback method | 
|  | */ | 
|  | static int idt_probe(struct i2c_client *client, const struct i2c_device_id *id) | 
|  | { | 
|  | struct idt_89hpesx_dev *pdev; | 
|  | int ret; | 
|  |  | 
|  | /* Create driver data */ | 
|  | pdev = idt_create_pdev(client); | 
|  | if (IS_ERR(pdev)) | 
|  | return PTR_ERR(pdev); | 
|  |  | 
|  | /* Set SMBus operations */ | 
|  | ret = idt_set_smbus_ops(pdev); | 
|  | if (ret != 0) | 
|  | goto err_free_pdev; | 
|  |  | 
|  | /* Check whether it is truly IDT 89HPESx device */ | 
|  | ret = idt_check_dev(pdev); | 
|  | if (ret != 0) | 
|  | goto err_free_pdev; | 
|  |  | 
|  | /* Create sysfs files */ | 
|  | ret = idt_create_sysfs_files(pdev); | 
|  | if (ret != 0) | 
|  | goto err_free_pdev; | 
|  |  | 
|  | /* Create debugfs files */ | 
|  | idt_create_dbgfs_files(pdev); | 
|  |  | 
|  | return 0; | 
|  |  | 
|  | err_free_pdev: | 
|  | idt_free_pdev(pdev); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * idt_remove() - IDT 89HPESx driver remove() callback method | 
|  | */ | 
|  | static int idt_remove(struct i2c_client *client) | 
|  | { | 
|  | struct idt_89hpesx_dev *pdev = i2c_get_clientdata(client); | 
|  |  | 
|  | /* Remove debugfs files first */ | 
|  | idt_remove_dbgfs_files(pdev); | 
|  |  | 
|  | /* Remove sysfs files */ | 
|  | idt_remove_sysfs_files(pdev); | 
|  |  | 
|  | /* Discard driver data structure */ | 
|  | idt_free_pdev(pdev); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * ee_ids - array of supported EEPROMs | 
|  | */ | 
|  | static const struct i2c_device_id ee_ids[] = { | 
|  | { "24c32",  4096}, | 
|  | { "24c64",  8192}, | 
|  | { "24c128", 16384}, | 
|  | { "24c256", 32768}, | 
|  | { "24c512", 65536}, | 
|  | {} | 
|  | }; | 
|  | MODULE_DEVICE_TABLE(i2c, ee_ids); | 
|  |  | 
|  | /* | 
|  | * idt_ids - supported IDT 89HPESx devices | 
|  | */ | 
|  | static const struct i2c_device_id idt_ids[] = { | 
|  | { "89hpes8nt2", 0 }, | 
|  | { "89hpes12nt3", 0 }, | 
|  |  | 
|  | { "89hpes24nt6ag2", 0 }, | 
|  | { "89hpes32nt8ag2", 0 }, | 
|  | { "89hpes32nt8bg2", 0 }, | 
|  | { "89hpes12nt12g2", 0 }, | 
|  | { "89hpes16nt16g2", 0 }, | 
|  | { "89hpes24nt24g2", 0 }, | 
|  | { "89hpes32nt24ag2", 0 }, | 
|  | { "89hpes32nt24bg2", 0 }, | 
|  |  | 
|  | { "89hpes12n3", 0 }, | 
|  | { "89hpes12n3a", 0 }, | 
|  | { "89hpes24n3", 0 }, | 
|  | { "89hpes24n3a", 0 }, | 
|  |  | 
|  | { "89hpes32h8", 0 }, | 
|  | { "89hpes32h8g2", 0 }, | 
|  | { "89hpes48h12", 0 }, | 
|  | { "89hpes48h12g2", 0 }, | 
|  | { "89hpes48h12ag2", 0 }, | 
|  | { "89hpes16h16", 0 }, | 
|  | { "89hpes22h16", 0 }, | 
|  | { "89hpes22h16g2", 0 }, | 
|  | { "89hpes34h16", 0 }, | 
|  | { "89hpes34h16g2", 0 }, | 
|  | { "89hpes64h16", 0 }, | 
|  | { "89hpes64h16g2", 0 }, | 
|  | { "89hpes64h16ag2", 0 }, | 
|  |  | 
|  | /* { "89hpes3t3", 0 }, // No SMBus-slave iface */ | 
|  | { "89hpes12t3g2", 0 }, | 
|  | { "89hpes24t3g2", 0 }, | 
|  | /* { "89hpes4t4", 0 }, // No SMBus-slave iface */ | 
|  | { "89hpes16t4", 0 }, | 
|  | { "89hpes4t4g2", 0 }, | 
|  | { "89hpes10t4g2", 0 }, | 
|  | { "89hpes16t4g2", 0 }, | 
|  | { "89hpes16t4ag2", 0 }, | 
|  | { "89hpes5t5", 0 }, | 
|  | { "89hpes6t5", 0 }, | 
|  | { "89hpes8t5", 0 }, | 
|  | { "89hpes8t5a", 0 }, | 
|  | { "89hpes24t6", 0 }, | 
|  | { "89hpes6t6g2", 0 }, | 
|  | { "89hpes24t6g2", 0 }, | 
|  | { "89hpes16t7", 0 }, | 
|  | { "89hpes32t8", 0 }, | 
|  | { "89hpes32t8g2", 0 }, | 
|  | { "89hpes48t12", 0 }, | 
|  | { "89hpes48t12g2", 0 }, | 
|  | { /* END OF LIST */ } | 
|  | }; | 
|  | MODULE_DEVICE_TABLE(i2c, idt_ids); | 
|  |  | 
|  | static const struct of_device_id idt_of_match[] = { | 
|  | { .compatible = "idt,89hpes8nt2", }, | 
|  | { .compatible = "idt,89hpes12nt3", }, | 
|  |  | 
|  | { .compatible = "idt,89hpes24nt6ag2", }, | 
|  | { .compatible = "idt,89hpes32nt8ag2", }, | 
|  | { .compatible = "idt,89hpes32nt8bg2", }, | 
|  | { .compatible = "idt,89hpes12nt12g2", }, | 
|  | { .compatible = "idt,89hpes16nt16g2", }, | 
|  | { .compatible = "idt,89hpes24nt24g2", }, | 
|  | { .compatible = "idt,89hpes32nt24ag2", }, | 
|  | { .compatible = "idt,89hpes32nt24bg2", }, | 
|  |  | 
|  | { .compatible = "idt,89hpes12n3", }, | 
|  | { .compatible = "idt,89hpes12n3a", }, | 
|  | { .compatible = "idt,89hpes24n3", }, | 
|  | { .compatible = "idt,89hpes24n3a", }, | 
|  |  | 
|  | { .compatible = "idt,89hpes32h8", }, | 
|  | { .compatible = "idt,89hpes32h8g2", }, | 
|  | { .compatible = "idt,89hpes48h12", }, | 
|  | { .compatible = "idt,89hpes48h12g2", }, | 
|  | { .compatible = "idt,89hpes48h12ag2", }, | 
|  | { .compatible = "idt,89hpes16h16", }, | 
|  | { .compatible = "idt,89hpes22h16", }, | 
|  | { .compatible = "idt,89hpes22h16g2", }, | 
|  | { .compatible = "idt,89hpes34h16", }, | 
|  | { .compatible = "idt,89hpes34h16g2", }, | 
|  | { .compatible = "idt,89hpes64h16", }, | 
|  | { .compatible = "idt,89hpes64h16g2", }, | 
|  | { .compatible = "idt,89hpes64h16ag2", }, | 
|  |  | 
|  | { .compatible = "idt,89hpes12t3g2", }, | 
|  | { .compatible = "idt,89hpes24t3g2", }, | 
|  |  | 
|  | { .compatible = "idt,89hpes16t4", }, | 
|  | { .compatible = "idt,89hpes4t4g2", }, | 
|  | { .compatible = "idt,89hpes10t4g2", }, | 
|  | { .compatible = "idt,89hpes16t4g2", }, | 
|  | { .compatible = "idt,89hpes16t4ag2", }, | 
|  | { .compatible = "idt,89hpes5t5", }, | 
|  | { .compatible = "idt,89hpes6t5", }, | 
|  | { .compatible = "idt,89hpes8t5", }, | 
|  | { .compatible = "idt,89hpes8t5a", }, | 
|  | { .compatible = "idt,89hpes24t6", }, | 
|  | { .compatible = "idt,89hpes6t6g2", }, | 
|  | { .compatible = "idt,89hpes24t6g2", }, | 
|  | { .compatible = "idt,89hpes16t7", }, | 
|  | { .compatible = "idt,89hpes32t8", }, | 
|  | { .compatible = "idt,89hpes32t8g2", }, | 
|  | { .compatible = "idt,89hpes48t12", }, | 
|  | { .compatible = "idt,89hpes48t12g2", }, | 
|  | { }, | 
|  | }; | 
|  | MODULE_DEVICE_TABLE(of, idt_of_match); | 
|  |  | 
|  | /* | 
|  | * idt_driver - IDT 89HPESx driver structure | 
|  | */ | 
|  | static struct i2c_driver idt_driver = { | 
|  | .driver = { | 
|  | .name = IDT_NAME, | 
|  | .of_match_table = idt_of_match, | 
|  | }, | 
|  | .probe = idt_probe, | 
|  | .remove = idt_remove, | 
|  | .id_table = idt_ids, | 
|  | }; | 
|  |  | 
|  | /* | 
|  | * idt_init() - IDT 89HPESx driver init() callback method | 
|  | */ | 
|  | static int __init idt_init(void) | 
|  | { | 
|  | /* Create Debugfs directory first */ | 
|  | if (debugfs_initialized()) | 
|  | csr_dbgdir = debugfs_create_dir("idt_csr", NULL); | 
|  |  | 
|  | /* Add new i2c-device driver */ | 
|  | return i2c_add_driver(&idt_driver); | 
|  | } | 
|  | module_init(idt_init); | 
|  |  | 
|  | /* | 
|  | * idt_exit() - IDT 89HPESx driver exit() callback method | 
|  | */ | 
|  | static void __exit idt_exit(void) | 
|  | { | 
|  | /* Discard debugfs directory and all files if any */ | 
|  | debugfs_remove_recursive(csr_dbgdir); | 
|  |  | 
|  | /* Unregister i2c-device driver */ | 
|  | i2c_del_driver(&idt_driver); | 
|  | } | 
|  | module_exit(idt_exit); |