blob: 5dc4fbba1fe8c254b99f6f3bf06ddeda5e74ee60 [file] [log] [blame]
Heiko Schocher4ce5a722009-07-20 09:59:37 +02001/*
Albert Aribaud306563a2010-08-27 18:26:05 +02002 * Driver for the TWSI (i2c) controller found on the Marvell
3 * orion5x and kirkwood SoC families.
Heiko Schocher4ce5a722009-07-20 09:59:37 +02004 *
Albert ARIBAUD57b4bce2011-04-22 19:41:02 +02005 * Author: Albert Aribaud <albert.u.boot@aribaud.net>
Albert Aribaud306563a2010-08-27 18:26:05 +02006 * Copyright (c) 2010 Albert Aribaud.
Heiko Schocher4ce5a722009-07-20 09:59:37 +02007 *
Wolfgang Denk1a459662013-07-08 09:37:19 +02008 * SPDX-License-Identifier: GPL-2.0+
Heiko Schocher4ce5a722009-07-20 09:59:37 +02009 */
Albert Aribaud306563a2010-08-27 18:26:05 +020010
Heiko Schocher4ce5a722009-07-20 09:59:37 +020011#include <common.h>
12#include <i2c.h>
Heiko Schocher4ce5a722009-07-20 09:59:37 +020013#include <asm/errno.h>
14#include <asm/io.h>
15
Heiko Schocher4ce5a722009-07-20 09:59:37 +020016/*
Paul Kocialkowskidd822422015-04-10 23:09:51 +020017 * include a file that will provide CONFIG_I2C_MVTWSI_BASE*
Albert Aribaud306563a2010-08-27 18:26:05 +020018 * and possibly other settings
Heiko Schocher4ce5a722009-07-20 09:59:37 +020019 */
20
Albert Aribaud306563a2010-08-27 18:26:05 +020021#if defined(CONFIG_ORION5X)
22#include <asm/arch/orion5x.h>
Stefan Roese81e33f42015-12-21 13:56:33 +010023#elif (defined(CONFIG_KIRKWOOD) || defined(CONFIG_ARCH_MVEBU))
Stefan Roese3dc23f72014-10-22 12:13:06 +020024#include <asm/arch/soc.h>
Hans de Goede66203772014-06-13 22:55:49 +020025#elif defined(CONFIG_SUNXI)
26#include <asm/arch/i2c.h>
Albert Aribaud306563a2010-08-27 18:26:05 +020027#else
28#error Driver mvtwsi not supported by SoC or board
29#endif
30
31/*
32 * TWSI register structure
33 */
34
Hans de Goede66203772014-06-13 22:55:49 +020035#ifdef CONFIG_SUNXI
36
37struct mvtwsi_registers {
38 u32 slave_address;
39 u32 xtnd_slave_addr;
40 u32 data;
41 u32 control;
42 u32 status;
43 u32 baudrate;
44 u32 soft_reset;
45};
46
47#else
48
Albert Aribaud306563a2010-08-27 18:26:05 +020049struct mvtwsi_registers {
50 u32 slave_address;
51 u32 data;
52 u32 control;
53 union {
54 u32 status; /* when reading */
55 u32 baudrate; /* when writing */
56 };
57 u32 xtnd_slave_addr;
58 u32 reserved[2];
59 u32 soft_reset;
60};
61
Hans de Goede66203772014-06-13 22:55:49 +020062#endif
63
Albert Aribaud306563a2010-08-27 18:26:05 +020064/*
65 * Control register fields
66 */
67
68#define MVTWSI_CONTROL_ACK 0x00000004
69#define MVTWSI_CONTROL_IFLG 0x00000008
70#define MVTWSI_CONTROL_STOP 0x00000010
71#define MVTWSI_CONTROL_START 0x00000020
72#define MVTWSI_CONTROL_TWSIEN 0x00000040
73#define MVTWSI_CONTROL_INTEN 0x00000080
74
75/*
76 * Status register values -- only those expected in normal master
77 * operation on non-10-bit-address devices; whatever status we don't
78 * expect in nominal conditions (bus errors, arbitration losses,
79 * missing ACKs...) we just pass back to the caller as an error
80 * code.
81 */
82
83#define MVTWSI_STATUS_START 0x08
84#define MVTWSI_STATUS_REPEATED_START 0x10
85#define MVTWSI_STATUS_ADDR_W_ACK 0x18
86#define MVTWSI_STATUS_DATA_W_ACK 0x28
87#define MVTWSI_STATUS_ADDR_R_ACK 0x40
88#define MVTWSI_STATUS_ADDR_R_NAK 0x48
89#define MVTWSI_STATUS_DATA_R_ACK 0x50
90#define MVTWSI_STATUS_DATA_R_NAK 0x58
91#define MVTWSI_STATUS_IDLE 0xF8
92
93/*
Paul Kocialkowskidd822422015-04-10 23:09:51 +020094 * MVTWSI controller base
Albert Aribaud306563a2010-08-27 18:26:05 +020095 */
96
Paul Kocialkowskidd822422015-04-10 23:09:51 +020097static struct mvtwsi_registers *twsi_get_base(struct i2c_adapter *adap)
98{
99 switch (adap->hwadapnr) {
100#ifdef CONFIG_I2C_MVTWSI_BASE0
101 case 0:
102 return (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE0;
103#endif
104#ifdef CONFIG_I2C_MVTWSI_BASE1
105 case 1:
106 return (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE1;
107#endif
108#ifdef CONFIG_I2C_MVTWSI_BASE2
109 case 2:
110 return (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE2;
111#endif
112#ifdef CONFIG_I2C_MVTWSI_BASE3
113 case 3:
114 return (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE3;
115#endif
116#ifdef CONFIG_I2C_MVTWSI_BASE4
117 case 4:
118 return (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE4;
119#endif
120 default:
121 printf("Missing mvtwsi controller %d base\n", adap->hwadapnr);
122 break;
123 }
124
125 return NULL;
126}
Albert Aribaud306563a2010-08-27 18:26:05 +0200127
128/*
129 * Returned statuses are 0 for success and nonzero otherwise.
130 * Currently, cmd_i2c and cmd_eeprom do not interpret an error status.
131 * Thus to ease debugging, the return status contains some debug info:
132 * - bits 31..24 are error class: 1 is timeout, 2 is 'status mismatch'.
133 * - bits 23..16 are the last value of the control register.
134 * - bits 15..8 are the last value of the status register.
135 * - bits 7..0 are the expected value of the status register.
136 */
137
138#define MVTWSI_ERROR_WRONG_STATUS 0x01
139#define MVTWSI_ERROR_TIMEOUT 0x02
140
141#define MVTWSI_ERROR(ec, lc, ls, es) (((ec << 24) & 0xFF000000) | \
142 ((lc << 16) & 0x00FF0000) | ((ls<<8) & 0x0000FF00) | (es & 0xFF))
143
144/*
145 * Wait for IFLG to raise, or return 'timeout'; then if status is as expected,
146 * return 0 (ok) or return 'wrong status'.
147 */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200148static int twsi_wait(struct i2c_adapter *adap, int expected_status)
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200149{
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200150 struct mvtwsi_registers *twsi = twsi_get_base(adap);
Albert Aribaud306563a2010-08-27 18:26:05 +0200151 int control, status;
152 int timeout = 1000;
153
154 do {
155 control = readl(&twsi->control);
156 if (control & MVTWSI_CONTROL_IFLG) {
157 status = readl(&twsi->status);
158 if (status == expected_status)
159 return 0;
160 else
161 return MVTWSI_ERROR(
162 MVTWSI_ERROR_WRONG_STATUS,
163 control, status, expected_status);
164 }
165 udelay(10); /* one clock cycle at 100 kHz */
166 } while (timeout--);
167 status = readl(&twsi->status);
168 return MVTWSI_ERROR(
169 MVTWSI_ERROR_TIMEOUT, control, status, expected_status);
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200170}
171
Albert Aribaud306563a2010-08-27 18:26:05 +0200172/*
173 * These flags are ORed to any write to the control register
174 * They allow global setting of TWSIEN and ACK.
175 * By default none are set.
176 * twsi_start() sets TWSIEN (in case the controller was disabled)
177 * twsi_recv() sets ACK or resets it depending on expected status.
178 */
179static u8 twsi_control_flags = MVTWSI_CONTROL_TWSIEN;
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200180
Albert Aribaud306563a2010-08-27 18:26:05 +0200181/*
182 * Assert the START condition, either in a single I2C transaction
183 * or inside back-to-back ones (repeated starts).
184 */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200185static int twsi_start(struct i2c_adapter *adap, int expected_status)
Albert Aribaud306563a2010-08-27 18:26:05 +0200186{
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200187 struct mvtwsi_registers *twsi = twsi_get_base(adap);
188
Albert Aribaud306563a2010-08-27 18:26:05 +0200189 /* globally set TWSIEN in case it was not */
190 twsi_control_flags |= MVTWSI_CONTROL_TWSIEN;
191 /* assert START */
192 writel(twsi_control_flags | MVTWSI_CONTROL_START, &twsi->control);
193 /* wait for controller to process START */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200194 return twsi_wait(adap, expected_status);
Albert Aribaud306563a2010-08-27 18:26:05 +0200195}
196
197/*
198 * Send a byte (i2c address or data).
199 */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200200static int twsi_send(struct i2c_adapter *adap, u8 byte, int expected_status)
Albert Aribaud306563a2010-08-27 18:26:05 +0200201{
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200202 struct mvtwsi_registers *twsi = twsi_get_base(adap);
203
Albert Aribaud306563a2010-08-27 18:26:05 +0200204 /* put byte in data register for sending */
205 writel(byte, &twsi->data);
206 /* clear any pending interrupt -- that'll cause sending */
207 writel(twsi_control_flags, &twsi->control);
208 /* wait for controller to receive byte and check ACK */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200209 return twsi_wait(adap, expected_status);
Albert Aribaud306563a2010-08-27 18:26:05 +0200210}
211
212/*
213 * Receive a byte.
214 * Global mvtwsi_control_flags variable says if we should ack or nak.
215 */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200216static int twsi_recv(struct i2c_adapter *adap, u8 *byte)
Albert Aribaud306563a2010-08-27 18:26:05 +0200217{
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200218 struct mvtwsi_registers *twsi = twsi_get_base(adap);
Albert Aribaud306563a2010-08-27 18:26:05 +0200219 int expected_status, status;
220
221 /* compute expected status based on ACK bit in global control flags */
222 if (twsi_control_flags & MVTWSI_CONTROL_ACK)
223 expected_status = MVTWSI_STATUS_DATA_R_ACK;
224 else
225 expected_status = MVTWSI_STATUS_DATA_R_NAK;
226 /* acknowledge *previous state* and launch receive */
227 writel(twsi_control_flags, &twsi->control);
228 /* wait for controller to receive byte and assert ACK or NAK */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200229 status = twsi_wait(adap, expected_status);
Albert Aribaud306563a2010-08-27 18:26:05 +0200230 /* if we did receive expected byte then store it */
231 if (status == 0)
232 *byte = readl(&twsi->data);
233 /* return status */
234 return status;
235}
236
237/*
238 * Assert the STOP condition.
239 * This is also used to force the bus back in idle (SDA=SCL=1).
240 */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200241static int twsi_stop(struct i2c_adapter *adap, int status)
Albert Aribaud306563a2010-08-27 18:26:05 +0200242{
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200243 struct mvtwsi_registers *twsi = twsi_get_base(adap);
Albert Aribaud306563a2010-08-27 18:26:05 +0200244 int control, stop_status;
245 int timeout = 1000;
246
247 /* assert STOP */
248 control = MVTWSI_CONTROL_TWSIEN | MVTWSI_CONTROL_STOP;
249 writel(control, &twsi->control);
250 /* wait for IDLE; IFLG won't rise so twsi_wait() is no use. */
251 do {
252 stop_status = readl(&twsi->status);
253 if (stop_status == MVTWSI_STATUS_IDLE)
254 break;
255 udelay(10); /* one clock cycle at 100 kHz */
256 } while (timeout--);
257 control = readl(&twsi->control);
258 if (stop_status != MVTWSI_STATUS_IDLE)
259 if (status == 0)
260 status = MVTWSI_ERROR(
261 MVTWSI_ERROR_TIMEOUT,
262 control, status, MVTWSI_STATUS_IDLE);
263 return status;
264}
265
Stefan Roesef582a152015-03-18 09:30:54 +0100266static unsigned int twsi_calc_freq(const int n, const int m)
267{
268#ifdef CONFIG_SUNXI
269 return CONFIG_SYS_TCLK / (10 * (m + 1) * (1 << n));
270#else
271 return CONFIG_SYS_TCLK / (10 * (m + 1) * (2 << n));
272#endif
273}
Albert Aribaud306563a2010-08-27 18:26:05 +0200274
275/*
Albert Aribaud306563a2010-08-27 18:26:05 +0200276 * Reset controller.
Albert Aribaud306563a2010-08-27 18:26:05 +0200277 * Controller reset also resets the baud rate and slave address, so
Hans de Goede0db2bbd2014-06-13 22:55:48 +0200278 * they must be re-established afterwards.
Albert Aribaud306563a2010-08-27 18:26:05 +0200279 */
Hans de Goede0db2bbd2014-06-13 22:55:48 +0200280static void twsi_reset(struct i2c_adapter *adap)
Albert Aribaud306563a2010-08-27 18:26:05 +0200281{
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200282 struct mvtwsi_registers *twsi = twsi_get_base(adap);
Albert Aribaud306563a2010-08-27 18:26:05 +0200283 /* ensure controller will be enabled by any twsi*() function */
284 twsi_control_flags = MVTWSI_CONTROL_TWSIEN;
285 /* reset controller */
286 writel(0, &twsi->soft_reset);
287 /* wait 2 ms -- this is what the Marvell LSP does */
288 udelay(20000);
Albert Aribaud306563a2010-08-27 18:26:05 +0200289}
290
291/*
292 * I2C init called by cmd_i2c when doing 'i2c reset'.
293 * Sets baud to the highest possible value not exceeding requested one.
294 */
Hans de Goede0db2bbd2014-06-13 22:55:48 +0200295static unsigned int twsi_i2c_set_bus_speed(struct i2c_adapter *adap,
296 unsigned int requested_speed)
Albert Aribaud306563a2010-08-27 18:26:05 +0200297{
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200298 struct mvtwsi_registers *twsi = twsi_get_base(adap);
Hans de Goede0db2bbd2014-06-13 22:55:48 +0200299 unsigned int tmp_speed, highest_speed, n, m;
300 unsigned int baud = 0x44; /* baudrate at controller reset */
Albert Aribaud306563a2010-08-27 18:26:05 +0200301
302 /* use actual speed to collect progressively higher values */
303 highest_speed = 0;
304 /* compute m, n setting for highest speed not above requested speed */
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200305 for (n = 0; n < 8; n++) {
306 for (m = 0; m < 16; m++) {
Stefan Roesef582a152015-03-18 09:30:54 +0100307 tmp_speed = twsi_calc_freq(n, m);
Albert Aribaud306563a2010-08-27 18:26:05 +0200308 if ((tmp_speed <= requested_speed)
309 && (tmp_speed > highest_speed)) {
310 highest_speed = tmp_speed;
311 baud = (m << 3) | n;
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200312 }
313 }
314 }
Hans de Goede0db2bbd2014-06-13 22:55:48 +0200315 writel(baud, &twsi->baudrate);
316 return 0;
317}
318
319static void twsi_i2c_init(struct i2c_adapter *adap, int speed, int slaveadd)
320{
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200321 struct mvtwsi_registers *twsi = twsi_get_base(adap);
322
Albert Aribaud306563a2010-08-27 18:26:05 +0200323 /* reset controller */
Hans de Goede0db2bbd2014-06-13 22:55:48 +0200324 twsi_reset(adap);
325 /* set speed */
326 twsi_i2c_set_bus_speed(adap, speed);
327 /* set slave address even though we don't use it */
328 writel(slaveadd, &twsi->slave_address);
329 writel(0, &twsi->xtnd_slave_addr);
330 /* assert STOP but don't care for the result */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200331 (void) twsi_stop(adap, 0);
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200332}
333
Albert Aribaud306563a2010-08-27 18:26:05 +0200334/*
335 * Begin I2C transaction with expected start status, at given address.
336 * Common to i2c_probe, i2c_read and i2c_write.
337 * Expected address status will derive from direction bit (bit 0) in addr.
338 */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200339static int i2c_begin(struct i2c_adapter *adap, int expected_start_status,
340 u8 addr)
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200341{
Albert Aribaud306563a2010-08-27 18:26:05 +0200342 int status, expected_addr_status;
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200343
Albert Aribaud306563a2010-08-27 18:26:05 +0200344 /* compute expected address status from direction bit in addr */
345 if (addr & 1) /* reading */
346 expected_addr_status = MVTWSI_STATUS_ADDR_R_ACK;
347 else /* writing */
348 expected_addr_status = MVTWSI_STATUS_ADDR_W_ACK;
349 /* assert START */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200350 status = twsi_start(adap, expected_start_status);
Albert Aribaud306563a2010-08-27 18:26:05 +0200351 /* send out the address if the start went well */
352 if (status == 0)
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200353 status = twsi_send(adap, addr, expected_addr_status);
Albert Aribaud306563a2010-08-27 18:26:05 +0200354 /* return ok or status of first failure to caller */
355 return status;
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200356}
357
Albert Aribaud306563a2010-08-27 18:26:05 +0200358/*
359 * I2C probe called by cmd_i2c when doing 'i2c probe'.
360 * Begin read, nak data byte, end.
361 */
Hans de Goede0db2bbd2014-06-13 22:55:48 +0200362static int twsi_i2c_probe(struct i2c_adapter *adap, uchar chip)
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200363{
Albert Aribaud306563a2010-08-27 18:26:05 +0200364 u8 dummy_byte;
365 int status;
366
367 /* begin i2c read */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200368 status = i2c_begin(adap, MVTWSI_STATUS_START, (chip << 1) | 1);
Albert Aribaud306563a2010-08-27 18:26:05 +0200369 /* dummy read was accepted: receive byte but NAK it. */
370 if (status == 0)
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200371 status = twsi_recv(adap, &dummy_byte);
Albert Aribaud306563a2010-08-27 18:26:05 +0200372 /* Stop transaction */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200373 twsi_stop(adap, 0);
Albert Aribaud306563a2010-08-27 18:26:05 +0200374 /* return 0 or status of first failure */
375 return status;
376}
377
378/*
379 * I2C read called by cmd_i2c when doing 'i2c read' and by cmd_eeprom.c
380 * Begin write, send address byte(s), begin read, receive data bytes, end.
381 *
382 * NOTE: some EEPROMS want a stop right before the second start, while
383 * some will choke if it is there. Deciding which we should do is eeprom
384 * stuff, not i2c, but at the moment the APIs won't let us put it in
385 * cmd_eeprom, so we have to choose here, and for the moment that'll be
386 * a repeated start without a preceding stop.
387 */
Hans de Goede0db2bbd2014-06-13 22:55:48 +0200388static int twsi_i2c_read(struct i2c_adapter *adap, uchar chip, uint addr,
389 int alen, uchar *data, int length)
Albert Aribaud306563a2010-08-27 18:26:05 +0200390{
391 int status;
392
393 /* begin i2c write to send the address bytes */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200394 status = i2c_begin(adap, MVTWSI_STATUS_START, (chip << 1));
Albert Aribaud306563a2010-08-27 18:26:05 +0200395 /* send addr bytes */
396 while ((status == 0) && alen--)
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200397 status = twsi_send(adap, addr >> (8*alen),
Albert Aribaud306563a2010-08-27 18:26:05 +0200398 MVTWSI_STATUS_DATA_W_ACK);
399 /* begin i2c read to receive eeprom data bytes */
400 if (status == 0)
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200401 status = i2c_begin(adap, MVTWSI_STATUS_REPEATED_START,
402 (chip << 1) | 1);
Albert Aribaud306563a2010-08-27 18:26:05 +0200403 /* prepare ACK if at least one byte must be received */
404 if (length > 0)
405 twsi_control_flags |= MVTWSI_CONTROL_ACK;
406 /* now receive actual bytes */
407 while ((status == 0) && length--) {
408 /* reset NAK if we if no more to read now */
409 if (length == 0)
410 twsi_control_flags &= ~MVTWSI_CONTROL_ACK;
411 /* read current byte */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200412 status = twsi_recv(adap, data++);
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200413 }
Albert Aribaud306563a2010-08-27 18:26:05 +0200414 /* Stop transaction */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200415 status = twsi_stop(adap, status);
Albert Aribaud306563a2010-08-27 18:26:05 +0200416 /* return 0 or status of first failure */
417 return status;
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200418}
419
Albert Aribaud306563a2010-08-27 18:26:05 +0200420/*
421 * I2C write called by cmd_i2c when doing 'i2c write' and by cmd_eeprom.c
422 * Begin write, send address byte(s), send data bytes, end.
423 */
Hans de Goede0db2bbd2014-06-13 22:55:48 +0200424static int twsi_i2c_write(struct i2c_adapter *adap, uchar chip, uint addr,
425 int alen, uchar *data, int length)
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200426{
Albert Aribaud306563a2010-08-27 18:26:05 +0200427 int status;
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200428
Albert Aribaud306563a2010-08-27 18:26:05 +0200429 /* begin i2c write to send the eeprom adress bytes then data bytes */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200430 status = i2c_begin(adap, MVTWSI_STATUS_START, (chip << 1));
Albert Aribaud306563a2010-08-27 18:26:05 +0200431 /* send addr bytes */
432 while ((status == 0) && alen--)
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200433 status = twsi_send(adap, addr >> (8*alen),
Albert Aribaud306563a2010-08-27 18:26:05 +0200434 MVTWSI_STATUS_DATA_W_ACK);
435 /* send data bytes */
436 while ((status == 0) && (length-- > 0))
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200437 status = twsi_send(adap, *(data++), MVTWSI_STATUS_DATA_W_ACK);
Albert Aribaud306563a2010-08-27 18:26:05 +0200438 /* Stop transaction */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200439 status = twsi_stop(adap, status);
Albert Aribaud306563a2010-08-27 18:26:05 +0200440 /* return 0 or status of first failure */
441 return status;
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200442}
443
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200444#ifdef CONFIG_I2C_MVTWSI_BASE0
Hans de Goede0db2bbd2014-06-13 22:55:48 +0200445U_BOOT_I2C_ADAP_COMPLETE(twsi0, twsi_i2c_init, twsi_i2c_probe,
446 twsi_i2c_read, twsi_i2c_write,
447 twsi_i2c_set_bus_speed,
448 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 0)
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200449#endif
450#ifdef CONFIG_I2C_MVTWSI_BASE1
451U_BOOT_I2C_ADAP_COMPLETE(twsi1, twsi_i2c_init, twsi_i2c_probe,
452 twsi_i2c_read, twsi_i2c_write,
453 twsi_i2c_set_bus_speed,
454 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 1)
455
456#endif
457#ifdef CONFIG_I2C_MVTWSI_BASE2
458U_BOOT_I2C_ADAP_COMPLETE(twsi2, twsi_i2c_init, twsi_i2c_probe,
459 twsi_i2c_read, twsi_i2c_write,
460 twsi_i2c_set_bus_speed,
461 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 2)
462
463#endif
464#ifdef CONFIG_I2C_MVTWSI_BASE3
465U_BOOT_I2C_ADAP_COMPLETE(twsi3, twsi_i2c_init, twsi_i2c_probe,
466 twsi_i2c_read, twsi_i2c_write,
467 twsi_i2c_set_bus_speed,
468 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 3)
469
470#endif
471#ifdef CONFIG_I2C_MVTWSI_BASE4
472U_BOOT_I2C_ADAP_COMPLETE(twsi4, twsi_i2c_init, twsi_i2c_probe,
473 twsi_i2c_read, twsi_i2c_write,
474 twsi_i2c_set_bus_speed,
475 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 4)
476
477#endif