xref: /openbmc/linux/drivers/misc/eeprom/idt_89hpesx.c (revision 3f6ee1c095156a74ab2df605af13020f1ce3e600)
1cfad6425SSerge Semin /*
2cfad6425SSerge Semin  *   This file is provided under a GPLv2 license.  When using or
3cfad6425SSerge Semin  *   redistributing this file, you may do so under that license.
4cfad6425SSerge Semin  *
5cfad6425SSerge Semin  *   GPL LICENSE SUMMARY
6cfad6425SSerge Semin  *
7cfad6425SSerge Semin  *   Copyright (C) 2016 T-Platforms. All Rights Reserved.
8cfad6425SSerge Semin  *
9cfad6425SSerge Semin  *   This program is free software; you can redistribute it and/or modify it
10cfad6425SSerge Semin  *   under the terms and conditions of the GNU General Public License,
11cfad6425SSerge Semin  *   version 2, as published by the Free Software Foundation.
12cfad6425SSerge Semin  *
13cfad6425SSerge Semin  *   This program is distributed in the hope that it will be useful, but WITHOUT
14cfad6425SSerge Semin  *   ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
15cfad6425SSerge Semin  *   FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
16cfad6425SSerge Semin  *   more details.
17cfad6425SSerge Semin  *
18cfad6425SSerge Semin  *   You should have received a copy of the GNU General Public License along
19cfad6425SSerge Semin  *   with this program; if not, it can be found <http://www.gnu.org/licenses/>.
20cfad6425SSerge Semin  *
21cfad6425SSerge Semin  *   The full GNU General Public License is included in this distribution in
22cfad6425SSerge Semin  *   the file called "COPYING".
23cfad6425SSerge Semin  *
24cfad6425SSerge Semin  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
25cfad6425SSerge Semin  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
26cfad6425SSerge Semin  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
27cfad6425SSerge Semin  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
28cfad6425SSerge Semin  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
29cfad6425SSerge Semin  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
30cfad6425SSerge Semin  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
31cfad6425SSerge Semin  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
32cfad6425SSerge Semin  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
33cfad6425SSerge Semin  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
34cfad6425SSerge Semin  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
35cfad6425SSerge Semin  *
36cfad6425SSerge Semin  * IDT PCIe-switch NTB Linux driver
37cfad6425SSerge Semin  *
38cfad6425SSerge Semin  * Contact Information:
39cfad6425SSerge Semin  * Serge Semin <fancer.lancer@gmail.com>, <Sergey.Semin@t-platforms.ru>
40cfad6425SSerge Semin  */
41cfad6425SSerge Semin /*
42cfad6425SSerge Semin  *           NOTE of the IDT 89HPESx SMBus-slave interface driver
43cfad6425SSerge Semin  *    This driver primarily is developed to have an access to EEPROM device of
44cfad6425SSerge Semin  * IDT PCIe-switches. IDT provides a simple SMBus interface to perform IO-
45cfad6425SSerge Semin  * operations from/to EEPROM, which is located at private (so called Master)
46cfad6425SSerge Semin  * SMBus of switches. Using that interface this the driver creates a simple
47cfad6425SSerge Semin  * binary sysfs-file in the device directory:
48cfad6425SSerge Semin  * /sys/bus/i2c/devices/<bus>-<devaddr>/eeprom
49cfad6425SSerge Semin  * In case if read-only flag is specified in the dts-node of device desription,
50cfad6425SSerge Semin  * User-space applications won't be able to write to the EEPROM sysfs-node.
51cfad6425SSerge Semin  *    Additionally IDT 89HPESx SMBus interface has an ability to write/read
52cfad6425SSerge Semin  * data of device CSRs. This driver exposes debugf-file to perform simple IO
53cfad6425SSerge Semin  * operations using that ability for just basic debug purpose. Particularly
54cfad6425SSerge Semin  * next file is created in the specific debugfs-directory:
55cfad6425SSerge Semin  * /sys/kernel/debug/idt_csr/
56cfad6425SSerge Semin  * Format of the debugfs-node is:
57cfad6425SSerge Semin  * $ cat /sys/kernel/debug/idt_csr/<bus>-<devaddr>/<devname>;
58cfad6425SSerge Semin  * <CSR address>:<CSR value>
59cfad6425SSerge Semin  * So reading the content of the file gives current CSR address and it value.
60cfad6425SSerge Semin  * If User-space application wishes to change current CSR address,
61cfad6425SSerge Semin  * it can just write a proper value to the sysfs-file:
62cfad6425SSerge Semin  * $ echo "<CSR address>" > /sys/kernel/debug/idt_csr/<bus>-<devaddr>/<devname>
63cfad6425SSerge Semin  * If it wants to change the CSR value as well, the format of the write
64cfad6425SSerge Semin  * operation is:
65cfad6425SSerge Semin  * $ echo "<CSR address>:<CSR value>" > \
66cfad6425SSerge Semin  *        /sys/kernel/debug/idt_csr/<bus>-<devaddr>/<devname>;
67cfad6425SSerge Semin  * CSR address and value can be any of hexadecimal, decimal or octal format.
68cfad6425SSerge Semin  */
69cfad6425SSerge Semin 
70cfad6425SSerge Semin #include <linux/kernel.h>
71cfad6425SSerge Semin #include <linux/init.h>
72cfad6425SSerge Semin #include <linux/module.h>
73cfad6425SSerge Semin #include <linux/types.h>
74cfad6425SSerge Semin #include <linux/sizes.h>
75cfad6425SSerge Semin #include <linux/slab.h>
76cfad6425SSerge Semin #include <linux/mutex.h>
77cfad6425SSerge Semin #include <linux/sysfs.h>
78cfad6425SSerge Semin #include <linux/debugfs.h>
79cfad6425SSerge Semin #include <linux/mod_devicetable.h>
80db15d73eSHuy Duong #include <linux/property.h>
81cfad6425SSerge Semin #include <linux/i2c.h>
82cfad6425SSerge Semin #include <linux/pci_ids.h>
83cfad6425SSerge Semin #include <linux/delay.h>
84cfad6425SSerge Semin 
85cfad6425SSerge Semin #define IDT_NAME		"89hpesx"
86cfad6425SSerge Semin #define IDT_89HPESX_DESC	"IDT 89HPESx SMBus-slave interface driver"
87cfad6425SSerge Semin #define IDT_89HPESX_VER		"1.0"
88cfad6425SSerge Semin 
89cfad6425SSerge Semin MODULE_DESCRIPTION(IDT_89HPESX_DESC);
90cfad6425SSerge Semin MODULE_VERSION(IDT_89HPESX_VER);
91cfad6425SSerge Semin MODULE_LICENSE("GPL v2");
92cfad6425SSerge Semin MODULE_AUTHOR("T-platforms");
93cfad6425SSerge Semin 
94cfad6425SSerge Semin /*
95cfad6425SSerge Semin  * csr_dbgdir - CSR read/write operations Debugfs directory
96cfad6425SSerge Semin  */
97cfad6425SSerge Semin static struct dentry *csr_dbgdir;
98cfad6425SSerge Semin 
99cfad6425SSerge Semin /*
100cfad6425SSerge Semin  * struct idt_89hpesx_dev - IDT 89HPESx device data structure
101cfad6425SSerge Semin  * @eesize:	Size of EEPROM in bytes (calculated from "idt,eecompatible")
102cfad6425SSerge Semin  * @eero:	EEPROM Read-only flag
103cfad6425SSerge Semin  * @eeaddr:	EEPROM custom address
104cfad6425SSerge Semin  *
105cfad6425SSerge Semin  * @inieecmd:	Initial cmd value for EEPROM read/write operations
106cfad6425SSerge Semin  * @inicsrcmd:	Initial cmd value for CSR read/write operations
107cfad6425SSerge Semin  * @iniccode:	Initialial command code value for IO-operations
108cfad6425SSerge Semin  *
109cfad6425SSerge Semin  * @csr:	CSR address to perform read operation
110cfad6425SSerge Semin  *
111cfad6425SSerge Semin  * @smb_write:	SMBus write method
112cfad6425SSerge Semin  * @smb_read:	SMBus read method
113cfad6425SSerge Semin  * @smb_mtx:	SMBus mutex
114cfad6425SSerge Semin  *
115cfad6425SSerge Semin  * @client:	i2c client used to perform IO operations
116cfad6425SSerge Semin  *
117cfad6425SSerge Semin  * @ee_file:	EEPROM read/write sysfs-file
118cfad6425SSerge Semin  */
119cfad6425SSerge Semin struct idt_smb_seq;
120cfad6425SSerge Semin struct idt_89hpesx_dev {
121cfad6425SSerge Semin 	u32 eesize;
122cfad6425SSerge Semin 	bool eero;
123cfad6425SSerge Semin 	u8 eeaddr;
124cfad6425SSerge Semin 
125cfad6425SSerge Semin 	u8 inieecmd;
126cfad6425SSerge Semin 	u8 inicsrcmd;
127cfad6425SSerge Semin 	u8 iniccode;
128cfad6425SSerge Semin 
129cfad6425SSerge Semin 	u16 csr;
130cfad6425SSerge Semin 
131cfad6425SSerge Semin 	int (*smb_write)(struct idt_89hpesx_dev *, const struct idt_smb_seq *);
132cfad6425SSerge Semin 	int (*smb_read)(struct idt_89hpesx_dev *, struct idt_smb_seq *);
133cfad6425SSerge Semin 	struct mutex smb_mtx;
134cfad6425SSerge Semin 
135cfad6425SSerge Semin 	struct i2c_client *client;
136cfad6425SSerge Semin 
137cfad6425SSerge Semin 	struct bin_attribute *ee_file;
138cfad6425SSerge Semin 	struct dentry *csr_dir;
139cfad6425SSerge Semin };
140cfad6425SSerge Semin 
141cfad6425SSerge Semin /*
142cfad6425SSerge Semin  * struct idt_smb_seq - sequence of data to be read/written from/to IDT 89HPESx
143cfad6425SSerge Semin  * @ccode:	SMBus command code
144cfad6425SSerge Semin  * @bytecnt:	Byte count of operation
145cfad6425SSerge Semin  * @data:	Data to by written
146cfad6425SSerge Semin  */
147cfad6425SSerge Semin struct idt_smb_seq {
148cfad6425SSerge Semin 	u8 ccode;
149cfad6425SSerge Semin 	u8 bytecnt;
150cfad6425SSerge Semin 	u8 *data;
151cfad6425SSerge Semin };
152cfad6425SSerge Semin 
153cfad6425SSerge Semin /*
154cfad6425SSerge Semin  * struct idt_eeprom_seq - sequence of data to be read/written from/to EEPROM
155cfad6425SSerge Semin  * @cmd:	Transaction CMD
156cfad6425SSerge Semin  * @eeaddr:	EEPROM custom address
157cfad6425SSerge Semin  * @memaddr:	Internal memory address of EEPROM
158cfad6425SSerge Semin  * @data:	Data to be written at the memory address
159cfad6425SSerge Semin  */
160cfad6425SSerge Semin struct idt_eeprom_seq {
161cfad6425SSerge Semin 	u8 cmd;
162cfad6425SSerge Semin 	u8 eeaddr;
163cfad6425SSerge Semin 	u16 memaddr;
164cfad6425SSerge Semin 	u8 data;
165cfad6425SSerge Semin } __packed;
166cfad6425SSerge Semin 
167cfad6425SSerge Semin /*
168cfad6425SSerge Semin  * struct idt_csr_seq - sequence of data to be read/written from/to CSR
169cfad6425SSerge Semin  * @cmd:	Transaction CMD
170cfad6425SSerge Semin  * @csraddr:	Internal IDT device CSR address
171cfad6425SSerge Semin  * @data:	Data to be read/written from/to the CSR address
172cfad6425SSerge Semin  */
173cfad6425SSerge Semin struct idt_csr_seq {
174cfad6425SSerge Semin 	u8 cmd;
175cfad6425SSerge Semin 	u16 csraddr;
176cfad6425SSerge Semin 	u32 data;
177cfad6425SSerge Semin } __packed;
178cfad6425SSerge Semin 
179cfad6425SSerge Semin /*
180cfad6425SSerge Semin  * SMBus command code macros
181cfad6425SSerge Semin  * @CCODE_END:		Indicates the end of transaction
182cfad6425SSerge Semin  * @CCODE_START:	Indicates the start of transaction
183cfad6425SSerge Semin  * @CCODE_CSR:		CSR read/write transaction
184cfad6425SSerge Semin  * @CCODE_EEPROM:	EEPROM read/write transaction
185cfad6425SSerge Semin  * @CCODE_BYTE:		Supplied data has BYTE length
186cfad6425SSerge Semin  * @CCODE_WORD:		Supplied data has WORD length
187cfad6425SSerge Semin  * @CCODE_BLOCK:	Supplied data has variable length passed in bytecnt
188cfad6425SSerge Semin  *			byte right following CCODE byte
189cfad6425SSerge Semin  */
190cfad6425SSerge Semin #define CCODE_END	((u8)0x01)
191cfad6425SSerge Semin #define CCODE_START	((u8)0x02)
192cfad6425SSerge Semin #define CCODE_CSR	((u8)0x00)
193cfad6425SSerge Semin #define CCODE_EEPROM	((u8)0x04)
194cfad6425SSerge Semin #define CCODE_BYTE	((u8)0x00)
195cfad6425SSerge Semin #define CCODE_WORD	((u8)0x20)
196cfad6425SSerge Semin #define CCODE_BLOCK	((u8)0x40)
197cfad6425SSerge Semin #define CCODE_PEC	((u8)0x80)
198cfad6425SSerge Semin 
199cfad6425SSerge Semin /*
200cfad6425SSerge Semin  * EEPROM command macros
201cfad6425SSerge Semin  * @EEPROM_OP_WRITE:	EEPROM write operation
202cfad6425SSerge Semin  * @EEPROM_OP_READ:	EEPROM read operation
203cfad6425SSerge Semin  * @EEPROM_USA:		Use specified address of EEPROM
204cfad6425SSerge Semin  * @EEPROM_NAERR:	EEPROM device is not ready to respond
205cfad6425SSerge Semin  * @EEPROM_LAERR:	EEPROM arbitration loss error
206cfad6425SSerge Semin  * @EEPROM_MSS:		EEPROM misplace start & stop bits error
207cfad6425SSerge Semin  * @EEPROM_WR_CNT:	Bytes count to perform write operation
208cfad6425SSerge Semin  * @EEPROM_WRRD_CNT:	Bytes count to write before reading
209cfad6425SSerge Semin  * @EEPROM_RD_CNT:	Bytes count to perform read operation
210cfad6425SSerge Semin  * @EEPROM_DEF_SIZE:	Fall back size of EEPROM
211cfad6425SSerge Semin  * @EEPROM_DEF_ADDR:	Defatul EEPROM address
212cfad6425SSerge Semin  * @EEPROM_TOUT:	Timeout before retry read operation if eeprom is busy
213cfad6425SSerge Semin  */
214cfad6425SSerge Semin #define EEPROM_OP_WRITE	((u8)0x00)
215cfad6425SSerge Semin #define EEPROM_OP_READ	((u8)0x01)
216cfad6425SSerge Semin #define EEPROM_USA	((u8)0x02)
217cfad6425SSerge Semin #define EEPROM_NAERR	((u8)0x08)
218cfad6425SSerge Semin #define EEPROM_LAERR    ((u8)0x10)
219cfad6425SSerge Semin #define EEPROM_MSS	((u8)0x20)
220cfad6425SSerge Semin #define EEPROM_WR_CNT	((u8)5)
221cfad6425SSerge Semin #define EEPROM_WRRD_CNT	((u8)4)
222cfad6425SSerge Semin #define EEPROM_RD_CNT	((u8)5)
223cfad6425SSerge Semin #define EEPROM_DEF_SIZE	((u16)4096)
224cfad6425SSerge Semin #define EEPROM_DEF_ADDR	((u8)0x50)
225cfad6425SSerge Semin #define EEPROM_TOUT	(100)
226cfad6425SSerge Semin 
227cfad6425SSerge Semin /*
228cfad6425SSerge Semin  * CSR command macros
229cfad6425SSerge Semin  * @CSR_DWE:		Enable all four bytes of the operation
230cfad6425SSerge Semin  * @CSR_OP_WRITE:	CSR write operation
231cfad6425SSerge Semin  * @CSR_OP_READ:	CSR read operation
232cfad6425SSerge Semin  * @CSR_RERR:		Read operation error
233cfad6425SSerge Semin  * @CSR_WERR:		Write operation error
234cfad6425SSerge Semin  * @CSR_WR_CNT:		Bytes count to perform write operation
235cfad6425SSerge Semin  * @CSR_WRRD_CNT:	Bytes count to write before reading
236cfad6425SSerge Semin  * @CSR_RD_CNT:		Bytes count to perform read operation
237cfad6425SSerge Semin  * @CSR_MAX:		Maximum CSR address
238cfad6425SSerge Semin  * @CSR_DEF:		Default CSR address
239cfad6425SSerge Semin  * @CSR_REAL_ADDR:	CSR real unshifted address
240cfad6425SSerge Semin  */
241cfad6425SSerge Semin #define CSR_DWE			((u8)0x0F)
242cfad6425SSerge Semin #define CSR_OP_WRITE		((u8)0x00)
243cfad6425SSerge Semin #define CSR_OP_READ		((u8)0x10)
244cfad6425SSerge Semin #define CSR_RERR		((u8)0x40)
245cfad6425SSerge Semin #define CSR_WERR		((u8)0x80)
246cfad6425SSerge Semin #define CSR_WR_CNT		((u8)7)
247cfad6425SSerge Semin #define CSR_WRRD_CNT		((u8)3)
248cfad6425SSerge Semin #define CSR_RD_CNT		((u8)7)
249cfad6425SSerge Semin #define CSR_MAX			((u32)0x3FFFF)
250cfad6425SSerge Semin #define CSR_DEF			((u16)0x0000)
251cfad6425SSerge Semin #define CSR_REAL_ADDR(val)	((unsigned int)val << 2)
252cfad6425SSerge Semin 
253cfad6425SSerge Semin /*
254cfad6425SSerge Semin  * IDT 89HPESx basic register
255cfad6425SSerge Semin  * @IDT_VIDDID_CSR:	PCIe VID and DID of IDT 89HPESx
256cfad6425SSerge Semin  * @IDT_VID_MASK:	Mask of VID
257cfad6425SSerge Semin  */
258cfad6425SSerge Semin #define IDT_VIDDID_CSR	((u32)0x0000)
259cfad6425SSerge Semin #define IDT_VID_MASK	((u32)0xFFFF)
260cfad6425SSerge Semin 
261cfad6425SSerge Semin /*
262cfad6425SSerge Semin  * IDT 89HPESx can send NACK when new command is sent before previous one
263cfad6425SSerge Semin  * fininshed execution. In this case driver retries operation
264cfad6425SSerge Semin  * certain times.
265cfad6425SSerge Semin  * @RETRY_CNT:		Number of retries before giving up and fail
266cfad6425SSerge Semin  * @idt_smb_safe:	Generate a retry loop on corresponding SMBus method
267cfad6425SSerge Semin  */
268cfad6425SSerge Semin #define RETRY_CNT (128)
269cfad6425SSerge Semin #define idt_smb_safe(ops, args...) ({ \
270cfad6425SSerge Semin 	int __retry = RETRY_CNT; \
271cfad6425SSerge Semin 	s32 __sts; \
272cfad6425SSerge Semin 	do { \
273cfad6425SSerge Semin 		__sts = i2c_smbus_ ## ops ## _data(args); \
274cfad6425SSerge Semin 	} while (__retry-- && __sts < 0); \
275cfad6425SSerge Semin 	__sts; \
276cfad6425SSerge Semin })
277cfad6425SSerge Semin 
278cfad6425SSerge Semin /*===========================================================================
279cfad6425SSerge Semin  *                         i2c bus level IO-operations
280cfad6425SSerge Semin  *===========================================================================
281cfad6425SSerge Semin  */
282cfad6425SSerge Semin 
283cfad6425SSerge Semin /*
284cfad6425SSerge Semin  * idt_smb_write_byte() - SMBus write method when I2C_SMBUS_BYTE_DATA operation
285cfad6425SSerge Semin  *                        is only available
286cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
287cfad6425SSerge Semin  * @seq:	Sequence of data to be written
288cfad6425SSerge Semin  */
289cfad6425SSerge Semin static int idt_smb_write_byte(struct idt_89hpesx_dev *pdev,
290cfad6425SSerge Semin 			      const struct idt_smb_seq *seq)
291cfad6425SSerge Semin {
292cfad6425SSerge Semin 	s32 sts;
293cfad6425SSerge Semin 	u8 ccode;
294cfad6425SSerge Semin 	int idx;
295cfad6425SSerge Semin 
296cfad6425SSerge Semin 	/* Loop over the supplied data sending byte one-by-one */
297cfad6425SSerge Semin 	for (idx = 0; idx < seq->bytecnt; idx++) {
298cfad6425SSerge Semin 		/* Collect the command code byte */
299cfad6425SSerge Semin 		ccode = seq->ccode | CCODE_BYTE;
300cfad6425SSerge Semin 		if (idx == 0)
301cfad6425SSerge Semin 			ccode |= CCODE_START;
302cfad6425SSerge Semin 		if (idx == seq->bytecnt - 1)
303cfad6425SSerge Semin 			ccode |= CCODE_END;
304cfad6425SSerge Semin 
305cfad6425SSerge Semin 		/* Send data to the device */
306cfad6425SSerge Semin 		sts = idt_smb_safe(write_byte, pdev->client, ccode,
307cfad6425SSerge Semin 			seq->data[idx]);
308cfad6425SSerge Semin 		if (sts != 0)
309cfad6425SSerge Semin 			return (int)sts;
310cfad6425SSerge Semin 	}
311cfad6425SSerge Semin 
312cfad6425SSerge Semin 	return 0;
313cfad6425SSerge Semin }
314cfad6425SSerge Semin 
315cfad6425SSerge Semin /*
316cfad6425SSerge Semin  * idt_smb_read_byte() - SMBus read method when I2C_SMBUS_BYTE_DATA operation
317cfad6425SSerge Semin  *                        is only available
318cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
319cfad6425SSerge Semin  * @seq:	Buffer to read data to
320cfad6425SSerge Semin  */
321cfad6425SSerge Semin static int idt_smb_read_byte(struct idt_89hpesx_dev *pdev,
322cfad6425SSerge Semin 			     struct idt_smb_seq *seq)
323cfad6425SSerge Semin {
324cfad6425SSerge Semin 	s32 sts;
325cfad6425SSerge Semin 	u8 ccode;
326cfad6425SSerge Semin 	int idx;
327cfad6425SSerge Semin 
328cfad6425SSerge Semin 	/* Loop over the supplied buffer receiving byte one-by-one */
329cfad6425SSerge Semin 	for (idx = 0; idx < seq->bytecnt; idx++) {
330cfad6425SSerge Semin 		/* Collect the command code byte */
331cfad6425SSerge Semin 		ccode = seq->ccode | CCODE_BYTE;
332cfad6425SSerge Semin 		if (idx == 0)
333cfad6425SSerge Semin 			ccode |= CCODE_START;
334cfad6425SSerge Semin 		if (idx == seq->bytecnt - 1)
335cfad6425SSerge Semin 			ccode |= CCODE_END;
336cfad6425SSerge Semin 
337cfad6425SSerge Semin 		/* Read data from the device */
338cfad6425SSerge Semin 		sts = idt_smb_safe(read_byte, pdev->client, ccode);
339cfad6425SSerge Semin 		if (sts < 0)
340cfad6425SSerge Semin 			return (int)sts;
341cfad6425SSerge Semin 
342cfad6425SSerge Semin 		seq->data[idx] = (u8)sts;
343cfad6425SSerge Semin 	}
344cfad6425SSerge Semin 
345cfad6425SSerge Semin 	return 0;
346cfad6425SSerge Semin }
347cfad6425SSerge Semin 
348cfad6425SSerge Semin /*
349cfad6425SSerge Semin  * idt_smb_write_word() - SMBus write method when I2C_SMBUS_BYTE_DATA and
350cfad6425SSerge Semin  *                        I2C_FUNC_SMBUS_WORD_DATA operations are available
351cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
352cfad6425SSerge Semin  * @seq:	Sequence of data to be written
353cfad6425SSerge Semin  */
354cfad6425SSerge Semin static int idt_smb_write_word(struct idt_89hpesx_dev *pdev,
355cfad6425SSerge Semin 			      const struct idt_smb_seq *seq)
356cfad6425SSerge Semin {
357cfad6425SSerge Semin 	s32 sts;
358cfad6425SSerge Semin 	u8 ccode;
359cfad6425SSerge Semin 	int idx, evencnt;
360cfad6425SSerge Semin 
361cfad6425SSerge Semin 	/* Calculate the even count of data to send */
362cfad6425SSerge Semin 	evencnt = seq->bytecnt - (seq->bytecnt % 2);
363cfad6425SSerge Semin 
364cfad6425SSerge Semin 	/* Loop over the supplied data sending two bytes at a time */
365cfad6425SSerge Semin 	for (idx = 0; idx < evencnt; idx += 2) {
366cfad6425SSerge Semin 		/* Collect the command code byte */
367cfad6425SSerge Semin 		ccode = seq->ccode | CCODE_WORD;
368cfad6425SSerge Semin 		if (idx == 0)
369cfad6425SSerge Semin 			ccode |= CCODE_START;
370cfad6425SSerge Semin 		if (idx == evencnt - 2)
371cfad6425SSerge Semin 			ccode |= CCODE_END;
372cfad6425SSerge Semin 
373cfad6425SSerge Semin 		/* Send word data to the device */
374cfad6425SSerge Semin 		sts = idt_smb_safe(write_word, pdev->client, ccode,
375cfad6425SSerge Semin 			*(u16 *)&seq->data[idx]);
376cfad6425SSerge Semin 		if (sts != 0)
377cfad6425SSerge Semin 			return (int)sts;
378cfad6425SSerge Semin 	}
379cfad6425SSerge Semin 
380cfad6425SSerge Semin 	/* If there is odd number of bytes then send just one last byte */
381cfad6425SSerge Semin 	if (seq->bytecnt != evencnt) {
382cfad6425SSerge Semin 		/* Collect the command code byte */
383cfad6425SSerge Semin 		ccode = seq->ccode | CCODE_BYTE | CCODE_END;
384cfad6425SSerge Semin 		if (idx == 0)
385cfad6425SSerge Semin 			ccode |= CCODE_START;
386cfad6425SSerge Semin 
387cfad6425SSerge Semin 		/* Send byte data to the device */
388cfad6425SSerge Semin 		sts = idt_smb_safe(write_byte, pdev->client, ccode,
389cfad6425SSerge Semin 			seq->data[idx]);
390cfad6425SSerge Semin 		if (sts != 0)
391cfad6425SSerge Semin 			return (int)sts;
392cfad6425SSerge Semin 	}
393cfad6425SSerge Semin 
394cfad6425SSerge Semin 	return 0;
395cfad6425SSerge Semin }
396cfad6425SSerge Semin 
397cfad6425SSerge Semin /*
398cfad6425SSerge Semin  * idt_smb_read_word() - SMBus read method when I2C_SMBUS_BYTE_DATA and
399cfad6425SSerge Semin  *                       I2C_FUNC_SMBUS_WORD_DATA operations are available
400cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
401cfad6425SSerge Semin  * @seq:	Buffer to read data to
402cfad6425SSerge Semin  */
403cfad6425SSerge Semin static int idt_smb_read_word(struct idt_89hpesx_dev *pdev,
404cfad6425SSerge Semin 			     struct idt_smb_seq *seq)
405cfad6425SSerge Semin {
406cfad6425SSerge Semin 	s32 sts;
407cfad6425SSerge Semin 	u8 ccode;
408cfad6425SSerge Semin 	int idx, evencnt;
409cfad6425SSerge Semin 
410cfad6425SSerge Semin 	/* Calculate the even count of data to send */
411cfad6425SSerge Semin 	evencnt = seq->bytecnt - (seq->bytecnt % 2);
412cfad6425SSerge Semin 
413cfad6425SSerge Semin 	/* Loop over the supplied data reading two bytes at a time */
414cfad6425SSerge Semin 	for (idx = 0; idx < evencnt; idx += 2) {
415cfad6425SSerge Semin 		/* Collect the command code byte */
416cfad6425SSerge Semin 		ccode = seq->ccode | CCODE_WORD;
417cfad6425SSerge Semin 		if (idx == 0)
418cfad6425SSerge Semin 			ccode |= CCODE_START;
419cfad6425SSerge Semin 		if (idx == evencnt - 2)
420cfad6425SSerge Semin 			ccode |= CCODE_END;
421cfad6425SSerge Semin 
422cfad6425SSerge Semin 		/* Read word data from the device */
423cfad6425SSerge Semin 		sts = idt_smb_safe(read_word, pdev->client, ccode);
424cfad6425SSerge Semin 		if (sts < 0)
425cfad6425SSerge Semin 			return (int)sts;
426cfad6425SSerge Semin 
427cfad6425SSerge Semin 		*(u16 *)&seq->data[idx] = (u16)sts;
428cfad6425SSerge Semin 	}
429cfad6425SSerge Semin 
430cfad6425SSerge Semin 	/* If there is odd number of bytes then receive just one last byte */
431cfad6425SSerge Semin 	if (seq->bytecnt != evencnt) {
432cfad6425SSerge Semin 		/* Collect the command code byte */
433cfad6425SSerge Semin 		ccode = seq->ccode | CCODE_BYTE | CCODE_END;
434cfad6425SSerge Semin 		if (idx == 0)
435cfad6425SSerge Semin 			ccode |= CCODE_START;
436cfad6425SSerge Semin 
437cfad6425SSerge Semin 		/* Read last data byte from the device */
438cfad6425SSerge Semin 		sts = idt_smb_safe(read_byte, pdev->client, ccode);
439cfad6425SSerge Semin 		if (sts < 0)
440cfad6425SSerge Semin 			return (int)sts;
441cfad6425SSerge Semin 
442cfad6425SSerge Semin 		seq->data[idx] = (u8)sts;
443cfad6425SSerge Semin 	}
444cfad6425SSerge Semin 
445cfad6425SSerge Semin 	return 0;
446cfad6425SSerge Semin }
447cfad6425SSerge Semin 
448cfad6425SSerge Semin /*
449cfad6425SSerge Semin  * idt_smb_write_block() - SMBus write method when I2C_SMBUS_BLOCK_DATA
450cfad6425SSerge Semin  *                         operation is available
451cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
452cfad6425SSerge Semin  * @seq:	Sequence of data to be written
453cfad6425SSerge Semin  */
454cfad6425SSerge Semin static int idt_smb_write_block(struct idt_89hpesx_dev *pdev,
455cfad6425SSerge Semin 			       const struct idt_smb_seq *seq)
456cfad6425SSerge Semin {
457cfad6425SSerge Semin 	u8 ccode;
458cfad6425SSerge Semin 
459cfad6425SSerge Semin 	/* Return error if too much data passed to send */
460cfad6425SSerge Semin 	if (seq->bytecnt > I2C_SMBUS_BLOCK_MAX)
461cfad6425SSerge Semin 		return -EINVAL;
462cfad6425SSerge Semin 
463cfad6425SSerge Semin 	/* Collect the command code byte */
464cfad6425SSerge Semin 	ccode = seq->ccode | CCODE_BLOCK | CCODE_START | CCODE_END;
465cfad6425SSerge Semin 
466cfad6425SSerge Semin 	/* Send block of data to the device */
467cfad6425SSerge Semin 	return idt_smb_safe(write_block, pdev->client, ccode, seq->bytecnt,
468cfad6425SSerge Semin 		seq->data);
469cfad6425SSerge Semin }
470cfad6425SSerge Semin 
471cfad6425SSerge Semin /*
472cfad6425SSerge Semin  * idt_smb_read_block() - SMBus read method when I2C_SMBUS_BLOCK_DATA
473cfad6425SSerge Semin  *                        operation is available
474cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
475cfad6425SSerge Semin  * @seq:	Buffer to read data to
476cfad6425SSerge Semin  */
477cfad6425SSerge Semin static int idt_smb_read_block(struct idt_89hpesx_dev *pdev,
478cfad6425SSerge Semin 			      struct idt_smb_seq *seq)
479cfad6425SSerge Semin {
480cfad6425SSerge Semin 	s32 sts;
481cfad6425SSerge Semin 	u8 ccode;
482cfad6425SSerge Semin 
483cfad6425SSerge Semin 	/* Return error if too much data passed to send */
484cfad6425SSerge Semin 	if (seq->bytecnt > I2C_SMBUS_BLOCK_MAX)
485cfad6425SSerge Semin 		return -EINVAL;
486cfad6425SSerge Semin 
487cfad6425SSerge Semin 	/* Collect the command code byte */
488cfad6425SSerge Semin 	ccode = seq->ccode | CCODE_BLOCK | CCODE_START | CCODE_END;
489cfad6425SSerge Semin 
490cfad6425SSerge Semin 	/* Read block of data from the device */
491cfad6425SSerge Semin 	sts = idt_smb_safe(read_block, pdev->client, ccode, seq->data);
492cfad6425SSerge Semin 	if (sts != seq->bytecnt)
493cfad6425SSerge Semin 		return (sts < 0 ? sts : -ENODATA);
494cfad6425SSerge Semin 
495cfad6425SSerge Semin 	return 0;
496cfad6425SSerge Semin }
497cfad6425SSerge Semin 
498cfad6425SSerge Semin /*
499cfad6425SSerge Semin  * idt_smb_write_i2c_block() - SMBus write method when I2C_SMBUS_I2C_BLOCK_DATA
500cfad6425SSerge Semin  *                             operation is available
501cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
502cfad6425SSerge Semin  * @seq:	Sequence of data to be written
503cfad6425SSerge Semin  *
504cfad6425SSerge Semin  * NOTE It's usual SMBus write block operation, except the actual data length is
505cfad6425SSerge Semin  * sent as first byte of data
506cfad6425SSerge Semin  */
507cfad6425SSerge Semin static int idt_smb_write_i2c_block(struct idt_89hpesx_dev *pdev,
508cfad6425SSerge Semin 				   const struct idt_smb_seq *seq)
509cfad6425SSerge Semin {
510cfad6425SSerge Semin 	u8 ccode, buf[I2C_SMBUS_BLOCK_MAX + 1];
511cfad6425SSerge Semin 
512cfad6425SSerge Semin 	/* Return error if too much data passed to send */
513cfad6425SSerge Semin 	if (seq->bytecnt > I2C_SMBUS_BLOCK_MAX)
514cfad6425SSerge Semin 		return -EINVAL;
515cfad6425SSerge Semin 
516cfad6425SSerge Semin 	/* Collect the data to send. Length byte must be added prior the data */
517cfad6425SSerge Semin 	buf[0] = seq->bytecnt;
518cfad6425SSerge Semin 	memcpy(&buf[1], seq->data, seq->bytecnt);
519cfad6425SSerge Semin 
520cfad6425SSerge Semin 	/* Collect the command code byte */
521cfad6425SSerge Semin 	ccode = seq->ccode | CCODE_BLOCK | CCODE_START | CCODE_END;
522cfad6425SSerge Semin 
523cfad6425SSerge Semin 	/* Send length and block of data to the device */
524cfad6425SSerge Semin 	return idt_smb_safe(write_i2c_block, pdev->client, ccode,
525cfad6425SSerge Semin 		seq->bytecnt + 1, buf);
526cfad6425SSerge Semin }
527cfad6425SSerge Semin 
528cfad6425SSerge Semin /*
529cfad6425SSerge Semin  * idt_smb_read_i2c_block() - SMBus read method when I2C_SMBUS_I2C_BLOCK_DATA
530cfad6425SSerge Semin  *                            operation is available
531cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
532cfad6425SSerge Semin  * @seq:	Buffer to read data to
533cfad6425SSerge Semin  *
534cfad6425SSerge Semin  * NOTE It's usual SMBus read block operation, except the actual data length is
535cfad6425SSerge Semin  * retrieved as first byte of data
536cfad6425SSerge Semin  */
537cfad6425SSerge Semin static int idt_smb_read_i2c_block(struct idt_89hpesx_dev *pdev,
538cfad6425SSerge Semin 				  struct idt_smb_seq *seq)
539cfad6425SSerge Semin {
540cfad6425SSerge Semin 	u8 ccode, buf[I2C_SMBUS_BLOCK_MAX + 1];
541cfad6425SSerge Semin 	s32 sts;
542cfad6425SSerge Semin 
543cfad6425SSerge Semin 	/* Return error if too much data passed to send */
544cfad6425SSerge Semin 	if (seq->bytecnt > I2C_SMBUS_BLOCK_MAX)
545cfad6425SSerge Semin 		return -EINVAL;
546cfad6425SSerge Semin 
547cfad6425SSerge Semin 	/* Collect the command code byte */
548cfad6425SSerge Semin 	ccode = seq->ccode | CCODE_BLOCK | CCODE_START | CCODE_END;
549cfad6425SSerge Semin 
550cfad6425SSerge Semin 	/* Read length and block of data from the device */
551cfad6425SSerge Semin 	sts = idt_smb_safe(read_i2c_block, pdev->client, ccode,
552cfad6425SSerge Semin 		seq->bytecnt + 1, buf);
553cfad6425SSerge Semin 	if (sts != seq->bytecnt + 1)
554cfad6425SSerge Semin 		return (sts < 0 ? sts : -ENODATA);
555cfad6425SSerge Semin 	if (buf[0] != seq->bytecnt)
556cfad6425SSerge Semin 		return -ENODATA;
557cfad6425SSerge Semin 
558cfad6425SSerge Semin 	/* Copy retrieved data to the output data buffer */
559cfad6425SSerge Semin 	memcpy(seq->data, &buf[1], seq->bytecnt);
560cfad6425SSerge Semin 
561cfad6425SSerge Semin 	return 0;
562cfad6425SSerge Semin }
563cfad6425SSerge Semin 
564cfad6425SSerge Semin /*===========================================================================
565cfad6425SSerge Semin  *                          EEPROM IO-operations
566cfad6425SSerge Semin  *===========================================================================
567cfad6425SSerge Semin  */
568cfad6425SSerge Semin 
569cfad6425SSerge Semin /*
570cfad6425SSerge Semin  * idt_eeprom_read_byte() - read just one byte from EEPROM
571cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
572cfad6425SSerge Semin  * @memaddr:	Start EEPROM memory address
573cfad6425SSerge Semin  * @data:	Data to be written to EEPROM
574cfad6425SSerge Semin  */
575cfad6425SSerge Semin static int idt_eeprom_read_byte(struct idt_89hpesx_dev *pdev, u16 memaddr,
576cfad6425SSerge Semin 				u8 *data)
577cfad6425SSerge Semin {
578cfad6425SSerge Semin 	struct device *dev = &pdev->client->dev;
579cfad6425SSerge Semin 	struct idt_eeprom_seq eeseq;
580cfad6425SSerge Semin 	struct idt_smb_seq smbseq;
581cfad6425SSerge Semin 	int ret, retry;
582cfad6425SSerge Semin 
583cfad6425SSerge Semin 	/* Initialize SMBus sequence fields */
584cfad6425SSerge Semin 	smbseq.ccode = pdev->iniccode | CCODE_EEPROM;
585cfad6425SSerge Semin 	smbseq.data = (u8 *)&eeseq;
586cfad6425SSerge Semin 
587cfad6425SSerge Semin 	/*
588cfad6425SSerge Semin 	 * Sometimes EEPROM may respond with NACK if it's busy with previous
589cfad6425SSerge Semin 	 * operation, so we need to perform a few attempts of read cycle
590cfad6425SSerge Semin 	 */
591cfad6425SSerge Semin 	retry = RETRY_CNT;
592cfad6425SSerge Semin 	do {
593cfad6425SSerge Semin 		/* Send EEPROM memory address to read data from */
594cfad6425SSerge Semin 		smbseq.bytecnt = EEPROM_WRRD_CNT;
595cfad6425SSerge Semin 		eeseq.cmd = pdev->inieecmd | EEPROM_OP_READ;
596cfad6425SSerge Semin 		eeseq.eeaddr = pdev->eeaddr;
597cfad6425SSerge Semin 		eeseq.memaddr = cpu_to_le16(memaddr);
598cfad6425SSerge Semin 		ret = pdev->smb_write(pdev, &smbseq);
599cfad6425SSerge Semin 		if (ret != 0) {
600cfad6425SSerge Semin 			dev_err(dev, "Failed to init eeprom addr 0x%02hhx",
601cfad6425SSerge Semin 				memaddr);
602cfad6425SSerge Semin 			break;
603cfad6425SSerge Semin 		}
604cfad6425SSerge Semin 
605cfad6425SSerge Semin 		/* Perform read operation */
606cfad6425SSerge Semin 		smbseq.bytecnt = EEPROM_RD_CNT;
607cfad6425SSerge Semin 		ret = pdev->smb_read(pdev, &smbseq);
608cfad6425SSerge Semin 		if (ret != 0) {
609cfad6425SSerge Semin 			dev_err(dev, "Failed to read eeprom data 0x%02hhx",
610cfad6425SSerge Semin 				memaddr);
611cfad6425SSerge Semin 			break;
612cfad6425SSerge Semin 		}
613cfad6425SSerge Semin 
614cfad6425SSerge Semin 		/* Restart read operation if the device is busy */
615cfad6425SSerge Semin 		if (retry && (eeseq.cmd & EEPROM_NAERR)) {
616cfad6425SSerge Semin 			dev_dbg(dev, "EEPROM busy, retry reading after %d ms",
617cfad6425SSerge Semin 				EEPROM_TOUT);
618cfad6425SSerge Semin 			msleep(EEPROM_TOUT);
619cfad6425SSerge Semin 			continue;
620cfad6425SSerge Semin 		}
621cfad6425SSerge Semin 
622cfad6425SSerge Semin 		/* Check whether IDT successfully read data from EEPROM */
623cfad6425SSerge Semin 		if (eeseq.cmd & (EEPROM_NAERR | EEPROM_LAERR | EEPROM_MSS)) {
624cfad6425SSerge Semin 			dev_err(dev,
625cfad6425SSerge Semin 				"Communication with eeprom failed, cmd 0x%hhx",
626cfad6425SSerge Semin 				eeseq.cmd);
627cfad6425SSerge Semin 			ret = -EREMOTEIO;
628cfad6425SSerge Semin 			break;
629cfad6425SSerge Semin 		}
630cfad6425SSerge Semin 
631cfad6425SSerge Semin 		/* Save retrieved data and exit the loop */
632cfad6425SSerge Semin 		*data = eeseq.data;
633cfad6425SSerge Semin 		break;
634cfad6425SSerge Semin 	} while (retry--);
635cfad6425SSerge Semin 
636cfad6425SSerge Semin 	/* Return the status of operation */
637cfad6425SSerge Semin 	return ret;
638cfad6425SSerge Semin }
639cfad6425SSerge Semin 
640cfad6425SSerge Semin /*
641cfad6425SSerge Semin  * idt_eeprom_write() - EEPROM write operation
642cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
643cfad6425SSerge Semin  * @memaddr:	Start EEPROM memory address
644cfad6425SSerge Semin  * @len:	Length of data to be written
645cfad6425SSerge Semin  * @data:	Data to be written to EEPROM
646cfad6425SSerge Semin  */
647cfad6425SSerge Semin static int idt_eeprom_write(struct idt_89hpesx_dev *pdev, u16 memaddr, u16 len,
648cfad6425SSerge Semin 			    const u8 *data)
649cfad6425SSerge Semin {
650cfad6425SSerge Semin 	struct device *dev = &pdev->client->dev;
651cfad6425SSerge Semin 	struct idt_eeprom_seq eeseq;
652cfad6425SSerge Semin 	struct idt_smb_seq smbseq;
653cfad6425SSerge Semin 	int ret;
654cfad6425SSerge Semin 	u16 idx;
655cfad6425SSerge Semin 
656cfad6425SSerge Semin 	/* Initialize SMBus sequence fields */
657cfad6425SSerge Semin 	smbseq.ccode = pdev->iniccode | CCODE_EEPROM;
658cfad6425SSerge Semin 	smbseq.data = (u8 *)&eeseq;
659cfad6425SSerge Semin 
660cfad6425SSerge Semin 	/* Send data byte-by-byte, checking if it is successfully written */
661cfad6425SSerge Semin 	for (idx = 0; idx < len; idx++, memaddr++) {
662cfad6425SSerge Semin 		/* Lock IDT SMBus device */
663cfad6425SSerge Semin 		mutex_lock(&pdev->smb_mtx);
664cfad6425SSerge Semin 
665cfad6425SSerge Semin 		/* Perform write operation */
666cfad6425SSerge Semin 		smbseq.bytecnt = EEPROM_WR_CNT;
667cfad6425SSerge Semin 		eeseq.cmd = pdev->inieecmd | EEPROM_OP_WRITE;
668cfad6425SSerge Semin 		eeseq.eeaddr = pdev->eeaddr;
669cfad6425SSerge Semin 		eeseq.memaddr = cpu_to_le16(memaddr);
670cfad6425SSerge Semin 		eeseq.data = data[idx];
671cfad6425SSerge Semin 		ret = pdev->smb_write(pdev, &smbseq);
672cfad6425SSerge Semin 		if (ret != 0) {
673cfad6425SSerge Semin 			dev_err(dev,
674cfad6425SSerge Semin 				"Failed to write 0x%04hx:0x%02hhx to eeprom",
675cfad6425SSerge Semin 				memaddr, data[idx]);
676cfad6425SSerge Semin 			goto err_mutex_unlock;
677cfad6425SSerge Semin 		}
678cfad6425SSerge Semin 
679cfad6425SSerge Semin 		/*
680cfad6425SSerge Semin 		 * Check whether the data is successfully written by reading
681cfad6425SSerge Semin 		 * from the same EEPROM memory address.
682cfad6425SSerge Semin 		 */
683cfad6425SSerge Semin 		eeseq.data = ~data[idx];
684cfad6425SSerge Semin 		ret = idt_eeprom_read_byte(pdev, memaddr, &eeseq.data);
685cfad6425SSerge Semin 		if (ret != 0)
686cfad6425SSerge Semin 			goto err_mutex_unlock;
687cfad6425SSerge Semin 
688cfad6425SSerge Semin 		/* Check whether the read byte is the same as written one */
689cfad6425SSerge Semin 		if (eeseq.data != data[idx]) {
690cfad6425SSerge Semin 			dev_err(dev, "Values don't match 0x%02hhx != 0x%02hhx",
691cfad6425SSerge Semin 				eeseq.data, data[idx]);
692cfad6425SSerge Semin 			ret = -EREMOTEIO;
693cfad6425SSerge Semin 			goto err_mutex_unlock;
694cfad6425SSerge Semin 		}
695cfad6425SSerge Semin 
696cfad6425SSerge Semin 		/* Unlock IDT SMBus device */
697cfad6425SSerge Semin err_mutex_unlock:
698cfad6425SSerge Semin 		mutex_unlock(&pdev->smb_mtx);
699cfad6425SSerge Semin 		if (ret != 0)
700cfad6425SSerge Semin 			return ret;
701cfad6425SSerge Semin 	}
702cfad6425SSerge Semin 
703cfad6425SSerge Semin 	return 0;
704cfad6425SSerge Semin }
705cfad6425SSerge Semin 
706cfad6425SSerge Semin /*
707cfad6425SSerge Semin  * idt_eeprom_read() - EEPROM read operation
708cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
709cfad6425SSerge Semin  * @memaddr:	Start EEPROM memory address
710cfad6425SSerge Semin  * @len:	Length of data to read
711cfad6425SSerge Semin  * @buf:	Buffer to read data to
712cfad6425SSerge Semin  */
713cfad6425SSerge Semin static int idt_eeprom_read(struct idt_89hpesx_dev *pdev, u16 memaddr, u16 len,
714cfad6425SSerge Semin 			   u8 *buf)
715cfad6425SSerge Semin {
716cfad6425SSerge Semin 	int ret;
717cfad6425SSerge Semin 	u16 idx;
718cfad6425SSerge Semin 
719cfad6425SSerge Semin 	/* Read data byte-by-byte, retrying if it wasn't successful */
720cfad6425SSerge Semin 	for (idx = 0; idx < len; idx++, memaddr++) {
721cfad6425SSerge Semin 		/* Lock IDT SMBus device */
722cfad6425SSerge Semin 		mutex_lock(&pdev->smb_mtx);
723cfad6425SSerge Semin 
724cfad6425SSerge Semin 		/* Just read the byte to the buffer */
725cfad6425SSerge Semin 		ret = idt_eeprom_read_byte(pdev, memaddr, &buf[idx]);
726cfad6425SSerge Semin 
727cfad6425SSerge Semin 		/* Unlock IDT SMBus device */
728cfad6425SSerge Semin 		mutex_unlock(&pdev->smb_mtx);
729cfad6425SSerge Semin 
730cfad6425SSerge Semin 		/* Return error if read operation failed */
731cfad6425SSerge Semin 		if (ret != 0)
732cfad6425SSerge Semin 			return ret;
733cfad6425SSerge Semin 	}
734cfad6425SSerge Semin 
735cfad6425SSerge Semin 	return 0;
736cfad6425SSerge Semin }
737cfad6425SSerge Semin 
738cfad6425SSerge Semin /*===========================================================================
739cfad6425SSerge Semin  *                          CSR IO-operations
740cfad6425SSerge Semin  *===========================================================================
741cfad6425SSerge Semin  */
742cfad6425SSerge Semin 
743cfad6425SSerge Semin /*
744cfad6425SSerge Semin  * idt_csr_write() - CSR write operation
745cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
746cfad6425SSerge Semin  * @csraddr:	CSR address (with no two LS bits)
747cfad6425SSerge Semin  * @data:	Data to be written to CSR
748cfad6425SSerge Semin  */
749cfad6425SSerge Semin static int idt_csr_write(struct idt_89hpesx_dev *pdev, u16 csraddr,
750cfad6425SSerge Semin 			 const u32 data)
751cfad6425SSerge Semin {
752cfad6425SSerge Semin 	struct device *dev = &pdev->client->dev;
753cfad6425SSerge Semin 	struct idt_csr_seq csrseq;
754cfad6425SSerge Semin 	struct idt_smb_seq smbseq;
755cfad6425SSerge Semin 	int ret;
756cfad6425SSerge Semin 
757cfad6425SSerge Semin 	/* Initialize SMBus sequence fields */
758cfad6425SSerge Semin 	smbseq.ccode = pdev->iniccode | CCODE_CSR;
759cfad6425SSerge Semin 	smbseq.data = (u8 *)&csrseq;
760cfad6425SSerge Semin 
761cfad6425SSerge Semin 	/* Lock IDT SMBus device */
762cfad6425SSerge Semin 	mutex_lock(&pdev->smb_mtx);
763cfad6425SSerge Semin 
764cfad6425SSerge Semin 	/* Perform write operation */
765cfad6425SSerge Semin 	smbseq.bytecnt = CSR_WR_CNT;
766cfad6425SSerge Semin 	csrseq.cmd = pdev->inicsrcmd | CSR_OP_WRITE;
767cfad6425SSerge Semin 	csrseq.csraddr = cpu_to_le16(csraddr);
768cfad6425SSerge Semin 	csrseq.data = cpu_to_le32(data);
769cfad6425SSerge Semin 	ret = pdev->smb_write(pdev, &smbseq);
770cfad6425SSerge Semin 	if (ret != 0) {
771cfad6425SSerge Semin 		dev_err(dev, "Failed to write 0x%04x: 0x%04x to csr",
772cfad6425SSerge Semin 			CSR_REAL_ADDR(csraddr), data);
773cfad6425SSerge Semin 		goto err_mutex_unlock;
774cfad6425SSerge Semin 	}
775cfad6425SSerge Semin 
776cfad6425SSerge Semin 	/* Send CSR address to read data from */
777cfad6425SSerge Semin 	smbseq.bytecnt = CSR_WRRD_CNT;
778cfad6425SSerge Semin 	csrseq.cmd = pdev->inicsrcmd | CSR_OP_READ;
779cfad6425SSerge Semin 	ret = pdev->smb_write(pdev, &smbseq);
780cfad6425SSerge Semin 	if (ret != 0) {
781cfad6425SSerge Semin 		dev_err(dev, "Failed to init csr address 0x%04x",
782cfad6425SSerge Semin 			CSR_REAL_ADDR(csraddr));
783cfad6425SSerge Semin 		goto err_mutex_unlock;
784cfad6425SSerge Semin 	}
785cfad6425SSerge Semin 
786cfad6425SSerge Semin 	/* Perform read operation */
787cfad6425SSerge Semin 	smbseq.bytecnt = CSR_RD_CNT;
788cfad6425SSerge Semin 	ret = pdev->smb_read(pdev, &smbseq);
789cfad6425SSerge Semin 	if (ret != 0) {
790cfad6425SSerge Semin 		dev_err(dev, "Failed to read csr 0x%04x",
791cfad6425SSerge Semin 			CSR_REAL_ADDR(csraddr));
792cfad6425SSerge Semin 		goto err_mutex_unlock;
793cfad6425SSerge Semin 	}
794cfad6425SSerge Semin 
795cfad6425SSerge Semin 	/* Check whether IDT successfully retrieved CSR data */
796cfad6425SSerge Semin 	if (csrseq.cmd & (CSR_RERR | CSR_WERR)) {
797cfad6425SSerge Semin 		dev_err(dev, "IDT failed to perform CSR r/w");
798cfad6425SSerge Semin 		ret = -EREMOTEIO;
799cfad6425SSerge Semin 		goto err_mutex_unlock;
800cfad6425SSerge Semin 	}
801cfad6425SSerge Semin 
802cfad6425SSerge Semin 	/* Unlock IDT SMBus device */
803cfad6425SSerge Semin err_mutex_unlock:
804cfad6425SSerge Semin 	mutex_unlock(&pdev->smb_mtx);
805cfad6425SSerge Semin 
806cfad6425SSerge Semin 	return ret;
807cfad6425SSerge Semin }
808cfad6425SSerge Semin 
809cfad6425SSerge Semin /*
810cfad6425SSerge Semin  * idt_csr_read() - CSR read operation
811cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
812cfad6425SSerge Semin  * @csraddr:	CSR address (with no two LS bits)
813cfad6425SSerge Semin  * @data:	Data to be written to CSR
814cfad6425SSerge Semin  */
815cfad6425SSerge Semin static int idt_csr_read(struct idt_89hpesx_dev *pdev, u16 csraddr, u32 *data)
816cfad6425SSerge Semin {
817cfad6425SSerge Semin 	struct device *dev = &pdev->client->dev;
818cfad6425SSerge Semin 	struct idt_csr_seq csrseq;
819cfad6425SSerge Semin 	struct idt_smb_seq smbseq;
820cfad6425SSerge Semin 	int ret;
821cfad6425SSerge Semin 
822cfad6425SSerge Semin 	/* Initialize SMBus sequence fields */
823cfad6425SSerge Semin 	smbseq.ccode = pdev->iniccode | CCODE_CSR;
824cfad6425SSerge Semin 	smbseq.data = (u8 *)&csrseq;
825cfad6425SSerge Semin 
826cfad6425SSerge Semin 	/* Lock IDT SMBus device */
827cfad6425SSerge Semin 	mutex_lock(&pdev->smb_mtx);
828cfad6425SSerge Semin 
829cfad6425SSerge Semin 	/* Send CSR register address before reading it */
830cfad6425SSerge Semin 	smbseq.bytecnt = CSR_WRRD_CNT;
831cfad6425SSerge Semin 	csrseq.cmd = pdev->inicsrcmd | CSR_OP_READ;
832cfad6425SSerge Semin 	csrseq.csraddr = cpu_to_le16(csraddr);
833cfad6425SSerge Semin 	ret = pdev->smb_write(pdev, &smbseq);
834cfad6425SSerge Semin 	if (ret != 0) {
835cfad6425SSerge Semin 		dev_err(dev, "Failed to init csr address 0x%04x",
836cfad6425SSerge Semin 			CSR_REAL_ADDR(csraddr));
837cfad6425SSerge Semin 		goto err_mutex_unlock;
838cfad6425SSerge Semin 	}
839cfad6425SSerge Semin 
840cfad6425SSerge Semin 	/* Perform read operation */
841cfad6425SSerge Semin 	smbseq.bytecnt = CSR_RD_CNT;
842cfad6425SSerge Semin 	ret = pdev->smb_read(pdev, &smbseq);
843cfad6425SSerge Semin 	if (ret != 0) {
844cfad6425SSerge Semin 		dev_err(dev, "Failed to read csr 0x%04hx",
845cfad6425SSerge Semin 			CSR_REAL_ADDR(csraddr));
846cfad6425SSerge Semin 		goto err_mutex_unlock;
847cfad6425SSerge Semin 	}
848cfad6425SSerge Semin 
849cfad6425SSerge Semin 	/* Check whether IDT successfully retrieved CSR data */
850cfad6425SSerge Semin 	if (csrseq.cmd & (CSR_RERR | CSR_WERR)) {
851cfad6425SSerge Semin 		dev_err(dev, "IDT failed to perform CSR r/w");
852cfad6425SSerge Semin 		ret = -EREMOTEIO;
853cfad6425SSerge Semin 		goto err_mutex_unlock;
854cfad6425SSerge Semin 	}
855cfad6425SSerge Semin 
856cfad6425SSerge Semin 	/* Save data retrieved from IDT */
857cfad6425SSerge Semin 	*data = le32_to_cpu(csrseq.data);
858cfad6425SSerge Semin 
859cfad6425SSerge Semin 	/* Unlock IDT SMBus device */
860cfad6425SSerge Semin err_mutex_unlock:
861cfad6425SSerge Semin 	mutex_unlock(&pdev->smb_mtx);
862cfad6425SSerge Semin 
863cfad6425SSerge Semin 	return ret;
864cfad6425SSerge Semin }
865cfad6425SSerge Semin 
866cfad6425SSerge Semin /*===========================================================================
867cfad6425SSerge Semin  *                          Sysfs/debugfs-nodes IO-operations
868cfad6425SSerge Semin  *===========================================================================
869cfad6425SSerge Semin  */
870cfad6425SSerge Semin 
871cfad6425SSerge Semin /*
872cfad6425SSerge Semin  * eeprom_write() - EEPROM sysfs-node write callback
873cfad6425SSerge Semin  * @filep:	Pointer to the file system node
874cfad6425SSerge Semin  * @kobj:	Pointer to the kernel object related to the sysfs-node
875cfad6425SSerge Semin  * @attr:	Attributes of the file
876cfad6425SSerge Semin  * @buf:	Buffer to write data to
877cfad6425SSerge Semin  * @off:	Offset at which data should be written to
878cfad6425SSerge Semin  * @count:	Number of bytes to write
879cfad6425SSerge Semin  */
880cfad6425SSerge Semin static ssize_t eeprom_write(struct file *filp, struct kobject *kobj,
881cfad6425SSerge Semin 			    struct bin_attribute *attr,
882cfad6425SSerge Semin 			    char *buf, loff_t off, size_t count)
883cfad6425SSerge Semin {
884cfad6425SSerge Semin 	struct idt_89hpesx_dev *pdev;
885cfad6425SSerge Semin 	int ret;
886cfad6425SSerge Semin 
887cfad6425SSerge Semin 	/* Retrieve driver data */
888cfad6425SSerge Semin 	pdev = dev_get_drvdata(kobj_to_dev(kobj));
889cfad6425SSerge Semin 
890cfad6425SSerge Semin 	/* Perform EEPROM write operation */
891cfad6425SSerge Semin 	ret = idt_eeprom_write(pdev, (u16)off, (u16)count, (u8 *)buf);
892cfad6425SSerge Semin 	return (ret != 0 ? ret : count);
893cfad6425SSerge Semin }
894cfad6425SSerge Semin 
895cfad6425SSerge Semin /*
896cfad6425SSerge Semin  * eeprom_read() - EEPROM sysfs-node read callback
897cfad6425SSerge Semin  * @filep:	Pointer to the file system node
898cfad6425SSerge Semin  * @kobj:	Pointer to the kernel object related to the sysfs-node
899cfad6425SSerge Semin  * @attr:	Attributes of the file
900cfad6425SSerge Semin  * @buf:	Buffer to write data to
901cfad6425SSerge Semin  * @off:	Offset at which data should be written to
902cfad6425SSerge Semin  * @count:	Number of bytes to write
903cfad6425SSerge Semin  */
904cfad6425SSerge Semin static ssize_t eeprom_read(struct file *filp, struct kobject *kobj,
905cfad6425SSerge Semin 			   struct bin_attribute *attr,
906cfad6425SSerge Semin 			   char *buf, loff_t off, size_t count)
907cfad6425SSerge Semin {
908cfad6425SSerge Semin 	struct idt_89hpesx_dev *pdev;
909cfad6425SSerge Semin 	int ret;
910cfad6425SSerge Semin 
911cfad6425SSerge Semin 	/* Retrieve driver data */
912cfad6425SSerge Semin 	pdev = dev_get_drvdata(kobj_to_dev(kobj));
913cfad6425SSerge Semin 
914cfad6425SSerge Semin 	/* Perform EEPROM read operation */
915cfad6425SSerge Semin 	ret = idt_eeprom_read(pdev, (u16)off, (u16)count, (u8 *)buf);
916cfad6425SSerge Semin 	return (ret != 0 ? ret : count);
917cfad6425SSerge Semin }
918cfad6425SSerge Semin 
919cfad6425SSerge Semin /*
920cfad6425SSerge Semin  * idt_dbgfs_csr_write() - CSR debugfs-node write callback
921cfad6425SSerge Semin  * @filep:	Pointer to the file system file descriptor
922cfad6425SSerge Semin  * @buf:	Buffer to read data from
923cfad6425SSerge Semin  * @count:	Size of the buffer
924cfad6425SSerge Semin  * @offp:	Offset within the file
925cfad6425SSerge Semin  *
926cfad6425SSerge Semin  * It accepts either "0x<reg addr>:0x<value>" for saving register address
927cfad6425SSerge Semin  * and writing value to specified DWORD register or "0x<reg addr>" for
928cfad6425SSerge Semin  * just saving register address in order to perform next read operation.
929cfad6425SSerge Semin  *
930cfad6425SSerge Semin  * WARNING No spaces are allowed. Incoming string must be strictly formated as:
931cfad6425SSerge Semin  * "<reg addr>:<value>". Register address must be aligned within 4 bytes
932cfad6425SSerge Semin  * (one DWORD).
933cfad6425SSerge Semin  */
934cfad6425SSerge Semin static ssize_t idt_dbgfs_csr_write(struct file *filep, const char __user *ubuf,
935cfad6425SSerge Semin 				   size_t count, loff_t *offp)
936cfad6425SSerge Semin {
937cfad6425SSerge Semin 	struct idt_89hpesx_dev *pdev = filep->private_data;
938cfad6425SSerge Semin 	char *colon_ch, *csraddr_str, *csrval_str;
9392e08b1dbSColin Ian King 	int ret, csraddr_len;
940cfad6425SSerge Semin 	u32 csraddr, csrval;
941cfad6425SSerge Semin 	char *buf;
942cfad6425SSerge Semin 
943cfad6425SSerge Semin 	/* Copy data from User-space */
944cfad6425SSerge Semin 	buf = kmalloc(count + 1, GFP_KERNEL);
945cfad6425SSerge Semin 	if (!buf)
946cfad6425SSerge Semin 		return -ENOMEM;
947cfad6425SSerge Semin 
948cfad6425SSerge Semin 	ret = simple_write_to_buffer(buf, count, offp, ubuf, count);
949cfad6425SSerge Semin 	if (ret < 0)
950cfad6425SSerge Semin 		goto free_buf;
951cfad6425SSerge Semin 	buf[count] = 0;
952cfad6425SSerge Semin 
953cfad6425SSerge Semin 	/* Find position of colon in the buffer */
954cfad6425SSerge Semin 	colon_ch = strnchr(buf, count, ':');
955cfad6425SSerge Semin 
956cfad6425SSerge Semin 	/*
957cfad6425SSerge Semin 	 * If there is colon passed then new CSR value should be parsed as
958cfad6425SSerge Semin 	 * well, so allocate buffer for CSR address substring.
959cfad6425SSerge Semin 	 * If no colon is found, then string must have just one number with
960cfad6425SSerge Semin 	 * no new CSR value
961cfad6425SSerge Semin 	 */
962cfad6425SSerge Semin 	if (colon_ch != NULL) {
963cfad6425SSerge Semin 		csraddr_len = colon_ch - buf;
964cfad6425SSerge Semin 		csraddr_str =
9656da2ec56SKees Cook 			kmalloc(csraddr_len + 1, GFP_KERNEL);
966acf50ec7SColin Ian King 		if (csraddr_str == NULL) {
967acf50ec7SColin Ian King 			ret = -ENOMEM;
968acf50ec7SColin Ian King 			goto free_buf;
969acf50ec7SColin Ian King 		}
970cfad6425SSerge Semin 		/* Copy the register address to the substring buffer */
971cfad6425SSerge Semin 		strncpy(csraddr_str, buf, csraddr_len);
972cfad6425SSerge Semin 		csraddr_str[csraddr_len] = '\0';
973cfad6425SSerge Semin 		/* Register value must follow the colon */
974cfad6425SSerge Semin 		csrval_str = colon_ch + 1;
975cfad6425SSerge Semin 	} else /* if (str_colon == NULL) */ {
976cfad6425SSerge Semin 		csraddr_str = (char *)buf; /* Just to shut warning up */
977cfad6425SSerge Semin 		csraddr_len = strnlen(csraddr_str, count);
978cfad6425SSerge Semin 		csrval_str = NULL;
979cfad6425SSerge Semin 	}
980cfad6425SSerge Semin 
981cfad6425SSerge Semin 	/* Convert CSR address to u32 value */
982cfad6425SSerge Semin 	ret = kstrtou32(csraddr_str, 0, &csraddr);
983cfad6425SSerge Semin 	if (ret != 0)
984cfad6425SSerge Semin 		goto free_csraddr_str;
985cfad6425SSerge Semin 
986cfad6425SSerge Semin 	/* Check whether passed register address is valid */
987cfad6425SSerge Semin 	if (csraddr > CSR_MAX || !IS_ALIGNED(csraddr, SZ_4)) {
988cfad6425SSerge Semin 		ret = -EINVAL;
989cfad6425SSerge Semin 		goto free_csraddr_str;
990cfad6425SSerge Semin 	}
991cfad6425SSerge Semin 
992cfad6425SSerge Semin 	/* Shift register address to the right so to have u16 address */
993cfad6425SSerge Semin 	pdev->csr = (csraddr >> 2);
994cfad6425SSerge Semin 
995cfad6425SSerge Semin 	/* Parse new CSR value and send it to IDT, if colon has been found */
996cfad6425SSerge Semin 	if (colon_ch != NULL) {
997cfad6425SSerge Semin 		ret = kstrtou32(csrval_str, 0, &csrval);
998cfad6425SSerge Semin 		if (ret != 0)
999cfad6425SSerge Semin 			goto free_csraddr_str;
1000cfad6425SSerge Semin 
1001cfad6425SSerge Semin 		ret = idt_csr_write(pdev, pdev->csr, csrval);
1002cfad6425SSerge Semin 		if (ret != 0)
1003cfad6425SSerge Semin 			goto free_csraddr_str;
1004cfad6425SSerge Semin 	}
1005cfad6425SSerge Semin 
1006cfad6425SSerge Semin 	/* Free memory only if colon has been found */
1007cfad6425SSerge Semin free_csraddr_str:
1008cfad6425SSerge Semin 	if (colon_ch != NULL)
1009cfad6425SSerge Semin 		kfree(csraddr_str);
1010cfad6425SSerge Semin 
1011cfad6425SSerge Semin 	/* Free buffer allocated for data retrieved from User-space */
1012cfad6425SSerge Semin free_buf:
1013cfad6425SSerge Semin 	kfree(buf);
1014cfad6425SSerge Semin 
1015cfad6425SSerge Semin 	return (ret != 0 ? ret : count);
1016cfad6425SSerge Semin }
1017cfad6425SSerge Semin 
1018cfad6425SSerge Semin /*
1019cfad6425SSerge Semin  * idt_dbgfs_csr_read() - CSR debugfs-node read callback
1020cfad6425SSerge Semin  * @filep:	Pointer to the file system file descriptor
1021cfad6425SSerge Semin  * @buf:	Buffer to write data to
1022cfad6425SSerge Semin  * @count:	Size of the buffer
1023cfad6425SSerge Semin  * @offp:	Offset within the file
1024cfad6425SSerge Semin  *
1025cfad6425SSerge Semin  * It just prints the pair "0x<reg addr>:0x<value>" to passed buffer.
1026cfad6425SSerge Semin  */
1027cfad6425SSerge Semin #define CSRBUF_SIZE	((size_t)32)
1028cfad6425SSerge Semin static ssize_t idt_dbgfs_csr_read(struct file *filep, char __user *ubuf,
1029cfad6425SSerge Semin 				  size_t count, loff_t *offp)
1030cfad6425SSerge Semin {
1031cfad6425SSerge Semin 	struct idt_89hpesx_dev *pdev = filep->private_data;
1032cfad6425SSerge Semin 	u32 csraddr, csrval;
1033cfad6425SSerge Semin 	char buf[CSRBUF_SIZE];
1034cfad6425SSerge Semin 	int ret, size;
1035cfad6425SSerge Semin 
1036cfad6425SSerge Semin 	/* Perform CSR read operation */
1037cfad6425SSerge Semin 	ret = idt_csr_read(pdev, pdev->csr, &csrval);
1038cfad6425SSerge Semin 	if (ret != 0)
1039cfad6425SSerge Semin 		return ret;
1040cfad6425SSerge Semin 
1041cfad6425SSerge Semin 	/* Shift register address to the left so to have real address */
1042cfad6425SSerge Semin 	csraddr = ((u32)pdev->csr << 2);
1043cfad6425SSerge Semin 
1044cfad6425SSerge Semin 	/* Print the "0x<reg addr>:0x<value>" to buffer */
1045cfad6425SSerge Semin 	size = snprintf(buf, CSRBUF_SIZE, "0x%05x:0x%08x\n",
1046cfad6425SSerge Semin 		(unsigned int)csraddr, (unsigned int)csrval);
1047cfad6425SSerge Semin 
1048cfad6425SSerge Semin 	/* Copy data to User-space */
1049cfad6425SSerge Semin 	return simple_read_from_buffer(ubuf, count, offp, buf, size);
1050cfad6425SSerge Semin }
1051cfad6425SSerge Semin 
1052cfad6425SSerge Semin /*
1053cfad6425SSerge Semin  * eeprom_attribute - EEPROM sysfs-node attributes
1054cfad6425SSerge Semin  *
1055cfad6425SSerge Semin  * NOTE Size will be changed in compliance with OF node. EEPROM attribute will
1056cfad6425SSerge Semin  * be read-only as well if the corresponding flag is specified in OF node.
1057cfad6425SSerge Semin  */
1058cfad6425SSerge Semin static BIN_ATTR_RW(eeprom, EEPROM_DEF_SIZE);
1059cfad6425SSerge Semin 
1060cfad6425SSerge Semin /*
1061cfad6425SSerge Semin  * csr_dbgfs_ops - CSR debugfs-node read/write operations
1062cfad6425SSerge Semin  */
1063cfad6425SSerge Semin static const struct file_operations csr_dbgfs_ops = {
1064cfad6425SSerge Semin 	.owner = THIS_MODULE,
1065cfad6425SSerge Semin 	.open = simple_open,
1066cfad6425SSerge Semin 	.write = idt_dbgfs_csr_write,
1067cfad6425SSerge Semin 	.read = idt_dbgfs_csr_read
1068cfad6425SSerge Semin };
1069cfad6425SSerge Semin 
1070cfad6425SSerge Semin /*===========================================================================
1071cfad6425SSerge Semin  *                       Driver init/deinit methods
1072cfad6425SSerge Semin  *===========================================================================
1073cfad6425SSerge Semin  */
1074cfad6425SSerge Semin 
1075cfad6425SSerge Semin /*
1076cfad6425SSerge Semin  * idt_set_defval() - disable EEPROM access by default
1077cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
1078cfad6425SSerge Semin  */
1079cfad6425SSerge Semin static void idt_set_defval(struct idt_89hpesx_dev *pdev)
1080cfad6425SSerge Semin {
1081cfad6425SSerge Semin 	/* If OF info is missing then use next values */
1082cfad6425SSerge Semin 	pdev->eesize = 0;
1083cfad6425SSerge Semin 	pdev->eero = true;
1084cfad6425SSerge Semin 	pdev->inieecmd = 0;
1085cfad6425SSerge Semin 	pdev->eeaddr = 0;
1086cfad6425SSerge Semin }
1087cfad6425SSerge Semin 
1088cfad6425SSerge Semin static const struct i2c_device_id ee_ids[];
1089db15d73eSHuy Duong 
1090cfad6425SSerge Semin /*
1091cfad6425SSerge Semin  * idt_ee_match_id() - check whether the node belongs to compatible EEPROMs
1092cfad6425SSerge Semin  */
1093db15d73eSHuy Duong static const struct i2c_device_id *idt_ee_match_id(struct fwnode_handle *fwnode)
1094cfad6425SSerge Semin {
1095cfad6425SSerge Semin 	const struct i2c_device_id *id = ee_ids;
1096db15d73eSHuy Duong 	const char *compatible, *p;
1097cfad6425SSerge Semin 	char devname[I2C_NAME_SIZE];
1098db15d73eSHuy Duong 	int ret;
1099cfad6425SSerge Semin 
1100db15d73eSHuy Duong 	ret = fwnode_property_read_string(fwnode, "compatible", &compatible);
1101db15d73eSHuy Duong 	if (ret)
1102cfad6425SSerge Semin 		return NULL;
1103cfad6425SSerge Semin 
1104db15d73eSHuy Duong 	p = strchr(compatible, ',');
1105db15d73eSHuy Duong 	strlcpy(devname, p ? p + 1 : compatible, sizeof(devname));
1106cfad6425SSerge Semin 	/* Search through the device name */
1107cfad6425SSerge Semin 	while (id->name[0]) {
1108cfad6425SSerge Semin 		if (strcmp(devname, id->name) == 0)
1109cfad6425SSerge Semin 			return id;
1110cfad6425SSerge Semin 		id++;
1111cfad6425SSerge Semin 	}
1112cfad6425SSerge Semin 	return NULL;
1113cfad6425SSerge Semin }
1114cfad6425SSerge Semin 
1115cfad6425SSerge Semin /*
1116db15d73eSHuy Duong  * idt_get_fw_data() - get IDT i2c-device parameters from device tree
1117cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
1118cfad6425SSerge Semin  */
1119db15d73eSHuy Duong static void idt_get_fw_data(struct idt_89hpesx_dev *pdev)
1120cfad6425SSerge Semin {
1121cfad6425SSerge Semin 	struct device *dev = &pdev->client->dev;
1122db15d73eSHuy Duong 	struct fwnode_handle *fwnode;
1123cfad6425SSerge Semin 	const struct i2c_device_id *ee_id = NULL;
1124db15d73eSHuy Duong 	u32 eeprom_addr;
1125db15d73eSHuy Duong 	int ret;
1126cfad6425SSerge Semin 
1127db15d73eSHuy Duong 	device_for_each_child_node(dev, fwnode) {
1128db15d73eSHuy Duong 		ee_id = idt_ee_match_id(fwnode);
1129c01513b4SDan Carpenter 		if (!ee_id) {
1130db15d73eSHuy Duong 			dev_warn(dev, "Skip unsupported EEPROM device");
1131cfad6425SSerge Semin 			continue;
1132cfad6425SSerge Semin 		} else
1133cfad6425SSerge Semin 			break;
1134cfad6425SSerge Semin 	}
1135cfad6425SSerge Semin 
1136db15d73eSHuy Duong 	/* If there is no fwnode EEPROM device, then set zero size */
1137cfad6425SSerge Semin 	if (!ee_id) {
1138db15d73eSHuy Duong 		dev_warn(dev, "No fwnode, EEPROM access disabled");
1139cfad6425SSerge Semin 		idt_set_defval(pdev);
1140cfad6425SSerge Semin 		return;
1141cfad6425SSerge Semin 	}
1142cfad6425SSerge Semin 
1143cfad6425SSerge Semin 	/* Retrieve EEPROM size */
1144cfad6425SSerge Semin 	pdev->eesize = (u32)ee_id->driver_data;
1145cfad6425SSerge Semin 
1146cfad6425SSerge Semin 	/* Get custom EEPROM address from 'reg' attribute */
1147db15d73eSHuy Duong 	ret = fwnode_property_read_u32(fwnode, "reg", &eeprom_addr);
1148db15d73eSHuy Duong 	if (ret || (eeprom_addr == 0)) {
1149db15d73eSHuy Duong 		dev_warn(dev, "No EEPROM reg found, use default address 0x%x",
1150db15d73eSHuy Duong 			 EEPROM_DEF_ADDR);
1151cfad6425SSerge Semin 		pdev->inieecmd = 0;
1152cfad6425SSerge Semin 		pdev->eeaddr = EEPROM_DEF_ADDR << 1;
1153cfad6425SSerge Semin 	} else {
1154cfad6425SSerge Semin 		pdev->inieecmd = EEPROM_USA;
1155db15d73eSHuy Duong 		pdev->eeaddr = eeprom_addr << 1;
1156cfad6425SSerge Semin 	}
1157cfad6425SSerge Semin 
1158cfad6425SSerge Semin 	/* Check EEPROM 'read-only' flag */
1159db15d73eSHuy Duong 	if (fwnode_property_read_bool(fwnode, "read-only"))
1160cfad6425SSerge Semin 		pdev->eero = true;
1161db15d73eSHuy Duong 	else /* if (!fwnode_property_read_bool(node, "read-only")) */
1162cfad6425SSerge Semin 		pdev->eero = false;
1163cfad6425SSerge Semin 
1164*3f6ee1c0SAndy Shevchenko 	fwnode_handle_put(fwnode);
1165db15d73eSHuy Duong 	dev_info(dev, "EEPROM of %d bytes found by 0x%x",
1166cfad6425SSerge Semin 		pdev->eesize, pdev->eeaddr);
1167cfad6425SSerge Semin }
1168cfad6425SSerge Semin 
1169cfad6425SSerge Semin /*
1170cfad6425SSerge Semin  * idt_create_pdev() - create and init data structure of the driver
1171cfad6425SSerge Semin  * @client:	i2c client of IDT PCIe-switch device
1172cfad6425SSerge Semin  */
1173cfad6425SSerge Semin static struct idt_89hpesx_dev *idt_create_pdev(struct i2c_client *client)
1174cfad6425SSerge Semin {
1175cfad6425SSerge Semin 	struct idt_89hpesx_dev *pdev;
1176cfad6425SSerge Semin 
1177cfad6425SSerge Semin 	/* Allocate memory for driver data */
1178cfad6425SSerge Semin 	pdev = devm_kmalloc(&client->dev, sizeof(struct idt_89hpesx_dev),
1179cfad6425SSerge Semin 		GFP_KERNEL);
1180cfad6425SSerge Semin 	if (pdev == NULL)
1181cfad6425SSerge Semin 		return ERR_PTR(-ENOMEM);
1182cfad6425SSerge Semin 
1183cfad6425SSerge Semin 	/* Initialize basic fields of the data */
1184cfad6425SSerge Semin 	pdev->client = client;
1185cfad6425SSerge Semin 	i2c_set_clientdata(client, pdev);
1186cfad6425SSerge Semin 
1187db15d73eSHuy Duong 	/* Read firmware nodes information */
1188db15d73eSHuy Duong 	idt_get_fw_data(pdev);
1189cfad6425SSerge Semin 
1190cfad6425SSerge Semin 	/* Initialize basic CSR CMD field - use full DWORD-sized r/w ops */
1191cfad6425SSerge Semin 	pdev->inicsrcmd = CSR_DWE;
1192cfad6425SSerge Semin 	pdev->csr = CSR_DEF;
1193cfad6425SSerge Semin 
1194cfad6425SSerge Semin 	/* Enable Packet Error Checking if it's supported by adapter */
1195cfad6425SSerge Semin 	if (i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_PEC)) {
1196cfad6425SSerge Semin 		pdev->iniccode = CCODE_PEC;
1197cfad6425SSerge Semin 		client->flags |= I2C_CLIENT_PEC;
1198cfad6425SSerge Semin 	} else /* PEC is unsupported */ {
1199cfad6425SSerge Semin 		pdev->iniccode = 0;
1200cfad6425SSerge Semin 	}
1201cfad6425SSerge Semin 
1202cfad6425SSerge Semin 	return pdev;
1203cfad6425SSerge Semin }
1204cfad6425SSerge Semin 
1205cfad6425SSerge Semin /*
1206cfad6425SSerge Semin  * idt_free_pdev() - free data structure of the driver
1207cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
1208cfad6425SSerge Semin  */
1209cfad6425SSerge Semin static void idt_free_pdev(struct idt_89hpesx_dev *pdev)
1210cfad6425SSerge Semin {
1211cfad6425SSerge Semin 	/* Clear driver data from device private field */
1212cfad6425SSerge Semin 	i2c_set_clientdata(pdev->client, NULL);
1213cfad6425SSerge Semin }
1214cfad6425SSerge Semin 
1215cfad6425SSerge Semin /*
1216cfad6425SSerge Semin  * idt_set_smbus_ops() - set supported SMBus operations
1217cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
1218cfad6425SSerge Semin  * Return status of smbus check operations
1219cfad6425SSerge Semin  */
1220cfad6425SSerge Semin static int idt_set_smbus_ops(struct idt_89hpesx_dev *pdev)
1221cfad6425SSerge Semin {
1222cfad6425SSerge Semin 	struct i2c_adapter *adapter = pdev->client->adapter;
1223cfad6425SSerge Semin 	struct device *dev = &pdev->client->dev;
1224cfad6425SSerge Semin 
1225cfad6425SSerge Semin 	/* Check i2c adapter read functionality */
1226cfad6425SSerge Semin 	if (i2c_check_functionality(adapter,
1227cfad6425SSerge Semin 				    I2C_FUNC_SMBUS_READ_BLOCK_DATA)) {
1228cfad6425SSerge Semin 		pdev->smb_read = idt_smb_read_block;
1229cfad6425SSerge Semin 		dev_dbg(dev, "SMBus block-read op chosen");
1230cfad6425SSerge Semin 	} else if (i2c_check_functionality(adapter,
1231cfad6425SSerge Semin 					   I2C_FUNC_SMBUS_READ_I2C_BLOCK)) {
1232cfad6425SSerge Semin 		pdev->smb_read = idt_smb_read_i2c_block;
1233cfad6425SSerge Semin 		dev_dbg(dev, "SMBus i2c-block-read op chosen");
1234cfad6425SSerge Semin 	} else if (i2c_check_functionality(adapter,
1235cfad6425SSerge Semin 					   I2C_FUNC_SMBUS_READ_WORD_DATA) &&
1236cfad6425SSerge Semin 		   i2c_check_functionality(adapter,
1237cfad6425SSerge Semin 					   I2C_FUNC_SMBUS_READ_BYTE_DATA)) {
1238cfad6425SSerge Semin 		pdev->smb_read = idt_smb_read_word;
1239cfad6425SSerge Semin 		dev_warn(dev, "Use slow word/byte SMBus read ops");
1240cfad6425SSerge Semin 	} else if (i2c_check_functionality(adapter,
1241cfad6425SSerge Semin 					   I2C_FUNC_SMBUS_READ_BYTE_DATA)) {
1242cfad6425SSerge Semin 		pdev->smb_read = idt_smb_read_byte;
1243cfad6425SSerge Semin 		dev_warn(dev, "Use slow byte SMBus read op");
1244cfad6425SSerge Semin 	} else /* no supported smbus read operations */ {
1245cfad6425SSerge Semin 		dev_err(dev, "No supported SMBus read op");
1246cfad6425SSerge Semin 		return -EPFNOSUPPORT;
1247cfad6425SSerge Semin 	}
1248cfad6425SSerge Semin 
1249cfad6425SSerge Semin 	/* Check i2c adapter write functionality */
1250cfad6425SSerge Semin 	if (i2c_check_functionality(adapter,
1251cfad6425SSerge Semin 				    I2C_FUNC_SMBUS_WRITE_BLOCK_DATA)) {
1252cfad6425SSerge Semin 		pdev->smb_write = idt_smb_write_block;
1253cfad6425SSerge Semin 		dev_dbg(dev, "SMBus block-write op chosen");
1254cfad6425SSerge Semin 	} else if (i2c_check_functionality(adapter,
1255cfad6425SSerge Semin 					   I2C_FUNC_SMBUS_WRITE_I2C_BLOCK)) {
1256cfad6425SSerge Semin 		pdev->smb_write = idt_smb_write_i2c_block;
1257cfad6425SSerge Semin 		dev_dbg(dev, "SMBus i2c-block-write op chosen");
1258cfad6425SSerge Semin 	} else if (i2c_check_functionality(adapter,
1259cfad6425SSerge Semin 					   I2C_FUNC_SMBUS_WRITE_WORD_DATA) &&
1260cfad6425SSerge Semin 		   i2c_check_functionality(adapter,
1261cfad6425SSerge Semin 					   I2C_FUNC_SMBUS_WRITE_BYTE_DATA)) {
1262cfad6425SSerge Semin 		pdev->smb_write = idt_smb_write_word;
1263cfad6425SSerge Semin 		dev_warn(dev, "Use slow word/byte SMBus write op");
1264cfad6425SSerge Semin 	} else if (i2c_check_functionality(adapter,
1265cfad6425SSerge Semin 					   I2C_FUNC_SMBUS_WRITE_BYTE_DATA)) {
1266cfad6425SSerge Semin 		pdev->smb_write = idt_smb_write_byte;
1267cfad6425SSerge Semin 		dev_warn(dev, "Use slow byte SMBus write op");
1268cfad6425SSerge Semin 	} else /* no supported smbus write operations */ {
1269cfad6425SSerge Semin 		dev_err(dev, "No supported SMBus write op");
1270cfad6425SSerge Semin 		return -EPFNOSUPPORT;
1271cfad6425SSerge Semin 	}
1272cfad6425SSerge Semin 
1273cfad6425SSerge Semin 	/* Initialize IDT SMBus slave interface mutex */
1274cfad6425SSerge Semin 	mutex_init(&pdev->smb_mtx);
1275cfad6425SSerge Semin 
1276cfad6425SSerge Semin 	return 0;
1277cfad6425SSerge Semin }
1278cfad6425SSerge Semin 
1279cfad6425SSerge Semin /*
1280cfad6425SSerge Semin  * idt_check_dev() - check whether it's really IDT 89HPESx device
1281cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
1282cfad6425SSerge Semin  * Return status of i2c adapter check operation
1283cfad6425SSerge Semin  */
1284cfad6425SSerge Semin static int idt_check_dev(struct idt_89hpesx_dev *pdev)
1285cfad6425SSerge Semin {
1286cfad6425SSerge Semin 	struct device *dev = &pdev->client->dev;
1287cfad6425SSerge Semin 	u32 viddid;
1288cfad6425SSerge Semin 	int ret;
1289cfad6425SSerge Semin 
1290cfad6425SSerge Semin 	/* Read VID and DID directly from IDT memory space */
1291cfad6425SSerge Semin 	ret = idt_csr_read(pdev, IDT_VIDDID_CSR, &viddid);
1292cfad6425SSerge Semin 	if (ret != 0) {
1293cfad6425SSerge Semin 		dev_err(dev, "Failed to read VID/DID");
1294cfad6425SSerge Semin 		return ret;
1295cfad6425SSerge Semin 	}
1296cfad6425SSerge Semin 
1297cfad6425SSerge Semin 	/* Check whether it's IDT device */
1298cfad6425SSerge Semin 	if ((viddid & IDT_VID_MASK) != PCI_VENDOR_ID_IDT) {
1299cfad6425SSerge Semin 		dev_err(dev, "Got unsupported VID/DID: 0x%08x", viddid);
1300cfad6425SSerge Semin 		return -ENODEV;
1301cfad6425SSerge Semin 	}
1302cfad6425SSerge Semin 
1303cfad6425SSerge Semin 	dev_info(dev, "Found IDT 89HPES device VID:0x%04x, DID:0x%04x",
1304cfad6425SSerge Semin 		(viddid & IDT_VID_MASK), (viddid >> 16));
1305cfad6425SSerge Semin 
1306cfad6425SSerge Semin 	return 0;
1307cfad6425SSerge Semin }
1308cfad6425SSerge Semin 
1309cfad6425SSerge Semin /*
1310cfad6425SSerge Semin  * idt_create_sysfs_files() - create sysfs attribute files
1311cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
1312cfad6425SSerge Semin  * Return status of operation
1313cfad6425SSerge Semin  */
1314cfad6425SSerge Semin static int idt_create_sysfs_files(struct idt_89hpesx_dev *pdev)
1315cfad6425SSerge Semin {
1316cfad6425SSerge Semin 	struct device *dev = &pdev->client->dev;
1317cfad6425SSerge Semin 	int ret;
1318cfad6425SSerge Semin 
1319cfad6425SSerge Semin 	/* Don't do anything if EEPROM isn't accessible */
1320cfad6425SSerge Semin 	if (pdev->eesize == 0) {
1321cfad6425SSerge Semin 		dev_dbg(dev, "Skip creating sysfs-files");
1322cfad6425SSerge Semin 		return 0;
1323cfad6425SSerge Semin 	}
1324cfad6425SSerge Semin 
1325cfad6425SSerge Semin 	/* Allocate memory for attribute file */
1326cfad6425SSerge Semin 	pdev->ee_file = devm_kmalloc(dev, sizeof(*pdev->ee_file), GFP_KERNEL);
1327cfad6425SSerge Semin 	if (!pdev->ee_file)
1328cfad6425SSerge Semin 		return -ENOMEM;
1329cfad6425SSerge Semin 
1330cfad6425SSerge Semin 	/* Copy the declared EEPROM attr structure to change some of fields */
1331cfad6425SSerge Semin 	memcpy(pdev->ee_file, &bin_attr_eeprom, sizeof(*pdev->ee_file));
1332cfad6425SSerge Semin 
1333cfad6425SSerge Semin 	/* In case of read-only EEPROM get rid of write ability */
1334cfad6425SSerge Semin 	if (pdev->eero) {
1335cfad6425SSerge Semin 		pdev->ee_file->attr.mode &= ~0200;
1336cfad6425SSerge Semin 		pdev->ee_file->write = NULL;
1337cfad6425SSerge Semin 	}
1338cfad6425SSerge Semin 	/* Create EEPROM sysfs file */
1339cfad6425SSerge Semin 	pdev->ee_file->size = pdev->eesize;
1340cfad6425SSerge Semin 	ret = sysfs_create_bin_file(&dev->kobj, pdev->ee_file);
1341cfad6425SSerge Semin 	if (ret != 0) {
1342cfad6425SSerge Semin 		dev_err(dev, "Failed to create EEPROM sysfs-node");
1343cfad6425SSerge Semin 		return ret;
1344cfad6425SSerge Semin 	}
1345cfad6425SSerge Semin 
1346cfad6425SSerge Semin 	return 0;
1347cfad6425SSerge Semin }
1348cfad6425SSerge Semin 
1349cfad6425SSerge Semin /*
1350cfad6425SSerge Semin  * idt_remove_sysfs_files() - remove sysfs attribute files
1351cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
1352cfad6425SSerge Semin  */
1353cfad6425SSerge Semin static void idt_remove_sysfs_files(struct idt_89hpesx_dev *pdev)
1354cfad6425SSerge Semin {
1355cfad6425SSerge Semin 	struct device *dev = &pdev->client->dev;
1356cfad6425SSerge Semin 
1357cfad6425SSerge Semin 	/* Don't do anything if EEPROM wasn't accessible */
1358cfad6425SSerge Semin 	if (pdev->eesize == 0)
1359cfad6425SSerge Semin 		return;
1360cfad6425SSerge Semin 
1361cfad6425SSerge Semin 	/* Remove EEPROM sysfs file */
1362cfad6425SSerge Semin 	sysfs_remove_bin_file(&dev->kobj, pdev->ee_file);
1363cfad6425SSerge Semin }
1364cfad6425SSerge Semin 
1365cfad6425SSerge Semin /*
1366cfad6425SSerge Semin  * idt_create_dbgfs_files() - create debugfs files
1367cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
1368cfad6425SSerge Semin  */
1369cfad6425SSerge Semin #define CSRNAME_LEN	((size_t)32)
1370cfad6425SSerge Semin static void idt_create_dbgfs_files(struct idt_89hpesx_dev *pdev)
1371cfad6425SSerge Semin {
1372cfad6425SSerge Semin 	struct i2c_client *cli = pdev->client;
1373cfad6425SSerge Semin 	char fname[CSRNAME_LEN];
1374cfad6425SSerge Semin 
1375cfad6425SSerge Semin 	/* Create Debugfs directory for CSR file */
1376cfad6425SSerge Semin 	snprintf(fname, CSRNAME_LEN, "%d-%04hx", cli->adapter->nr, cli->addr);
1377cfad6425SSerge Semin 	pdev->csr_dir = debugfs_create_dir(fname, csr_dbgdir);
1378cfad6425SSerge Semin 
1379cfad6425SSerge Semin 	/* Create Debugfs file for CSR read/write operations */
1380f506a547SGreg Kroah-Hartman 	debugfs_create_file(cli->name, 0600, pdev->csr_dir, pdev,
1381f506a547SGreg Kroah-Hartman 			    &csr_dbgfs_ops);
1382cfad6425SSerge Semin }
1383cfad6425SSerge Semin 
1384cfad6425SSerge Semin /*
1385cfad6425SSerge Semin  * idt_remove_dbgfs_files() - remove debugfs files
1386cfad6425SSerge Semin  * @pdev:	Pointer to the driver data
1387cfad6425SSerge Semin  */
1388cfad6425SSerge Semin static void idt_remove_dbgfs_files(struct idt_89hpesx_dev *pdev)
1389cfad6425SSerge Semin {
1390cfad6425SSerge Semin 	/* Remove CSR directory and it sysfs-node */
1391cfad6425SSerge Semin 	debugfs_remove_recursive(pdev->csr_dir);
1392cfad6425SSerge Semin }
1393cfad6425SSerge Semin 
1394cfad6425SSerge Semin /*
1395cfad6425SSerge Semin  * idt_probe() - IDT 89HPESx driver probe() callback method
1396cfad6425SSerge Semin  */
1397cfad6425SSerge Semin static int idt_probe(struct i2c_client *client, const struct i2c_device_id *id)
1398cfad6425SSerge Semin {
1399cfad6425SSerge Semin 	struct idt_89hpesx_dev *pdev;
1400cfad6425SSerge Semin 	int ret;
1401cfad6425SSerge Semin 
1402cfad6425SSerge Semin 	/* Create driver data */
1403cfad6425SSerge Semin 	pdev = idt_create_pdev(client);
1404cfad6425SSerge Semin 	if (IS_ERR(pdev))
1405cfad6425SSerge Semin 		return PTR_ERR(pdev);
1406cfad6425SSerge Semin 
1407cfad6425SSerge Semin 	/* Set SMBus operations */
1408cfad6425SSerge Semin 	ret = idt_set_smbus_ops(pdev);
1409cfad6425SSerge Semin 	if (ret != 0)
1410cfad6425SSerge Semin 		goto err_free_pdev;
1411cfad6425SSerge Semin 
1412cfad6425SSerge Semin 	/* Check whether it is truly IDT 89HPESx device */
1413cfad6425SSerge Semin 	ret = idt_check_dev(pdev);
1414cfad6425SSerge Semin 	if (ret != 0)
1415cfad6425SSerge Semin 		goto err_free_pdev;
1416cfad6425SSerge Semin 
1417cfad6425SSerge Semin 	/* Create sysfs files */
1418cfad6425SSerge Semin 	ret = idt_create_sysfs_files(pdev);
1419cfad6425SSerge Semin 	if (ret != 0)
1420cfad6425SSerge Semin 		goto err_free_pdev;
1421cfad6425SSerge Semin 
1422cfad6425SSerge Semin 	/* Create debugfs files */
1423cfad6425SSerge Semin 	idt_create_dbgfs_files(pdev);
1424cfad6425SSerge Semin 
1425cfad6425SSerge Semin 	return 0;
1426cfad6425SSerge Semin 
1427cfad6425SSerge Semin err_free_pdev:
1428cfad6425SSerge Semin 	idt_free_pdev(pdev);
1429cfad6425SSerge Semin 
1430cfad6425SSerge Semin 	return ret;
1431cfad6425SSerge Semin }
1432cfad6425SSerge Semin 
1433cfad6425SSerge Semin /*
1434cfad6425SSerge Semin  * idt_remove() - IDT 89HPESx driver remove() callback method
1435cfad6425SSerge Semin  */
1436cfad6425SSerge Semin static int idt_remove(struct i2c_client *client)
1437cfad6425SSerge Semin {
1438cfad6425SSerge Semin 	struct idt_89hpesx_dev *pdev = i2c_get_clientdata(client);
1439cfad6425SSerge Semin 
1440cfad6425SSerge Semin 	/* Remove debugfs files first */
1441cfad6425SSerge Semin 	idt_remove_dbgfs_files(pdev);
1442cfad6425SSerge Semin 
1443cfad6425SSerge Semin 	/* Remove sysfs files */
1444cfad6425SSerge Semin 	idt_remove_sysfs_files(pdev);
1445cfad6425SSerge Semin 
1446cfad6425SSerge Semin 	/* Discard driver data structure */
1447cfad6425SSerge Semin 	idt_free_pdev(pdev);
1448cfad6425SSerge Semin 
1449cfad6425SSerge Semin 	return 0;
1450cfad6425SSerge Semin }
1451cfad6425SSerge Semin 
1452cfad6425SSerge Semin /*
1453cfad6425SSerge Semin  * ee_ids - array of supported EEPROMs
1454cfad6425SSerge Semin  */
1455cfad6425SSerge Semin static const struct i2c_device_id ee_ids[] = {
1456cfad6425SSerge Semin 	{ "24c32",  4096},
1457cfad6425SSerge Semin 	{ "24c64",  8192},
1458cfad6425SSerge Semin 	{ "24c128", 16384},
1459cfad6425SSerge Semin 	{ "24c256", 32768},
1460cfad6425SSerge Semin 	{ "24c512", 65536},
1461cfad6425SSerge Semin 	{}
1462cfad6425SSerge Semin };
1463cfad6425SSerge Semin MODULE_DEVICE_TABLE(i2c, ee_ids);
1464cfad6425SSerge Semin 
1465cfad6425SSerge Semin /*
1466cfad6425SSerge Semin  * idt_ids - supported IDT 89HPESx devices
1467cfad6425SSerge Semin  */
1468cfad6425SSerge Semin static const struct i2c_device_id idt_ids[] = {
1469cfad6425SSerge Semin 	{ "89hpes8nt2", 0 },
1470cfad6425SSerge Semin 	{ "89hpes12nt3", 0 },
1471cfad6425SSerge Semin 
1472cfad6425SSerge Semin 	{ "89hpes24nt6ag2", 0 },
1473cfad6425SSerge Semin 	{ "89hpes32nt8ag2", 0 },
1474cfad6425SSerge Semin 	{ "89hpes32nt8bg2", 0 },
1475cfad6425SSerge Semin 	{ "89hpes12nt12g2", 0 },
1476cfad6425SSerge Semin 	{ "89hpes16nt16g2", 0 },
1477cfad6425SSerge Semin 	{ "89hpes24nt24g2", 0 },
1478cfad6425SSerge Semin 	{ "89hpes32nt24ag2", 0 },
1479cfad6425SSerge Semin 	{ "89hpes32nt24bg2", 0 },
1480cfad6425SSerge Semin 
1481cfad6425SSerge Semin 	{ "89hpes12n3", 0 },
1482cfad6425SSerge Semin 	{ "89hpes12n3a", 0 },
1483cfad6425SSerge Semin 	{ "89hpes24n3", 0 },
1484cfad6425SSerge Semin 	{ "89hpes24n3a", 0 },
1485cfad6425SSerge Semin 
1486cfad6425SSerge Semin 	{ "89hpes32h8", 0 },
1487cfad6425SSerge Semin 	{ "89hpes32h8g2", 0 },
1488cfad6425SSerge Semin 	{ "89hpes48h12", 0 },
1489cfad6425SSerge Semin 	{ "89hpes48h12g2", 0 },
1490cfad6425SSerge Semin 	{ "89hpes48h12ag2", 0 },
1491cfad6425SSerge Semin 	{ "89hpes16h16", 0 },
1492cfad6425SSerge Semin 	{ "89hpes22h16", 0 },
1493cfad6425SSerge Semin 	{ "89hpes22h16g2", 0 },
1494cfad6425SSerge Semin 	{ "89hpes34h16", 0 },
1495cfad6425SSerge Semin 	{ "89hpes34h16g2", 0 },
1496cfad6425SSerge Semin 	{ "89hpes64h16", 0 },
1497cfad6425SSerge Semin 	{ "89hpes64h16g2", 0 },
1498cfad6425SSerge Semin 	{ "89hpes64h16ag2", 0 },
1499cfad6425SSerge Semin 
1500cfad6425SSerge Semin 	/* { "89hpes3t3", 0 }, // No SMBus-slave iface */
1501cfad6425SSerge Semin 	{ "89hpes12t3g2", 0 },
1502cfad6425SSerge Semin 	{ "89hpes24t3g2", 0 },
1503cfad6425SSerge Semin 	/* { "89hpes4t4", 0 }, // No SMBus-slave iface */
1504cfad6425SSerge Semin 	{ "89hpes16t4", 0 },
1505cfad6425SSerge Semin 	{ "89hpes4t4g2", 0 },
1506cfad6425SSerge Semin 	{ "89hpes10t4g2", 0 },
1507cfad6425SSerge Semin 	{ "89hpes16t4g2", 0 },
1508cfad6425SSerge Semin 	{ "89hpes16t4ag2", 0 },
1509cfad6425SSerge Semin 	{ "89hpes5t5", 0 },
1510cfad6425SSerge Semin 	{ "89hpes6t5", 0 },
1511cfad6425SSerge Semin 	{ "89hpes8t5", 0 },
1512cfad6425SSerge Semin 	{ "89hpes8t5a", 0 },
1513cfad6425SSerge Semin 	{ "89hpes24t6", 0 },
1514cfad6425SSerge Semin 	{ "89hpes6t6g2", 0 },
1515cfad6425SSerge Semin 	{ "89hpes24t6g2", 0 },
1516cfad6425SSerge Semin 	{ "89hpes16t7", 0 },
1517cfad6425SSerge Semin 	{ "89hpes32t8", 0 },
1518cfad6425SSerge Semin 	{ "89hpes32t8g2", 0 },
1519cfad6425SSerge Semin 	{ "89hpes48t12", 0 },
1520cfad6425SSerge Semin 	{ "89hpes48t12g2", 0 },
1521cfad6425SSerge Semin 	{ /* END OF LIST */ }
1522cfad6425SSerge Semin };
1523cfad6425SSerge Semin MODULE_DEVICE_TABLE(i2c, idt_ids);
1524cfad6425SSerge Semin 
1525615cdd7cSJavier Martinez Canillas static const struct of_device_id idt_of_match[] = {
1526615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes8nt2", },
1527615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes12nt3", },
1528615cdd7cSJavier Martinez Canillas 
1529615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes24nt6ag2", },
1530615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes32nt8ag2", },
1531615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes32nt8bg2", },
1532615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes12nt12g2", },
1533615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes16nt16g2", },
1534615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes24nt24g2", },
1535615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes32nt24ag2", },
1536615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes32nt24bg2", },
1537615cdd7cSJavier Martinez Canillas 
1538615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes12n3", },
1539615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes12n3a", },
1540615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes24n3", },
1541615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes24n3a", },
1542615cdd7cSJavier Martinez Canillas 
1543615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes32h8", },
1544615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes32h8g2", },
1545615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes48h12", },
1546615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes48h12g2", },
1547615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes48h12ag2", },
1548615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes16h16", },
1549615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes22h16", },
1550615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes22h16g2", },
1551615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes34h16", },
1552615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes34h16g2", },
1553615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes64h16", },
1554615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes64h16g2", },
1555615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes64h16ag2", },
1556615cdd7cSJavier Martinez Canillas 
1557615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes12t3g2", },
1558615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes24t3g2", },
1559615cdd7cSJavier Martinez Canillas 
1560615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes16t4", },
1561615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes4t4g2", },
1562615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes10t4g2", },
1563615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes16t4g2", },
1564615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes16t4ag2", },
1565615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes5t5", },
1566615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes6t5", },
1567615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes8t5", },
1568615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes8t5a", },
1569615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes24t6", },
1570615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes6t6g2", },
1571615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes24t6g2", },
1572615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes16t7", },
1573615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes32t8", },
1574615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes32t8g2", },
1575615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes48t12", },
1576615cdd7cSJavier Martinez Canillas 	{ .compatible = "idt,89hpes48t12g2", },
1577615cdd7cSJavier Martinez Canillas 	{ },
1578615cdd7cSJavier Martinez Canillas };
1579615cdd7cSJavier Martinez Canillas MODULE_DEVICE_TABLE(of, idt_of_match);
1580615cdd7cSJavier Martinez Canillas 
1581cfad6425SSerge Semin /*
1582cfad6425SSerge Semin  * idt_driver - IDT 89HPESx driver structure
1583cfad6425SSerge Semin  */
1584cfad6425SSerge Semin static struct i2c_driver idt_driver = {
1585cfad6425SSerge Semin 	.driver = {
1586cfad6425SSerge Semin 		.name = IDT_NAME,
1587615cdd7cSJavier Martinez Canillas 		.of_match_table = idt_of_match,
1588cfad6425SSerge Semin 	},
1589cfad6425SSerge Semin 	.probe = idt_probe,
1590cfad6425SSerge Semin 	.remove = idt_remove,
1591cfad6425SSerge Semin 	.id_table = idt_ids,
1592cfad6425SSerge Semin };
1593cfad6425SSerge Semin 
1594cfad6425SSerge Semin /*
1595cfad6425SSerge Semin  * idt_init() - IDT 89HPESx driver init() callback method
1596cfad6425SSerge Semin  */
1597cfad6425SSerge Semin static int __init idt_init(void)
1598cfad6425SSerge Semin {
1599cfad6425SSerge Semin 	/* Create Debugfs directory first */
1600cfad6425SSerge Semin 	if (debugfs_initialized())
1601cfad6425SSerge Semin 		csr_dbgdir = debugfs_create_dir("idt_csr", NULL);
1602cfad6425SSerge Semin 
1603cfad6425SSerge Semin 	/* Add new i2c-device driver */
1604cfad6425SSerge Semin 	return i2c_add_driver(&idt_driver);
1605cfad6425SSerge Semin }
1606cfad6425SSerge Semin module_init(idt_init);
1607cfad6425SSerge Semin 
1608cfad6425SSerge Semin /*
1609cfad6425SSerge Semin  * idt_exit() - IDT 89HPESx driver exit() callback method
1610cfad6425SSerge Semin  */
1611cfad6425SSerge Semin static void __exit idt_exit(void)
1612cfad6425SSerge Semin {
1613cfad6425SSerge Semin 	/* Discard debugfs directory and all files if any */
1614cfad6425SSerge Semin 	debugfs_remove_recursive(csr_dbgdir);
1615cfad6425SSerge Semin 
1616cfad6425SSerge Semin 	/* Unregister i2c-device driver */
1617cfad6425SSerge Semin 	i2c_del_driver(&idt_driver);
1618cfad6425SSerge Semin }
1619cfad6425SSerge Semin module_exit(idt_exit);
1620