xref: /rk3399_rockchip-uboot/drivers/i2c/mxc_i2c.c (revision a1c662965dcdc6f0986691db2ddfcbc963e82194)
1cdace066SSascha Hauer /*
2db84140bSMarek Vasut  * i2c driver for Freescale i.MX series
3cdace066SSascha Hauer  *
4cdace066SSascha Hauer  * (c) 2007 Pengutronix, Sascha Hauer <s.hauer@pengutronix.de>
5db84140bSMarek Vasut  * (c) 2011 Marek Vasut <marek.vasut@gmail.com>
6db84140bSMarek Vasut  *
7db84140bSMarek Vasut  * Based on i2c-imx.c from linux kernel:
8db84140bSMarek Vasut  *  Copyright (C) 2005 Torsten Koschorrek <koschorrek at synertronixx.de>
9db84140bSMarek Vasut  *  Copyright (C) 2005 Matthias Blaschke <blaschke at synertronixx.de>
10db84140bSMarek Vasut  *  Copyright (C) 2007 RightHand Technologies, Inc.
11db84140bSMarek Vasut  *  Copyright (C) 2008 Darius Augulis <darius.augulis at teltonika.lt>
12db84140bSMarek Vasut  *
13cdace066SSascha Hauer  *
14cdace066SSascha Hauer  * See file CREDITS for list of people who contributed to this
15cdace066SSascha Hauer  * project.
16cdace066SSascha Hauer  *
17cdace066SSascha Hauer  * This program is free software; you can redistribute it and/or
18cdace066SSascha Hauer  * modify it under the terms of the GNU General Public License as
19cdace066SSascha Hauer  * published by the Free Software Foundation; either version 2 of
20cdace066SSascha Hauer  * the License, or (at your option) any later version.
21cdace066SSascha Hauer  *
22cdace066SSascha Hauer  * This program is distributed in the hope that it will be useful,
23cdace066SSascha Hauer  * but WITHOUT ANY WARRANTY; without even the implied warranty of
24cdace066SSascha Hauer  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
25cdace066SSascha Hauer  * GNU General Public License for more details.
26cdace066SSascha Hauer  *
27cdace066SSascha Hauer  * You should have received a copy of the GNU General Public License
28cdace066SSascha Hauer  * along with this program; if not, write to the Free Software
29cdace066SSascha Hauer  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
30cdace066SSascha Hauer  * MA 02111-1307 USA
31cdace066SSascha Hauer  */
32cdace066SSascha Hauer 
33cdace066SSascha Hauer #include <common.h>
341d549adeSStefano Babic #include <asm/io.h>
35cdace066SSascha Hauer 
36a4a549b4SMichal Simek #if defined(CONFIG_HARD_I2C)
37cdace066SSascha Hauer 
38127cec18SLiu Hui-R64343 #include <asm/arch/clock.h>
3986271115SStefano Babic #include <asm/arch/imx-regs.h>
40cdace066SSascha Hauer 
41db84140bSMarek Vasut struct mxc_i2c_regs {
42db84140bSMarek Vasut 	uint32_t	iadr;
43db84140bSMarek Vasut 	uint32_t	ifdr;
44db84140bSMarek Vasut 	uint32_t	i2cr;
45db84140bSMarek Vasut 	uint32_t	i2sr;
46db84140bSMarek Vasut 	uint32_t	i2dr;
47db84140bSMarek Vasut };
48cdace066SSascha Hauer 
49cdace066SSascha Hauer #define I2CR_IEN	(1 << 7)
50cdace066SSascha Hauer #define I2CR_IIEN	(1 << 6)
51cdace066SSascha Hauer #define I2CR_MSTA	(1 << 5)
52cdace066SSascha Hauer #define I2CR_MTX	(1 << 4)
53cdace066SSascha Hauer #define I2CR_TX_NO_AK	(1 << 3)
54cdace066SSascha Hauer #define I2CR_RSTA	(1 << 2)
55cdace066SSascha Hauer 
56cdace066SSascha Hauer #define I2SR_ICF	(1 << 7)
57cdace066SSascha Hauer #define I2SR_IBB	(1 << 5)
58cdace066SSascha Hauer #define I2SR_IIF	(1 << 1)
59cdace066SSascha Hauer #define I2SR_RX_NO_AK	(1 << 0)
60cdace066SSascha Hauer 
61127cec18SLiu Hui-R64343 #if defined(CONFIG_SYS_I2C_MX31_PORT1)
62cdace066SSascha Hauer #define I2C_BASE	0x43f80000
63e7de18afSGuennadi Liakhovetski #define I2C_CLK_OFFSET	26
646d0f6bcfSJean-Christophe PLAGNIOL-VILLARD #elif defined (CONFIG_SYS_I2C_MX31_PORT2)
65cdace066SSascha Hauer #define I2C_BASE	0x43f98000
66e7de18afSGuennadi Liakhovetski #define I2C_CLK_OFFSET	28
676d0f6bcfSJean-Christophe PLAGNIOL-VILLARD #elif defined (CONFIG_SYS_I2C_MX31_PORT3)
68cdace066SSascha Hauer #define I2C_BASE	0x43f84000
69e7de18afSGuennadi Liakhovetski #define I2C_CLK_OFFSET	30
70127cec18SLiu Hui-R64343 #elif defined(CONFIG_SYS_I2C_MX53_PORT1)
71127cec18SLiu Hui-R64343 #define I2C_BASE        I2C1_BASE_ADDR
72127cec18SLiu Hui-R64343 #elif defined(CONFIG_SYS_I2C_MX53_PORT2)
73127cec18SLiu Hui-R64343 #define I2C_BASE        I2C2_BASE_ADDR
7404220612SStefano Babic #elif defined(CONFIG_SYS_I2C_MX35_PORT1)
7504220612SStefano Babic #define I2C_BASE	I2C_BASE_ADDR
76*a1c66296SStefano Babic #elif defined(CONFIG_SYS_I2C_MX35_PORT2)
77*a1c66296SStefano Babic #define I2C_BASE	I2C2_BASE_ADDR
78*a1c66296SStefano Babic #elif defined(CONFIG_SYS_I2C_MX35_PORT3)
79*a1c66296SStefano Babic #define I2C_BASE	I2C3_BASE_ADDR
80cdace066SSascha Hauer #else
8104220612SStefano Babic #error "define CONFIG_SYS_I2C_MX<Processor>_PORTx to use the mx I2C driver"
82cdace066SSascha Hauer #endif
83cdace066SSascha Hauer 
8481687212SStefano Babic #define I2C_MAX_TIMEOUT		10000
85cdace066SSascha Hauer 
86db84140bSMarek Vasut static u16 i2c_clk_div[50][2] = {
87db84140bSMarek Vasut 	{ 22,	0x20 }, { 24,	0x21 }, { 26,	0x22 }, { 28,	0x23 },
88db84140bSMarek Vasut 	{ 30,	0x00 }, { 32,	0x24 }, { 36,	0x25 }, { 40,	0x26 },
89db84140bSMarek Vasut 	{ 42,	0x03 }, { 44,	0x27 }, { 48,	0x28 }, { 52,	0x05 },
90db84140bSMarek Vasut 	{ 56,	0x29 }, { 60,	0x06 }, { 64,	0x2A }, { 72,	0x2B },
91db84140bSMarek Vasut 	{ 80,	0x2C }, { 88,	0x09 }, { 96,	0x2D }, { 104,	0x0A },
92db84140bSMarek Vasut 	{ 112,	0x2E }, { 128,	0x2F }, { 144,	0x0C }, { 160,	0x30 },
93db84140bSMarek Vasut 	{ 192,	0x31 }, { 224,	0x32 }, { 240,	0x0F }, { 256,	0x33 },
94db84140bSMarek Vasut 	{ 288,	0x10 }, { 320,	0x34 }, { 384,	0x35 }, { 448,	0x36 },
95db84140bSMarek Vasut 	{ 480,	0x13 }, { 512,	0x37 }, { 576,	0x14 }, { 640,	0x38 },
96db84140bSMarek Vasut 	{ 768,	0x39 }, { 896,	0x3A }, { 960,	0x17 }, { 1024,	0x3B },
97db84140bSMarek Vasut 	{ 1152,	0x18 }, { 1280,	0x3C }, { 1536,	0x3D }, { 1792,	0x3E },
98db84140bSMarek Vasut 	{ 1920,	0x1B }, { 2048,	0x3F }, { 2304,	0x1C }, { 2560,	0x1D },
99db84140bSMarek Vasut 	{ 3072,	0x1E }, { 3840,	0x1F }
100db84140bSMarek Vasut };
101cdace066SSascha Hauer 
102b567b8ffSMarek Vasut static u8 clk_div;
103db84140bSMarek Vasut 
104db84140bSMarek Vasut /*
105db84140bSMarek Vasut  * Calculate and set proper clock divider
106db84140bSMarek Vasut  */
107db84140bSMarek Vasut static void i2c_imx_set_clk(unsigned int rate)
1081d549adeSStefano Babic {
109db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
110db84140bSMarek Vasut 	unsigned int i2c_clk_rate;
111db84140bSMarek Vasut 	unsigned int div;
112cdace066SSascha Hauer 
113127cec18SLiu Hui-R64343 #if defined(CONFIG_MX31)
1141d549adeSStefano Babic 	struct clock_control_regs *sc_regs =
1151d549adeSStefano Babic 		(struct clock_control_regs *)CCM_BASE;
116db84140bSMarek Vasut 
117e7de18afSGuennadi Liakhovetski 	/* start the required I2C clock */
1181d549adeSStefano Babic 	writel(readl(&sc_regs->cgr0) | (3 << I2C_CLK_OFFSET),
1191d549adeSStefano Babic 		&sc_regs->cgr0);
120127cec18SLiu Hui-R64343 #endif
121e7de18afSGuennadi Liakhovetski 
122db84140bSMarek Vasut 	/* Divider value calculation */
123db84140bSMarek Vasut 	i2c_clk_rate = mxc_get_clock(MXC_IPG_PERCLK);
124db84140bSMarek Vasut 	div = (i2c_clk_rate + rate - 1) / rate;
125db84140bSMarek Vasut 	if (div < i2c_clk_div[0][0])
126b567b8ffSMarek Vasut 		clk_div = 0;
127db84140bSMarek Vasut 	else if (div > i2c_clk_div[ARRAY_SIZE(i2c_clk_div) - 1][0])
128b567b8ffSMarek Vasut 		clk_div = ARRAY_SIZE(i2c_clk_div) - 1;
129db84140bSMarek Vasut 	else
130b567b8ffSMarek Vasut 		for (clk_div = 0; i2c_clk_div[clk_div][0] < div; clk_div++)
131db84140bSMarek Vasut 			;
132cdace066SSascha Hauer 
133db84140bSMarek Vasut 	/* Store divider value */
134b567b8ffSMarek Vasut 	writeb(i2c_clk_div[clk_div][1], &i2c_regs->ifdr);
135db84140bSMarek Vasut }
136cdace066SSascha Hauer 
137db84140bSMarek Vasut /*
138db84140bSMarek Vasut  * Reset I2C Controller
139db84140bSMarek Vasut  */
140db84140bSMarek Vasut void i2c_reset(void)
141db84140bSMarek Vasut {
142db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
143db84140bSMarek Vasut 
144db84140bSMarek Vasut 	writeb(0, &i2c_regs->i2cr);	/* Reset module */
145db84140bSMarek Vasut 	writeb(0, &i2c_regs->i2sr);
146db84140bSMarek Vasut }
147db84140bSMarek Vasut 
148db84140bSMarek Vasut /*
149db84140bSMarek Vasut  * Init I2C Bus
150db84140bSMarek Vasut  */
151db84140bSMarek Vasut void i2c_init(int speed, int unused)
152db84140bSMarek Vasut {
153db84140bSMarek Vasut 	i2c_imx_set_clk(speed);
1541d549adeSStefano Babic 	i2c_reset();
155cdace066SSascha Hauer }
156cdace066SSascha Hauer 
157db84140bSMarek Vasut /*
158b567b8ffSMarek Vasut  * Set I2C Speed
159b567b8ffSMarek Vasut  */
160b567b8ffSMarek Vasut int i2c_set_bus_speed(unsigned int speed)
161b567b8ffSMarek Vasut {
162b567b8ffSMarek Vasut 	i2c_init(speed, 0);
163b567b8ffSMarek Vasut 	return 0;
164b567b8ffSMarek Vasut }
165b567b8ffSMarek Vasut 
166b567b8ffSMarek Vasut /*
167b567b8ffSMarek Vasut  * Get I2C Speed
168b567b8ffSMarek Vasut  */
169b567b8ffSMarek Vasut unsigned int i2c_get_bus_speed(void)
170b567b8ffSMarek Vasut {
171b567b8ffSMarek Vasut 	return mxc_get_clock(MXC_IPG_PERCLK) / i2c_clk_div[clk_div][0];
172b567b8ffSMarek Vasut }
173b567b8ffSMarek Vasut 
174b567b8ffSMarek Vasut /*
175db84140bSMarek Vasut  * Wait for bus to be busy (or free if for_busy = 0)
176db84140bSMarek Vasut  *
177db84140bSMarek Vasut  * for_busy = 1: Wait for IBB to be asserted
178db84140bSMarek Vasut  * for_busy = 0: Wait for IBB to be de-asserted
179db84140bSMarek Vasut  */
180db84140bSMarek Vasut int i2c_imx_bus_busy(int for_busy)
18181687212SStefano Babic {
182db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
183db84140bSMarek Vasut 	unsigned int temp;
184db84140bSMarek Vasut 
18581687212SStefano Babic 	int timeout = I2C_MAX_TIMEOUT;
18681687212SStefano Babic 
187db84140bSMarek Vasut 	while (timeout--) {
188db84140bSMarek Vasut 		temp = readb(&i2c_regs->i2sr);
189db84140bSMarek Vasut 
190db84140bSMarek Vasut 		if (for_busy && (temp & I2SR_IBB))
191db84140bSMarek Vasut 			return 0;
192db84140bSMarek Vasut 		if (!for_busy && !(temp & I2SR_IBB))
193db84140bSMarek Vasut 			return 0;
194db84140bSMarek Vasut 
19581687212SStefano Babic 		udelay(1);
19681687212SStefano Babic 	}
197db84140bSMarek Vasut 
198db84140bSMarek Vasut 	return 1;
19981687212SStefano Babic }
20081687212SStefano Babic 
201db84140bSMarek Vasut /*
202db84140bSMarek Vasut  * Wait for transaction to complete
203db84140bSMarek Vasut  */
204db84140bSMarek Vasut int i2c_imx_trx_complete(void)
205cdace066SSascha Hauer {
206db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
20781687212SStefano Babic 	int timeout = I2C_MAX_TIMEOUT;
208cdace066SSascha Hauer 
209db84140bSMarek Vasut 	while (timeout--) {
210db84140bSMarek Vasut 		if (readb(&i2c_regs->i2sr) & I2SR_IIF) {
211db84140bSMarek Vasut 			writeb(0, &i2c_regs->i2sr);
212cdace066SSascha Hauer 			return 0;
213cdace066SSascha Hauer 		}
214cdace066SSascha Hauer 
215db84140bSMarek Vasut 		udelay(1);
216cdace066SSascha Hauer 	}
217cdace066SSascha Hauer 
218db84140bSMarek Vasut 	return 1;
219db84140bSMarek Vasut }
220db84140bSMarek Vasut 
221db84140bSMarek Vasut /*
222db84140bSMarek Vasut  * Check if the transaction was ACKed
223db84140bSMarek Vasut  */
224db84140bSMarek Vasut int i2c_imx_acked(void)
225cdace066SSascha Hauer {
226db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
227db84140bSMarek Vasut 
228db84140bSMarek Vasut 	return readb(&i2c_regs->i2sr) & I2SR_RX_NO_AK;
229db84140bSMarek Vasut }
230db84140bSMarek Vasut 
231db84140bSMarek Vasut /*
232db84140bSMarek Vasut  * Start the controller
233db84140bSMarek Vasut  */
234db84140bSMarek Vasut int i2c_imx_start(void)
235db84140bSMarek Vasut {
236db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
237db84140bSMarek Vasut 	unsigned int temp = 0;
238db84140bSMarek Vasut 	int result;
239db84140bSMarek Vasut 
240b567b8ffSMarek Vasut 	writeb(i2c_clk_div[clk_div][1], &i2c_regs->ifdr);
241db84140bSMarek Vasut 
242db84140bSMarek Vasut 	/* Enable I2C controller */
243db84140bSMarek Vasut 	writeb(0, &i2c_regs->i2sr);
244db84140bSMarek Vasut 	writeb(I2CR_IEN, &i2c_regs->i2cr);
245db84140bSMarek Vasut 
246db84140bSMarek Vasut 	/* Wait controller to be stable */
247db84140bSMarek Vasut 	udelay(50);
248db84140bSMarek Vasut 
249db84140bSMarek Vasut 	/* Start I2C transaction */
250db84140bSMarek Vasut 	temp = readb(&i2c_regs->i2cr);
251db84140bSMarek Vasut 	temp |= I2CR_MSTA;
252db84140bSMarek Vasut 	writeb(temp, &i2c_regs->i2cr);
253db84140bSMarek Vasut 
254db84140bSMarek Vasut 	result = i2c_imx_bus_busy(1);
255db84140bSMarek Vasut 	if (result)
256db84140bSMarek Vasut 		return result;
257db84140bSMarek Vasut 
258db84140bSMarek Vasut 	temp |= I2CR_MTX | I2CR_TX_NO_AK;
259db84140bSMarek Vasut 	writeb(temp, &i2c_regs->i2cr);
260db84140bSMarek Vasut 
261db84140bSMarek Vasut 	return 0;
262db84140bSMarek Vasut }
263db84140bSMarek Vasut 
264db84140bSMarek Vasut /*
265db84140bSMarek Vasut  * Stop the controller
266db84140bSMarek Vasut  */
267db84140bSMarek Vasut void i2c_imx_stop(void)
268db84140bSMarek Vasut {
269db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
270db84140bSMarek Vasut 	unsigned int temp = 0;
271db84140bSMarek Vasut 
272db84140bSMarek Vasut 	/* Stop I2C transaction */
273db84140bSMarek Vasut 	temp = readb(&i2c_regs->i2cr);
274db84140bSMarek Vasut 	temp |= ~(I2CR_MSTA | I2CR_MTX);
275db84140bSMarek Vasut 	writeb(temp, &i2c_regs->i2cr);
276db84140bSMarek Vasut 
277db84140bSMarek Vasut 	i2c_imx_bus_busy(0);
278db84140bSMarek Vasut 
279db84140bSMarek Vasut 	/* Disable I2C controller */
280db84140bSMarek Vasut 	writeb(0, &i2c_regs->i2cr);
281db84140bSMarek Vasut }
282db84140bSMarek Vasut 
283db84140bSMarek Vasut /*
284db84140bSMarek Vasut  * Set chip address and access mode
285db84140bSMarek Vasut  *
286db84140bSMarek Vasut  * read = 1: READ access
287db84140bSMarek Vasut  * read = 0: WRITE access
288db84140bSMarek Vasut  */
289db84140bSMarek Vasut int i2c_imx_set_chip_addr(uchar chip, int read)
290db84140bSMarek Vasut {
291db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
292cdace066SSascha Hauer 	int ret;
293cdace066SSascha Hauer 
294db84140bSMarek Vasut 	writeb((chip << 1) | read, &i2c_regs->i2dr);
295cdace066SSascha Hauer 
296db84140bSMarek Vasut 	ret = i2c_imx_trx_complete();
297db84140bSMarek Vasut 	if (ret)
298db84140bSMarek Vasut 		return ret;
299db84140bSMarek Vasut 
300db84140bSMarek Vasut 	ret = i2c_imx_acked();
301db84140bSMarek Vasut 	if (ret)
302db84140bSMarek Vasut 		return ret;
303cdace066SSascha Hauer 
304cdace066SSascha Hauer 	return ret;
305cdace066SSascha Hauer }
306cdace066SSascha Hauer 
307db84140bSMarek Vasut /*
308db84140bSMarek Vasut  * Write register address
309db84140bSMarek Vasut  */
310db84140bSMarek Vasut int i2c_imx_set_reg_addr(uint addr, int alen)
311cdace066SSascha Hauer {
312db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
313db84140bSMarek Vasut 	int ret;
314db84140bSMarek Vasut 	int i;
315db84140bSMarek Vasut 
316db84140bSMarek Vasut 	for (i = 0; i < (8 * alen); i += 8) {
317db84140bSMarek Vasut 		writeb((addr >> i) & 0xff, &i2c_regs->i2dr);
318db84140bSMarek Vasut 
319db84140bSMarek Vasut 		ret = i2c_imx_trx_complete();
320db84140bSMarek Vasut 		if (ret)
32181687212SStefano Babic 			break;
322cdace066SSascha Hauer 
323db84140bSMarek Vasut 		ret = i2c_imx_acked();
324db84140bSMarek Vasut 		if (ret)
325db84140bSMarek Vasut 			break;
32681687212SStefano Babic 	}
327cdace066SSascha Hauer 
328db84140bSMarek Vasut 	return ret;
329cdace066SSascha Hauer }
330cdace066SSascha Hauer 
331db84140bSMarek Vasut /*
332db84140bSMarek Vasut  * Try if a chip add given address responds (probe the chip)
333db84140bSMarek Vasut  */
334db84140bSMarek Vasut int i2c_probe(uchar chip)
335cdace066SSascha Hauer {
336cdace066SSascha Hauer 	int ret;
337cdace066SSascha Hauer 
338db84140bSMarek Vasut 	ret = i2c_imx_start();
339db84140bSMarek Vasut 	if (ret)
340db84140bSMarek Vasut 		return ret;
341cdace066SSascha Hauer 
342db84140bSMarek Vasut 	ret = i2c_imx_set_chip_addr(chip, 0);
343db84140bSMarek Vasut 	if (ret)
344db84140bSMarek Vasut 		return ret;
345db84140bSMarek Vasut 
346db84140bSMarek Vasut 	i2c_imx_stop();
347db84140bSMarek Vasut 
348db84140bSMarek Vasut 	return ret;
349cdace066SSascha Hauer }
350cdace066SSascha Hauer 
351db84140bSMarek Vasut /*
352db84140bSMarek Vasut  * Read data from I2C device
353db84140bSMarek Vasut  */
354db84140bSMarek Vasut int i2c_read(uchar chip, uint addr, int alen, uchar *buf, int len)
355db84140bSMarek Vasut {
356db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
357db84140bSMarek Vasut 	int ret;
358db84140bSMarek Vasut 	unsigned int temp;
359db84140bSMarek Vasut 	int i;
360cdace066SSascha Hauer 
361db84140bSMarek Vasut 	ret = i2c_imx_start();
362db84140bSMarek Vasut 	if (ret)
363db84140bSMarek Vasut 		return ret;
364cdace066SSascha Hauer 
365db84140bSMarek Vasut 	/* write slave address */
366db84140bSMarek Vasut 	ret = i2c_imx_set_chip_addr(chip, 0);
367db84140bSMarek Vasut 	if (ret)
368db84140bSMarek Vasut 		return ret;
369cdace066SSascha Hauer 
370db84140bSMarek Vasut 	ret = i2c_imx_set_reg_addr(addr, alen);
371db84140bSMarek Vasut 	if (ret)
372db84140bSMarek Vasut 		return ret;
373cdace066SSascha Hauer 
374db84140bSMarek Vasut 	temp = readb(&i2c_regs->i2cr);
375db84140bSMarek Vasut 	temp |= I2CR_RSTA;
376db84140bSMarek Vasut 	writeb(temp, &i2c_regs->i2cr);
377db84140bSMarek Vasut 
378db84140bSMarek Vasut 	ret = i2c_imx_set_chip_addr(chip, 1);
379db84140bSMarek Vasut 	if (ret)
380db84140bSMarek Vasut 		return ret;
381db84140bSMarek Vasut 
382db84140bSMarek Vasut 	/* setup bus to read data */
383db84140bSMarek Vasut 	temp = readb(&i2c_regs->i2cr);
384db84140bSMarek Vasut 	temp &= ~(I2CR_MTX | I2CR_TX_NO_AK);
385db84140bSMarek Vasut 	if (len == 1)
386db84140bSMarek Vasut 		temp |= I2CR_TX_NO_AK;
387db84140bSMarek Vasut 	writeb(temp, &i2c_regs->i2cr);
388db84140bSMarek Vasut 	readb(&i2c_regs->i2dr);
389db84140bSMarek Vasut 
390db84140bSMarek Vasut 	/* read data */
391db84140bSMarek Vasut 	for (i = 0; i < len; i++) {
392db84140bSMarek Vasut 		ret = i2c_imx_trx_complete();
393db84140bSMarek Vasut 		if (ret)
394db84140bSMarek Vasut 			return ret;
395db84140bSMarek Vasut 
396db84140bSMarek Vasut 		/*
397db84140bSMarek Vasut 		 * It must generate STOP before read I2DR to prevent
398db84140bSMarek Vasut 		 * controller from generating another clock cycle
399db84140bSMarek Vasut 		 */
400db84140bSMarek Vasut 		if (i == (len - 1)) {
401db84140bSMarek Vasut 			temp = readb(&i2c_regs->i2cr);
402db84140bSMarek Vasut 			temp &= ~(I2CR_MSTA | I2CR_MTX);
403db84140bSMarek Vasut 			writeb(temp, &i2c_regs->i2cr);
404db84140bSMarek Vasut 			i2c_imx_bus_busy(0);
405db84140bSMarek Vasut 		} else if (i == (len - 2)) {
406db84140bSMarek Vasut 			temp = readb(&i2c_regs->i2cr);
407db84140bSMarek Vasut 			temp |= I2CR_TX_NO_AK;
408db84140bSMarek Vasut 			writeb(temp, &i2c_regs->i2cr);
409cdace066SSascha Hauer 		}
410cdace066SSascha Hauer 
411db84140bSMarek Vasut 		buf[i] = readb(&i2c_regs->i2dr);
412cdace066SSascha Hauer 	}
413cdace066SSascha Hauer 
414db84140bSMarek Vasut 	i2c_imx_stop();
415db84140bSMarek Vasut 
416db84140bSMarek Vasut 	return ret;
417db84140bSMarek Vasut }
418db84140bSMarek Vasut 
419db84140bSMarek Vasut /*
420db84140bSMarek Vasut  * Write data to I2C device
421db84140bSMarek Vasut  */
422cdace066SSascha Hauer int i2c_write(uchar chip, uint addr, int alen, uchar *buf, int len)
423cdace066SSascha Hauer {
424db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
425db84140bSMarek Vasut 	int ret;
426db84140bSMarek Vasut 	int i;
427cdace066SSascha Hauer 
428db84140bSMarek Vasut 	ret = i2c_imx_start();
429db84140bSMarek Vasut 	if (ret)
430db84140bSMarek Vasut 		return ret;
431cdace066SSascha Hauer 
432db84140bSMarek Vasut 	/* write slave address */
433db84140bSMarek Vasut 	ret = i2c_imx_set_chip_addr(chip, 0);
434db84140bSMarek Vasut 	if (ret)
435db84140bSMarek Vasut 		return ret;
436cdace066SSascha Hauer 
437db84140bSMarek Vasut 	ret = i2c_imx_set_reg_addr(addr, alen);
438db84140bSMarek Vasut 	if (ret)
439db84140bSMarek Vasut 		return ret;
440cdace066SSascha Hauer 
441db84140bSMarek Vasut 	for (i = 0; i < len; i++) {
442db84140bSMarek Vasut 		writeb(buf[i], &i2c_regs->i2dr);
443cdace066SSascha Hauer 
444db84140bSMarek Vasut 		ret = i2c_imx_trx_complete();
445db84140bSMarek Vasut 		if (ret)
446db84140bSMarek Vasut 			return ret;
447db84140bSMarek Vasut 
448db84140bSMarek Vasut 		ret = i2c_imx_acked();
449db84140bSMarek Vasut 		if (ret)
450db84140bSMarek Vasut 			return ret;
451cdace066SSascha Hauer 	}
452cdace066SSascha Hauer 
453db84140bSMarek Vasut 	i2c_imx_stop();
454db84140bSMarek Vasut 
455db84140bSMarek Vasut 	return ret;
456db84140bSMarek Vasut }
457cdace066SSascha Hauer #endif /* CONFIG_HARD_I2C */
458