2 * Copyright (c) 2003-2015 Broadcom Corporation
4 * This file is licensed under the terms of the GNU General Public
5 * License version 2. This program is licensed "as is" without any
6 * warranty of any kind, whether express or implied.
9 #include <linux/acpi.h>
10 #include <linux/completion.h>
11 #include <linux/i2c.h>
12 #include <linux/init.h>
13 #include <linux/interrupt.h>
15 #include <linux/kernel.h>
16 #include <linux/module.h>
17 #include <linux/platform_device.h>
19 #define XLP9XX_I2C_DIV 0x0
20 #define XLP9XX_I2C_CTRL 0x1
21 #define XLP9XX_I2C_CMD 0x2
22 #define XLP9XX_I2C_STATUS 0x3
23 #define XLP9XX_I2C_MTXFIFO 0x4
24 #define XLP9XX_I2C_MRXFIFO 0x5
25 #define XLP9XX_I2C_MFIFOCTRL 0x6
26 #define XLP9XX_I2C_STXFIFO 0x7
27 #define XLP9XX_I2C_SRXFIFO 0x8
28 #define XLP9XX_I2C_SFIFOCTRL 0x9
29 #define XLP9XX_I2C_SLAVEADDR 0xA
30 #define XLP9XX_I2C_OWNADDR 0xB
31 #define XLP9XX_I2C_FIFOWCNT 0xC
32 #define XLP9XX_I2C_INTEN 0xD
33 #define XLP9XX_I2C_INTST 0xE
34 #define XLP9XX_I2C_WAITCNT 0xF
35 #define XLP9XX_I2C_TIMEOUT 0X10
36 #define XLP9XX_I2C_GENCALLADDR 0x11
38 #define XLP9XX_I2C_CMD_START BIT(7)
39 #define XLP9XX_I2C_CMD_STOP BIT(6)
40 #define XLP9XX_I2C_CMD_READ BIT(5)
41 #define XLP9XX_I2C_CMD_WRITE BIT(4)
42 #define XLP9XX_I2C_CMD_ACK BIT(3)
44 #define XLP9XX_I2C_CTRL_MCTLEN_SHIFT 16
45 #define XLP9XX_I2C_CTRL_MCTLEN_MASK 0xffff0000
46 #define XLP9XX_I2C_CTRL_RST BIT(8)
47 #define XLP9XX_I2C_CTRL_EN BIT(6)
48 #define XLP9XX_I2C_CTRL_MASTER BIT(4)
49 #define XLP9XX_I2C_CTRL_FIFORD BIT(1)
50 #define XLP9XX_I2C_CTRL_ADDMODE BIT(0)
52 #define XLP9XX_I2C_INTEN_NACKADDR BIT(25)
53 #define XLP9XX_I2C_INTEN_SADDR BIT(13)
54 #define XLP9XX_I2C_INTEN_DATADONE BIT(12)
55 #define XLP9XX_I2C_INTEN_ARLOST BIT(11)
56 #define XLP9XX_I2C_INTEN_MFIFOFULL BIT(4)
57 #define XLP9XX_I2C_INTEN_MFIFOEMTY BIT(3)
58 #define XLP9XX_I2C_INTEN_MFIFOHI BIT(2)
59 #define XLP9XX_I2C_INTEN_BUSERR BIT(0)
61 #define XLP9XX_I2C_MFIFOCTRL_HITH_SHIFT 8
62 #define XLP9XX_I2C_MFIFOCTRL_LOTH_SHIFT 0
63 #define XLP9XX_I2C_MFIFOCTRL_RST BIT(16)
65 #define XLP9XX_I2C_SLAVEADDR_RW BIT(0)
66 #define XLP9XX_I2C_SLAVEADDR_ADDR_SHIFT 1
68 #define XLP9XX_I2C_IP_CLK_FREQ 133000000UL
69 #define XLP9XX_I2C_DEFAULT_FREQ 100000
70 #define XLP9XX_I2C_HIGH_FREQ 400000
71 #define XLP9XX_I2C_FIFO_SIZE 0x80U
72 #define XLP9XX_I2C_TIMEOUT_MS 1000
74 #define XLP9XX_I2C_FIFO_WCNT_MASK 0xff
75 #define XLP9XX_I2C_STATUS_ERRMASK (XLP9XX_I2C_INTEN_ARLOST | \
76 XLP9XX_I2C_INTEN_NACKADDR | XLP9XX_I2C_INTEN_BUSERR)
78 struct xlp9xx_i2c_dev
{
80 struct i2c_adapter adapter
;
81 struct completion msg_complete
;
85 u32 msg_buf_remaining
;
92 static inline void xlp9xx_write_i2c_reg(struct xlp9xx_i2c_dev
*priv
,
93 unsigned long reg
, u32 val
)
95 writel(val
, priv
->base
+ reg
);
98 static inline u32
xlp9xx_read_i2c_reg(struct xlp9xx_i2c_dev
*priv
,
101 return readl(priv
->base
+ reg
);
104 static void xlp9xx_i2c_mask_irq(struct xlp9xx_i2c_dev
*priv
, u32 mask
)
108 inten
= xlp9xx_read_i2c_reg(priv
, XLP9XX_I2C_INTEN
) & ~mask
;
109 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_INTEN
, inten
);
112 static void xlp9xx_i2c_unmask_irq(struct xlp9xx_i2c_dev
*priv
, u32 mask
)
116 inten
= xlp9xx_read_i2c_reg(priv
, XLP9XX_I2C_INTEN
) | mask
;
117 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_INTEN
, inten
);
120 static void xlp9xx_i2c_update_rx_fifo_thres(struct xlp9xx_i2c_dev
*priv
)
124 thres
= min(priv
->msg_buf_remaining
, XLP9XX_I2C_FIFO_SIZE
);
125 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_MFIFOCTRL
,
126 thres
<< XLP9XX_I2C_MFIFOCTRL_HITH_SHIFT
);
129 static void xlp9xx_i2c_fill_tx_fifo(struct xlp9xx_i2c_dev
*priv
)
132 u8
*buf
= priv
->msg_buf
;
134 len
= min(priv
->msg_buf_remaining
, XLP9XX_I2C_FIFO_SIZE
);
135 for (i
= 0; i
< len
; i
++)
136 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_MTXFIFO
, buf
[i
]);
137 priv
->msg_buf_remaining
-= len
;
138 priv
->msg_buf
+= len
;
141 static void xlp9xx_i2c_drain_rx_fifo(struct xlp9xx_i2c_dev
*priv
)
144 u8
*buf
= priv
->msg_buf
;
146 len
= xlp9xx_read_i2c_reg(priv
, XLP9XX_I2C_FIFOWCNT
) &
147 XLP9XX_I2C_FIFO_WCNT_MASK
;
148 len
= min(priv
->msg_buf_remaining
, len
);
149 for (i
= 0; i
< len
; i
++, buf
++)
150 *buf
= xlp9xx_read_i2c_reg(priv
, XLP9XX_I2C_MRXFIFO
);
152 priv
->msg_buf_remaining
-= len
;
155 if (priv
->msg_buf_remaining
)
156 xlp9xx_i2c_update_rx_fifo_thres(priv
);
159 static irqreturn_t
xlp9xx_i2c_isr(int irq
, void *dev_id
)
161 struct xlp9xx_i2c_dev
*priv
= dev_id
;
164 status
= xlp9xx_read_i2c_reg(priv
, XLP9XX_I2C_INTST
);
168 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_INTST
, status
);
169 if (status
& XLP9XX_I2C_STATUS_ERRMASK
) {
170 priv
->msg_err
= status
;
174 /* SADDR ACK for SMBUS_QUICK */
175 if ((status
& XLP9XX_I2C_INTEN_SADDR
) && (priv
->msg_len
== 0))
178 if (!priv
->msg_read
) {
179 if (status
& XLP9XX_I2C_INTEN_MFIFOEMTY
) {
180 /* TX FIFO got empty, fill it up again */
181 if (priv
->msg_buf_remaining
)
182 xlp9xx_i2c_fill_tx_fifo(priv
);
184 xlp9xx_i2c_mask_irq(priv
,
185 XLP9XX_I2C_INTEN_MFIFOEMTY
);
188 if (status
& (XLP9XX_I2C_INTEN_DATADONE
|
189 XLP9XX_I2C_INTEN_MFIFOHI
)) {
190 /* data is in FIFO, read it */
191 if (priv
->msg_buf_remaining
)
192 xlp9xx_i2c_drain_rx_fifo(priv
);
196 /* Transfer complete */
197 if (status
& XLP9XX_I2C_INTEN_DATADONE
)
203 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_INTEN
, 0);
204 complete(&priv
->msg_complete
);
208 static int xlp9xx_i2c_init(struct xlp9xx_i2c_dev
*priv
)
213 * The controller uses 5 * SCL clock internally.
214 * So prescale value should be divided by 5.
216 prescale
= DIV_ROUND_UP(XLP9XX_I2C_IP_CLK_FREQ
, priv
->clk_hz
);
217 prescale
= ((prescale
- 8) / 5) - 1;
218 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_CTRL
, XLP9XX_I2C_CTRL_RST
);
219 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_CTRL
, XLP9XX_I2C_CTRL_EN
|
220 XLP9XX_I2C_CTRL_MASTER
);
221 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_DIV
, prescale
);
222 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_INTEN
, 0);
227 static int xlp9xx_i2c_xfer_msg(struct xlp9xx_i2c_dev
*priv
, struct i2c_msg
*msg
,
230 unsigned long timeleft
;
231 u32 intr_mask
, cmd
, val
;
233 priv
->msg_buf
= msg
->buf
;
234 priv
->msg_buf_remaining
= priv
->msg_len
= msg
->len
;
236 priv
->msg_read
= (msg
->flags
& I2C_M_RD
);
237 reinit_completion(&priv
->msg_complete
);
240 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_MFIFOCTRL
,
241 XLP9XX_I2C_MFIFOCTRL_RST
);
243 /* set FIFO threshold if reading */
245 xlp9xx_i2c_update_rx_fifo_thres(priv
);
248 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_SLAVEADDR
,
249 (msg
->addr
<< XLP9XX_I2C_SLAVEADDR_ADDR_SHIFT
) |
250 (priv
->msg_read
? XLP9XX_I2C_SLAVEADDR_RW
: 0));
252 /* Build control word for transfer */
253 val
= xlp9xx_read_i2c_reg(priv
, XLP9XX_I2C_CTRL
);
255 val
&= ~XLP9XX_I2C_CTRL_FIFORD
;
257 val
|= XLP9XX_I2C_CTRL_FIFORD
; /* read */
259 if (msg
->flags
& I2C_M_TEN
)
260 val
|= XLP9XX_I2C_CTRL_ADDMODE
; /* 10-bit address mode*/
262 val
&= ~XLP9XX_I2C_CTRL_ADDMODE
;
264 /* set data length to be transferred */
265 val
= (val
& ~XLP9XX_I2C_CTRL_MCTLEN_MASK
) |
266 (msg
->len
<< XLP9XX_I2C_CTRL_MCTLEN_SHIFT
);
267 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_CTRL
, val
);
269 /* fill fifo during tx */
271 xlp9xx_i2c_fill_tx_fifo(priv
);
273 /* set interrupt mask */
274 intr_mask
= (XLP9XX_I2C_INTEN_ARLOST
| XLP9XX_I2C_INTEN_BUSERR
|
275 XLP9XX_I2C_INTEN_NACKADDR
| XLP9XX_I2C_INTEN_DATADONE
);
277 if (priv
->msg_read
) {
278 intr_mask
|= XLP9XX_I2C_INTEN_MFIFOHI
;
280 intr_mask
|= XLP9XX_I2C_INTEN_SADDR
;
283 intr_mask
|= XLP9XX_I2C_INTEN_SADDR
;
285 intr_mask
|= XLP9XX_I2C_INTEN_MFIFOEMTY
;
287 xlp9xx_i2c_unmask_irq(priv
, intr_mask
);
290 cmd
= XLP9XX_I2C_CMD_START
;
291 cmd
|= (priv
->msg_read
? XLP9XX_I2C_CMD_READ
: XLP9XX_I2C_CMD_WRITE
);
293 cmd
|= XLP9XX_I2C_CMD_STOP
;
295 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_CMD
, cmd
);
297 timeleft
= msecs_to_jiffies(XLP9XX_I2C_TIMEOUT_MS
);
298 timeleft
= wait_for_completion_timeout(&priv
->msg_complete
, timeleft
);
301 dev_dbg(priv
->dev
, "transfer error %x!\n", priv
->msg_err
);
302 if (priv
->msg_err
& XLP9XX_I2C_INTEN_BUSERR
)
303 xlp9xx_i2c_init(priv
);
308 dev_dbg(priv
->dev
, "i2c transfer timed out!\n");
309 xlp9xx_i2c_init(priv
);
316 static int xlp9xx_i2c_xfer(struct i2c_adapter
*adap
, struct i2c_msg
*msgs
,
320 struct xlp9xx_i2c_dev
*priv
= i2c_get_adapdata(adap
);
322 for (i
= 0; i
< num
; i
++) {
323 ret
= xlp9xx_i2c_xfer_msg(priv
, &msgs
[i
], i
== num
- 1);
331 static u32
xlp9xx_i2c_functionality(struct i2c_adapter
*adapter
)
333 return I2C_FUNC_SMBUS_EMUL
| I2C_FUNC_I2C
|
337 static struct i2c_algorithm xlp9xx_i2c_algo
= {
338 .master_xfer
= xlp9xx_i2c_xfer
,
339 .functionality
= xlp9xx_i2c_functionality
,
342 static int xlp9xx_i2c_get_frequency(struct platform_device
*pdev
,
343 struct xlp9xx_i2c_dev
*priv
)
348 err
= device_property_read_u32(&pdev
->dev
, "clock-frequency", &freq
);
350 freq
= XLP9XX_I2C_DEFAULT_FREQ
;
351 dev_dbg(&pdev
->dev
, "using default frequency %u\n", freq
);
352 } else if (freq
== 0 || freq
> XLP9XX_I2C_HIGH_FREQ
) {
353 dev_warn(&pdev
->dev
, "invalid frequency %u, using default\n",
355 freq
= XLP9XX_I2C_DEFAULT_FREQ
;
362 static int xlp9xx_i2c_probe(struct platform_device
*pdev
)
364 struct xlp9xx_i2c_dev
*priv
;
365 struct resource
*res
;
368 priv
= devm_kzalloc(&pdev
->dev
, sizeof(*priv
), GFP_KERNEL
);
372 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
373 priv
->base
= devm_ioremap_resource(&pdev
->dev
, res
);
374 if (IS_ERR(priv
->base
))
375 return PTR_ERR(priv
->base
);
377 priv
->irq
= platform_get_irq(pdev
, 0);
378 if (priv
->irq
<= 0) {
379 dev_err(&pdev
->dev
, "invalid irq!\n");
383 xlp9xx_i2c_get_frequency(pdev
, priv
);
384 xlp9xx_i2c_init(priv
);
386 err
= devm_request_irq(&pdev
->dev
, priv
->irq
, xlp9xx_i2c_isr
, 0,
389 dev_err(&pdev
->dev
, "IRQ request failed!\n");
393 init_completion(&priv
->msg_complete
);
394 priv
->adapter
.dev
.parent
= &pdev
->dev
;
395 priv
->adapter
.algo
= &xlp9xx_i2c_algo
;
396 priv
->adapter
.dev
.of_node
= pdev
->dev
.of_node
;
397 priv
->dev
= &pdev
->dev
;
399 snprintf(priv
->adapter
.name
, sizeof(priv
->adapter
.name
), "xlp9xx-i2c");
400 i2c_set_adapdata(&priv
->adapter
, priv
);
402 err
= i2c_add_adapter(&priv
->adapter
);
406 platform_set_drvdata(pdev
, priv
);
407 dev_dbg(&pdev
->dev
, "I2C bus:%d added\n", priv
->adapter
.nr
);
412 static int xlp9xx_i2c_remove(struct platform_device
*pdev
)
414 struct xlp9xx_i2c_dev
*priv
;
416 priv
= platform_get_drvdata(pdev
);
417 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_INTEN
, 0);
418 synchronize_irq(priv
->irq
);
419 i2c_del_adapter(&priv
->adapter
);
420 xlp9xx_write_i2c_reg(priv
, XLP9XX_I2C_CTRL
, 0);
425 static const struct of_device_id xlp9xx_i2c_of_match
[] = {
426 { .compatible
= "netlogic,xlp980-i2c", },
431 static const struct acpi_device_id xlp9xx_i2c_acpi_ids
[] = {
435 MODULE_DEVICE_TABLE(acpi
, xlp9xx_i2c_acpi_ids
);
438 static struct platform_driver xlp9xx_i2c_driver
= {
439 .probe
= xlp9xx_i2c_probe
,
440 .remove
= xlp9xx_i2c_remove
,
442 .name
= "xlp9xx-i2c",
443 .of_match_table
= xlp9xx_i2c_of_match
,
444 .acpi_match_table
= ACPI_PTR(xlp9xx_i2c_acpi_ids
),
448 module_platform_driver(xlp9xx_i2c_driver
);
450 MODULE_AUTHOR("Subhendu Sekhar Behera <sbehera@broadcom.com>");
451 MODULE_DESCRIPTION("XLP9XX/5XX I2C Bus Controller Driver");
452 MODULE_LICENSE("GPL v2");