blob: f48a4f25aae6e0675aec10b024afe484d04664d9 [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Heiko Schocher4ce5a722009-07-20 09:59:37 +02002/*
Albert Aribaud306563a2010-08-27 18:26:05 +02003 * Driver for the TWSI (i2c) controller found on the Marvell
4 * orion5x and kirkwood SoC families.
Heiko Schocher4ce5a722009-07-20 09:59:37 +02005 *
Albert ARIBAUD57b4bce2011-04-22 19:41:02 +02006 * Author: Albert Aribaud <albert.u.boot@aribaud.net>
Albert Aribaud306563a2010-08-27 18:26:05 +02007 * Copyright (c) 2010 Albert Aribaud.
Heiko Schocher4ce5a722009-07-20 09:59:37 +02008 */
Albert Aribaud306563a2010-08-27 18:26:05 +02009
Heiko Schocher4ce5a722009-07-20 09:59:37 +020010#include <common.h>
11#include <i2c.h>
Simon Glassf7ae49f2020-05-10 11:40:05 -060012#include <log.h>
Simon Glass401d1c42020-10-30 21:38:53 -060013#include <asm/global_data.h>
Simon Glassc05ed002020-05-10 11:40:11 -060014#include <linux/delay.h>
Masahiro Yamada1221ce42016-09-21 11:28:55 +090015#include <linux/errno.h>
Heiko Schocher4ce5a722009-07-20 09:59:37 +020016#include <asm/io.h>
Baruch Siach173ec352018-06-07 12:38:10 +030017#include <linux/bitops.h>
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +020018#include <linux/compat.h>
Igor Opaniuk2147a162021-02-09 13:52:45 +020019#if CONFIG_IS_ENABLED(DM_I2C)
Samuel Holland06cec892021-09-12 10:21:39 -050020#include <clk.h>
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +020021#include <dm.h>
Samuel Holland06cec892021-09-12 10:21:39 -050022#include <reset.h>
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +020023#endif
24
25DECLARE_GLOBAL_DATA_PTR;
Heiko Schocher4ce5a722009-07-20 09:59:37 +020026
Heiko Schocher4ce5a722009-07-20 09:59:37 +020027/*
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +020028 * Include a file that will provide CONFIG_I2C_MVTWSI_BASE*, and possibly other
29 * settings
Heiko Schocher4ce5a722009-07-20 09:59:37 +020030 */
31
Igor Opaniuk2147a162021-02-09 13:52:45 +020032#if !CONFIG_IS_ENABLED(DM_I2C)
Trevor Woernerb16a3312020-05-06 08:02:38 -040033#if defined(CONFIG_ARCH_ORION5X)
Albert Aribaud306563a2010-08-27 18:26:05 +020034#include <asm/arch/orion5x.h>
Trevor Woernerbb0fb4c2020-05-06 08:02:40 -040035#elif (defined(CONFIG_ARCH_KIRKWOOD) || defined(CONFIG_ARCH_MVEBU))
Stefan Roese3dc23f72014-10-22 12:13:06 +020036#include <asm/arch/soc.h>
Jagan Tekiaec9a0f2016-10-13 14:19:35 +053037#elif defined(CONFIG_ARCH_SUNXI)
Hans de Goede66203772014-06-13 22:55:49 +020038#include <asm/arch/i2c.h>
Albert Aribaud306563a2010-08-27 18:26:05 +020039#else
40#error Driver mvtwsi not supported by SoC or board
41#endif
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +020042#endif /* CONFIG_DM_I2C */
Albert Aribaud306563a2010-08-27 18:26:05 +020043
44/*
Jernej Skrabeca8f01cc2017-04-27 00:03:36 +020045 * On SUNXI, we get CONFIG_SYS_TCLK from this include, so we want to
46 * always have it.
47 */
Igor Opaniuk2147a162021-02-09 13:52:45 +020048#if CONFIG_IS_ENABLED(DM_I2C) && defined(CONFIG_ARCH_SUNXI)
Jernej Skrabeca8f01cc2017-04-27 00:03:36 +020049#include <asm/arch/i2c.h>
50#endif
51
52/*
Albert Aribaud306563a2010-08-27 18:26:05 +020053 * TWSI register structure
54 */
55
Jagan Tekiaec9a0f2016-10-13 14:19:35 +053056#ifdef CONFIG_ARCH_SUNXI
Hans de Goede66203772014-06-13 22:55:49 +020057
58struct mvtwsi_registers {
59 u32 slave_address;
60 u32 xtnd_slave_addr;
61 u32 data;
62 u32 control;
63 u32 status;
64 u32 baudrate;
65 u32 soft_reset;
Baruch Siach173ec352018-06-07 12:38:10 +030066 u32 debug; /* Dummy field for build compatibility with mvebu */
Hans de Goede66203772014-06-13 22:55:49 +020067};
68
69#else
70
Albert Aribaud306563a2010-08-27 18:26:05 +020071struct mvtwsi_registers {
72 u32 slave_address;
73 u32 data;
74 u32 control;
75 union {
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +020076 u32 status; /* When reading */
77 u32 baudrate; /* When writing */
Albert Aribaud306563a2010-08-27 18:26:05 +020078 };
79 u32 xtnd_slave_addr;
Baruch Siach173ec352018-06-07 12:38:10 +030080 u32 reserved0[2];
Albert Aribaud306563a2010-08-27 18:26:05 +020081 u32 soft_reset;
Baruch Siach173ec352018-06-07 12:38:10 +030082 u32 reserved1[27];
83 u32 debug;
Albert Aribaud306563a2010-08-27 18:26:05 +020084};
85
Hans de Goede66203772014-06-13 22:55:49 +020086#endif
87
Igor Opaniuk2147a162021-02-09 13:52:45 +020088#if CONFIG_IS_ENABLED(DM_I2C)
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +020089struct mvtwsi_i2c_dev {
90 /* TWSI Register base for the device */
91 struct mvtwsi_registers *base;
92 /* Number of the device (determined from cell-index property) */
93 int index;
94 /* The I2C slave address for the device */
95 u8 slaveadd;
96 /* The configured I2C speed in Hz */
97 uint speed;
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +020098 /* The current length of a clock period (depending on speed) */
99 uint tick;
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200100};
101#endif /* CONFIG_DM_I2C */
102
Albert Aribaud306563a2010-08-27 18:26:05 +0200103/*
mario.six@gdsys.ccdfc39582016-07-21 11:57:02 +0200104 * enum mvtwsi_ctrl_register_fields - Bit masks for flags in the control
105 * register
Albert Aribaud306563a2010-08-27 18:26:05 +0200106 */
mario.six@gdsys.ccdfc39582016-07-21 11:57:02 +0200107enum mvtwsi_ctrl_register_fields {
108 /* Acknowledge bit */
109 MVTWSI_CONTROL_ACK = 0x00000004,
110 /* Interrupt flag */
111 MVTWSI_CONTROL_IFLG = 0x00000008,
112 /* Stop bit */
113 MVTWSI_CONTROL_STOP = 0x00000010,
114 /* Start bit */
115 MVTWSI_CONTROL_START = 0x00000020,
116 /* I2C enable */
117 MVTWSI_CONTROL_TWSIEN = 0x00000040,
118 /* Interrupt enable */
119 MVTWSI_CONTROL_INTEN = 0x00000080,
120};
Albert Aribaud306563a2010-08-27 18:26:05 +0200121
122/*
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200123 * On sun6i and newer, IFLG is a write-clear bit, which is cleared by writing 1;
124 * on other platforms, it is a normal r/w bit, which is cleared by writing 0.
Hans de Goede904dfbf2016-01-14 14:06:25 +0100125 */
126
Jernej Skrabecb2968002021-01-11 21:11:36 +0100127#if defined(CONFIG_SUNXI_GEN_SUN6I) || defined(CONFIG_SUN50I_GEN_H6)
Hans de Goede904dfbf2016-01-14 14:06:25 +0100128#define MVTWSI_CONTROL_CLEAR_IFLG 0x00000008
129#else
130#define MVTWSI_CONTROL_CLEAR_IFLG 0x00000000
131#endif
132
133/*
mario.six@gdsys.ccdfc39582016-07-21 11:57:02 +0200134 * enum mvstwsi_status_values - Possible values of I2C controller's status
135 * register
136 *
137 * Only those statuses expected in normal master operation on
138 * non-10-bit-address devices are specified.
139 *
140 * Every status that's unexpected during normal operation (bus errors,
141 * arbitration losses, missing ACKs...) is passed back to the caller as an error
Albert Aribaud306563a2010-08-27 18:26:05 +0200142 * code.
143 */
mario.six@gdsys.ccdfc39582016-07-21 11:57:02 +0200144enum mvstwsi_status_values {
145 /* START condition transmitted */
146 MVTWSI_STATUS_START = 0x08,
147 /* Repeated START condition transmitted */
148 MVTWSI_STATUS_REPEATED_START = 0x10,
149 /* Address + write bit transmitted, ACK received */
150 MVTWSI_STATUS_ADDR_W_ACK = 0x18,
151 /* Data transmitted, ACK received */
152 MVTWSI_STATUS_DATA_W_ACK = 0x28,
153 /* Address + read bit transmitted, ACK received */
154 MVTWSI_STATUS_ADDR_R_ACK = 0x40,
155 /* Address + read bit transmitted, ACK not received */
156 MVTWSI_STATUS_ADDR_R_NAK = 0x48,
157 /* Data received, ACK transmitted */
158 MVTWSI_STATUS_DATA_R_ACK = 0x50,
159 /* Data received, ACK not transmitted */
160 MVTWSI_STATUS_DATA_R_NAK = 0x58,
161 /* No relevant status */
162 MVTWSI_STATUS_IDLE = 0xF8,
163};
Albert Aribaud306563a2010-08-27 18:26:05 +0200164
165/*
mario.six@gdsys.cc670514f2016-07-21 11:57:04 +0200166 * enum mvstwsi_ack_flags - Determine whether a read byte should be
167 * acknowledged or not.
168 */
169enum mvtwsi_ack_flags {
170 /* Send NAK after received byte */
171 MVTWSI_READ_NAK = 0,
172 /* Send ACK after received byte */
173 MVTWSI_READ_ACK = 1,
174};
175
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200176/*
177 * calc_tick() - Calculate the duration of a clock cycle from the I2C speed
178 *
179 * @speed: The speed in Hz to calculate the clock cycle duration for.
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100180 * Return: The duration of a clock cycle in ns.
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200181 */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200182inline uint calc_tick(uint speed)
183{
184 /* One tick = the duration of a period at the specified speed in ns (we
185 * add 100 ns to be on the safe side) */
186 return (1000000000u / speed) + 100;
187}
188
Igor Opaniuk2147a162021-02-09 13:52:45 +0200189#if !CONFIG_IS_ENABLED(DM_I2C)
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200190
mario.six@gdsys.cc670514f2016-07-21 11:57:04 +0200191/*
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200192 * twsi_get_base() - Get controller register base for specified adapter
193 *
194 * @adap: Adapter to get the register base for.
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100195 * Return: Register base for the specified adapter.
Albert Aribaud306563a2010-08-27 18:26:05 +0200196 */
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200197static struct mvtwsi_registers *twsi_get_base(struct i2c_adapter *adap)
198{
199 switch (adap->hwadapnr) {
200#ifdef CONFIG_I2C_MVTWSI_BASE0
201 case 0:
mario.six@gdsys.cc9ec43b02016-07-21 11:57:01 +0200202 return (struct mvtwsi_registers *)CONFIG_I2C_MVTWSI_BASE0;
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200203#endif
204#ifdef CONFIG_I2C_MVTWSI_BASE1
205 case 1:
mario.six@gdsys.cc9ec43b02016-07-21 11:57:01 +0200206 return (struct mvtwsi_registers *)CONFIG_I2C_MVTWSI_BASE1;
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200207#endif
208#ifdef CONFIG_I2C_MVTWSI_BASE2
209 case 2:
mario.six@gdsys.cc9ec43b02016-07-21 11:57:01 +0200210 return (struct mvtwsi_registers *)CONFIG_I2C_MVTWSI_BASE2;
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200211#endif
212#ifdef CONFIG_I2C_MVTWSI_BASE3
213 case 3:
mario.six@gdsys.cc9ec43b02016-07-21 11:57:01 +0200214 return (struct mvtwsi_registers *)CONFIG_I2C_MVTWSI_BASE3;
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200215#endif
216#ifdef CONFIG_I2C_MVTWSI_BASE4
217 case 4:
mario.six@gdsys.cc9ec43b02016-07-21 11:57:01 +0200218 return (struct mvtwsi_registers *)CONFIG_I2C_MVTWSI_BASE4;
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200219#endif
Jelle van der Waa9d082682016-01-14 14:06:26 +0100220#ifdef CONFIG_I2C_MVTWSI_BASE5
221 case 5:
mario.six@gdsys.cc9ec43b02016-07-21 11:57:01 +0200222 return (struct mvtwsi_registers *)CONFIG_I2C_MVTWSI_BASE5;
Jelle van der Waa9d082682016-01-14 14:06:26 +0100223#endif
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200224 default:
225 printf("Missing mvtwsi controller %d base\n", adap->hwadapnr);
226 break;
227 }
228
229 return NULL;
230}
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200231#endif
Albert Aribaud306563a2010-08-27 18:26:05 +0200232
233/*
mario.six@gdsys.ccdfc39582016-07-21 11:57:02 +0200234 * enum mvtwsi_error_class - types of I2C errors
Albert Aribaud306563a2010-08-27 18:26:05 +0200235 */
mario.six@gdsys.ccdfc39582016-07-21 11:57:02 +0200236enum mvtwsi_error_class {
237 /* The controller returned a different status than expected */
238 MVTWSI_ERROR_WRONG_STATUS = 0x01,
239 /* The controller timed out */
240 MVTWSI_ERROR_TIMEOUT = 0x02,
241};
Albert Aribaud306563a2010-08-27 18:26:05 +0200242
mario.six@gdsys.ccdfc39582016-07-21 11:57:02 +0200243/*
244 * mvtwsi_error() - Build I2C return code from error information
245 *
246 * For debugging purposes, this function packs some information of an occurred
247 * error into a return code. These error codes are returned from I2C API
248 * functions (i2c_{read,write}, dm_i2c_{read,write}, etc.).
249 *
250 * @ec: The error class of the error (enum mvtwsi_error_class).
251 * @lc: The last value of the control register.
252 * @ls: The last value of the status register.
253 * @es: The expected value of the status register.
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100254 * Return: The generated error code.
mario.six@gdsys.ccdfc39582016-07-21 11:57:02 +0200255 */
256inline uint mvtwsi_error(uint ec, uint lc, uint ls, uint es)
257{
258 return ((ec << 24) & 0xFF000000)
259 | ((lc << 16) & 0x00FF0000)
260 | ((ls << 8) & 0x0000FF00)
261 | (es & 0xFF);
262}
Albert Aribaud306563a2010-08-27 18:26:05 +0200263
264/*
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200265 * twsi_wait() - Wait for I2C bus interrupt flag and check status, or time out.
266 *
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100267 * Return: Zero if status is as expected, or a non-zero code if either a time
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200268 * out occurred, or the status was not the expected one.
Albert Aribaud306563a2010-08-27 18:26:05 +0200269 */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200270static int twsi_wait(struct mvtwsi_registers *twsi, int expected_status,
271 uint tick)
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200272{
Albert Aribaud306563a2010-08-27 18:26:05 +0200273 int control, status;
274 int timeout = 1000;
275
276 do {
277 control = readl(&twsi->control);
278 if (control & MVTWSI_CONTROL_IFLG) {
Marek Behúnd50e2962019-05-02 16:53:38 +0200279 /*
280 * On Armada 38x it seems that the controller works as
281 * if it first set the MVTWSI_CONTROL_IFLAG in the
282 * control register and only after that it changed the
283 * status register.
284 * This sometimes caused weird bugs which only appeared
285 * on selected I2C speeds and even then only sometimes.
286 * We therefore add here a simple ndealy(100), which
287 * seems to fix this weird bug.
288 */
289 ndelay(100);
Albert Aribaud306563a2010-08-27 18:26:05 +0200290 status = readl(&twsi->status);
291 if (status == expected_status)
292 return 0;
293 else
mario.six@gdsys.ccdfc39582016-07-21 11:57:02 +0200294 return mvtwsi_error(
Albert Aribaud306563a2010-08-27 18:26:05 +0200295 MVTWSI_ERROR_WRONG_STATUS,
296 control, status, expected_status);
297 }
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200298 ndelay(tick); /* One clock cycle */
Albert Aribaud306563a2010-08-27 18:26:05 +0200299 } while (timeout--);
300 status = readl(&twsi->status);
mario.six@gdsys.ccdfc39582016-07-21 11:57:02 +0200301 return mvtwsi_error(MVTWSI_ERROR_TIMEOUT, control, status,
302 expected_status);
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200303}
304
Albert Aribaud306563a2010-08-27 18:26:05 +0200305/*
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200306 * twsi_start() - Assert a START condition on the bus.
307 *
308 * This function is used in both single I2C transactions and inside
309 * back-to-back transactions (repeated starts).
310 *
311 * @twsi: The MVTWSI register structure to use.
312 * @expected_status: The I2C bus status expected to be asserted after the
313 * operation completion.
314 * @tick: The duration of a clock cycle at the current I2C speed.
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100315 * Return: Zero if status is as expected, or a non-zero code if either a time
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200316 * out occurred or the status was not the expected one.
Albert Aribaud306563a2010-08-27 18:26:05 +0200317 */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200318static int twsi_start(struct mvtwsi_registers *twsi, int expected_status,
319 uint tick)
Albert Aribaud306563a2010-08-27 18:26:05 +0200320{
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200321 /* Assert START */
mario.six@gdsys.cc670514f2016-07-21 11:57:04 +0200322 writel(MVTWSI_CONTROL_TWSIEN | MVTWSI_CONTROL_START |
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200323 MVTWSI_CONTROL_CLEAR_IFLG, &twsi->control);
324 /* Wait for controller to process START */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200325 return twsi_wait(twsi, expected_status, tick);
Albert Aribaud306563a2010-08-27 18:26:05 +0200326}
327
328/*
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200329 * twsi_send() - Send a byte on the I2C bus.
330 *
331 * The byte may be part of an address byte or data.
332 *
333 * @twsi: The MVTWSI register structure to use.
334 * @byte: The byte to send.
335 * @expected_status: The I2C bus status expected to be asserted after the
336 * operation completion.
337 * @tick: The duration of a clock cycle at the current I2C speed.
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100338 * Return: Zero if status is as expected, or a non-zero code if either a time
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200339 * out occurred or the status was not the expected one.
Albert Aribaud306563a2010-08-27 18:26:05 +0200340 */
mario.six@gdsys.cc3c4db632016-07-21 11:57:08 +0200341static int twsi_send(struct mvtwsi_registers *twsi, u8 byte,
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200342 int expected_status, uint tick)
Albert Aribaud306563a2010-08-27 18:26:05 +0200343{
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200344 /* Write byte to data register for sending */
Albert Aribaud306563a2010-08-27 18:26:05 +0200345 writel(byte, &twsi->data);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200346 /* Clear any pending interrupt -- that will cause sending */
mario.six@gdsys.cc670514f2016-07-21 11:57:04 +0200347 writel(MVTWSI_CONTROL_TWSIEN | MVTWSI_CONTROL_CLEAR_IFLG,
348 &twsi->control);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200349 /* Wait for controller to receive byte, and check ACK */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200350 return twsi_wait(twsi, expected_status, tick);
Albert Aribaud306563a2010-08-27 18:26:05 +0200351}
352
353/*
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200354 * twsi_recv() - Receive a byte on the I2C bus.
355 *
356 * The static variable mvtwsi_control_flags controls whether we ack or nak.
357 *
358 * @twsi: The MVTWSI register structure to use.
359 * @byte: The byte to send.
360 * @ack_flag: Flag that determines whether the received byte should
361 * be acknowledged by the controller or not (sent ACK/NAK).
362 * @tick: The duration of a clock cycle at the current I2C speed.
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100363 * Return: Zero if status is as expected, or a non-zero code if either a time
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200364 * out occurred or the status was not the expected one.
Albert Aribaud306563a2010-08-27 18:26:05 +0200365 */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200366static int twsi_recv(struct mvtwsi_registers *twsi, u8 *byte, int ack_flag,
367 uint tick)
Albert Aribaud306563a2010-08-27 18:26:05 +0200368{
mario.six@gdsys.cc670514f2016-07-21 11:57:04 +0200369 int expected_status, status, control;
Albert Aribaud306563a2010-08-27 18:26:05 +0200370
mario.six@gdsys.cc670514f2016-07-21 11:57:04 +0200371 /* Compute expected status based on passed ACK flag */
372 expected_status = ack_flag ? MVTWSI_STATUS_DATA_R_ACK :
373 MVTWSI_STATUS_DATA_R_NAK;
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200374 /* Acknowledge *previous state*, and launch receive */
mario.six@gdsys.cc670514f2016-07-21 11:57:04 +0200375 control = MVTWSI_CONTROL_TWSIEN;
376 control |= ack_flag == MVTWSI_READ_ACK ? MVTWSI_CONTROL_ACK : 0;
377 writel(control | MVTWSI_CONTROL_CLEAR_IFLG, &twsi->control);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200378 /* Wait for controller to receive byte, and assert ACK or NAK */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200379 status = twsi_wait(twsi, expected_status, tick);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200380 /* If we did receive the expected byte, store it */
Albert Aribaud306563a2010-08-27 18:26:05 +0200381 if (status == 0)
382 *byte = readl(&twsi->data);
Albert Aribaud306563a2010-08-27 18:26:05 +0200383 return status;
384}
385
386/*
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200387 * twsi_stop() - Assert a STOP condition on the bus.
388 *
389 * This function is also used to force the bus back to idle state (SDA =
390 * SCL = 1).
391 *
392 * @twsi: The MVTWSI register structure to use.
393 * @tick: The duration of a clock cycle at the current I2C speed.
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100394 * Return: Zero if the operation succeeded, or a non-zero code if a time out
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200395 * occurred.
Albert Aribaud306563a2010-08-27 18:26:05 +0200396 */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200397static int twsi_stop(struct mvtwsi_registers *twsi, uint tick)
Albert Aribaud306563a2010-08-27 18:26:05 +0200398{
399 int control, stop_status;
mario.six@gdsys.cc059fce92016-07-21 11:57:05 +0200400 int status = 0;
Albert Aribaud306563a2010-08-27 18:26:05 +0200401 int timeout = 1000;
402
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200403 /* Assert STOP */
Albert Aribaud306563a2010-08-27 18:26:05 +0200404 control = MVTWSI_CONTROL_TWSIEN | MVTWSI_CONTROL_STOP;
Hans de Goede904dfbf2016-01-14 14:06:25 +0100405 writel(control | MVTWSI_CONTROL_CLEAR_IFLG, &twsi->control);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200406 /* Wait for IDLE; IFLG won't rise, so we can't use twsi_wait() */
Albert Aribaud306563a2010-08-27 18:26:05 +0200407 do {
408 stop_status = readl(&twsi->status);
409 if (stop_status == MVTWSI_STATUS_IDLE)
410 break;
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200411 ndelay(tick); /* One clock cycle */
Albert Aribaud306563a2010-08-27 18:26:05 +0200412 } while (timeout--);
413 control = readl(&twsi->control);
414 if (stop_status != MVTWSI_STATUS_IDLE)
mario.six@gdsys.cc059fce92016-07-21 11:57:05 +0200415 status = mvtwsi_error(MVTWSI_ERROR_TIMEOUT,
416 control, status, MVTWSI_STATUS_IDLE);
Albert Aribaud306563a2010-08-27 18:26:05 +0200417 return status;
418}
419
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200420/*
421 * twsi_calc_freq() - Compute I2C frequency depending on m and n parameters.
422 *
423 * @n: Parameter 'n' for the frequency calculation algorithm.
424 * @m: Parameter 'm' for the frequency calculation algorithm.
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100425 * Return: The I2C frequency corresponding to the passed m and n parameters.
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200426 */
mario.six@gdsys.cce0758282016-07-21 11:57:06 +0200427static uint twsi_calc_freq(const int n, const int m)
Stefan Roesef582a152015-03-18 09:30:54 +0100428{
Jagan Tekiaec9a0f2016-10-13 14:19:35 +0530429#ifdef CONFIG_ARCH_SUNXI
Stefan Roesef582a152015-03-18 09:30:54 +0100430 return CONFIG_SYS_TCLK / (10 * (m + 1) * (1 << n));
431#else
432 return CONFIG_SYS_TCLK / (10 * (m + 1) * (2 << n));
433#endif
434}
Albert Aribaud306563a2010-08-27 18:26:05 +0200435
436/*
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200437 * twsi_reset() - Reset the I2C controller.
438 *
439 * Resetting the controller also resets the baud rate and slave address, hence
440 * they must be re-established after the reset.
441 *
442 * @twsi: The MVTWSI register structure to use.
Albert Aribaud306563a2010-08-27 18:26:05 +0200443 */
mario.six@gdsys.cc3c4db632016-07-21 11:57:08 +0200444static void twsi_reset(struct mvtwsi_registers *twsi)
Albert Aribaud306563a2010-08-27 18:26:05 +0200445{
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200446 /* Reset controller */
Albert Aribaud306563a2010-08-27 18:26:05 +0200447 writel(0, &twsi->soft_reset);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200448 /* Wait 2 ms -- this is what the Marvell LSP does */
Albert Aribaud306563a2010-08-27 18:26:05 +0200449 udelay(20000);
Albert Aribaud306563a2010-08-27 18:26:05 +0200450}
451
452/*
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200453 * __twsi_i2c_set_bus_speed() - Set the speed of the I2C controller.
454 *
455 * This function sets baud rate to the highest possible value that does not
456 * exceed the requested rate.
457 *
458 * @twsi: The MVTWSI register structure to use.
459 * @requested_speed: The desired frequency the controller should run at
460 * in Hz.
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100461 * Return: The actual frequency the controller was configured to.
Albert Aribaud306563a2010-08-27 18:26:05 +0200462 */
mario.six@gdsys.cc3c4db632016-07-21 11:57:08 +0200463static uint __twsi_i2c_set_bus_speed(struct mvtwsi_registers *twsi,
mario.six@gdsys.cc61bc02b2016-07-21 11:57:07 +0200464 uint requested_speed)
Albert Aribaud306563a2010-08-27 18:26:05 +0200465{
mario.six@gdsys.cce0758282016-07-21 11:57:06 +0200466 uint tmp_speed, highest_speed, n, m;
467 uint baud = 0x44; /* Baud rate after controller reset */
Albert Aribaud306563a2010-08-27 18:26:05 +0200468
Albert Aribaud306563a2010-08-27 18:26:05 +0200469 highest_speed = 0;
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200470 /* Successively try m, n combinations, and use the combination
471 * resulting in the largest speed that's not above the requested
472 * speed */
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200473 for (n = 0; n < 8; n++) {
474 for (m = 0; m < 16; m++) {
Stefan Roesef582a152015-03-18 09:30:54 +0100475 tmp_speed = twsi_calc_freq(n, m);
mario.six@gdsys.cc9ec43b02016-07-21 11:57:01 +0200476 if ((tmp_speed <= requested_speed) &&
477 (tmp_speed > highest_speed)) {
Albert Aribaud306563a2010-08-27 18:26:05 +0200478 highest_speed = tmp_speed;
479 baud = (m << 3) | n;
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200480 }
481 }
482 }
Hans de Goede0db2bbd2014-06-13 22:55:48 +0200483 writel(baud, &twsi->baudrate);
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200484
485 /* Wait for controller for one tick */
Igor Opaniuk2147a162021-02-09 13:52:45 +0200486#if CONFIG_IS_ENABLED(DM_I2C)
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200487 ndelay(calc_tick(highest_speed));
488#else
489 ndelay(10000);
490#endif
491 return highest_speed;
Hans de Goede0db2bbd2014-06-13 22:55:48 +0200492}
493
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200494/*
495 * __twsi_i2c_init() - Initialize the I2C controller.
496 *
497 * @twsi: The MVTWSI register structure to use.
498 * @speed: The initial frequency the controller should run at
499 * in Hz.
500 * @slaveadd: The I2C address to be set for the I2C master.
501 * @actual_speed: A output parameter that receives the actual frequency
502 * in Hz the controller was set to by the function.
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100503 * Return: Zero if the operation succeeded, or a non-zero code if a time out
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200504 * occurred.
505 */
mario.six@gdsys.cc3c4db632016-07-21 11:57:08 +0200506static void __twsi_i2c_init(struct mvtwsi_registers *twsi, int speed,
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200507 int slaveadd, uint *actual_speed)
Hans de Goede0db2bbd2014-06-13 22:55:48 +0200508{
Stefan Mavrodiev004b4cd2018-02-13 09:27:40 +0200509 uint tmp_speed;
510
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200511 /* Reset controller */
mario.six@gdsys.cc3c4db632016-07-21 11:57:08 +0200512 twsi_reset(twsi);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200513 /* Set speed */
Stefan Mavrodiev004b4cd2018-02-13 09:27:40 +0200514 tmp_speed = __twsi_i2c_set_bus_speed(twsi, speed);
Heinrich Schuchardt8bcf12c2018-01-31 00:57:17 +0100515 if (actual_speed)
Stefan Mavrodiev004b4cd2018-02-13 09:27:40 +0200516 *actual_speed = tmp_speed;
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200517 /* Set slave address; even though we don't use it */
Hans de Goede0db2bbd2014-06-13 22:55:48 +0200518 writel(slaveadd, &twsi->slave_address);
519 writel(0, &twsi->xtnd_slave_addr);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200520 /* Assert STOP, but don't care for the result */
Igor Opaniuk2147a162021-02-09 13:52:45 +0200521#if CONFIG_IS_ENABLED(DM_I2C)
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200522 (void) twsi_stop(twsi, calc_tick(*actual_speed));
523#else
524 (void) twsi_stop(twsi, 10000);
525#endif
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200526}
527
Albert Aribaud306563a2010-08-27 18:26:05 +0200528/*
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200529 * i2c_begin() - Start a I2C transaction.
530 *
531 * Begin a I2C transaction with a given expected start status and chip address.
532 * A START is asserted, and the address byte is sent to the I2C controller. The
533 * expected address status will be derived from the direction bit (bit 0) of
534 * the address byte.
535 *
536 * @twsi: The MVTWSI register structure to use.
537 * @expected_start_status: The I2C status the controller is expected to
538 * assert after the address byte was sent.
539 * @addr: The address byte to be sent.
540 * @tick: The duration of a clock cycle at the current
541 * I2C speed.
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100542 * Return: Zero if the operation succeeded, or a non-zero code if a time out or
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200543 * unexpected I2C status occurred.
Albert Aribaud306563a2010-08-27 18:26:05 +0200544 */
mario.six@gdsys.cc3c4db632016-07-21 11:57:08 +0200545static int i2c_begin(struct mvtwsi_registers *twsi, int expected_start_status,
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200546 u8 addr, uint tick)
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200547{
Albert Aribaud306563a2010-08-27 18:26:05 +0200548 int status, expected_addr_status;
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200549
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200550 /* Compute the expected address status from the direction bit in
551 * the address byte */
552 if (addr & 1) /* Reading */
Albert Aribaud306563a2010-08-27 18:26:05 +0200553 expected_addr_status = MVTWSI_STATUS_ADDR_R_ACK;
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200554 else /* Writing */
Albert Aribaud306563a2010-08-27 18:26:05 +0200555 expected_addr_status = MVTWSI_STATUS_ADDR_W_ACK;
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200556 /* Assert START */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200557 status = twsi_start(twsi, expected_start_status, tick);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200558 /* Send out the address if the start went well */
Albert Aribaud306563a2010-08-27 18:26:05 +0200559 if (status == 0)
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200560 status = twsi_send(twsi, addr, expected_addr_status, tick);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200561 /* Return 0, or the status of the first failure */
Albert Aribaud306563a2010-08-27 18:26:05 +0200562 return status;
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200563}
564
Albert Aribaud306563a2010-08-27 18:26:05 +0200565/*
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200566 * __twsi_i2c_probe_chip() - Probe the given I2C chip address.
567 *
568 * This function begins a I2C read transaction, does a dummy read and NAKs; if
569 * the procedure succeeds, the chip is considered to be present.
570 *
571 * @twsi: The MVTWSI register structure to use.
572 * @chip: The chip address to probe.
573 * @tick: The duration of a clock cycle at the current I2C speed.
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100574 * Return: Zero if the operation succeeded, or a non-zero code if a time out or
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200575 * unexpected I2C status occurred.
Albert Aribaud306563a2010-08-27 18:26:05 +0200576 */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200577static int __twsi_i2c_probe_chip(struct mvtwsi_registers *twsi, uchar chip,
578 uint tick)
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200579{
Albert Aribaud306563a2010-08-27 18:26:05 +0200580 u8 dummy_byte;
581 int status;
582
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200583 /* Begin i2c read */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200584 status = i2c_begin(twsi, MVTWSI_STATUS_START, (chip << 1) | 1, tick);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200585 /* Dummy read was accepted: receive byte, but NAK it. */
Albert Aribaud306563a2010-08-27 18:26:05 +0200586 if (status == 0)
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200587 status = twsi_recv(twsi, &dummy_byte, MVTWSI_READ_NAK, tick);
Albert Aribaud306563a2010-08-27 18:26:05 +0200588 /* Stop transaction */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200589 twsi_stop(twsi, tick);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200590 /* Return 0, or the status of the first failure */
Albert Aribaud306563a2010-08-27 18:26:05 +0200591 return status;
592}
593
594/*
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200595 * __twsi_i2c_read() - Read data from a I2C chip.
596 *
597 * This function begins a I2C write transaction, and transmits the address
598 * bytes; then begins a I2C read transaction, and receives the data bytes.
Albert Aribaud306563a2010-08-27 18:26:05 +0200599 *
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200600 * NOTE: Some devices want a stop right before the second start, while some
601 * will choke if it is there. Since deciding this is not yet supported in
602 * higher level APIs, we need to make a decision here, and for the moment that
603 * will be a repeated start without a preceding stop.
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200604 *
605 * @twsi: The MVTWSI register structure to use.
606 * @chip: The chip address to read from.
607 * @addr: The address bytes to send.
608 * @alen: The length of the address bytes in bytes.
609 * @data: The buffer to receive the data read from the chip (has to have
610 * a size of at least 'length' bytes).
611 * @length: The amount of data to be read from the chip in bytes.
612 * @tick: The duration of a clock cycle at the current I2C speed.
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100613 * Return: Zero if the operation succeeded, or a non-zero code if a time out or
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200614 * unexpected I2C status occurred.
Albert Aribaud306563a2010-08-27 18:26:05 +0200615 */
mario.six@gdsys.cc3c4db632016-07-21 11:57:08 +0200616static int __twsi_i2c_read(struct mvtwsi_registers *twsi, uchar chip,
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200617 u8 *addr, int alen, uchar *data, int length,
618 uint tick)
Albert Aribaud306563a2010-08-27 18:26:05 +0200619{
mario.six@gdsys.cc059fce92016-07-21 11:57:05 +0200620 int status = 0;
621 int stop_status;
mario.six@gdsys.cc24f9c6b2016-07-21 11:57:11 +0200622 int expected_start = MVTWSI_STATUS_START;
Albert Aribaud306563a2010-08-27 18:26:05 +0200623
mario.six@gdsys.cc24f9c6b2016-07-21 11:57:11 +0200624 if (alen > 0) {
625 /* Begin i2c write to send the address bytes */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200626 status = i2c_begin(twsi, expected_start, (chip << 1), tick);
mario.six@gdsys.cc24f9c6b2016-07-21 11:57:11 +0200627 /* Send address bytes */
628 while ((status == 0) && alen--)
Stefan Roese03d6cd92016-08-25 15:20:01 +0200629 status = twsi_send(twsi, addr[alen],
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200630 MVTWSI_STATUS_DATA_W_ACK, tick);
mario.six@gdsys.cc24f9c6b2016-07-21 11:57:11 +0200631 /* Send repeated STARTs after the initial START */
632 expected_start = MVTWSI_STATUS_REPEATED_START;
633 }
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200634 /* Begin i2c read to receive data bytes */
Albert Aribaud306563a2010-08-27 18:26:05 +0200635 if (status == 0)
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200636 status = i2c_begin(twsi, expected_start, (chip << 1) | 1, tick);
mario.six@gdsys.cc670514f2016-07-21 11:57:04 +0200637 /* Receive actual data bytes; set NAK if we if we have nothing more to
638 * read */
639 while ((status == 0) && length--)
mario.six@gdsys.cc3c4db632016-07-21 11:57:08 +0200640 status = twsi_recv(twsi, data++,
mario.six@gdsys.cc670514f2016-07-21 11:57:04 +0200641 length > 0 ?
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200642 MVTWSI_READ_ACK : MVTWSI_READ_NAK, tick);
Albert Aribaud306563a2010-08-27 18:26:05 +0200643 /* Stop transaction */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200644 stop_status = twsi_stop(twsi, tick);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200645 /* Return 0, or the status of the first failure */
mario.six@gdsys.cc059fce92016-07-21 11:57:05 +0200646 return status != 0 ? status : stop_status;
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200647}
648
Albert Aribaud306563a2010-08-27 18:26:05 +0200649/*
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200650 * __twsi_i2c_write() - Send data to a I2C chip.
651 *
652 * This function begins a I2C write transaction, and transmits the address
653 * bytes; then begins a new I2C write transaction, and sends the data bytes.
654 *
655 * @twsi: The MVTWSI register structure to use.
656 * @chip: The chip address to read from.
657 * @addr: The address bytes to send.
658 * @alen: The length of the address bytes in bytes.
659 * @data: The buffer containing the data to be sent to the chip.
660 * @length: The length of data to be sent to the chip in bytes.
661 * @tick: The duration of a clock cycle at the current I2C speed.
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100662 * Return: Zero if the operation succeeded, or a non-zero code if a time out or
mario.six@gdsys.cc6e677ca2016-07-21 11:57:13 +0200663 * unexpected I2C status occurred.
Albert Aribaud306563a2010-08-27 18:26:05 +0200664 */
mario.six@gdsys.cc3c4db632016-07-21 11:57:08 +0200665static int __twsi_i2c_write(struct mvtwsi_registers *twsi, uchar chip,
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200666 u8 *addr, int alen, uchar *data, int length,
667 uint tick)
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200668{
mario.six@gdsys.cc059fce92016-07-21 11:57:05 +0200669 int status, stop_status;
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200670
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200671 /* Begin i2c write to send first the address bytes, then the
672 * data bytes */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200673 status = i2c_begin(twsi, MVTWSI_STATUS_START, (chip << 1), tick);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200674 /* Send address bytes */
mario.six@gdsys.ccf8a10ed2016-07-21 11:57:09 +0200675 while ((status == 0) && (alen-- > 0))
Stefan Roese03d6cd92016-08-25 15:20:01 +0200676 status = twsi_send(twsi, addr[alen], MVTWSI_STATUS_DATA_W_ACK,
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200677 tick);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200678 /* Send data bytes */
Albert Aribaud306563a2010-08-27 18:26:05 +0200679 while ((status == 0) && (length-- > 0))
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200680 status = twsi_send(twsi, *(data++), MVTWSI_STATUS_DATA_W_ACK,
681 tick);
Albert Aribaud306563a2010-08-27 18:26:05 +0200682 /* Stop transaction */
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200683 stop_status = twsi_stop(twsi, tick);
mario.six@gdsys.cc49c801b2016-07-21 11:57:03 +0200684 /* Return 0, or the status of the first failure */
mario.six@gdsys.cc059fce92016-07-21 11:57:05 +0200685 return status != 0 ? status : stop_status;
Heiko Schocher4ce5a722009-07-20 09:59:37 +0200686}
687
Igor Opaniuk2147a162021-02-09 13:52:45 +0200688#if !CONFIG_IS_ENABLED(DM_I2C)
mario.six@gdsys.cc61bc02b2016-07-21 11:57:07 +0200689static void twsi_i2c_init(struct i2c_adapter *adap, int speed,
690 int slaveadd)
691{
mario.six@gdsys.cc3c4db632016-07-21 11:57:08 +0200692 struct mvtwsi_registers *twsi = twsi_get_base(adap);
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200693 __twsi_i2c_init(twsi, speed, slaveadd, NULL);
mario.six@gdsys.cc61bc02b2016-07-21 11:57:07 +0200694}
695
696static uint twsi_i2c_set_bus_speed(struct i2c_adapter *adap,
697 uint requested_speed)
698{
mario.six@gdsys.cc3c4db632016-07-21 11:57:08 +0200699 struct mvtwsi_registers *twsi = twsi_get_base(adap);
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200700 __twsi_i2c_set_bus_speed(twsi, requested_speed);
701 return 0;
mario.six@gdsys.cc61bc02b2016-07-21 11:57:07 +0200702}
703
704static int twsi_i2c_probe(struct i2c_adapter *adap, uchar chip)
705{
mario.six@gdsys.cc3c4db632016-07-21 11:57:08 +0200706 struct mvtwsi_registers *twsi = twsi_get_base(adap);
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200707 return __twsi_i2c_probe_chip(twsi, chip, 10000);
mario.six@gdsys.cc61bc02b2016-07-21 11:57:07 +0200708}
709
710static int twsi_i2c_read(struct i2c_adapter *adap, uchar chip, uint addr,
711 int alen, uchar *data, int length)
712{
mario.six@gdsys.cc3c4db632016-07-21 11:57:08 +0200713 struct mvtwsi_registers *twsi = twsi_get_base(adap);
mario.six@gdsys.ccf8a10ed2016-07-21 11:57:09 +0200714 u8 addr_bytes[4];
715
716 addr_bytes[0] = (addr >> 0) & 0xFF;
717 addr_bytes[1] = (addr >> 8) & 0xFF;
718 addr_bytes[2] = (addr >> 16) & 0xFF;
719 addr_bytes[3] = (addr >> 24) & 0xFF;
720
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200721 return __twsi_i2c_read(twsi, chip, addr_bytes, alen, data, length,
722 10000);
mario.six@gdsys.cc61bc02b2016-07-21 11:57:07 +0200723}
724
725static int twsi_i2c_write(struct i2c_adapter *adap, uchar chip, uint addr,
726 int alen, uchar *data, int length)
727{
mario.six@gdsys.cc3c4db632016-07-21 11:57:08 +0200728 struct mvtwsi_registers *twsi = twsi_get_base(adap);
mario.six@gdsys.ccf8a10ed2016-07-21 11:57:09 +0200729 u8 addr_bytes[4];
730
731 addr_bytes[0] = (addr >> 0) & 0xFF;
732 addr_bytes[1] = (addr >> 8) & 0xFF;
733 addr_bytes[2] = (addr >> 16) & 0xFF;
734 addr_bytes[3] = (addr >> 24) & 0xFF;
735
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200736 return __twsi_i2c_write(twsi, chip, addr_bytes, alen, data, length,
737 10000);
mario.six@gdsys.cc61bc02b2016-07-21 11:57:07 +0200738}
739
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200740#ifdef CONFIG_I2C_MVTWSI_BASE0
Hans de Goede0db2bbd2014-06-13 22:55:48 +0200741U_BOOT_I2C_ADAP_COMPLETE(twsi0, twsi_i2c_init, twsi_i2c_probe,
742 twsi_i2c_read, twsi_i2c_write,
743 twsi_i2c_set_bus_speed,
744 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 0)
Paul Kocialkowskidd822422015-04-10 23:09:51 +0200745#endif
746#ifdef CONFIG_I2C_MVTWSI_BASE1
747U_BOOT_I2C_ADAP_COMPLETE(twsi1, twsi_i2c_init, twsi_i2c_probe,
748 twsi_i2c_read, twsi_i2c_write,
749 twsi_i2c_set_bus_speed,
750 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 1)
751
752#endif
753#ifdef CONFIG_I2C_MVTWSI_BASE2
754U_BOOT_I2C_ADAP_COMPLETE(twsi2, twsi_i2c_init, twsi_i2c_probe,
755 twsi_i2c_read, twsi_i2c_write,
756 twsi_i2c_set_bus_speed,
757 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 2)
758
759#endif
760#ifdef CONFIG_I2C_MVTWSI_BASE3
761U_BOOT_I2C_ADAP_COMPLETE(twsi3, twsi_i2c_init, twsi_i2c_probe,
762 twsi_i2c_read, twsi_i2c_write,
763 twsi_i2c_set_bus_speed,
764 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 3)
765
766#endif
767#ifdef CONFIG_I2C_MVTWSI_BASE4
768U_BOOT_I2C_ADAP_COMPLETE(twsi4, twsi_i2c_init, twsi_i2c_probe,
769 twsi_i2c_read, twsi_i2c_write,
770 twsi_i2c_set_bus_speed,
771 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 4)
772
773#endif
Jelle van der Waa9d082682016-01-14 14:06:26 +0100774#ifdef CONFIG_I2C_MVTWSI_BASE5
775U_BOOT_I2C_ADAP_COMPLETE(twsi5, twsi_i2c_init, twsi_i2c_probe,
776 twsi_i2c_read, twsi_i2c_write,
777 twsi_i2c_set_bus_speed,
778 CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE, 5)
779
780#endif
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200781#else /* CONFIG_DM_I2C */
782
783static int mvtwsi_i2c_probe_chip(struct udevice *bus, u32 chip_addr,
784 u32 chip_flags)
785{
786 struct mvtwsi_i2c_dev *dev = dev_get_priv(bus);
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200787 return __twsi_i2c_probe_chip(dev->base, chip_addr, dev->tick);
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200788}
789
790static int mvtwsi_i2c_set_bus_speed(struct udevice *bus, uint speed)
791{
792 struct mvtwsi_i2c_dev *dev = dev_get_priv(bus);
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200793
794 dev->speed = __twsi_i2c_set_bus_speed(dev->base, speed);
795 dev->tick = calc_tick(dev->speed);
796
797 return 0;
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200798}
799
Simon Glassd1998a92020-12-03 16:55:21 -0700800static int mvtwsi_i2c_of_to_plat(struct udevice *bus)
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200801{
802 struct mvtwsi_i2c_dev *dev = dev_get_priv(bus);
803
Masahiro Yamada702e57e2020-08-04 14:14:43 +0900804 dev->base = dev_read_addr_ptr(bus);
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200805
806 if (!dev->base)
807 return -ENOMEM;
808
Simon Glasse160f7d2017-01-17 16:52:55 -0700809 dev->index = fdtdec_get_int(gd->fdt_blob, dev_of_offset(bus),
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200810 "cell-index", -1);
Simon Glasse160f7d2017-01-17 16:52:55 -0700811 dev->slaveadd = fdtdec_get_int(gd->fdt_blob, dev_of_offset(bus),
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200812 "u-boot,i2c-slave-addr", 0x0);
Simon Glassf3d46152020-01-23 11:48:22 -0700813 dev->speed = dev_read_u32_default(bus, "clock-frequency",
814 I2C_SPEED_STANDARD_RATE);
815
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200816 return 0;
817}
818
Baruch Siach173ec352018-06-07 12:38:10 +0300819static void twsi_disable_i2c_slave(struct mvtwsi_registers *twsi)
820{
821 clrbits_le32(&twsi->debug, BIT(18));
822}
823
824static int mvtwsi_i2c_bind(struct udevice *bus)
825{
Masahiro Yamada702e57e2020-08-04 14:14:43 +0900826 struct mvtwsi_registers *twsi = dev_read_addr_ptr(bus);
Baruch Siach173ec352018-06-07 12:38:10 +0300827
828 /* Disable the hidden slave in i2c0 of these platforms */
Simon Glass16df9932020-12-16 21:20:15 -0700829 if ((IS_ENABLED(CONFIG_ARMADA_38X) ||
830 IS_ENABLED(CONFIG_ARCH_KIRKWOOD) ||
831 IS_ENABLED(CONFIG_ARMADA_8K)) && !dev_seq(bus))
Baruch Siach173ec352018-06-07 12:38:10 +0300832 twsi_disable_i2c_slave(twsi);
833
834 return 0;
835}
836
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200837static int mvtwsi_i2c_probe(struct udevice *bus)
838{
839 struct mvtwsi_i2c_dev *dev = dev_get_priv(bus);
Samuel Holland06cec892021-09-12 10:21:39 -0500840 struct reset_ctl reset;
841 struct clk clk;
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200842 uint actual_speed;
Samuel Holland06cec892021-09-12 10:21:39 -0500843 int ret;
844
845 ret = reset_get_by_index(bus, 0, &reset);
846 if (!ret)
847 reset_deassert(&reset);
848
849 ret = clk_get_by_index(bus, 0, &clk);
850 if (!ret)
851 clk_enable(&clk);
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200852
853 __twsi_i2c_init(dev->base, dev->speed, dev->slaveadd, &actual_speed);
854 dev->speed = actual_speed;
855 dev->tick = calc_tick(dev->speed);
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200856 return 0;
857}
858
859static int mvtwsi_i2c_xfer(struct udevice *bus, struct i2c_msg *msg, int nmsgs)
860{
861 struct mvtwsi_i2c_dev *dev = dev_get_priv(bus);
862 struct i2c_msg *dmsg, *omsg, dummy;
Stefan Roeseccea46c2021-11-18 09:18:41 +0100863 u8 *addr_buf_ptr;
864 u8 addr_buf[4];
865 int i;
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200866
867 memset(&dummy, 0, sizeof(struct i2c_msg));
868
869 /* We expect either two messages (one with an offset and one with the
870 * actual data) or one message (just data or offset/data combined) */
871 if (nmsgs > 2 || nmsgs == 0) {
872 debug("%s: Only one or two messages are supported.", __func__);
873 return -1;
874 }
875
876 omsg = nmsgs == 1 ? &dummy : msg;
877 dmsg = nmsgs == 1 ? msg : msg + 1;
878
Stefan Roeseccea46c2021-11-18 09:18:41 +0100879 /* We need to swap the register address if its size is > 1 */
880 addr_buf_ptr = &addr_buf[0];
881 for (i = omsg->len; i > 0; i--)
882 *addr_buf_ptr++ = omsg->buf[i - 1];
883
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200884 if (dmsg->flags & I2C_M_RD)
Stefan Roeseccea46c2021-11-18 09:18:41 +0100885 return __twsi_i2c_read(dev->base, dmsg->addr, addr_buf,
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200886 omsg->len, dmsg->buf, dmsg->len,
887 dev->tick);
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200888 else
Stefan Roeseccea46c2021-11-18 09:18:41 +0100889 return __twsi_i2c_write(dev->base, dmsg->addr, addr_buf,
mario.six@gdsys.ccc68c6242016-07-21 11:57:12 +0200890 omsg->len, dmsg->buf, dmsg->len,
891 dev->tick);
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200892}
893
894static const struct dm_i2c_ops mvtwsi_i2c_ops = {
895 .xfer = mvtwsi_i2c_xfer,
896 .probe_chip = mvtwsi_i2c_probe_chip,
897 .set_bus_speed = mvtwsi_i2c_set_bus_speed,
898};
899
900static const struct udevice_id mvtwsi_i2c_ids[] = {
901 { .compatible = "marvell,mv64xxx-i2c", },
Stefan Roese87de0eb2016-09-16 15:07:55 +0200902 { .compatible = "marvell,mv78230-i2c", },
Chris Morganeb31a4a2022-01-07 11:52:54 -0600903 { .compatible = "allwinner,sun4i-a10-i2c", },
Jernej Skrabeca8f01cc2017-04-27 00:03:36 +0200904 { .compatible = "allwinner,sun6i-a31-i2c", },
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200905 { /* sentinel */ }
906};
907
908U_BOOT_DRIVER(i2c_mvtwsi) = {
909 .name = "i2c_mvtwsi",
910 .id = UCLASS_I2C,
911 .of_match = mvtwsi_i2c_ids,
Baruch Siach173ec352018-06-07 12:38:10 +0300912 .bind = mvtwsi_i2c_bind,
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200913 .probe = mvtwsi_i2c_probe,
Simon Glassd1998a92020-12-03 16:55:21 -0700914 .of_to_plat = mvtwsi_i2c_of_to_plat,
Simon Glass41575d82020-12-03 16:55:17 -0700915 .priv_auto = sizeof(struct mvtwsi_i2c_dev),
mario.six@gdsys.cc14a6ff22016-07-21 11:57:10 +0200916 .ops = &mvtwsi_i2c_ops,
917};
918#endif /* CONFIG_DM_I2C */