xref: /rk3399_rockchip-uboot/drivers/i2c/mvtwsi.c (revision 81e33f4b65171a7dcb99a3efd9b3a45da129a21a)
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>
23*81e33f4bSStefan 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 /*
76306563a7SAlbert Aribaud  * Status register values -- only those expected in normal master
77306563a7SAlbert Aribaud  * operation on non-10-bit-address devices; whatever status we don't
78306563a7SAlbert Aribaud  * expect in nominal conditions (bus errors, arbitration losses,
79306563a7SAlbert Aribaud  * missing ACKs...) we just pass back to the caller as an error
80306563a7SAlbert Aribaud  * code.
81306563a7SAlbert Aribaud  */
82306563a7SAlbert Aribaud 
83306563a7SAlbert Aribaud #define	MVTWSI_STATUS_START		0x08
84306563a7SAlbert Aribaud #define	MVTWSI_STATUS_REPEATED_START	0x10
85306563a7SAlbert Aribaud #define	MVTWSI_STATUS_ADDR_W_ACK	0x18
86306563a7SAlbert Aribaud #define	MVTWSI_STATUS_DATA_W_ACK	0x28
87306563a7SAlbert Aribaud #define	MVTWSI_STATUS_ADDR_R_ACK	0x40
88306563a7SAlbert Aribaud #define	MVTWSI_STATUS_ADDR_R_NAK	0x48
89306563a7SAlbert Aribaud #define	MVTWSI_STATUS_DATA_R_ACK	0x50
90306563a7SAlbert Aribaud #define	MVTWSI_STATUS_DATA_R_NAK	0x58
91306563a7SAlbert Aribaud #define	MVTWSI_STATUS_IDLE		0xF8
92306563a7SAlbert Aribaud 
93306563a7SAlbert Aribaud /*
94dd82242bSPaul Kocialkowski  * MVTWSI controller base
95306563a7SAlbert Aribaud  */
96306563a7SAlbert Aribaud 
97dd82242bSPaul Kocialkowski static struct mvtwsi_registers *twsi_get_base(struct i2c_adapter *adap)
98dd82242bSPaul Kocialkowski {
99dd82242bSPaul Kocialkowski 	switch (adap->hwadapnr) {
100dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE0
101dd82242bSPaul Kocialkowski 	case 0:
102dd82242bSPaul Kocialkowski 		return (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE0;
103dd82242bSPaul Kocialkowski #endif
104dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE1
105dd82242bSPaul Kocialkowski 	case 1:
106dd82242bSPaul Kocialkowski 		return (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE1;
107dd82242bSPaul Kocialkowski #endif
108dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE2
109dd82242bSPaul Kocialkowski 	case 2:
110dd82242bSPaul Kocialkowski 		return (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE2;
111dd82242bSPaul Kocialkowski #endif
112dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE3
113dd82242bSPaul Kocialkowski 	case 3:
114dd82242bSPaul Kocialkowski 		return (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE3;
115dd82242bSPaul Kocialkowski #endif
116dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE4
117dd82242bSPaul Kocialkowski 	case 4:
118dd82242bSPaul Kocialkowski 		return (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE4;
119dd82242bSPaul Kocialkowski #endif
120dd82242bSPaul Kocialkowski 	default:
121dd82242bSPaul Kocialkowski 		printf("Missing mvtwsi controller %d base\n", adap->hwadapnr);
122dd82242bSPaul Kocialkowski 		break;
123dd82242bSPaul Kocialkowski 	}
124dd82242bSPaul Kocialkowski 
125dd82242bSPaul Kocialkowski 	return NULL;
126dd82242bSPaul Kocialkowski }
127306563a7SAlbert Aribaud 
128306563a7SAlbert Aribaud /*
129306563a7SAlbert Aribaud  * Returned statuses are 0 for success and nonzero otherwise.
130306563a7SAlbert Aribaud  * Currently, cmd_i2c and cmd_eeprom do not interpret an error status.
131306563a7SAlbert Aribaud  * Thus to ease debugging, the return status contains some debug info:
132306563a7SAlbert Aribaud  * - bits 31..24 are error class: 1 is timeout, 2 is 'status mismatch'.
133306563a7SAlbert Aribaud  * - bits 23..16 are the last value of the control register.
134306563a7SAlbert Aribaud  * - bits 15..8 are the last value of the status register.
135306563a7SAlbert Aribaud  * - bits 7..0 are the expected value of the status register.
136306563a7SAlbert Aribaud  */
137306563a7SAlbert Aribaud 
138306563a7SAlbert Aribaud #define MVTWSI_ERROR_WRONG_STATUS	0x01
139306563a7SAlbert Aribaud #define MVTWSI_ERROR_TIMEOUT		0x02
140306563a7SAlbert Aribaud 
141306563a7SAlbert Aribaud #define MVTWSI_ERROR(ec, lc, ls, es) (((ec << 24) & 0xFF000000) | \
142306563a7SAlbert Aribaud 	((lc << 16) & 0x00FF0000) | ((ls<<8) & 0x0000FF00) | (es & 0xFF))
143306563a7SAlbert Aribaud 
144306563a7SAlbert Aribaud /*
145306563a7SAlbert Aribaud  * Wait for IFLG to raise, or return 'timeout'; then if status is as expected,
146306563a7SAlbert Aribaud  * return 0 (ok) or return 'wrong status'.
147306563a7SAlbert Aribaud  */
148dd82242bSPaul Kocialkowski static int twsi_wait(struct i2c_adapter *adap, int expected_status)
14901ec99d9SAlbert Aribaud {
150dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
151306563a7SAlbert Aribaud 	int control, status;
152306563a7SAlbert Aribaud 	int timeout = 1000;
153306563a7SAlbert Aribaud 
154306563a7SAlbert Aribaud 	do {
155306563a7SAlbert Aribaud 		control = readl(&twsi->control);
156306563a7SAlbert Aribaud 		if (control & MVTWSI_CONTROL_IFLG) {
157306563a7SAlbert Aribaud 			status = readl(&twsi->status);
158306563a7SAlbert Aribaud 			if (status == expected_status)
159306563a7SAlbert Aribaud 				return 0;
16001ec99d9SAlbert Aribaud 			else
161306563a7SAlbert Aribaud 				return MVTWSI_ERROR(
162306563a7SAlbert Aribaud 					MVTWSI_ERROR_WRONG_STATUS,
163306563a7SAlbert Aribaud 					control, status, expected_status);
164306563a7SAlbert Aribaud 		}
165306563a7SAlbert Aribaud 		udelay(10); /* one clock cycle at 100 kHz */
166306563a7SAlbert Aribaud 	} while (timeout--);
167306563a7SAlbert Aribaud 	status = readl(&twsi->status);
168306563a7SAlbert Aribaud 	return MVTWSI_ERROR(
169306563a7SAlbert Aribaud 		MVTWSI_ERROR_TIMEOUT, control, status, expected_status);
17001ec99d9SAlbert Aribaud }
17101ec99d9SAlbert Aribaud 
172306563a7SAlbert Aribaud /*
173306563a7SAlbert Aribaud  * These flags are ORed to any write to the control register
174306563a7SAlbert Aribaud  * They allow global setting of TWSIEN and ACK.
175306563a7SAlbert Aribaud  * By default none are set.
176306563a7SAlbert Aribaud  * twsi_start() sets TWSIEN (in case the controller was disabled)
177306563a7SAlbert Aribaud  * twsi_recv() sets ACK or resets it depending on expected status.
178306563a7SAlbert Aribaud  */
179306563a7SAlbert Aribaud static u8 twsi_control_flags = MVTWSI_CONTROL_TWSIEN;
18001ec99d9SAlbert Aribaud 
181306563a7SAlbert Aribaud /*
182306563a7SAlbert Aribaud  * Assert the START condition, either in a single I2C transaction
183306563a7SAlbert Aribaud  * or inside back-to-back ones (repeated starts).
184306563a7SAlbert Aribaud  */
185dd82242bSPaul Kocialkowski static int twsi_start(struct i2c_adapter *adap, int expected_status)
186306563a7SAlbert Aribaud {
187dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
188dd82242bSPaul Kocialkowski 
189306563a7SAlbert Aribaud 	/* globally set TWSIEN in case it was not */
190306563a7SAlbert Aribaud 	twsi_control_flags |= MVTWSI_CONTROL_TWSIEN;
191306563a7SAlbert Aribaud 	/* assert START */
192306563a7SAlbert Aribaud 	writel(twsi_control_flags | MVTWSI_CONTROL_START, &twsi->control);
193306563a7SAlbert Aribaud 	/* wait for controller to process START */
194dd82242bSPaul Kocialkowski 	return twsi_wait(adap, expected_status);
195306563a7SAlbert Aribaud }
196306563a7SAlbert Aribaud 
197306563a7SAlbert Aribaud /*
198306563a7SAlbert Aribaud  * Send a byte (i2c address or data).
199306563a7SAlbert Aribaud  */
200dd82242bSPaul Kocialkowski static int twsi_send(struct i2c_adapter *adap, u8 byte, int expected_status)
201306563a7SAlbert Aribaud {
202dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
203dd82242bSPaul Kocialkowski 
204306563a7SAlbert Aribaud 	/* put byte in data register for sending */
205306563a7SAlbert Aribaud 	writel(byte, &twsi->data);
206306563a7SAlbert Aribaud 	/* clear any pending interrupt -- that'll cause sending */
207306563a7SAlbert Aribaud 	writel(twsi_control_flags, &twsi->control);
208306563a7SAlbert Aribaud 	/* wait for controller to receive byte and check ACK */
209dd82242bSPaul Kocialkowski 	return twsi_wait(adap, expected_status);
210306563a7SAlbert Aribaud }
211306563a7SAlbert Aribaud 
212306563a7SAlbert Aribaud /*
213306563a7SAlbert Aribaud  * Receive a byte.
214306563a7SAlbert Aribaud  * Global mvtwsi_control_flags variable says if we should ack or nak.
215306563a7SAlbert Aribaud  */
216dd82242bSPaul Kocialkowski static int twsi_recv(struct i2c_adapter *adap, u8 *byte)
217306563a7SAlbert Aribaud {
218dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
219306563a7SAlbert Aribaud 	int expected_status, status;
220306563a7SAlbert Aribaud 
221306563a7SAlbert Aribaud 	/* compute expected status based on ACK bit in global control flags */
222306563a7SAlbert Aribaud 	if (twsi_control_flags & MVTWSI_CONTROL_ACK)
223306563a7SAlbert Aribaud 		expected_status = MVTWSI_STATUS_DATA_R_ACK;
224306563a7SAlbert Aribaud 	else
225306563a7SAlbert Aribaud 		expected_status = MVTWSI_STATUS_DATA_R_NAK;
226306563a7SAlbert Aribaud 	/* acknowledge *previous state* and launch receive */
227306563a7SAlbert Aribaud 	writel(twsi_control_flags, &twsi->control);
228306563a7SAlbert Aribaud 	/* wait for controller to receive byte and assert ACK or NAK */
229dd82242bSPaul Kocialkowski 	status = twsi_wait(adap, expected_status);
230306563a7SAlbert Aribaud 	/* if we did receive expected byte then store it */
231306563a7SAlbert Aribaud 	if (status == 0)
232306563a7SAlbert Aribaud 		*byte = readl(&twsi->data);
233306563a7SAlbert Aribaud 	/* return status */
234306563a7SAlbert Aribaud 	return status;
235306563a7SAlbert Aribaud }
236306563a7SAlbert Aribaud 
237306563a7SAlbert Aribaud /*
238306563a7SAlbert Aribaud  * Assert the STOP condition.
239306563a7SAlbert Aribaud  * This is also used to force the bus back in idle (SDA=SCL=1).
240306563a7SAlbert Aribaud  */
241dd82242bSPaul Kocialkowski static int twsi_stop(struct i2c_adapter *adap, int status)
242306563a7SAlbert Aribaud {
243dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
244306563a7SAlbert Aribaud 	int control, stop_status;
245306563a7SAlbert Aribaud 	int timeout = 1000;
246306563a7SAlbert Aribaud 
247306563a7SAlbert Aribaud 	/* assert STOP */
248306563a7SAlbert Aribaud 	control = MVTWSI_CONTROL_TWSIEN | MVTWSI_CONTROL_STOP;
249306563a7SAlbert Aribaud 	writel(control, &twsi->control);
250306563a7SAlbert Aribaud 	/* wait for IDLE; IFLG won't rise so twsi_wait() is no use. */
251306563a7SAlbert Aribaud 	do {
252306563a7SAlbert Aribaud 		stop_status = readl(&twsi->status);
253306563a7SAlbert Aribaud 		if (stop_status == MVTWSI_STATUS_IDLE)
254306563a7SAlbert Aribaud 			break;
255306563a7SAlbert Aribaud 		udelay(10); /* one clock cycle at 100 kHz */
256306563a7SAlbert Aribaud 	} while (timeout--);
257306563a7SAlbert Aribaud 	control = readl(&twsi->control);
258306563a7SAlbert Aribaud 	if (stop_status != MVTWSI_STATUS_IDLE)
259306563a7SAlbert Aribaud 		if (status == 0)
260306563a7SAlbert Aribaud 			status = MVTWSI_ERROR(
261306563a7SAlbert Aribaud 				MVTWSI_ERROR_TIMEOUT,
262306563a7SAlbert Aribaud 				control, status, MVTWSI_STATUS_IDLE);
263306563a7SAlbert Aribaud 	return status;
264306563a7SAlbert Aribaud }
265306563a7SAlbert Aribaud 
266f582a158SStefan Roese static unsigned int twsi_calc_freq(const int n, const int m)
267f582a158SStefan Roese {
268f582a158SStefan Roese #ifdef CONFIG_SUNXI
269f582a158SStefan Roese 	return CONFIG_SYS_TCLK / (10 * (m + 1) * (1 << n));
270f582a158SStefan Roese #else
271f582a158SStefan Roese 	return CONFIG_SYS_TCLK / (10 * (m + 1) * (2 << n));
272f582a158SStefan Roese #endif
273f582a158SStefan Roese }
274306563a7SAlbert Aribaud 
275306563a7SAlbert Aribaud /*
276306563a7SAlbert Aribaud  * Reset controller.
277306563a7SAlbert Aribaud  * Controller reset also resets the baud rate and slave address, so
2780db2bbdcSHans de Goede  * they must be re-established afterwards.
279306563a7SAlbert Aribaud  */
2800db2bbdcSHans de Goede static void twsi_reset(struct i2c_adapter *adap)
281306563a7SAlbert Aribaud {
282dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
283306563a7SAlbert Aribaud 	/* ensure controller will be enabled by any twsi*() function */
284306563a7SAlbert Aribaud 	twsi_control_flags = MVTWSI_CONTROL_TWSIEN;
285306563a7SAlbert Aribaud 	/* reset controller */
286306563a7SAlbert Aribaud 	writel(0, &twsi->soft_reset);
287306563a7SAlbert Aribaud 	/* wait 2 ms -- this is what the Marvell LSP does */
288306563a7SAlbert Aribaud 	udelay(20000);
289306563a7SAlbert Aribaud }
290306563a7SAlbert Aribaud 
291306563a7SAlbert Aribaud /*
292306563a7SAlbert Aribaud  * I2C init called by cmd_i2c when doing 'i2c reset'.
293306563a7SAlbert Aribaud  * Sets baud to the highest possible value not exceeding requested one.
294306563a7SAlbert Aribaud  */
2950db2bbdcSHans de Goede static unsigned int twsi_i2c_set_bus_speed(struct i2c_adapter *adap,
2960db2bbdcSHans de Goede 					   unsigned int requested_speed)
297306563a7SAlbert Aribaud {
298dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
2990db2bbdcSHans de Goede 	unsigned int tmp_speed, highest_speed, n, m;
3000db2bbdcSHans de Goede 	unsigned int baud = 0x44; /* baudrate at controller reset */
301306563a7SAlbert Aribaud 
302306563a7SAlbert Aribaud 	/* use actual speed to collect progressively higher values */
303306563a7SAlbert Aribaud 	highest_speed = 0;
304306563a7SAlbert Aribaud 	/* compute m, n setting for highest speed not above requested speed */
30501ec99d9SAlbert Aribaud 	for (n = 0; n < 8; n++) {
30601ec99d9SAlbert Aribaud 		for (m = 0; m < 16; m++) {
307f582a158SStefan Roese 			tmp_speed = twsi_calc_freq(n, m);
308306563a7SAlbert Aribaud 			if ((tmp_speed <= requested_speed)
309306563a7SAlbert Aribaud 			 && (tmp_speed > highest_speed)) {
310306563a7SAlbert Aribaud 				highest_speed = tmp_speed;
311306563a7SAlbert Aribaud 				baud = (m << 3) | n;
31201ec99d9SAlbert Aribaud 			}
31301ec99d9SAlbert Aribaud 		}
31401ec99d9SAlbert Aribaud 	}
3150db2bbdcSHans de Goede 	writel(baud, &twsi->baudrate);
3160db2bbdcSHans de Goede 	return 0;
3170db2bbdcSHans de Goede }
3180db2bbdcSHans de Goede 
3190db2bbdcSHans de Goede static void twsi_i2c_init(struct i2c_adapter *adap, int speed, int slaveadd)
3200db2bbdcSHans de Goede {
321dd82242bSPaul Kocialkowski 	struct mvtwsi_registers *twsi = twsi_get_base(adap);
322dd82242bSPaul Kocialkowski 
323306563a7SAlbert Aribaud 	/* reset controller */
3240db2bbdcSHans de Goede 	twsi_reset(adap);
3250db2bbdcSHans de Goede 	/* set speed */
3260db2bbdcSHans de Goede 	twsi_i2c_set_bus_speed(adap, speed);
3270db2bbdcSHans de Goede 	/* set slave address even though we don't use it */
3280db2bbdcSHans de Goede 	writel(slaveadd, &twsi->slave_address);
3290db2bbdcSHans de Goede 	writel(0, &twsi->xtnd_slave_addr);
3300db2bbdcSHans de Goede 	/* assert STOP but don't care for the result */
331dd82242bSPaul Kocialkowski 	(void) twsi_stop(adap, 0);
33201ec99d9SAlbert Aribaud }
33301ec99d9SAlbert Aribaud 
33401ec99d9SAlbert Aribaud /*
335306563a7SAlbert Aribaud  * Begin I2C transaction with expected start status, at given address.
336306563a7SAlbert Aribaud  * Common to i2c_probe, i2c_read and i2c_write.
337306563a7SAlbert Aribaud  * Expected address status will derive from direction bit (bit 0) in addr.
33801ec99d9SAlbert Aribaud  */
339dd82242bSPaul Kocialkowski static int i2c_begin(struct i2c_adapter *adap, int expected_start_status,
340dd82242bSPaul Kocialkowski 		     u8 addr)
34101ec99d9SAlbert Aribaud {
342306563a7SAlbert Aribaud 	int status, expected_addr_status;
34301ec99d9SAlbert Aribaud 
344306563a7SAlbert Aribaud 	/* compute expected address status from direction bit in addr */
345306563a7SAlbert Aribaud 	if (addr & 1) /* reading */
346306563a7SAlbert Aribaud 		expected_addr_status = MVTWSI_STATUS_ADDR_R_ACK;
347306563a7SAlbert Aribaud 	else /* writing */
348306563a7SAlbert Aribaud 		expected_addr_status = MVTWSI_STATUS_ADDR_W_ACK;
349306563a7SAlbert Aribaud 	/* assert START */
350dd82242bSPaul Kocialkowski 	status = twsi_start(adap, expected_start_status);
351306563a7SAlbert Aribaud 	/* send out the address if the start went well */
352306563a7SAlbert Aribaud 	if (status == 0)
353dd82242bSPaul Kocialkowski 		status = twsi_send(adap, addr, expected_addr_status);
354306563a7SAlbert Aribaud 	/* return ok or status of first failure to caller */
355306563a7SAlbert Aribaud 	return status;
35601ec99d9SAlbert Aribaud }
35701ec99d9SAlbert Aribaud 
358306563a7SAlbert Aribaud /*
359306563a7SAlbert Aribaud  * I2C probe called by cmd_i2c when doing 'i2c probe'.
360306563a7SAlbert Aribaud  * Begin read, nak data byte, end.
361306563a7SAlbert Aribaud  */
3620db2bbdcSHans de Goede static int twsi_i2c_probe(struct i2c_adapter *adap, uchar chip)
36301ec99d9SAlbert Aribaud {
364306563a7SAlbert Aribaud 	u8 dummy_byte;
365306563a7SAlbert Aribaud 	int status;
36601ec99d9SAlbert Aribaud 
367306563a7SAlbert Aribaud 	/* begin i2c read */
368dd82242bSPaul Kocialkowski 	status = i2c_begin(adap, MVTWSI_STATUS_START, (chip << 1) | 1);
369306563a7SAlbert Aribaud 	/* dummy read was accepted: receive byte but NAK it. */
370306563a7SAlbert Aribaud 	if (status == 0)
371dd82242bSPaul Kocialkowski 		status = twsi_recv(adap, &dummy_byte);
372306563a7SAlbert Aribaud 	/* Stop transaction */
373dd82242bSPaul Kocialkowski 	twsi_stop(adap, 0);
374306563a7SAlbert Aribaud 	/* return 0 or status of first failure */
375306563a7SAlbert Aribaud 	return status;
37601ec99d9SAlbert Aribaud }
37701ec99d9SAlbert Aribaud 
378306563a7SAlbert Aribaud /*
379306563a7SAlbert Aribaud  * I2C read called by cmd_i2c when doing 'i2c read' and by cmd_eeprom.c
380306563a7SAlbert Aribaud  * Begin write, send address byte(s), begin read, receive data bytes, end.
381306563a7SAlbert Aribaud  *
382306563a7SAlbert Aribaud  * NOTE: some EEPROMS want a stop right before the second start, while
383306563a7SAlbert Aribaud  * some will choke if it is there. Deciding which we should do is eeprom
384306563a7SAlbert Aribaud  * stuff, not i2c, but at the moment the APIs won't let us put it in
385306563a7SAlbert Aribaud  * cmd_eeprom, so we have to choose here, and for the moment that'll be
386306563a7SAlbert Aribaud  * a repeated start without a preceding stop.
387306563a7SAlbert Aribaud  */
3880db2bbdcSHans de Goede static int twsi_i2c_read(struct i2c_adapter *adap, uchar chip, uint addr,
3890db2bbdcSHans de Goede 			int alen, uchar *data, int length)
39001ec99d9SAlbert Aribaud {
391306563a7SAlbert Aribaud 	int status;
39201ec99d9SAlbert Aribaud 
393306563a7SAlbert Aribaud 	/* begin i2c write to send the address bytes */
394dd82242bSPaul Kocialkowski 	status = i2c_begin(adap, MVTWSI_STATUS_START, (chip << 1));
395306563a7SAlbert Aribaud 	/* send addr bytes */
396306563a7SAlbert Aribaud 	while ((status == 0) && alen--)
397dd82242bSPaul Kocialkowski 		status = twsi_send(adap, addr >> (8*alen),
398306563a7SAlbert Aribaud 			MVTWSI_STATUS_DATA_W_ACK);
399306563a7SAlbert Aribaud 	/* begin i2c read to receive eeprom data bytes */
400306563a7SAlbert Aribaud 	if (status == 0)
401dd82242bSPaul Kocialkowski 		status = i2c_begin(adap, MVTWSI_STATUS_REPEATED_START,
402dd82242bSPaul Kocialkowski 				   (chip << 1) | 1);
403306563a7SAlbert Aribaud 	/* prepare ACK if at least one byte must be received */
404306563a7SAlbert Aribaud 	if (length > 0)
405306563a7SAlbert Aribaud 		twsi_control_flags |= MVTWSI_CONTROL_ACK;
406306563a7SAlbert Aribaud 	/* now receive actual bytes */
407306563a7SAlbert Aribaud 	while ((status == 0) && length--) {
408306563a7SAlbert Aribaud 		/* reset NAK if we if no more to read now */
409306563a7SAlbert Aribaud 		if (length == 0)
410306563a7SAlbert Aribaud 			twsi_control_flags &= ~MVTWSI_CONTROL_ACK;
411306563a7SAlbert Aribaud 		/* read current byte */
412dd82242bSPaul Kocialkowski 		status = twsi_recv(adap, data++);
41301ec99d9SAlbert Aribaud 	}
414306563a7SAlbert Aribaud 	/* Stop transaction */
415dd82242bSPaul Kocialkowski 	status = twsi_stop(adap, status);
416306563a7SAlbert Aribaud 	/* return 0 or status of first failure */
417306563a7SAlbert Aribaud 	return status;
41801ec99d9SAlbert Aribaud }
41901ec99d9SAlbert Aribaud 
420306563a7SAlbert Aribaud /*
421306563a7SAlbert Aribaud  * I2C write called by cmd_i2c when doing 'i2c write' and by cmd_eeprom.c
422306563a7SAlbert Aribaud  * Begin write, send address byte(s), send data bytes, end.
423306563a7SAlbert Aribaud  */
4240db2bbdcSHans de Goede static int twsi_i2c_write(struct i2c_adapter *adap, uchar chip, uint addr,
4250db2bbdcSHans de Goede 			int alen, uchar *data, int length)
42601ec99d9SAlbert Aribaud {
427306563a7SAlbert Aribaud 	int status;
42801ec99d9SAlbert Aribaud 
429306563a7SAlbert Aribaud 	/* begin i2c write to send the eeprom adress bytes then data bytes */
430dd82242bSPaul Kocialkowski 	status = i2c_begin(adap, MVTWSI_STATUS_START, (chip << 1));
431306563a7SAlbert Aribaud 	/* send addr bytes */
432306563a7SAlbert Aribaud 	while ((status == 0) && alen--)
433dd82242bSPaul Kocialkowski 		status = twsi_send(adap, addr >> (8*alen),
434306563a7SAlbert Aribaud 			MVTWSI_STATUS_DATA_W_ACK);
435306563a7SAlbert Aribaud 	/* send data bytes */
436306563a7SAlbert Aribaud 	while ((status == 0) && (length-- > 0))
437dd82242bSPaul Kocialkowski 		status = twsi_send(adap, *(data++), MVTWSI_STATUS_DATA_W_ACK);
438306563a7SAlbert Aribaud 	/* Stop transaction */
439dd82242bSPaul Kocialkowski 	status = twsi_stop(adap, status);
440306563a7SAlbert Aribaud 	/* return 0 or status of first failure */
441306563a7SAlbert Aribaud 	return status;
44201ec99d9SAlbert Aribaud }
44301ec99d9SAlbert Aribaud 
444dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE0
4450db2bbdcSHans de Goede U_BOOT_I2C_ADAP_COMPLETE(twsi0, twsi_i2c_init, twsi_i2c_probe,
4460db2bbdcSHans de Goede 			 twsi_i2c_read, twsi_i2c_write,
4470db2bbdcSHans de Goede 			 twsi_i2c_set_bus_speed,
4480db2bbdcSHans de Goede 			 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 0)
449dd82242bSPaul Kocialkowski #endif
450dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE1
451dd82242bSPaul Kocialkowski U_BOOT_I2C_ADAP_COMPLETE(twsi1, twsi_i2c_init, twsi_i2c_probe,
452dd82242bSPaul Kocialkowski 			 twsi_i2c_read, twsi_i2c_write,
453dd82242bSPaul Kocialkowski 			 twsi_i2c_set_bus_speed,
454dd82242bSPaul Kocialkowski 			 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 1)
455dd82242bSPaul Kocialkowski 
456dd82242bSPaul Kocialkowski #endif
457dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE2
458dd82242bSPaul Kocialkowski U_BOOT_I2C_ADAP_COMPLETE(twsi2, twsi_i2c_init, twsi_i2c_probe,
459dd82242bSPaul Kocialkowski 			 twsi_i2c_read, twsi_i2c_write,
460dd82242bSPaul Kocialkowski 			 twsi_i2c_set_bus_speed,
461dd82242bSPaul Kocialkowski 			 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 2)
462dd82242bSPaul Kocialkowski 
463dd82242bSPaul Kocialkowski #endif
464dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE3
465dd82242bSPaul Kocialkowski U_BOOT_I2C_ADAP_COMPLETE(twsi3, twsi_i2c_init, twsi_i2c_probe,
466dd82242bSPaul Kocialkowski 			 twsi_i2c_read, twsi_i2c_write,
467dd82242bSPaul Kocialkowski 			 twsi_i2c_set_bus_speed,
468dd82242bSPaul Kocialkowski 			 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 3)
469dd82242bSPaul Kocialkowski 
470dd82242bSPaul Kocialkowski #endif
471dd82242bSPaul Kocialkowski #ifdef CONFIG_I2C_MVTWSI_BASE4
472dd82242bSPaul Kocialkowski U_BOOT_I2C_ADAP_COMPLETE(twsi4, twsi_i2c_init, twsi_i2c_probe,
473dd82242bSPaul Kocialkowski 			 twsi_i2c_read, twsi_i2c_write,
474dd82242bSPaul Kocialkowski 			 twsi_i2c_set_bus_speed,
475dd82242bSPaul Kocialkowski 			 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 4)
476dd82242bSPaul Kocialkowski 
477dd82242bSPaul Kocialkowski #endif
478