xref: /rk3399_rockchip-uboot/drivers/i2c/mxc_i2c.c (revision de6f604de245b19ce2e330bc63b6522af134d7ae)
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>
40bf0783dfSMarek Vasut #include <i2c.h>
41cdace066SSascha Hauer 
42db84140bSMarek Vasut struct mxc_i2c_regs {
43db84140bSMarek Vasut 	uint32_t	iadr;
44db84140bSMarek Vasut 	uint32_t	ifdr;
45db84140bSMarek Vasut 	uint32_t	i2cr;
46db84140bSMarek Vasut 	uint32_t	i2sr;
47db84140bSMarek Vasut 	uint32_t	i2dr;
48db84140bSMarek Vasut };
49cdace066SSascha Hauer 
50cdace066SSascha Hauer #define I2CR_IEN	(1 << 7)
51cdace066SSascha Hauer #define I2CR_IIEN	(1 << 6)
52cdace066SSascha Hauer #define I2CR_MSTA	(1 << 5)
53cdace066SSascha Hauer #define I2CR_MTX	(1 << 4)
54cdace066SSascha Hauer #define I2CR_TX_NO_AK	(1 << 3)
55cdace066SSascha Hauer #define I2CR_RSTA	(1 << 2)
56cdace066SSascha Hauer 
57cdace066SSascha Hauer #define I2SR_ICF	(1 << 7)
58cdace066SSascha Hauer #define I2SR_IBB	(1 << 5)
59cdace066SSascha Hauer #define I2SR_IIF	(1 << 1)
60cdace066SSascha Hauer #define I2SR_RX_NO_AK	(1 << 0)
61cdace066SSascha Hauer 
62*de6f604dSTroy Kisky #ifdef CONFIG_SYS_I2C_BASE
63*de6f604dSTroy Kisky #define I2C_BASE	CONFIG_SYS_I2C_BASE
64cdace066SSascha Hauer #else
65*de6f604dSTroy Kisky #error "define CONFIG_SYS_I2C_BASE to use the mxc_i2c driver"
66cdace066SSascha Hauer #endif
67cdace066SSascha Hauer 
6881687212SStefano Babic #define I2C_MAX_TIMEOUT		10000
69cdace066SSascha Hauer 
70db84140bSMarek Vasut static u16 i2c_clk_div[50][2] = {
71db84140bSMarek Vasut 	{ 22,	0x20 }, { 24,	0x21 }, { 26,	0x22 }, { 28,	0x23 },
72db84140bSMarek Vasut 	{ 30,	0x00 }, { 32,	0x24 }, { 36,	0x25 }, { 40,	0x26 },
73db84140bSMarek Vasut 	{ 42,	0x03 }, { 44,	0x27 }, { 48,	0x28 }, { 52,	0x05 },
74db84140bSMarek Vasut 	{ 56,	0x29 }, { 60,	0x06 }, { 64,	0x2A }, { 72,	0x2B },
75db84140bSMarek Vasut 	{ 80,	0x2C }, { 88,	0x09 }, { 96,	0x2D }, { 104,	0x0A },
76db84140bSMarek Vasut 	{ 112,	0x2E }, { 128,	0x2F }, { 144,	0x0C }, { 160,	0x30 },
77db84140bSMarek Vasut 	{ 192,	0x31 }, { 224,	0x32 }, { 240,	0x0F }, { 256,	0x33 },
78db84140bSMarek Vasut 	{ 288,	0x10 }, { 320,	0x34 }, { 384,	0x35 }, { 448,	0x36 },
79db84140bSMarek Vasut 	{ 480,	0x13 }, { 512,	0x37 }, { 576,	0x14 }, { 640,	0x38 },
80db84140bSMarek Vasut 	{ 768,	0x39 }, { 896,	0x3A }, { 960,	0x17 }, { 1024,	0x3B },
81db84140bSMarek Vasut 	{ 1152,	0x18 }, { 1280,	0x3C }, { 1536,	0x3D }, { 1792,	0x3E },
82db84140bSMarek Vasut 	{ 1920,	0x1B }, { 2048,	0x3F }, { 2304,	0x1C }, { 2560,	0x1D },
83db84140bSMarek Vasut 	{ 3072,	0x1E }, { 3840,	0x1F }
84db84140bSMarek Vasut };
85cdace066SSascha Hauer 
86db84140bSMarek Vasut /*
87db84140bSMarek Vasut  * Calculate and set proper clock divider
88db84140bSMarek Vasut  */
89bf0783dfSMarek Vasut static uint8_t i2c_imx_get_clk(unsigned int rate)
901d549adeSStefano Babic {
91db84140bSMarek Vasut 	unsigned int i2c_clk_rate;
92db84140bSMarek Vasut 	unsigned int div;
93bf0783dfSMarek Vasut 	u8 clk_div;
94cdace066SSascha Hauer 
95127cec18SLiu Hui-R64343 #if defined(CONFIG_MX31)
961d549adeSStefano Babic 	struct clock_control_regs *sc_regs =
971d549adeSStefano Babic 		(struct clock_control_regs *)CCM_BASE;
98db84140bSMarek Vasut 
99e7de18afSGuennadi Liakhovetski 	/* start the required I2C clock */
100*de6f604dSTroy Kisky 	writel(readl(&sc_regs->cgr0) | (3 << CONFIG_SYS_I2C_CLK_OFFSET),
1011d549adeSStefano Babic 		&sc_regs->cgr0);
102127cec18SLiu Hui-R64343 #endif
103e7de18afSGuennadi Liakhovetski 
104db84140bSMarek Vasut 	/* Divider value calculation */
105db84140bSMarek Vasut 	i2c_clk_rate = mxc_get_clock(MXC_IPG_PERCLK);
106db84140bSMarek Vasut 	div = (i2c_clk_rate + rate - 1) / rate;
107db84140bSMarek Vasut 	if (div < i2c_clk_div[0][0])
108b567b8ffSMarek Vasut 		clk_div = 0;
109db84140bSMarek Vasut 	else if (div > i2c_clk_div[ARRAY_SIZE(i2c_clk_div) - 1][0])
110b567b8ffSMarek Vasut 		clk_div = ARRAY_SIZE(i2c_clk_div) - 1;
111db84140bSMarek Vasut 	else
112b567b8ffSMarek Vasut 		for (clk_div = 0; i2c_clk_div[clk_div][0] < div; clk_div++)
113db84140bSMarek Vasut 			;
114cdace066SSascha Hauer 
115db84140bSMarek Vasut 	/* Store divider value */
116bf0783dfSMarek Vasut 	return clk_div;
117db84140bSMarek Vasut }
118cdace066SSascha Hauer 
119db84140bSMarek Vasut /*
120db84140bSMarek Vasut  * Reset I2C Controller
121db84140bSMarek Vasut  */
122db84140bSMarek Vasut void i2c_reset(void)
123db84140bSMarek Vasut {
124db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
125db84140bSMarek Vasut 
126db84140bSMarek Vasut 	writeb(0, &i2c_regs->i2cr);	/* Reset module */
127db84140bSMarek Vasut 	writeb(0, &i2c_regs->i2sr);
128db84140bSMarek Vasut }
129db84140bSMarek Vasut 
130db84140bSMarek Vasut /*
131db84140bSMarek Vasut  * Init I2C Bus
132db84140bSMarek Vasut  */
133db84140bSMarek Vasut void i2c_init(int speed, int unused)
134db84140bSMarek Vasut {
135bf0783dfSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
136bf0783dfSMarek Vasut 	u8 clk_idx = i2c_imx_get_clk(speed);
137bf0783dfSMarek Vasut 	u8 idx = i2c_clk_div[clk_idx][1];
138bf0783dfSMarek Vasut 
139bf0783dfSMarek Vasut 	/* Store divider value */
140bf0783dfSMarek Vasut 	writeb(idx, &i2c_regs->ifdr);
141bf0783dfSMarek Vasut 
1421d549adeSStefano Babic 	i2c_reset();
143cdace066SSascha Hauer }
144cdace066SSascha Hauer 
145db84140bSMarek Vasut /*
146b567b8ffSMarek Vasut  * Set I2C Speed
147b567b8ffSMarek Vasut  */
148b567b8ffSMarek Vasut int i2c_set_bus_speed(unsigned int speed)
149b567b8ffSMarek Vasut {
150b567b8ffSMarek Vasut 	i2c_init(speed, 0);
151b567b8ffSMarek Vasut 	return 0;
152b567b8ffSMarek Vasut }
153b567b8ffSMarek Vasut 
154b567b8ffSMarek Vasut /*
155b567b8ffSMarek Vasut  * Get I2C Speed
156b567b8ffSMarek Vasut  */
157b567b8ffSMarek Vasut unsigned int i2c_get_bus_speed(void)
158b567b8ffSMarek Vasut {
159bf0783dfSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
160bf0783dfSMarek Vasut 	u8 clk_idx = readb(&i2c_regs->ifdr);
161bf0783dfSMarek Vasut 	u8 clk_div;
162bf0783dfSMarek Vasut 
163bf0783dfSMarek Vasut 	for (clk_div = 0; i2c_clk_div[clk_div][1] != clk_idx; clk_div++)
164bf0783dfSMarek Vasut 		;
165bf0783dfSMarek Vasut 
166b567b8ffSMarek Vasut 	return mxc_get_clock(MXC_IPG_PERCLK) / i2c_clk_div[clk_div][0];
167b567b8ffSMarek Vasut }
168b567b8ffSMarek Vasut 
169b567b8ffSMarek Vasut /*
170db84140bSMarek Vasut  * Wait for bus to be busy (or free if for_busy = 0)
171db84140bSMarek Vasut  *
172db84140bSMarek Vasut  * for_busy = 1: Wait for IBB to be asserted
173db84140bSMarek Vasut  * for_busy = 0: Wait for IBB to be de-asserted
174db84140bSMarek Vasut  */
175db84140bSMarek Vasut int i2c_imx_bus_busy(int for_busy)
17681687212SStefano Babic {
177db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
178db84140bSMarek Vasut 	unsigned int temp;
179db84140bSMarek Vasut 
18081687212SStefano Babic 	int timeout = I2C_MAX_TIMEOUT;
18181687212SStefano Babic 
182db84140bSMarek Vasut 	while (timeout--) {
183db84140bSMarek Vasut 		temp = readb(&i2c_regs->i2sr);
184db84140bSMarek Vasut 
185db84140bSMarek Vasut 		if (for_busy && (temp & I2SR_IBB))
186db84140bSMarek Vasut 			return 0;
187db84140bSMarek Vasut 		if (!for_busy && !(temp & I2SR_IBB))
188db84140bSMarek Vasut 			return 0;
189db84140bSMarek Vasut 
19081687212SStefano Babic 		udelay(1);
19181687212SStefano Babic 	}
192db84140bSMarek Vasut 
193db84140bSMarek Vasut 	return 1;
19481687212SStefano Babic }
19581687212SStefano Babic 
196db84140bSMarek Vasut /*
197db84140bSMarek Vasut  * Wait for transaction to complete
198db84140bSMarek Vasut  */
199db84140bSMarek Vasut int i2c_imx_trx_complete(void)
200cdace066SSascha Hauer {
201db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
20281687212SStefano Babic 	int timeout = I2C_MAX_TIMEOUT;
203cdace066SSascha Hauer 
204db84140bSMarek Vasut 	while (timeout--) {
205db84140bSMarek Vasut 		if (readb(&i2c_regs->i2sr) & I2SR_IIF) {
206db84140bSMarek Vasut 			writeb(0, &i2c_regs->i2sr);
207cdace066SSascha Hauer 			return 0;
208cdace066SSascha Hauer 		}
209cdace066SSascha Hauer 
210db84140bSMarek Vasut 		udelay(1);
211cdace066SSascha Hauer 	}
212cdace066SSascha Hauer 
213db84140bSMarek Vasut 	return 1;
214db84140bSMarek Vasut }
215db84140bSMarek Vasut 
216db84140bSMarek Vasut /*
217db84140bSMarek Vasut  * Check if the transaction was ACKed
218db84140bSMarek Vasut  */
219db84140bSMarek Vasut int i2c_imx_acked(void)
220cdace066SSascha Hauer {
221db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
222db84140bSMarek Vasut 
223db84140bSMarek Vasut 	return readb(&i2c_regs->i2sr) & I2SR_RX_NO_AK;
224db84140bSMarek Vasut }
225db84140bSMarek Vasut 
226db84140bSMarek Vasut /*
227db84140bSMarek Vasut  * Start the controller
228db84140bSMarek Vasut  */
229db84140bSMarek Vasut int i2c_imx_start(void)
230db84140bSMarek Vasut {
231db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
232db84140bSMarek Vasut 	unsigned int temp = 0;
233db84140bSMarek Vasut 	int result;
234bf0783dfSMarek Vasut 	int speed = i2c_get_bus_speed();
235bf0783dfSMarek Vasut 	u8 clk_idx = i2c_imx_get_clk(speed);
236bf0783dfSMarek Vasut 	u8 idx = i2c_clk_div[clk_idx][1];
237db84140bSMarek Vasut 
238bf0783dfSMarek Vasut 	/* Store divider value */
239bf0783dfSMarek Vasut 	writeb(idx, &i2c_regs->ifdr);
240db84140bSMarek Vasut 
241db84140bSMarek Vasut 	/* Enable I2C controller */
242db84140bSMarek Vasut 	writeb(0, &i2c_regs->i2sr);
243db84140bSMarek Vasut 	writeb(I2CR_IEN, &i2c_regs->i2cr);
244db84140bSMarek Vasut 
245db84140bSMarek Vasut 	/* Wait controller to be stable */
246db84140bSMarek Vasut 	udelay(50);
247db84140bSMarek Vasut 
248db84140bSMarek Vasut 	/* Start I2C transaction */
249db84140bSMarek Vasut 	temp = readb(&i2c_regs->i2cr);
250db84140bSMarek Vasut 	temp |= I2CR_MSTA;
251db84140bSMarek Vasut 	writeb(temp, &i2c_regs->i2cr);
252db84140bSMarek Vasut 
253db84140bSMarek Vasut 	result = i2c_imx_bus_busy(1);
254db84140bSMarek Vasut 	if (result)
255db84140bSMarek Vasut 		return result;
256db84140bSMarek Vasut 
257db84140bSMarek Vasut 	temp |= I2CR_MTX | I2CR_TX_NO_AK;
258db84140bSMarek Vasut 	writeb(temp, &i2c_regs->i2cr);
259db84140bSMarek Vasut 
260db84140bSMarek Vasut 	return 0;
261db84140bSMarek Vasut }
262db84140bSMarek Vasut 
263db84140bSMarek Vasut /*
264db84140bSMarek Vasut  * Stop the controller
265db84140bSMarek Vasut  */
266db84140bSMarek Vasut void i2c_imx_stop(void)
267db84140bSMarek Vasut {
268db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
269db84140bSMarek Vasut 	unsigned int temp = 0;
270db84140bSMarek Vasut 
271db84140bSMarek Vasut 	/* Stop I2C transaction */
272db84140bSMarek Vasut 	temp = readb(&i2c_regs->i2cr);
273db84140bSMarek Vasut 	temp |= ~(I2CR_MSTA | I2CR_MTX);
274db84140bSMarek Vasut 	writeb(temp, &i2c_regs->i2cr);
275db84140bSMarek Vasut 
276db84140bSMarek Vasut 	i2c_imx_bus_busy(0);
277db84140bSMarek Vasut 
278db84140bSMarek Vasut 	/* Disable I2C controller */
279db84140bSMarek Vasut 	writeb(0, &i2c_regs->i2cr);
280db84140bSMarek Vasut }
281db84140bSMarek Vasut 
282db84140bSMarek Vasut /*
283db84140bSMarek Vasut  * Set chip address and access mode
284db84140bSMarek Vasut  *
285db84140bSMarek Vasut  * read = 1: READ access
286db84140bSMarek Vasut  * read = 0: WRITE access
287db84140bSMarek Vasut  */
288db84140bSMarek Vasut int i2c_imx_set_chip_addr(uchar chip, int read)
289db84140bSMarek Vasut {
290db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
291cdace066SSascha Hauer 	int ret;
292cdace066SSascha Hauer 
293db84140bSMarek Vasut 	writeb((chip << 1) | read, &i2c_regs->i2dr);
294cdace066SSascha Hauer 
295db84140bSMarek Vasut 	ret = i2c_imx_trx_complete();
296db84140bSMarek Vasut 	if (ret)
297db84140bSMarek Vasut 		return ret;
298db84140bSMarek Vasut 
299db84140bSMarek Vasut 	ret = i2c_imx_acked();
300db84140bSMarek Vasut 	if (ret)
301db84140bSMarek Vasut 		return ret;
302cdace066SSascha Hauer 
303cdace066SSascha Hauer 	return ret;
304cdace066SSascha Hauer }
305cdace066SSascha Hauer 
306db84140bSMarek Vasut /*
307db84140bSMarek Vasut  * Write register address
308db84140bSMarek Vasut  */
309db84140bSMarek Vasut int i2c_imx_set_reg_addr(uint addr, int alen)
310cdace066SSascha Hauer {
311db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
312bf0783dfSMarek Vasut 	int ret = 0;
313db84140bSMarek Vasut 
314bf0783dfSMarek Vasut 	while (alen--) {
315bf0783dfSMarek Vasut 		writeb((addr >> (alen * 8)) & 0xff, &i2c_regs->i2dr);
316db84140bSMarek Vasut 
317db84140bSMarek Vasut 		ret = i2c_imx_trx_complete();
318db84140bSMarek Vasut 		if (ret)
31981687212SStefano Babic 			break;
320cdace066SSascha Hauer 
321db84140bSMarek Vasut 		ret = i2c_imx_acked();
322db84140bSMarek Vasut 		if (ret)
323db84140bSMarek Vasut 			break;
32481687212SStefano Babic 	}
325cdace066SSascha Hauer 
326db84140bSMarek Vasut 	return ret;
327cdace066SSascha Hauer }
328cdace066SSascha Hauer 
329db84140bSMarek Vasut /*
330db84140bSMarek Vasut  * Try if a chip add given address responds (probe the chip)
331db84140bSMarek Vasut  */
332db84140bSMarek Vasut int i2c_probe(uchar chip)
333cdace066SSascha Hauer {
334cdace066SSascha Hauer 	int ret;
335cdace066SSascha Hauer 
336db84140bSMarek Vasut 	ret = i2c_imx_start();
337db84140bSMarek Vasut 	if (ret)
338db84140bSMarek Vasut 		return ret;
339cdace066SSascha Hauer 
340db84140bSMarek Vasut 	ret = i2c_imx_set_chip_addr(chip, 0);
341db84140bSMarek Vasut 	if (ret)
342db84140bSMarek Vasut 		return ret;
343db84140bSMarek Vasut 
344db84140bSMarek Vasut 	i2c_imx_stop();
345db84140bSMarek Vasut 
346db84140bSMarek Vasut 	return ret;
347cdace066SSascha Hauer }
348cdace066SSascha Hauer 
349db84140bSMarek Vasut /*
350db84140bSMarek Vasut  * Read data from I2C device
351db84140bSMarek Vasut  */
352db84140bSMarek Vasut int i2c_read(uchar chip, uint addr, int alen, uchar *buf, int len)
353db84140bSMarek Vasut {
354db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
355db84140bSMarek Vasut 	int ret;
356db84140bSMarek Vasut 	unsigned int temp;
357db84140bSMarek Vasut 	int i;
358cdace066SSascha Hauer 
359db84140bSMarek Vasut 	ret = i2c_imx_start();
360db84140bSMarek Vasut 	if (ret)
361db84140bSMarek Vasut 		return ret;
362cdace066SSascha Hauer 
363db84140bSMarek Vasut 	/* write slave address */
364db84140bSMarek Vasut 	ret = i2c_imx_set_chip_addr(chip, 0);
365db84140bSMarek Vasut 	if (ret)
366db84140bSMarek Vasut 		return ret;
367cdace066SSascha Hauer 
368db84140bSMarek Vasut 	ret = i2c_imx_set_reg_addr(addr, alen);
369db84140bSMarek Vasut 	if (ret)
370db84140bSMarek Vasut 		return ret;
371cdace066SSascha Hauer 
372db84140bSMarek Vasut 	temp = readb(&i2c_regs->i2cr);
373db84140bSMarek Vasut 	temp |= I2CR_RSTA;
374db84140bSMarek Vasut 	writeb(temp, &i2c_regs->i2cr);
375db84140bSMarek Vasut 
376db84140bSMarek Vasut 	ret = i2c_imx_set_chip_addr(chip, 1);
377db84140bSMarek Vasut 	if (ret)
378db84140bSMarek Vasut 		return ret;
379db84140bSMarek Vasut 
380db84140bSMarek Vasut 	/* setup bus to read data */
381db84140bSMarek Vasut 	temp = readb(&i2c_regs->i2cr);
382db84140bSMarek Vasut 	temp &= ~(I2CR_MTX | I2CR_TX_NO_AK);
383db84140bSMarek Vasut 	if (len == 1)
384db84140bSMarek Vasut 		temp |= I2CR_TX_NO_AK;
385db84140bSMarek Vasut 	writeb(temp, &i2c_regs->i2cr);
386db84140bSMarek Vasut 	readb(&i2c_regs->i2dr);
387db84140bSMarek Vasut 
388db84140bSMarek Vasut 	/* read data */
389db84140bSMarek Vasut 	for (i = 0; i < len; i++) {
390db84140bSMarek Vasut 		ret = i2c_imx_trx_complete();
391db84140bSMarek Vasut 		if (ret)
392db84140bSMarek Vasut 			return ret;
393db84140bSMarek Vasut 
394db84140bSMarek Vasut 		/*
395db84140bSMarek Vasut 		 * It must generate STOP before read I2DR to prevent
396db84140bSMarek Vasut 		 * controller from generating another clock cycle
397db84140bSMarek Vasut 		 */
398db84140bSMarek Vasut 		if (i == (len - 1)) {
399db84140bSMarek Vasut 			temp = readb(&i2c_regs->i2cr);
400db84140bSMarek Vasut 			temp &= ~(I2CR_MSTA | I2CR_MTX);
401db84140bSMarek Vasut 			writeb(temp, &i2c_regs->i2cr);
402db84140bSMarek Vasut 			i2c_imx_bus_busy(0);
403db84140bSMarek Vasut 		} else if (i == (len - 2)) {
404db84140bSMarek Vasut 			temp = readb(&i2c_regs->i2cr);
405db84140bSMarek Vasut 			temp |= I2CR_TX_NO_AK;
406db84140bSMarek Vasut 			writeb(temp, &i2c_regs->i2cr);
407cdace066SSascha Hauer 		}
408cdace066SSascha Hauer 
409db84140bSMarek Vasut 		buf[i] = readb(&i2c_regs->i2dr);
410cdace066SSascha Hauer 	}
411cdace066SSascha Hauer 
412db84140bSMarek Vasut 	i2c_imx_stop();
413db84140bSMarek Vasut 
414db84140bSMarek Vasut 	return ret;
415db84140bSMarek Vasut }
416db84140bSMarek Vasut 
417db84140bSMarek Vasut /*
418db84140bSMarek Vasut  * Write data to I2C device
419db84140bSMarek Vasut  */
420cdace066SSascha Hauer int i2c_write(uchar chip, uint addr, int alen, uchar *buf, int len)
421cdace066SSascha Hauer {
422db84140bSMarek Vasut 	struct mxc_i2c_regs *i2c_regs = (struct mxc_i2c_regs *)I2C_BASE;
423db84140bSMarek Vasut 	int ret;
424db84140bSMarek Vasut 	int i;
425cdace066SSascha Hauer 
426db84140bSMarek Vasut 	ret = i2c_imx_start();
427db84140bSMarek Vasut 	if (ret)
428db84140bSMarek Vasut 		return ret;
429cdace066SSascha Hauer 
430db84140bSMarek Vasut 	/* write slave address */
431db84140bSMarek Vasut 	ret = i2c_imx_set_chip_addr(chip, 0);
432db84140bSMarek Vasut 	if (ret)
433db84140bSMarek Vasut 		return ret;
434cdace066SSascha Hauer 
435db84140bSMarek Vasut 	ret = i2c_imx_set_reg_addr(addr, alen);
436db84140bSMarek Vasut 	if (ret)
437db84140bSMarek Vasut 		return ret;
438cdace066SSascha Hauer 
439db84140bSMarek Vasut 	for (i = 0; i < len; i++) {
440db84140bSMarek Vasut 		writeb(buf[i], &i2c_regs->i2dr);
441cdace066SSascha Hauer 
442db84140bSMarek Vasut 		ret = i2c_imx_trx_complete();
443db84140bSMarek Vasut 		if (ret)
444db84140bSMarek Vasut 			return ret;
445db84140bSMarek Vasut 
446db84140bSMarek Vasut 		ret = i2c_imx_acked();
447db84140bSMarek Vasut 		if (ret)
448db84140bSMarek Vasut 			return ret;
449cdace066SSascha Hauer 	}
450cdace066SSascha Hauer 
451db84140bSMarek Vasut 	i2c_imx_stop();
452db84140bSMarek Vasut 
453db84140bSMarek Vasut 	return ret;
454db84140bSMarek Vasut }
455cdace066SSascha Hauer #endif /* CONFIG_HARD_I2C */
456