xref: /rk3399_rockchip-uboot/drivers/i2c/mvtwsi.c (revision 904dfbfd67fbdf4562236efb3f0769ecfe7a7e58)
101ec99d9SAlbert Aribaud /*
2306563a7SAlbert Aribaud  * Driver for the TWSI (i2c) controller found on the Marvell
3306563a7SAlbert Aribaud  * orion5x and kirkwood SoC families.
401ec99d9SAlbert Aribaud  *
557b4bce9SAlbert ARIBAUD  * Author: Albert Aribaud <albert.u.boot@aribaud.net>
6306563a7SAlbert Aribaud  * Copyright (c) 2010 Albert Aribaud.
701ec99d9SAlbert Aribaud  *
81a459660SWolfgang Denk  * SPDX-License-Identifier:	GPL-2.0+
901ec99d9SAlbert Aribaud  */
10306563a7SAlbert Aribaud 
1101ec99d9SAlbert Aribaud #include <common.h>
1201ec99d9SAlbert Aribaud #include <i2c.h>
1301ec99d9SAlbert Aribaud #include <asm/errno.h>
1401ec99d9SAlbert Aribaud #include <asm/io.h>
1501ec99d9SAlbert Aribaud 
16306563a7SAlbert Aribaud /*
17dd82242bSPaul Kocialkowski  * include a file that will provide CONFIG_I2C_MVTWSI_BASE*
18306563a7SAlbert Aribaud  * and possibly other settings
19306563a7SAlbert Aribaud  */
2001ec99d9SAlbert Aribaud 
21306563a7SAlbert Aribaud #if defined(CONFIG_ORION5X)
22306563a7SAlbert Aribaud #include <asm/arch/orion5x.h>
2381e33f4bSStefan Roese #elif (defined(CONFIG_KIRKWOOD) || defined(CONFIG_ARCH_MVEBU))
243dc23f78SStefan Roese #include <asm/arch/soc.h>
256620377eSHans de Goede #elif defined(CONFIG_SUNXI)
266620377eSHans de Goede #include <asm/arch/i2c.h>
27306563a7SAlbert Aribaud #else
28306563a7SAlbert Aribaud #error Driver mvtwsi not supported by SoC or board
2901ec99d9SAlbert Aribaud #endif
3001ec99d9SAlbert Aribaud 
3101ec99d9SAlbert Aribaud /*
32306563a7SAlbert Aribaud  * TWSI register structure
3301ec99d9SAlbert Aribaud  */
3401ec99d9SAlbert Aribaud 
356620377eSHans de Goede #ifdef CONFIG_SUNXI
366620377eSHans de Goede 
376620377eSHans de Goede struct  mvtwsi_registers {
386620377eSHans de Goede 	u32 slave_address;
396620377eSHans de Goede 	u32 xtnd_slave_addr;
406620377eSHans de Goede 	u32 data;
416620377eSHans de Goede 	u32 control;
426620377eSHans de Goede 	u32 status;
436620377eSHans de Goede 	u32 baudrate;
446620377eSHans de Goede 	u32 soft_reset;
456620377eSHans de Goede };
466620377eSHans de Goede 
476620377eSHans de Goede #else
486620377eSHans de Goede 
49306563a7SAlbert Aribaud struct  mvtwsi_registers {
50306563a7SAlbert Aribaud 	u32 slave_address;
51306563a7SAlbert Aribaud 	u32 data;
52306563a7SAlbert Aribaud 	u32 control;
53306563a7SAlbert Aribaud 	union {
54306563a7SAlbert Aribaud 		u32 status;	/* when reading */
55306563a7SAlbert Aribaud 		u32 baudrate;	/* when writing */
56306563a7SAlbert Aribaud 	};
57306563a7SAlbert Aribaud 	u32 xtnd_slave_addr;
58306563a7SAlbert Aribaud 	u32 reserved[2];
59306563a7SAlbert Aribaud 	u32 soft_reset;
60306563a7SAlbert Aribaud };
61306563a7SAlbert Aribaud 
626620377eSHans de Goede #endif
636620377eSHans de Goede 
64306563a7SAlbert Aribaud /*
65306563a7SAlbert Aribaud  * Control register fields
66306563a7SAlbert Aribaud  */
67306563a7SAlbert Aribaud 
68306563a7SAlbert Aribaud #define	MVTWSI_CONTROL_ACK	0x00000004
69306563a7SAlbert Aribaud #define	MVTWSI_CONTROL_IFLG	0x00000008
70306563a7SAlbert Aribaud #define	MVTWSI_CONTROL_STOP	0x00000010
71306563a7SAlbert Aribaud #define	MVTWSI_CONTROL_START	0x00000020
72306563a7SAlbert Aribaud #define	MVTWSI_CONTROL_TWSIEN	0x00000040
73306563a7SAlbert Aribaud #define	MVTWSI_CONTROL_INTEN	0x00000080
74306563a7SAlbert Aribaud 
75306563a7SAlbert Aribaud /*
76*904dfbfdSHans de Goede  * On sun6i and newer IFLG is a write-clear bit which is cleared by writing 1,
77*904dfbfdSHans de Goede  * on other platforms it is a normal r/w bit which is cleared by writing 0.
78*904dfbfdSHans de Goede  */
79*904dfbfdSHans de Goede 
80*904dfbfdSHans de Goede #ifdef CONFIG_SUNXI_GEN_SUN6I
81*904dfbfdSHans de Goede #define	MVTWSI_CONTROL_CLEAR_IFLG	0x00000008
82*904dfbfdSHans de Goede #else
83*904dfbfdSHans de Goede #define	MVTWSI_CONTROL_CLEAR_IFLG	0x00000000
84*904dfbfdSHans de Goede #endif
85*904dfbfdSHans de Goede 
86*904dfbfdSHans de Goede /*
87306563a7SAlbert Aribaud  * Status register values -- only those expected in normal master
88306563a7SAlbert Aribaud  * operation on non-10-bit-address devices; whatever status we don't
89306563a7SAlbert Aribaud  * expect in nominal conditions (bus errors, arbitration losses,
90306563a7SAlbert Aribaud  * missing ACKs...) we just pass back to the caller as an error
91306563a7SAlbert Aribaud  * code.
92306563a7SAlbert Aribaud  */
93306563a7SAlbert Aribaud 
94306563a7SAlbert Aribaud #define	MVTWSI_STATUS_START		0x08
95306563a7SAlbert Aribaud #define	MVTWSI_STATUS_REPEATED_START	0x10
96306563a7SAlbert Aribaud #define	MVTWSI_STATUS_ADDR_W_ACK	0x18
97306563a7SAlbert Aribaud #define	MVTWSI_STATUS_DATA_W_ACK	0x28
98306563a7SAlbert Aribaud #define	MVTWSI_STATUS_ADDR_R_ACK	0x40
99306563a7SAlbert Aribaud #define	MVTWSI_STATUS_ADDR_R_NAK	0x48
100306563a7SAlbert Aribaud #define	MVTWSI_STATUS_DATA_R_ACK	0x50
101306563a7SAlbert Aribaud #define	MVTWSI_STATUS_DATA_R_NAK	0x58
102306563a7SAlbert Aribaud #define	MVTWSI_STATUS_IDLE		0xF8
103306563a7SAlbert Aribaud 
104306563a7SAlbert Aribaud /*
105dd82242bSPaul Kocialkowski  * MVTWSI controller base
106306563a7SAlbert Aribaud  */
107306563a7SAlbert Aribaud 
108dd82242bSPaul Kocialkowski static struct mvtwsi_registers *twsi_get_base(struct i2c_adapter *adap)
109dd82242bSPaul Kocialkowski {
110dd82242bSPaul Kocialkowski 	switch (adap->hwadapnr) {
111dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE0
112dd82242bSPaul Kocialkowski 	case 0:
113dd82242bSPaul Kocialkowski 		return (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE0;
114dd82242bSPaul Kocialkowski #endif
115dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE1
116dd82242bSPaul Kocialkowski 	case 1:
117dd82242bSPaul Kocialkowski 		return (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE1;
118dd82242bSPaul Kocialkowski #endif
119dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE2
120dd82242bSPaul Kocialkowski 	case 2:
121dd82242bSPaul Kocialkowski 		return (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE2;
122dd82242bSPaul Kocialkowski #endif
123dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE3
124dd82242bSPaul Kocialkowski 	case 3:
125dd82242bSPaul Kocialkowski 		return (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE3;
126dd82242bSPaul Kocialkowski #endif
127dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE4
128dd82242bSPaul Kocialkowski 	case 4:
129dd82242bSPaul Kocialkowski 		return (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE4;
130dd82242bSPaul Kocialkowski #endif
131dd82242bSPaul Kocialkowski 	default:
132dd82242bSPaul Kocialkowski 		printf("Missing mvtwsi controller %d base\n", adap->hwadapnr);
133dd82242bSPaul Kocialkowski 		break;
134dd82242bSPaul Kocialkowski 	}
135dd82242bSPaul Kocialkowski 
136dd82242bSPaul Kocialkowski 	return NULL;
137dd82242bSPaul Kocialkowski }
138306563a7SAlbert Aribaud 
139306563a7SAlbert Aribaud /*
140306563a7SAlbert Aribaud  * Returned statuses are 0 for success and nonzero otherwise.
141306563a7SAlbert Aribaud  * Currently, cmd_i2c and cmd_eeprom do not interpret an error status.
142306563a7SAlbert Aribaud  * Thus to ease debugging, the return status contains some debug info:
143306563a7SAlbert Aribaud  * - bits 31..24 are error class: 1 is timeout, 2 is 'status mismatch'.
144306563a7SAlbert Aribaud  * - bits 23..16 are the last value of the control register.
145306563a7SAlbert Aribaud  * - bits 15..8 are the last value of the status register.
146306563a7SAlbert Aribaud  * - bits 7..0 are the expected value of the status register.
147306563a7SAlbert Aribaud  */
148306563a7SAlbert Aribaud 
149306563a7SAlbert Aribaud #define MVTWSI_ERROR_WRONG_STATUS	0x01
150306563a7SAlbert Aribaud #define MVTWSI_ERROR_TIMEOUT		0x02
151306563a7SAlbert Aribaud 
152306563a7SAlbert Aribaud #define MVTWSI_ERROR(ec, lc, ls, es) (((ec << 24) & 0xFF000000) | \
153306563a7SAlbert Aribaud 	((lc << 16) & 0x00FF0000) | ((ls<<8) & 0x0000FF00) | (es & 0xFF))
154306563a7SAlbert Aribaud 
155306563a7SAlbert Aribaud /*
156306563a7SAlbert Aribaud  * Wait for IFLG to raise, or return 'timeout'; then if status is as expected,
157306563a7SAlbert Aribaud  * return 0 (ok) or return 'wrong status'.
158306563a7SAlbert Aribaud  */
159dd82242bSPaul Kocialkowski static int twsi_wait(struct i2c_adapter *adap, int expected_status)
16001ec99d9SAlbert Aribaud {
161dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
162306563a7SAlbert Aribaud 	int control, status;
163306563a7SAlbert Aribaud 	int timeout = 1000;
164306563a7SAlbert Aribaud 
165306563a7SAlbert Aribaud 	do {
166306563a7SAlbert Aribaud 		control = readl(&twsi->control);
167306563a7SAlbert Aribaud 		if (control & MVTWSI_CONTROL_IFLG) {
168306563a7SAlbert Aribaud 			status = readl(&twsi->status);
169306563a7SAlbert Aribaud 			if (status == expected_status)
170306563a7SAlbert Aribaud 				return 0;
17101ec99d9SAlbert Aribaud 			else
172306563a7SAlbert Aribaud 				return MVTWSI_ERROR(
173306563a7SAlbert Aribaud 					MVTWSI_ERROR_WRONG_STATUS,
174306563a7SAlbert Aribaud 					control, status, expected_status);
175306563a7SAlbert Aribaud 		}
176306563a7SAlbert Aribaud 		udelay(10); /* one clock cycle at 100 kHz */
177306563a7SAlbert Aribaud 	} while (timeout--);
178306563a7SAlbert Aribaud 	status = readl(&twsi->status);
179306563a7SAlbert Aribaud 	return MVTWSI_ERROR(
180306563a7SAlbert Aribaud 		MVTWSI_ERROR_TIMEOUT, control, status, expected_status);
18101ec99d9SAlbert Aribaud }
18201ec99d9SAlbert Aribaud 
183306563a7SAlbert Aribaud /*
184306563a7SAlbert Aribaud  * These flags are ORed to any write to the control register
185306563a7SAlbert Aribaud  * They allow global setting of TWSIEN and ACK.
186306563a7SAlbert Aribaud  * By default none are set.
187306563a7SAlbert Aribaud  * twsi_start() sets TWSIEN (in case the controller was disabled)
188306563a7SAlbert Aribaud  * twsi_recv() sets ACK or resets it depending on expected status.
189306563a7SAlbert Aribaud  */
190306563a7SAlbert Aribaud static u8 twsi_control_flags = MVTWSI_CONTROL_TWSIEN;
19101ec99d9SAlbert Aribaud 
192306563a7SAlbert Aribaud /*
193306563a7SAlbert Aribaud  * Assert the START condition, either in a single I2C transaction
194306563a7SAlbert Aribaud  * or inside back-to-back ones (repeated starts).
195306563a7SAlbert Aribaud  */
196dd82242bSPaul Kocialkowski static int twsi_start(struct i2c_adapter *adap, int expected_status)
197306563a7SAlbert Aribaud {
198dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
199dd82242bSPaul Kocialkowski 
200306563a7SAlbert Aribaud 	/* globally set TWSIEN in case it was not */
201306563a7SAlbert Aribaud 	twsi_control_flags |= MVTWSI_CONTROL_TWSIEN;
202306563a7SAlbert Aribaud 	/* assert START */
203*904dfbfdSHans de Goede 	twsi_control_flags |= MVTWSI_CONTROL_START | MVTWSI_CONTROL_CLEAR_IFLG;
204*904dfbfdSHans de Goede 	writel(twsi_control_flags, &twsi->control);
205306563a7SAlbert Aribaud 	/* wait for controller to process START */
206dd82242bSPaul Kocialkowski 	return twsi_wait(adap, expected_status);
207306563a7SAlbert Aribaud }
208306563a7SAlbert Aribaud 
209306563a7SAlbert Aribaud /*
210306563a7SAlbert Aribaud  * Send a byte (i2c address or data).
211306563a7SAlbert Aribaud  */
212dd82242bSPaul Kocialkowski static int twsi_send(struct i2c_adapter *adap, u8 byte, int expected_status)
213306563a7SAlbert Aribaud {
214dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
215dd82242bSPaul Kocialkowski 
216306563a7SAlbert Aribaud 	/* put byte in data register for sending */
217306563a7SAlbert Aribaud 	writel(byte, &twsi->data);
218306563a7SAlbert Aribaud 	/* clear any pending interrupt -- that'll cause sending */
219*904dfbfdSHans de Goede 	writel(twsi_control_flags | MVTWSI_CONTROL_CLEAR_IFLG, &twsi->control);
220306563a7SAlbert Aribaud 	/* wait for controller to receive byte and check ACK */
221dd82242bSPaul Kocialkowski 	return twsi_wait(adap, expected_status);
222306563a7SAlbert Aribaud }
223306563a7SAlbert Aribaud 
224306563a7SAlbert Aribaud /*
225306563a7SAlbert Aribaud  * Receive a byte.
226306563a7SAlbert Aribaud  * Global mvtwsi_control_flags variable says if we should ack or nak.
227306563a7SAlbert Aribaud  */
228dd82242bSPaul Kocialkowski static int twsi_recv(struct i2c_adapter *adap, u8 *byte)
229306563a7SAlbert Aribaud {
230dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
231306563a7SAlbert Aribaud 	int expected_status, status;
232306563a7SAlbert Aribaud 
233306563a7SAlbert Aribaud 	/* compute expected status based on ACK bit in global control flags */
234306563a7SAlbert Aribaud 	if (twsi_control_flags & MVTWSI_CONTROL_ACK)
235306563a7SAlbert Aribaud 		expected_status = MVTWSI_STATUS_DATA_R_ACK;
236306563a7SAlbert Aribaud 	else
237306563a7SAlbert Aribaud 		expected_status = MVTWSI_STATUS_DATA_R_NAK;
238306563a7SAlbert Aribaud 	/* acknowledge *previous state* and launch receive */
239*904dfbfdSHans de Goede 	writel(twsi_control_flags | MVTWSI_CONTROL_CLEAR_IFLG, &twsi->control);
240306563a7SAlbert Aribaud 	/* wait for controller to receive byte and assert ACK or NAK */
241dd82242bSPaul Kocialkowski 	status = twsi_wait(adap, expected_status);
242306563a7SAlbert Aribaud 	/* if we did receive expected byte then store it */
243306563a7SAlbert Aribaud 	if (status == 0)
244306563a7SAlbert Aribaud 		*byte = readl(&twsi->data);
245306563a7SAlbert Aribaud 	/* return status */
246306563a7SAlbert Aribaud 	return status;
247306563a7SAlbert Aribaud }
248306563a7SAlbert Aribaud 
249306563a7SAlbert Aribaud /*
250306563a7SAlbert Aribaud  * Assert the STOP condition.
251306563a7SAlbert Aribaud  * This is also used to force the bus back in idle (SDA=SCL=1).
252306563a7SAlbert Aribaud  */
253dd82242bSPaul Kocialkowski static int twsi_stop(struct i2c_adapter *adap, int status)
254306563a7SAlbert Aribaud {
255dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
256306563a7SAlbert Aribaud 	int control, stop_status;
257306563a7SAlbert Aribaud 	int timeout = 1000;
258306563a7SAlbert Aribaud 
259306563a7SAlbert Aribaud 	/* assert STOP */
260306563a7SAlbert Aribaud 	control = MVTWSI_CONTROL_TWSIEN | MVTWSI_CONTROL_STOP;
261*904dfbfdSHans de Goede 	writel(control | MVTWSI_CONTROL_CLEAR_IFLG, &twsi->control);
262306563a7SAlbert Aribaud 	/* wait for IDLE; IFLG won't rise so twsi_wait() is no use. */
263306563a7SAlbert Aribaud 	do {
264306563a7SAlbert Aribaud 		stop_status = readl(&twsi->status);
265306563a7SAlbert Aribaud 		if (stop_status == MVTWSI_STATUS_IDLE)
266306563a7SAlbert Aribaud 			break;
267306563a7SAlbert Aribaud 		udelay(10); /* one clock cycle at 100 kHz */
268306563a7SAlbert Aribaud 	} while (timeout--);
269306563a7SAlbert Aribaud 	control = readl(&twsi->control);
270306563a7SAlbert Aribaud 	if (stop_status != MVTWSI_STATUS_IDLE)
271306563a7SAlbert Aribaud 		if (status == 0)
272306563a7SAlbert Aribaud 			status = MVTWSI_ERROR(
273306563a7SAlbert Aribaud 				MVTWSI_ERROR_TIMEOUT,
274306563a7SAlbert Aribaud 				control, status, MVTWSI_STATUS_IDLE);
275306563a7SAlbert Aribaud 	return status;
276306563a7SAlbert Aribaud }
277306563a7SAlbert Aribaud 
278f582a158SStefan Roese static unsigned int twsi_calc_freq(const int n, const int m)
279f582a158SStefan Roese {
280f582a158SStefan Roese #ifdef CONFIG_SUNXI
281f582a158SStefan Roese 	return CONFIG_SYS_TCLK / (10 * (m + 1) * (1 << n));
282f582a158SStefan Roese #else
283f582a158SStefan Roese 	return CONFIG_SYS_TCLK / (10 * (m + 1) * (2 << n));
284f582a158SStefan Roese #endif
285f582a158SStefan Roese }
286306563a7SAlbert Aribaud 
287306563a7SAlbert Aribaud /*
288306563a7SAlbert Aribaud  * Reset controller.
289306563a7SAlbert Aribaud  * Controller reset also resets the baud rate and slave address, so
2900db2bbdcSHans de Goede  * they must be re-established afterwards.
291306563a7SAlbert Aribaud  */
2920db2bbdcSHans de Goede static void twsi_reset(struct i2c_adapter *adap)
293306563a7SAlbert Aribaud {
294dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
295306563a7SAlbert Aribaud 	/* ensure controller will be enabled by any twsi*() function */
296306563a7SAlbert Aribaud 	twsi_control_flags = MVTWSI_CONTROL_TWSIEN;
297306563a7SAlbert Aribaud 	/* reset controller */
298306563a7SAlbert Aribaud 	writel(0, &twsi->soft_reset);
299306563a7SAlbert Aribaud 	/* wait 2 ms -- this is what the Marvell LSP does */
300306563a7SAlbert Aribaud 	udelay(20000);
301306563a7SAlbert Aribaud }
302306563a7SAlbert Aribaud 
303306563a7SAlbert Aribaud /*
304306563a7SAlbert Aribaud  * I2C init called by cmd_i2c when doing 'i2c reset'.
305306563a7SAlbert Aribaud  * Sets baud to the highest possible value not exceeding requested one.
306306563a7SAlbert Aribaud  */
3070db2bbdcSHans de Goede static unsigned int twsi_i2c_set_bus_speed(struct i2c_adapter *adap,
3080db2bbdcSHans de Goede 					   unsigned int requested_speed)
309306563a7SAlbert Aribaud {
310dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
3110db2bbdcSHans de Goede 	unsigned int tmp_speed, highest_speed, n, m;
3120db2bbdcSHans de Goede 	unsigned int baud = 0x44; /* baudrate at controller reset */
313306563a7SAlbert Aribaud 
314306563a7SAlbert Aribaud 	/* use actual speed to collect progressively higher values */
315306563a7SAlbert Aribaud 	highest_speed = 0;
316306563a7SAlbert Aribaud 	/* compute m, n setting for highest speed not above requested speed */
31701ec99d9SAlbert Aribaud 	for (n = 0; n < 8; n++) {
31801ec99d9SAlbert Aribaud 		for (m = 0; m < 16; m++) {
319f582a158SStefan Roese 			tmp_speed = twsi_calc_freq(n, m);
320306563a7SAlbert Aribaud 			if ((tmp_speed <= requested_speed)
321306563a7SAlbert Aribaud 			 && (tmp_speed > highest_speed)) {
322306563a7SAlbert Aribaud 				highest_speed = tmp_speed;
323306563a7SAlbert Aribaud 				baud = (m << 3) | n;
32401ec99d9SAlbert Aribaud 			}
32501ec99d9SAlbert Aribaud 		}
32601ec99d9SAlbert Aribaud 	}
3270db2bbdcSHans de Goede 	writel(baud, &twsi->baudrate);
3280db2bbdcSHans de Goede 	return 0;
3290db2bbdcSHans de Goede }
3300db2bbdcSHans de Goede 
3310db2bbdcSHans de Goede static void twsi_i2c_init(struct i2c_adapter *adap, int speed, int slaveadd)
3320db2bbdcSHans de Goede {
333dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
334dd82242bSPaul Kocialkowski 
335306563a7SAlbert Aribaud 	/* reset controller */
3360db2bbdcSHans de Goede 	twsi_reset(adap);
3370db2bbdcSHans de Goede 	/* set speed */
3380db2bbdcSHans de Goede 	twsi_i2c_set_bus_speed(adap, speed);
3390db2bbdcSHans de Goede 	/* set slave address even though we don't use it */
3400db2bbdcSHans de Goede 	writel(slaveadd, &twsi->slave_address);
3410db2bbdcSHans de Goede 	writel(0, &twsi->xtnd_slave_addr);
3420db2bbdcSHans de Goede 	/* assert STOP but don't care for the result */
343dd82242bSPaul Kocialkowski 	(void) twsi_stop(adap, 0);
34401ec99d9SAlbert Aribaud }
34501ec99d9SAlbert Aribaud 
34601ec99d9SAlbert Aribaud /*
347306563a7SAlbert Aribaud  * Begin I2C transaction with expected start status, at given address.
348306563a7SAlbert Aribaud  * Common to i2c_probe, i2c_read and i2c_write.
349306563a7SAlbert Aribaud  * Expected address status will derive from direction bit (bit 0) in addr.
35001ec99d9SAlbert Aribaud  */
351dd82242bSPaul Kocialkowski static int i2c_begin(struct i2c_adapter *adap, int expected_start_status,
352dd82242bSPaul Kocialkowski 		     u8 addr)
35301ec99d9SAlbert Aribaud {
354306563a7SAlbert Aribaud 	int status, expected_addr_status;
35501ec99d9SAlbert Aribaud 
356306563a7SAlbert Aribaud 	/* compute expected address status from direction bit in addr */
357306563a7SAlbert Aribaud 	if (addr & 1) /* reading */
358306563a7SAlbert Aribaud 		expected_addr_status = MVTWSI_STATUS_ADDR_R_ACK;
359306563a7SAlbert Aribaud 	else /* writing */
360306563a7SAlbert Aribaud 		expected_addr_status = MVTWSI_STATUS_ADDR_W_ACK;
361306563a7SAlbert Aribaud 	/* assert START */
362dd82242bSPaul Kocialkowski 	status = twsi_start(adap, expected_start_status);
363306563a7SAlbert Aribaud 	/* send out the address if the start went well */
364306563a7SAlbert Aribaud 	if (status == 0)
365dd82242bSPaul Kocialkowski 		status = twsi_send(adap, addr, expected_addr_status);
366306563a7SAlbert Aribaud 	/* return ok or status of first failure to caller */
367306563a7SAlbert Aribaud 	return status;
36801ec99d9SAlbert Aribaud }
36901ec99d9SAlbert Aribaud 
370306563a7SAlbert Aribaud /*
371306563a7SAlbert Aribaud  * I2C probe called by cmd_i2c when doing 'i2c probe'.
372306563a7SAlbert Aribaud  * Begin read, nak data byte, end.
373306563a7SAlbert Aribaud  */
3740db2bbdcSHans de Goede static int twsi_i2c_probe(struct i2c_adapter *adap, uchar chip)
37501ec99d9SAlbert Aribaud {
376306563a7SAlbert Aribaud 	u8 dummy_byte;
377306563a7SAlbert Aribaud 	int status;
37801ec99d9SAlbert Aribaud 
379306563a7SAlbert Aribaud 	/* begin i2c read */
380dd82242bSPaul Kocialkowski 	status = i2c_begin(adap, MVTWSI_STATUS_START, (chip << 1) | 1);
381306563a7SAlbert Aribaud 	/* dummy read was accepted: receive byte but NAK it. */
382306563a7SAlbert Aribaud 	if (status == 0)
383dd82242bSPaul Kocialkowski 		status = twsi_recv(adap, &dummy_byte);
384306563a7SAlbert Aribaud 	/* Stop transaction */
385dd82242bSPaul Kocialkowski 	twsi_stop(adap, 0);
386306563a7SAlbert Aribaud 	/* return 0 or status of first failure */
387306563a7SAlbert Aribaud 	return status;
38801ec99d9SAlbert Aribaud }
38901ec99d9SAlbert Aribaud 
390306563a7SAlbert Aribaud /*
391306563a7SAlbert Aribaud  * I2C read called by cmd_i2c when doing 'i2c read' and by cmd_eeprom.c
392306563a7SAlbert Aribaud  * Begin write, send address byte(s), begin read, receive data bytes, end.
393306563a7SAlbert Aribaud  *
394306563a7SAlbert Aribaud  * NOTE: some EEPROMS want a stop right before the second start, while
395306563a7SAlbert Aribaud  * some will choke if it is there. Deciding which we should do is eeprom
396306563a7SAlbert Aribaud  * stuff, not i2c, but at the moment the APIs won't let us put it in
397306563a7SAlbert Aribaud  * cmd_eeprom, so we have to choose here, and for the moment that'll be
398306563a7SAlbert Aribaud  * a repeated start without a preceding stop.
399306563a7SAlbert Aribaud  */
4000db2bbdcSHans de Goede static int twsi_i2c_read(struct i2c_adapter *adap, uchar chip, uint addr,
4010db2bbdcSHans de Goede 			int alen, uchar *data, int length)
40201ec99d9SAlbert Aribaud {
403306563a7SAlbert Aribaud 	int status;
40401ec99d9SAlbert Aribaud 
405306563a7SAlbert Aribaud 	/* begin i2c write to send the address bytes */
406dd82242bSPaul Kocialkowski 	status = i2c_begin(adap, MVTWSI_STATUS_START, (chip << 1));
407306563a7SAlbert Aribaud 	/* send addr bytes */
408306563a7SAlbert Aribaud 	while ((status == 0) && alen--)
409dd82242bSPaul Kocialkowski 		status = twsi_send(adap, addr >> (8*alen),
410306563a7SAlbert Aribaud 			MVTWSI_STATUS_DATA_W_ACK);
411306563a7SAlbert Aribaud 	/* begin i2c read to receive eeprom data bytes */
412306563a7SAlbert Aribaud 	if (status == 0)
413dd82242bSPaul Kocialkowski 		status = i2c_begin(adap, MVTWSI_STATUS_REPEATED_START,
414dd82242bSPaul Kocialkowski 				   (chip << 1) | 1);
415306563a7SAlbert Aribaud 	/* prepare ACK if at least one byte must be received */
416306563a7SAlbert Aribaud 	if (length > 0)
417306563a7SAlbert Aribaud 		twsi_control_flags |= MVTWSI_CONTROL_ACK;
418306563a7SAlbert Aribaud 	/* now receive actual bytes */
419306563a7SAlbert Aribaud 	while ((status == 0) && length--) {
420306563a7SAlbert Aribaud 		/* reset NAK if we if no more to read now */
421306563a7SAlbert Aribaud 		if (length == 0)
422306563a7SAlbert Aribaud 			twsi_control_flags &= ~MVTWSI_CONTROL_ACK;
423306563a7SAlbert Aribaud 		/* read current byte */
424dd82242bSPaul Kocialkowski 		status = twsi_recv(adap, data++);
42501ec99d9SAlbert Aribaud 	}
426306563a7SAlbert Aribaud 	/* Stop transaction */
427dd82242bSPaul Kocialkowski 	status = twsi_stop(adap, status);
428306563a7SAlbert Aribaud 	/* return 0 or status of first failure */
429306563a7SAlbert Aribaud 	return status;
43001ec99d9SAlbert Aribaud }
43101ec99d9SAlbert Aribaud 
432306563a7SAlbert Aribaud /*
433306563a7SAlbert Aribaud  * I2C write called by cmd_i2c when doing 'i2c write' and by cmd_eeprom.c
434306563a7SAlbert Aribaud  * Begin write, send address byte(s), send data bytes, end.
435306563a7SAlbert Aribaud  */
4360db2bbdcSHans de Goede static int twsi_i2c_write(struct i2c_adapter *adap, uchar chip, uint addr,
4370db2bbdcSHans de Goede 			int alen, uchar *data, int length)
43801ec99d9SAlbert Aribaud {
439306563a7SAlbert Aribaud 	int status;
44001ec99d9SAlbert Aribaud 
441306563a7SAlbert Aribaud 	/* begin i2c write to send the eeprom adress bytes then data bytes */
442dd82242bSPaul Kocialkowski 	status = i2c_begin(adap, MVTWSI_STATUS_START, (chip << 1));
443306563a7SAlbert Aribaud 	/* send addr bytes */
444306563a7SAlbert Aribaud 	while ((status == 0) && alen--)
445dd82242bSPaul Kocialkowski 		status = twsi_send(adap, addr >> (8*alen),
446306563a7SAlbert Aribaud 			MVTWSI_STATUS_DATA_W_ACK);
447306563a7SAlbert Aribaud 	/* send data bytes */
448306563a7SAlbert Aribaud 	while ((status == 0) && (length-- > 0))
449dd82242bSPaul Kocialkowski 		status = twsi_send(adap, *(data++), MVTWSI_STATUS_DATA_W_ACK);
450306563a7SAlbert Aribaud 	/* Stop transaction */
451dd82242bSPaul Kocialkowski 	status = twsi_stop(adap, status);
452306563a7SAlbert Aribaud 	/* return 0 or status of first failure */
453306563a7SAlbert Aribaud 	return status;
45401ec99d9SAlbert Aribaud }
45501ec99d9SAlbert Aribaud 
456dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE0
4570db2bbdcSHans de Goede U_BOOT_I2C_ADAP_COMPLETE(twsi0, twsi_i2c_init, twsi_i2c_probe,
4580db2bbdcSHans de Goede 			 twsi_i2c_read, twsi_i2c_write,
4590db2bbdcSHans de Goede 			 twsi_i2c_set_bus_speed,
4600db2bbdcSHans de Goede 			 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 0)
461dd82242bSPaul Kocialkowski #endif
462dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE1
463dd82242bSPaul Kocialkowski U_BOOT_I2C_ADAP_COMPLETE(twsi1, twsi_i2c_init, twsi_i2c_probe,
464dd82242bSPaul Kocialkowski 			 twsi_i2c_read, twsi_i2c_write,
465dd82242bSPaul Kocialkowski 			 twsi_i2c_set_bus_speed,
466dd82242bSPaul Kocialkowski 			 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 1)
467dd82242bSPaul Kocialkowski 
468dd82242bSPaul Kocialkowski #endif
469dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE2
470dd82242bSPaul Kocialkowski U_BOOT_I2C_ADAP_COMPLETE(twsi2, twsi_i2c_init, twsi_i2c_probe,
471dd82242bSPaul Kocialkowski 			 twsi_i2c_read, twsi_i2c_write,
472dd82242bSPaul Kocialkowski 			 twsi_i2c_set_bus_speed,
473dd82242bSPaul Kocialkowski 			 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 2)
474dd82242bSPaul Kocialkowski 
475dd82242bSPaul Kocialkowski #endif
476dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE3
477dd82242bSPaul Kocialkowski U_BOOT_I2C_ADAP_COMPLETE(twsi3, twsi_i2c_init, twsi_i2c_probe,
478dd82242bSPaul Kocialkowski 			 twsi_i2c_read, twsi_i2c_write,
479dd82242bSPaul Kocialkowski 			 twsi_i2c_set_bus_speed,
480dd82242bSPaul Kocialkowski 			 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 3)
481dd82242bSPaul Kocialkowski 
482dd82242bSPaul Kocialkowski #endif
483dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE4
484dd82242bSPaul Kocialkowski U_BOOT_I2C_ADAP_COMPLETE(twsi4, twsi_i2c_init, twsi_i2c_probe,
485dd82242bSPaul Kocialkowski 			 twsi_i2c_read, twsi_i2c_write,
486dd82242bSPaul Kocialkowski 			 twsi_i2c_set_bus_speed,
487dd82242bSPaul Kocialkowski 			 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 4)
488dd82242bSPaul Kocialkowski 
489dd82242bSPaul Kocialkowski #endif
490