xref: /rk3399_rockchip-uboot/drivers/i2c/mvtwsi.c (revision 57b4bce9967630b4acc4ca7eb778bc869ea0f927)
101ec99d9SAlbert Aribaud /*
2306563a7SAlbert Aribaud  * Driver for the TWSI (i2c) controller found on the Marvell
3306563a7SAlbert Aribaud  * orion5x and kirkwood SoC families.
401ec99d9SAlbert Aribaud  *
5*57b4bce9SAlbert ARIBAUD  * Author: Albert Aribaud <albert.u.boot@aribaud.net>
6306563a7SAlbert Aribaud  * Copyright (c) 2010 Albert Aribaud.
701ec99d9SAlbert Aribaud  *
801ec99d9SAlbert Aribaud  * See file CREDITS for list of people who contributed to this
901ec99d9SAlbert Aribaud  * project.
1001ec99d9SAlbert Aribaud  *
1101ec99d9SAlbert Aribaud  * This program is free software; you can redistribute it and/or
1201ec99d9SAlbert Aribaud  * modify it under the terms of the GNU General Public License as
1301ec99d9SAlbert Aribaud  * published by the Free Software Foundation; either version 2 of
1401ec99d9SAlbert Aribaud  * the License, or (at your option) any later version.
1501ec99d9SAlbert Aribaud  *
1601ec99d9SAlbert Aribaud  * This program is distributed in the hope that it will be useful,
1701ec99d9SAlbert Aribaud  * but WITHOUT ANY WARRANTY; without even the implied warranty of
1801ec99d9SAlbert Aribaud  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
1901ec99d9SAlbert Aribaud  * GNU General Public License for more details.
2001ec99d9SAlbert Aribaud  *
2101ec99d9SAlbert Aribaud  * You should have received a copy of the GNU General Public License
2201ec99d9SAlbert Aribaud  * along with this program; if not, write to the Free Software
2301ec99d9SAlbert Aribaud  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
2401ec99d9SAlbert Aribaud  * MA 02110-1301 USA
2501ec99d9SAlbert Aribaud  */
26306563a7SAlbert Aribaud 
2701ec99d9SAlbert Aribaud #include <common.h>
2801ec99d9SAlbert Aribaud #include <i2c.h>
2901ec99d9SAlbert Aribaud #include <asm/errno.h>
3001ec99d9SAlbert Aribaud #include <asm/io.h>
3101ec99d9SAlbert Aribaud 
32306563a7SAlbert Aribaud /*
33306563a7SAlbert Aribaud  * include a file that will provide CONFIG_I2C_MVTWSI_BASE
34306563a7SAlbert Aribaud  * and possibly other settings
35306563a7SAlbert Aribaud  */
3601ec99d9SAlbert Aribaud 
37306563a7SAlbert Aribaud #if defined(CONFIG_ORION5X)
38306563a7SAlbert Aribaud #include <asm/arch/orion5x.h>
39306563a7SAlbert Aribaud #elif defined(CONFIG_KIRKWOOD)
40306563a7SAlbert Aribaud #include <asm/arch/kirkwood.h>
41306563a7SAlbert Aribaud #else
42306563a7SAlbert Aribaud #error Driver mvtwsi not supported by SoC or board
4301ec99d9SAlbert Aribaud #endif
4401ec99d9SAlbert Aribaud 
4501ec99d9SAlbert Aribaud /*
46306563a7SAlbert Aribaud  * TWSI register structure
4701ec99d9SAlbert Aribaud  */
4801ec99d9SAlbert Aribaud 
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 
62306563a7SAlbert Aribaud /*
63306563a7SAlbert Aribaud  * Control register fields
64306563a7SAlbert Aribaud  */
65306563a7SAlbert Aribaud 
66306563a7SAlbert Aribaud #define	MVTWSI_CONTROL_ACK	0x00000004
67306563a7SAlbert Aribaud #define	MVTWSI_CONTROL_IFLG	0x00000008
68306563a7SAlbert Aribaud #define	MVTWSI_CONTROL_STOP	0x00000010
69306563a7SAlbert Aribaud #define	MVTWSI_CONTROL_START	0x00000020
70306563a7SAlbert Aribaud #define	MVTWSI_CONTROL_TWSIEN	0x00000040
71306563a7SAlbert Aribaud #define	MVTWSI_CONTROL_INTEN	0x00000080
72306563a7SAlbert Aribaud 
73306563a7SAlbert Aribaud /*
74306563a7SAlbert Aribaud  * Status register values -- only those expected in normal master
75306563a7SAlbert Aribaud  * operation on non-10-bit-address devices; whatever status we don't
76306563a7SAlbert Aribaud  * expect in nominal conditions (bus errors, arbitration losses,
77306563a7SAlbert Aribaud  * missing ACKs...) we just pass back to the caller as an error
78306563a7SAlbert Aribaud  * code.
79306563a7SAlbert Aribaud  */
80306563a7SAlbert Aribaud 
81306563a7SAlbert Aribaud #define	MVTWSI_STATUS_START		0x08
82306563a7SAlbert Aribaud #define	MVTWSI_STATUS_REPEATED_START	0x10
83306563a7SAlbert Aribaud #define	MVTWSI_STATUS_ADDR_W_ACK	0x18
84306563a7SAlbert Aribaud #define	MVTWSI_STATUS_DATA_W_ACK	0x28
85306563a7SAlbert Aribaud #define	MVTWSI_STATUS_ADDR_R_ACK	0x40
86306563a7SAlbert Aribaud #define	MVTWSI_STATUS_ADDR_R_NAK	0x48
87306563a7SAlbert Aribaud #define	MVTWSI_STATUS_DATA_R_ACK	0x50
88306563a7SAlbert Aribaud #define	MVTWSI_STATUS_DATA_R_NAK	0x58
89306563a7SAlbert Aribaud #define	MVTWSI_STATUS_IDLE		0xF8
90306563a7SAlbert Aribaud 
91306563a7SAlbert Aribaud /*
92306563a7SAlbert Aribaud  * The single instance of the controller we'll be dealing with
93306563a7SAlbert Aribaud  */
94306563a7SAlbert Aribaud 
95306563a7SAlbert Aribaud static struct  mvtwsi_registers *twsi =
96306563a7SAlbert Aribaud 	(struct  mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE;
97306563a7SAlbert Aribaud 
98306563a7SAlbert Aribaud /*
99306563a7SAlbert Aribaud  * Returned statuses are 0 for success and nonzero otherwise.
100306563a7SAlbert Aribaud  * Currently, cmd_i2c and cmd_eeprom do not interpret an error status.
101306563a7SAlbert Aribaud  * Thus to ease debugging, the return status contains some debug info:
102306563a7SAlbert Aribaud  * - bits 31..24 are error class: 1 is timeout, 2 is 'status mismatch'.
103306563a7SAlbert Aribaud  * - bits 23..16 are the last value of the control register.
104306563a7SAlbert Aribaud  * - bits 15..8 are the last value of the status register.
105306563a7SAlbert Aribaud  * - bits 7..0 are the expected value of the status register.
106306563a7SAlbert Aribaud  */
107306563a7SAlbert Aribaud 
108306563a7SAlbert Aribaud #define MVTWSI_ERROR_WRONG_STATUS	0x01
109306563a7SAlbert Aribaud #define MVTWSI_ERROR_TIMEOUT		0x02
110306563a7SAlbert Aribaud 
111306563a7SAlbert Aribaud #define MVTWSI_ERROR(ec, lc, ls, es) (((ec << 24) & 0xFF000000) | \
112306563a7SAlbert Aribaud 	((lc << 16) & 0x00FF0000) | ((ls<<8) & 0x0000FF00) | (es & 0xFF))
113306563a7SAlbert Aribaud 
114306563a7SAlbert Aribaud /*
115306563a7SAlbert Aribaud  * Wait for IFLG to raise, or return 'timeout'; then if status is as expected,
116306563a7SAlbert Aribaud  * return 0 (ok) or return 'wrong status'.
117306563a7SAlbert Aribaud  */
118306563a7SAlbert Aribaud static int twsi_wait(int expected_status)
11901ec99d9SAlbert Aribaud {
120306563a7SAlbert Aribaud 	int control, status;
121306563a7SAlbert Aribaud 	int timeout = 1000;
122306563a7SAlbert Aribaud 
123306563a7SAlbert Aribaud 	do {
124306563a7SAlbert Aribaud 		control = readl(&twsi->control);
125306563a7SAlbert Aribaud 		if (control & MVTWSI_CONTROL_IFLG) {
126306563a7SAlbert Aribaud 			status = readl(&twsi->status);
127306563a7SAlbert Aribaud 			if (status == expected_status)
128306563a7SAlbert Aribaud 				return 0;
12901ec99d9SAlbert Aribaud 			else
130306563a7SAlbert Aribaud 				return MVTWSI_ERROR(
131306563a7SAlbert Aribaud 					MVTWSI_ERROR_WRONG_STATUS,
132306563a7SAlbert Aribaud 					control, status, expected_status);
133306563a7SAlbert Aribaud 		}
134306563a7SAlbert Aribaud 		udelay(10); /* one clock cycle at 100 kHz */
135306563a7SAlbert Aribaud 	} while (timeout--);
136306563a7SAlbert Aribaud 	status = readl(&twsi->status);
137306563a7SAlbert Aribaud 	return MVTWSI_ERROR(
138306563a7SAlbert Aribaud 		MVTWSI_ERROR_TIMEOUT, control, status, expected_status);
13901ec99d9SAlbert Aribaud }
14001ec99d9SAlbert Aribaud 
141306563a7SAlbert Aribaud /*
142306563a7SAlbert Aribaud  * These flags are ORed to any write to the control register
143306563a7SAlbert Aribaud  * They allow global setting of TWSIEN and ACK.
144306563a7SAlbert Aribaud  * By default none are set.
145306563a7SAlbert Aribaud  * twsi_start() sets TWSIEN (in case the controller was disabled)
146306563a7SAlbert Aribaud  * twsi_recv() sets ACK or resets it depending on expected status.
147306563a7SAlbert Aribaud  */
148306563a7SAlbert Aribaud static u8 twsi_control_flags = MVTWSI_CONTROL_TWSIEN;
14901ec99d9SAlbert Aribaud 
150306563a7SAlbert Aribaud /*
151306563a7SAlbert Aribaud  * Assert the START condition, either in a single I2C transaction
152306563a7SAlbert Aribaud  * or inside back-to-back ones (repeated starts).
153306563a7SAlbert Aribaud  */
154306563a7SAlbert Aribaud static int twsi_start(int expected_status)
155306563a7SAlbert Aribaud {
156306563a7SAlbert Aribaud 	/* globally set TWSIEN in case it was not */
157306563a7SAlbert Aribaud 	twsi_control_flags |= MVTWSI_CONTROL_TWSIEN;
158306563a7SAlbert Aribaud 	/* assert START */
159306563a7SAlbert Aribaud 	writel(twsi_control_flags | MVTWSI_CONTROL_START, &twsi->control);
160306563a7SAlbert Aribaud 	/* wait for controller to process START */
161306563a7SAlbert Aribaud 	return twsi_wait(expected_status);
162306563a7SAlbert Aribaud }
163306563a7SAlbert Aribaud 
164306563a7SAlbert Aribaud /*
165306563a7SAlbert Aribaud  * Send a byte (i2c address or data).
166306563a7SAlbert Aribaud  */
167306563a7SAlbert Aribaud static int twsi_send(u8 byte, int expected_status)
168306563a7SAlbert Aribaud {
169306563a7SAlbert Aribaud 	/* put byte in data register for sending */
170306563a7SAlbert Aribaud 	writel(byte, &twsi->data);
171306563a7SAlbert Aribaud 	/* clear any pending interrupt -- that'll cause sending */
172306563a7SAlbert Aribaud 	writel(twsi_control_flags, &twsi->control);
173306563a7SAlbert Aribaud 	/* wait for controller to receive byte and check ACK */
174306563a7SAlbert Aribaud 	return twsi_wait(expected_status);
175306563a7SAlbert Aribaud }
176306563a7SAlbert Aribaud 
177306563a7SAlbert Aribaud /*
178306563a7SAlbert Aribaud  * Receive a byte.
179306563a7SAlbert Aribaud  * Global mvtwsi_control_flags variable says if we should ack or nak.
180306563a7SAlbert Aribaud  */
181306563a7SAlbert Aribaud static int twsi_recv(u8 *byte)
182306563a7SAlbert Aribaud {
183306563a7SAlbert Aribaud 	int expected_status, status;
184306563a7SAlbert Aribaud 
185306563a7SAlbert Aribaud 	/* compute expected status based on ACK bit in global control flags */
186306563a7SAlbert Aribaud 	if (twsi_control_flags & MVTWSI_CONTROL_ACK)
187306563a7SAlbert Aribaud 		expected_status = MVTWSI_STATUS_DATA_R_ACK;
188306563a7SAlbert Aribaud 	else
189306563a7SAlbert Aribaud 		expected_status = MVTWSI_STATUS_DATA_R_NAK;
190306563a7SAlbert Aribaud 	/* acknowledge *previous state* and launch receive */
191306563a7SAlbert Aribaud 	writel(twsi_control_flags, &twsi->control);
192306563a7SAlbert Aribaud 	/* wait for controller to receive byte and assert ACK or NAK */
193306563a7SAlbert Aribaud 	status = twsi_wait(expected_status);
194306563a7SAlbert Aribaud 	/* if we did receive expected byte then store it */
195306563a7SAlbert Aribaud 	if (status == 0)
196306563a7SAlbert Aribaud 		*byte = readl(&twsi->data);
197306563a7SAlbert Aribaud 	/* return status */
198306563a7SAlbert Aribaud 	return status;
199306563a7SAlbert Aribaud }
200306563a7SAlbert Aribaud 
201306563a7SAlbert Aribaud /*
202306563a7SAlbert Aribaud  * Assert the STOP condition.
203306563a7SAlbert Aribaud  * This is also used to force the bus back in idle (SDA=SCL=1).
204306563a7SAlbert Aribaud  */
205306563a7SAlbert Aribaud static int twsi_stop(int status)
206306563a7SAlbert Aribaud {
207306563a7SAlbert Aribaud 	int control, stop_status;
208306563a7SAlbert Aribaud 	int timeout = 1000;
209306563a7SAlbert Aribaud 
210306563a7SAlbert Aribaud 	/* assert STOP */
211306563a7SAlbert Aribaud 	control = MVTWSI_CONTROL_TWSIEN | MVTWSI_CONTROL_STOP;
212306563a7SAlbert Aribaud 	writel(control, &twsi->control);
213306563a7SAlbert Aribaud 	/* wait for IDLE; IFLG won't rise so twsi_wait() is no use. */
214306563a7SAlbert Aribaud 	do {
215306563a7SAlbert Aribaud 		stop_status = readl(&twsi->status);
216306563a7SAlbert Aribaud 		if (stop_status == MVTWSI_STATUS_IDLE)
217306563a7SAlbert Aribaud 			break;
218306563a7SAlbert Aribaud 		udelay(10); /* one clock cycle at 100 kHz */
219306563a7SAlbert Aribaud 	} while (timeout--);
220306563a7SAlbert Aribaud 	control = readl(&twsi->control);
221306563a7SAlbert Aribaud 	if (stop_status != MVTWSI_STATUS_IDLE)
222306563a7SAlbert Aribaud 		if (status == 0)
223306563a7SAlbert Aribaud 			status = MVTWSI_ERROR(
224306563a7SAlbert Aribaud 				MVTWSI_ERROR_TIMEOUT,
225306563a7SAlbert Aribaud 				control, status, MVTWSI_STATUS_IDLE);
226306563a7SAlbert Aribaud 	return status;
227306563a7SAlbert Aribaud }
228306563a7SAlbert Aribaud 
229306563a7SAlbert Aribaud /*
230306563a7SAlbert Aribaud  * Ugly formula to convert m and n values to a frequency comes from
231306563a7SAlbert Aribaud  * TWSI specifications
232306563a7SAlbert Aribaud  */
233306563a7SAlbert Aribaud 
234306563a7SAlbert Aribaud #define TWSI_FREQUENCY(m, n) \
235306563a7SAlbert Aribaud 	((u8) (CONFIG_SYS_TCLK / (10 * (m + 1) * 2 * (1 << n))))
236306563a7SAlbert Aribaud 
237306563a7SAlbert Aribaud /*
238306563a7SAlbert Aribaud  * These are required to be reprogrammed before enabling the controller
239306563a7SAlbert Aribaud  * because a reset loses them.
240306563a7SAlbert Aribaud  * Default values come from the spec, but a twsi_reset will change them.
241306563a7SAlbert Aribaud  * twsi_slave_address left uninitialized lest checkpatch.pl complains.
242306563a7SAlbert Aribaud  */
243306563a7SAlbert Aribaud 
244306563a7SAlbert Aribaud /* Baudrate generator: m (bits 7..4) =4, n (bits 3..0) =4 */
245306563a7SAlbert Aribaud static u8 twsi_baud_rate = 0x44; /* baudrate at controller reset */
246306563a7SAlbert Aribaud /* Default frequency corresponding to default m=4, n=4 */
247306563a7SAlbert Aribaud static u8 twsi_actual_speed = TWSI_FREQUENCY(4, 4);
248306563a7SAlbert Aribaud /* Default slave address is 0 (so is an uninitialized static) */
249306563a7SAlbert Aribaud static u8 twsi_slave_address;
250306563a7SAlbert Aribaud 
251306563a7SAlbert Aribaud /*
252306563a7SAlbert Aribaud  * Reset controller.
253306563a7SAlbert Aribaud  * Called at end of i2c_init unsuccessful i2c transactions.
254306563a7SAlbert Aribaud  * Controller reset also resets the baud rate and slave address, so
255306563a7SAlbert Aribaud  * re-establish them.
256306563a7SAlbert Aribaud  */
257306563a7SAlbert Aribaud static void twsi_reset(void)
258306563a7SAlbert Aribaud {
259306563a7SAlbert Aribaud 	/* ensure controller will be enabled by any twsi*() function */
260306563a7SAlbert Aribaud 	twsi_control_flags = MVTWSI_CONTROL_TWSIEN;
261306563a7SAlbert Aribaud 	/* reset controller */
262306563a7SAlbert Aribaud 	writel(0, &twsi->soft_reset);
263306563a7SAlbert Aribaud 	/* wait 2 ms -- this is what the Marvell LSP does */
264306563a7SAlbert Aribaud 	udelay(20000);
265306563a7SAlbert Aribaud 	/* set baud rate */
266306563a7SAlbert Aribaud 	writel(twsi_baud_rate, &twsi->baudrate);
267306563a7SAlbert Aribaud 	/* set slave address even though we don't use it */
268306563a7SAlbert Aribaud 	writel(twsi_slave_address, &twsi->slave_address);
269306563a7SAlbert Aribaud 	writel(0, &twsi->xtnd_slave_addr);
270306563a7SAlbert Aribaud 	/* assert STOP but don't care for the result */
271306563a7SAlbert Aribaud 	(void) twsi_stop(0);
272306563a7SAlbert Aribaud }
273306563a7SAlbert Aribaud 
274306563a7SAlbert Aribaud /*
275306563a7SAlbert Aribaud  * I2C init called by cmd_i2c when doing 'i2c reset'.
276306563a7SAlbert Aribaud  * Sets baud to the highest possible value not exceeding requested one.
277306563a7SAlbert Aribaud  */
278306563a7SAlbert Aribaud void i2c_init(int requested_speed, int slaveadd)
279306563a7SAlbert Aribaud {
280306563a7SAlbert Aribaud 	int	tmp_speed, highest_speed, n, m;
281306563a7SAlbert Aribaud 	int	baud = 0x44; /* baudrate at controller reset */
282306563a7SAlbert Aribaud 
283306563a7SAlbert Aribaud 	/* use actual speed to collect progressively higher values */
284306563a7SAlbert Aribaud 	highest_speed = 0;
285306563a7SAlbert Aribaud 	/* compute m, n setting for highest speed not above requested speed */
28601ec99d9SAlbert Aribaud 	for (n = 0; n < 8; n++) {
28701ec99d9SAlbert Aribaud 		for (m = 0; m < 16; m++) {
288306563a7SAlbert Aribaud 			tmp_speed = TWSI_FREQUENCY(m, n);
289306563a7SAlbert Aribaud 			if ((tmp_speed <= requested_speed)
290306563a7SAlbert Aribaud 			 && (tmp_speed > highest_speed)) {
291306563a7SAlbert Aribaud 				highest_speed = tmp_speed;
292306563a7SAlbert Aribaud 				baud = (m << 3) | n;
29301ec99d9SAlbert Aribaud 			}
29401ec99d9SAlbert Aribaud 		}
29501ec99d9SAlbert Aribaud 	}
296306563a7SAlbert Aribaud 	/* save baud rate and slave for later calls to twsi_reset */
297306563a7SAlbert Aribaud 	twsi_baud_rate = baud;
298306563a7SAlbert Aribaud 	twsi_actual_speed = highest_speed;
299306563a7SAlbert Aribaud 	twsi_slave_address = slaveadd;
300306563a7SAlbert Aribaud 	/* reset controller */
301306563a7SAlbert Aribaud 	twsi_reset();
30201ec99d9SAlbert Aribaud }
30301ec99d9SAlbert Aribaud 
30401ec99d9SAlbert Aribaud /*
305306563a7SAlbert Aribaud  * Begin I2C transaction with expected start status, at given address.
306306563a7SAlbert Aribaud  * Common to i2c_probe, i2c_read and i2c_write.
307306563a7SAlbert Aribaud  * Expected address status will derive from direction bit (bit 0) in addr.
30801ec99d9SAlbert Aribaud  */
309306563a7SAlbert Aribaud static int i2c_begin(int expected_start_status, u8 addr)
31001ec99d9SAlbert Aribaud {
311306563a7SAlbert Aribaud 	int status, expected_addr_status;
31201ec99d9SAlbert Aribaud 
313306563a7SAlbert Aribaud 	/* compute expected address status from direction bit in addr */
314306563a7SAlbert Aribaud 	if (addr & 1) /* reading */
315306563a7SAlbert Aribaud 		expected_addr_status = MVTWSI_STATUS_ADDR_R_ACK;
316306563a7SAlbert Aribaud 	else /* writing */
317306563a7SAlbert Aribaud 		expected_addr_status = MVTWSI_STATUS_ADDR_W_ACK;
318306563a7SAlbert Aribaud 	/* assert START */
319306563a7SAlbert Aribaud 	status = twsi_start(expected_start_status);
320306563a7SAlbert Aribaud 	/* send out the address if the start went well */
321306563a7SAlbert Aribaud 	if (status == 0)
322306563a7SAlbert Aribaud 		status = twsi_send(addr, expected_addr_status);
323306563a7SAlbert Aribaud 	/* return ok or status of first failure to caller */
324306563a7SAlbert Aribaud 	return status;
32501ec99d9SAlbert Aribaud }
32601ec99d9SAlbert Aribaud 
327306563a7SAlbert Aribaud /*
328306563a7SAlbert Aribaud  * I2C probe called by cmd_i2c when doing 'i2c probe'.
329306563a7SAlbert Aribaud  * Begin read, nak data byte, end.
330306563a7SAlbert Aribaud  */
331306563a7SAlbert Aribaud int i2c_probe(uchar chip)
33201ec99d9SAlbert Aribaud {
333306563a7SAlbert Aribaud 	u8 dummy_byte;
334306563a7SAlbert Aribaud 	int status;
33501ec99d9SAlbert Aribaud 
336306563a7SAlbert Aribaud 	/* begin i2c read */
337306563a7SAlbert Aribaud 	status = i2c_begin(MVTWSI_STATUS_START, (chip << 1) | 1);
338306563a7SAlbert Aribaud 	/* dummy read was accepted: receive byte but NAK it. */
339306563a7SAlbert Aribaud 	if (status == 0)
340306563a7SAlbert Aribaud 		status = twsi_recv(&dummy_byte);
341306563a7SAlbert Aribaud 	/* Stop transaction */
342306563a7SAlbert Aribaud 	twsi_stop(0);
343306563a7SAlbert Aribaud 	/* return 0 or status of first failure */
344306563a7SAlbert Aribaud 	return status;
34501ec99d9SAlbert Aribaud }
34601ec99d9SAlbert Aribaud 
347306563a7SAlbert Aribaud /*
348306563a7SAlbert Aribaud  * I2C read called by cmd_i2c when doing 'i2c read' and by cmd_eeprom.c
349306563a7SAlbert Aribaud  * Begin write, send address byte(s), begin read, receive data bytes, end.
350306563a7SAlbert Aribaud  *
351306563a7SAlbert Aribaud  * NOTE: some EEPROMS want a stop right before the second start, while
352306563a7SAlbert Aribaud  * some will choke if it is there. Deciding which we should do is eeprom
353306563a7SAlbert Aribaud  * stuff, not i2c, but at the moment the APIs won't let us put it in
354306563a7SAlbert Aribaud  * cmd_eeprom, so we have to choose here, and for the moment that'll be
355306563a7SAlbert Aribaud  * a repeated start without a preceding stop.
356306563a7SAlbert Aribaud  */
357306563a7SAlbert Aribaud int i2c_read(u8 dev, uint addr, int alen, u8 *data, int length)
35801ec99d9SAlbert Aribaud {
359306563a7SAlbert Aribaud 	int status;
36001ec99d9SAlbert Aribaud 
361306563a7SAlbert Aribaud 	/* begin i2c write to send the address bytes */
362306563a7SAlbert Aribaud 	status = i2c_begin(MVTWSI_STATUS_START, (dev << 1));
363306563a7SAlbert Aribaud 	/* send addr bytes */
364306563a7SAlbert Aribaud 	while ((status == 0) && alen--)
365306563a7SAlbert Aribaud 		status = twsi_send(addr >> (8*alen),
366306563a7SAlbert Aribaud 			MVTWSI_STATUS_DATA_W_ACK);
367306563a7SAlbert Aribaud 	/* begin i2c read to receive eeprom data bytes */
368306563a7SAlbert Aribaud 	if (status == 0)
369306563a7SAlbert Aribaud 		status = i2c_begin(
370306563a7SAlbert Aribaud 			MVTWSI_STATUS_REPEATED_START, (dev << 1) | 1);
371306563a7SAlbert Aribaud 	/* prepare ACK if at least one byte must be received */
372306563a7SAlbert Aribaud 	if (length > 0)
373306563a7SAlbert Aribaud 		twsi_control_flags |= MVTWSI_CONTROL_ACK;
374306563a7SAlbert Aribaud 	/* now receive actual bytes */
375306563a7SAlbert Aribaud 	while ((status == 0) && length--) {
376306563a7SAlbert Aribaud 		/* reset NAK if we if no more to read now */
377306563a7SAlbert Aribaud 		if (length == 0)
378306563a7SAlbert Aribaud 			twsi_control_flags &= ~MVTWSI_CONTROL_ACK;
379306563a7SAlbert Aribaud 		/* read current byte */
380306563a7SAlbert Aribaud 		status = twsi_recv(data++);
38101ec99d9SAlbert Aribaud 	}
382306563a7SAlbert Aribaud 	/* Stop transaction */
383306563a7SAlbert Aribaud 	status = twsi_stop(status);
384306563a7SAlbert Aribaud 	/* return 0 or status of first failure */
385306563a7SAlbert Aribaud 	return status;
38601ec99d9SAlbert Aribaud }
38701ec99d9SAlbert Aribaud 
388306563a7SAlbert Aribaud /*
389306563a7SAlbert Aribaud  * I2C write called by cmd_i2c when doing 'i2c write' and by cmd_eeprom.c
390306563a7SAlbert Aribaud  * Begin write, send address byte(s), send data bytes, end.
391306563a7SAlbert Aribaud  */
392306563a7SAlbert Aribaud int i2c_write(u8 dev, uint addr, int alen, u8 *data, int length)
39301ec99d9SAlbert Aribaud {
394306563a7SAlbert Aribaud 	int status;
39501ec99d9SAlbert Aribaud 
396306563a7SAlbert Aribaud 	/* begin i2c write to send the eeprom adress bytes then data bytes */
397306563a7SAlbert Aribaud 	status = i2c_begin(MVTWSI_STATUS_START, (dev << 1));
398306563a7SAlbert Aribaud 	/* send addr bytes */
399306563a7SAlbert Aribaud 	while ((status == 0) && alen--)
400306563a7SAlbert Aribaud 		status = twsi_send(addr >> (8*alen),
401306563a7SAlbert Aribaud 			MVTWSI_STATUS_DATA_W_ACK);
402306563a7SAlbert Aribaud 	/* send data bytes */
403306563a7SAlbert Aribaud 	while ((status == 0) && (length-- > 0))
404306563a7SAlbert Aribaud 		status = twsi_send(*(data++), MVTWSI_STATUS_DATA_W_ACK);
405306563a7SAlbert Aribaud 	/* Stop transaction */
406306563a7SAlbert Aribaud 	status = twsi_stop(status);
407306563a7SAlbert Aribaud 	/* return 0 or status of first failure */
408306563a7SAlbert Aribaud 	return status;
40901ec99d9SAlbert Aribaud }
41001ec99d9SAlbert Aribaud 
411306563a7SAlbert Aribaud /*
412306563a7SAlbert Aribaud  * Bus set routine: we only support bus 0.
413306563a7SAlbert Aribaud  */
41401ec99d9SAlbert Aribaud int i2c_set_bus_num(unsigned int bus)
41501ec99d9SAlbert Aribaud {
41601ec99d9SAlbert Aribaud 	if (bus > 0) {
41701ec99d9SAlbert Aribaud 		return -1;
41801ec99d9SAlbert Aribaud 	}
41901ec99d9SAlbert Aribaud 	return 0;
42001ec99d9SAlbert Aribaud }
42101ec99d9SAlbert Aribaud 
422306563a7SAlbert Aribaud /*
423306563a7SAlbert Aribaud  * Bus get routine: hard-return bus 0.
424306563a7SAlbert Aribaud  */
42501ec99d9SAlbert Aribaud unsigned int i2c_get_bus_num(void)
42601ec99d9SAlbert Aribaud {
427306563a7SAlbert Aribaud 	return 0;
42801ec99d9SAlbert Aribaud }
429