1/*
2 * Copyright (C) 2013 Broadcom Corporation
3 *
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License as
6 * published by the Free Software Foundation version 2.
7 *
8 * This program is distributed "as is" WITHOUT ANY WARRANTY of any
9 * kind, whether express or implied; without even the implied warranty
10 * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
11 * GNU General Public License for more details.
12 */
13
14#include <linux/device.h>
15#include <linux/kernel.h>
16#include <linux/module.h>
17#include <linux/sched.h>
18#include <linux/i2c.h>
19#include <linux/interrupt.h>
20#include <linux/platform_device.h>
21#include <linux/clk.h>
22#include <linux/io.h>
23#include <linux/slab.h>
24
25/* Hardware register offsets and field defintions */
26#define CS_OFFSET				0x00000020
27#define CS_ACK_SHIFT				3
28#define CS_ACK_MASK				0x00000008
29#define CS_ACK_CMD_GEN_START			0x00000000
30#define CS_ACK_CMD_GEN_RESTART			0x00000001
31#define CS_CMD_SHIFT				1
32#define CS_CMD_CMD_NO_ACTION			0x00000000
33#define CS_CMD_CMD_START_RESTART		0x00000001
34#define CS_CMD_CMD_STOP				0x00000002
35#define CS_EN_SHIFT				0
36#define CS_EN_CMD_ENABLE_BSC			0x00000001
37
38#define TIM_OFFSET				0x00000024
39#define TIM_PRESCALE_SHIFT			6
40#define TIM_P_SHIFT				3
41#define TIM_NO_DIV_SHIFT			2
42#define TIM_DIV_SHIFT				0
43
44#define DAT_OFFSET				0x00000028
45
46#define TOUT_OFFSET				0x0000002c
47
48#define TXFCR_OFFSET				0x0000003c
49#define TXFCR_FIFO_FLUSH_MASK			0x00000080
50#define TXFCR_FIFO_EN_MASK			0x00000040
51
52#define IER_OFFSET				0x00000044
53#define IER_READ_COMPLETE_INT_MASK		0x00000010
54#define IER_I2C_INT_EN_MASK			0x00000008
55#define IER_FIFO_INT_EN_MASK			0x00000002
56#define IER_NOACK_EN_MASK			0x00000001
57
58#define ISR_OFFSET				0x00000048
59#define ISR_RESERVED_MASK			0xffffff60
60#define ISR_CMDBUSY_MASK			0x00000080
61#define ISR_READ_COMPLETE_MASK			0x00000010
62#define ISR_SES_DONE_MASK			0x00000008
63#define ISR_ERR_MASK				0x00000004
64#define ISR_TXFIFOEMPTY_MASK			0x00000002
65#define ISR_NOACK_MASK				0x00000001
66
67#define CLKEN_OFFSET				0x0000004C
68#define CLKEN_AUTOSENSE_OFF_MASK		0x00000080
69#define CLKEN_M_SHIFT				4
70#define CLKEN_N_SHIFT				1
71#define CLKEN_CLKEN_MASK			0x00000001
72
73#define FIFO_STATUS_OFFSET			0x00000054
74#define FIFO_STATUS_RXFIFO_EMPTY_MASK		0x00000004
75#define FIFO_STATUS_TXFIFO_EMPTY_MASK		0x00000010
76
77#define HSTIM_OFFSET				0x00000058
78#define HSTIM_HS_MODE_MASK			0x00008000
79#define HSTIM_HS_HOLD_SHIFT			10
80#define HSTIM_HS_HIGH_PHASE_SHIFT		5
81#define HSTIM_HS_SETUP_SHIFT			0
82
83#define PADCTL_OFFSET				0x0000005c
84#define PADCTL_PAD_OUT_EN_MASK			0x00000004
85
86#define RXFCR_OFFSET				0x00000068
87#define RXFCR_NACK_EN_SHIFT			7
88#define RXFCR_READ_COUNT_SHIFT			0
89#define RXFIFORDOUT_OFFSET			0x0000006c
90
91/* Locally used constants */
92#define MAX_RX_FIFO_SIZE		64U /* bytes */
93#define MAX_TX_FIFO_SIZE		64U /* bytes */
94
95#define STD_EXT_CLK_FREQ		13000000UL
96#define HS_EXT_CLK_FREQ			104000000UL
97
98#define MASTERCODE			0x08 /* Mastercodes are 0000_1xxxb */
99
100#define I2C_TIMEOUT			100 /* msecs */
101
102/* Operations that can be commanded to the controller */
103enum bcm_kona_cmd_t {
104	BCM_CMD_NOACTION = 0,
105	BCM_CMD_START,
106	BCM_CMD_RESTART,
107	BCM_CMD_STOP,
108};
109
110enum bus_speed_index {
111	BCM_SPD_100K = 0,
112	BCM_SPD_400K,
113	BCM_SPD_1MHZ,
114};
115
116enum hs_bus_speed_index {
117	BCM_SPD_3P4MHZ = 0,
118};
119
120/* Internal divider settings for standard mode, fast mode and fast mode plus */
121struct bus_speed_cfg {
122	uint8_t time_m;		/* Number of cycles for setup time */
123	uint8_t time_n;		/* Number of cycles for hold time */
124	uint8_t prescale;	/* Prescale divider */
125	uint8_t time_p;		/* Timing coefficient */
126	uint8_t no_div;		/* Disable clock divider */
127	uint8_t time_div;	/* Post-prescale divider */
128};
129
130/* Internal divider settings for high-speed mode */
131struct hs_bus_speed_cfg {
132	uint8_t hs_hold;	/* Number of clock cycles SCL stays low until
133				   the end of bit period */
134	uint8_t hs_high_phase;	/* Number of clock cycles SCL stays high
135				   before it falls */
136	uint8_t hs_setup;	/* Number of clock cycles SCL stays low
137				   before it rises  */
138	uint8_t prescale;	/* Prescale divider */
139	uint8_t time_p;		/* Timing coefficient */
140	uint8_t no_div;		/* Disable clock divider */
141	uint8_t time_div;	/* Post-prescale divider */
142};
143
144static const struct bus_speed_cfg std_cfg_table[] = {
145	[BCM_SPD_100K] = {0x01, 0x01, 0x03, 0x06, 0x00, 0x02},
146	[BCM_SPD_400K] = {0x05, 0x01, 0x03, 0x05, 0x01, 0x02},
147	[BCM_SPD_1MHZ] = {0x01, 0x01, 0x03, 0x01, 0x01, 0x03},
148};
149
150static const struct hs_bus_speed_cfg hs_cfg_table[] = {
151	[BCM_SPD_3P4MHZ] = {0x01, 0x08, 0x14, 0x00, 0x06, 0x01, 0x00},
152};
153
154struct bcm_kona_i2c_dev {
155	struct device *device;
156
157	void __iomem *base;
158	int irq;
159	struct clk *external_clk;
160
161	struct i2c_adapter adapter;
162
163	struct completion done;
164
165	const struct bus_speed_cfg *std_cfg;
166	const struct hs_bus_speed_cfg *hs_cfg;
167};
168
169static void bcm_kona_i2c_send_cmd_to_ctrl(struct bcm_kona_i2c_dev *dev,
170					  enum bcm_kona_cmd_t cmd)
171{
172	dev_dbg(dev->device, "%s, %d\n", __func__, cmd);
173
174	switch (cmd) {
175	case BCM_CMD_NOACTION:
176		writel((CS_CMD_CMD_NO_ACTION << CS_CMD_SHIFT) |
177		       (CS_EN_CMD_ENABLE_BSC << CS_EN_SHIFT),
178		       dev->base + CS_OFFSET);
179		break;
180
181	case BCM_CMD_START:
182		writel((CS_ACK_CMD_GEN_START << CS_ACK_SHIFT) |
183		       (CS_CMD_CMD_START_RESTART << CS_CMD_SHIFT) |
184		       (CS_EN_CMD_ENABLE_BSC << CS_EN_SHIFT),
185		       dev->base + CS_OFFSET);
186		break;
187
188	case BCM_CMD_RESTART:
189		writel((CS_ACK_CMD_GEN_RESTART << CS_ACK_SHIFT) |
190		       (CS_CMD_CMD_START_RESTART << CS_CMD_SHIFT) |
191		       (CS_EN_CMD_ENABLE_BSC << CS_EN_SHIFT),
192		       dev->base + CS_OFFSET);
193		break;
194
195	case BCM_CMD_STOP:
196		writel((CS_CMD_CMD_STOP << CS_CMD_SHIFT) |
197		       (CS_EN_CMD_ENABLE_BSC << CS_EN_SHIFT),
198		       dev->base + CS_OFFSET);
199		break;
200
201	default:
202		dev_err(dev->device, "Unknown command %d\n", cmd);
203	}
204}
205
206static void bcm_kona_i2c_enable_clock(struct bcm_kona_i2c_dev *dev)
207{
208	writel(readl(dev->base + CLKEN_OFFSET) | CLKEN_CLKEN_MASK,
209	       dev->base + CLKEN_OFFSET);
210}
211
212static void bcm_kona_i2c_disable_clock(struct bcm_kona_i2c_dev *dev)
213{
214	writel(readl(dev->base + CLKEN_OFFSET) & ~CLKEN_CLKEN_MASK,
215	       dev->base + CLKEN_OFFSET);
216}
217
218static irqreturn_t bcm_kona_i2c_isr(int irq, void *devid)
219{
220	struct bcm_kona_i2c_dev *dev = devid;
221	uint32_t status = readl(dev->base + ISR_OFFSET);
222
223	if ((status & ~ISR_RESERVED_MASK) == 0)
224		return IRQ_NONE;
225
226	/* Must flush the TX FIFO when NAK detected */
227	if (status & ISR_NOACK_MASK)
228		writel(TXFCR_FIFO_FLUSH_MASK | TXFCR_FIFO_EN_MASK,
229		       dev->base + TXFCR_OFFSET);
230
231	writel(status & ~ISR_RESERVED_MASK, dev->base + ISR_OFFSET);
232	complete_all(&dev->done);
233
234	return IRQ_HANDLED;
235}
236
237/* Wait for ISR_CMDBUSY_MASK to go low before writing to CS, DAT, or RCD */
238static int bcm_kona_i2c_wait_if_busy(struct bcm_kona_i2c_dev *dev)
239{
240	unsigned long timeout = jiffies + msecs_to_jiffies(I2C_TIMEOUT);
241
242	while (readl(dev->base + ISR_OFFSET) & ISR_CMDBUSY_MASK)
243		if (time_after(jiffies, timeout)) {
244			dev_err(dev->device, "CMDBUSY timeout\n");
245			return -ETIMEDOUT;
246		}
247
248	return 0;
249}
250
251/* Send command to I2C bus */
252static int bcm_kona_send_i2c_cmd(struct bcm_kona_i2c_dev *dev,
253				 enum bcm_kona_cmd_t cmd)
254{
255	int rc;
256	unsigned long time_left = msecs_to_jiffies(I2C_TIMEOUT);
257
258	/* Make sure the hardware is ready */
259	rc = bcm_kona_i2c_wait_if_busy(dev);
260	if (rc < 0)
261		return rc;
262
263	/* Unmask the session done interrupt */
264	writel(IER_I2C_INT_EN_MASK, dev->base + IER_OFFSET);
265
266	/* Mark as incomplete before sending the command */
267	reinit_completion(&dev->done);
268
269	/* Send the command */
270	bcm_kona_i2c_send_cmd_to_ctrl(dev, cmd);
271
272	/* Wait for transaction to finish or timeout */
273	time_left = wait_for_completion_timeout(&dev->done, time_left);
274
275	/* Mask all interrupts */
276	writel(0, dev->base + IER_OFFSET);
277
278	if (!time_left) {
279		dev_err(dev->device, "controller timed out\n");
280		rc = -ETIMEDOUT;
281	}
282
283	/* Clear command */
284	bcm_kona_i2c_send_cmd_to_ctrl(dev, BCM_CMD_NOACTION);
285
286	return rc;
287}
288
289/* Read a single RX FIFO worth of data from the i2c bus */
290static int bcm_kona_i2c_read_fifo_single(struct bcm_kona_i2c_dev *dev,
291					 uint8_t *buf, unsigned int len,
292					 unsigned int last_byte_nak)
293{
294	unsigned long time_left = msecs_to_jiffies(I2C_TIMEOUT);
295
296	/* Mark as incomplete before starting the RX FIFO */
297	reinit_completion(&dev->done);
298
299	/* Unmask the read complete interrupt */
300	writel(IER_READ_COMPLETE_INT_MASK, dev->base + IER_OFFSET);
301
302	/* Start the RX FIFO */
303	writel((last_byte_nak << RXFCR_NACK_EN_SHIFT) |
304	       (len << RXFCR_READ_COUNT_SHIFT),
305		dev->base + RXFCR_OFFSET);
306
307	/* Wait for FIFO read to complete */
308	time_left = wait_for_completion_timeout(&dev->done, time_left);
309
310	/* Mask all interrupts */
311	writel(0, dev->base + IER_OFFSET);
312
313	if (!time_left) {
314		dev_err(dev->device, "RX FIFO time out\n");
315		return -EREMOTEIO;
316	}
317
318	/* Read data from FIFO */
319	for (; len > 0; len--, buf++)
320		*buf = readl(dev->base + RXFIFORDOUT_OFFSET);
321
322	return 0;
323}
324
325/* Read any amount of data using the RX FIFO from the i2c bus */
326static int bcm_kona_i2c_read_fifo(struct bcm_kona_i2c_dev *dev,
327				  struct i2c_msg *msg)
328{
329	unsigned int bytes_to_read = MAX_RX_FIFO_SIZE;
330	unsigned int last_byte_nak = 0;
331	unsigned int bytes_read = 0;
332	int rc;
333
334	uint8_t *tmp_buf = msg->buf;
335
336	while (bytes_read < msg->len) {
337		if (msg->len - bytes_read <= MAX_RX_FIFO_SIZE) {
338			last_byte_nak = 1; /* NAK last byte of transfer */
339			bytes_to_read = msg->len - bytes_read;
340		}
341
342		rc = bcm_kona_i2c_read_fifo_single(dev, tmp_buf, bytes_to_read,
343						   last_byte_nak);
344		if (rc < 0)
345			return -EREMOTEIO;
346
347		bytes_read += bytes_to_read;
348		tmp_buf += bytes_to_read;
349	}
350
351	return 0;
352}
353
354/* Write a single byte of data to the i2c bus */
355static int bcm_kona_i2c_write_byte(struct bcm_kona_i2c_dev *dev, uint8_t data,
356				   unsigned int nak_expected)
357{
358	int rc;
359	unsigned long time_left = msecs_to_jiffies(I2C_TIMEOUT);
360	unsigned int nak_received;
361
362	/* Make sure the hardware is ready */
363	rc = bcm_kona_i2c_wait_if_busy(dev);
364	if (rc < 0)
365		return rc;
366
367	/* Clear pending session done interrupt */
368	writel(ISR_SES_DONE_MASK, dev->base + ISR_OFFSET);
369
370	/* Unmask the session done interrupt */
371	writel(IER_I2C_INT_EN_MASK, dev->base + IER_OFFSET);
372
373	/* Mark as incomplete before sending the data */
374	reinit_completion(&dev->done);
375
376	/* Send one byte of data */
377	writel(data, dev->base + DAT_OFFSET);
378
379	/* Wait for byte to be written */
380	time_left = wait_for_completion_timeout(&dev->done, time_left);
381
382	/* Mask all interrupts */
383	writel(0, dev->base + IER_OFFSET);
384
385	if (!time_left) {
386		dev_dbg(dev->device, "controller timed out\n");
387		return -ETIMEDOUT;
388	}
389
390	nak_received = readl(dev->base + CS_OFFSET) & CS_ACK_MASK ? 1 : 0;
391
392	if (nak_received ^ nak_expected) {
393		dev_dbg(dev->device, "unexpected NAK/ACK\n");
394		return -EREMOTEIO;
395	}
396
397	return 0;
398}
399
400/* Write a single TX FIFO worth of data to the i2c bus */
401static int bcm_kona_i2c_write_fifo_single(struct bcm_kona_i2c_dev *dev,
402					  uint8_t *buf, unsigned int len)
403{
404	int k;
405	unsigned long time_left = msecs_to_jiffies(I2C_TIMEOUT);
406	unsigned int fifo_status;
407
408	/* Mark as incomplete before sending data to the TX FIFO */
409	reinit_completion(&dev->done);
410
411	/* Unmask the fifo empty and nak interrupt */
412	writel(IER_FIFO_INT_EN_MASK | IER_NOACK_EN_MASK,
413	       dev->base + IER_OFFSET);
414
415	/* Disable IRQ to load a FIFO worth of data without interruption */
416	disable_irq(dev->irq);
417
418	/* Write data into FIFO */
419	for (k = 0; k < len; k++)
420		writel(buf[k], (dev->base + DAT_OFFSET));
421
422	/* Enable IRQ now that data has been loaded */
423	enable_irq(dev->irq);
424
425	/* Wait for FIFO to empty */
426	do {
427		time_left = wait_for_completion_timeout(&dev->done, time_left);
428		fifo_status = readl(dev->base + FIFO_STATUS_OFFSET);
429	} while (time_left && !(fifo_status & FIFO_STATUS_TXFIFO_EMPTY_MASK));
430
431	/* Mask all interrupts */
432	writel(0, dev->base + IER_OFFSET);
433
434	/* Check if there was a NAK */
435	if (readl(dev->base + CS_OFFSET) & CS_ACK_MASK) {
436		dev_err(dev->device, "unexpected NAK\n");
437		return -EREMOTEIO;
438	}
439
440	/* Check if a timeout occured */
441	if (!time_left) {
442		dev_err(dev->device, "completion timed out\n");
443		return -EREMOTEIO;
444	}
445
446	return 0;
447}
448
449
450/* Write any amount of data using TX FIFO to the i2c bus */
451static int bcm_kona_i2c_write_fifo(struct bcm_kona_i2c_dev *dev,
452				   struct i2c_msg *msg)
453{
454	unsigned int bytes_to_write = MAX_TX_FIFO_SIZE;
455	unsigned int bytes_written = 0;
456	int rc;
457
458	uint8_t *tmp_buf = msg->buf;
459
460	while (bytes_written < msg->len) {
461		if (msg->len - bytes_written <= MAX_TX_FIFO_SIZE)
462			bytes_to_write = msg->len - bytes_written;
463
464		rc = bcm_kona_i2c_write_fifo_single(dev, tmp_buf,
465						    bytes_to_write);
466		if (rc < 0)
467			return -EREMOTEIO;
468
469		bytes_written += bytes_to_write;
470		tmp_buf += bytes_to_write;
471	}
472
473	return 0;
474}
475
476/* Send i2c address */
477static int bcm_kona_i2c_do_addr(struct bcm_kona_i2c_dev *dev,
478				     struct i2c_msg *msg)
479{
480	unsigned char addr;
481
482	if (msg->flags & I2C_M_TEN) {
483		/* First byte is 11110XX0 where XX is upper 2 bits */
484		addr = 0xF0 | ((msg->addr & 0x300) >> 7);
485		if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0)
486			return -EREMOTEIO;
487
488		/* Second byte is the remaining 8 bits */
489		addr = msg->addr & 0xFF;
490		if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0)
491			return -EREMOTEIO;
492
493		if (msg->flags & I2C_M_RD) {
494			/* For read, send restart command */
495			if (bcm_kona_send_i2c_cmd(dev, BCM_CMD_RESTART) < 0)
496				return -EREMOTEIO;
497
498			/* Then re-send the first byte with the read bit set */
499			addr = 0xF0 | ((msg->addr & 0x300) >> 7) | 0x01;
500			if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0)
501				return -EREMOTEIO;
502		}
503	} else {
504		addr = msg->addr << 1;
505
506		if (msg->flags & I2C_M_RD)
507			addr |= 1;
508
509		if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0)
510			return -EREMOTEIO;
511	}
512
513	return 0;
514}
515
516static void bcm_kona_i2c_enable_autosense(struct bcm_kona_i2c_dev *dev)
517{
518	writel(readl(dev->base + CLKEN_OFFSET) & ~CLKEN_AUTOSENSE_OFF_MASK,
519	       dev->base + CLKEN_OFFSET);
520}
521
522static void bcm_kona_i2c_config_timing(struct bcm_kona_i2c_dev *dev)
523{
524	writel(readl(dev->base + HSTIM_OFFSET) & ~HSTIM_HS_MODE_MASK,
525	       dev->base + HSTIM_OFFSET);
526
527	writel((dev->std_cfg->prescale << TIM_PRESCALE_SHIFT) |
528	       (dev->std_cfg->time_p << TIM_P_SHIFT) |
529	       (dev->std_cfg->no_div << TIM_NO_DIV_SHIFT) |
530	       (dev->std_cfg->time_div	<< TIM_DIV_SHIFT),
531	       dev->base + TIM_OFFSET);
532
533	writel((dev->std_cfg->time_m << CLKEN_M_SHIFT) |
534	       (dev->std_cfg->time_n << CLKEN_N_SHIFT) |
535	       CLKEN_CLKEN_MASK,
536	       dev->base + CLKEN_OFFSET);
537}
538
539static void bcm_kona_i2c_config_timing_hs(struct bcm_kona_i2c_dev *dev)
540{
541	writel((dev->hs_cfg->prescale << TIM_PRESCALE_SHIFT) |
542	       (dev->hs_cfg->time_p << TIM_P_SHIFT) |
543	       (dev->hs_cfg->no_div << TIM_NO_DIV_SHIFT) |
544	       (dev->hs_cfg->time_div << TIM_DIV_SHIFT),
545	       dev->base + TIM_OFFSET);
546
547	writel((dev->hs_cfg->hs_hold << HSTIM_HS_HOLD_SHIFT) |
548	       (dev->hs_cfg->hs_high_phase << HSTIM_HS_HIGH_PHASE_SHIFT) |
549	       (dev->hs_cfg->hs_setup << HSTIM_HS_SETUP_SHIFT),
550	       dev->base + HSTIM_OFFSET);
551
552	writel(readl(dev->base + HSTIM_OFFSET) | HSTIM_HS_MODE_MASK,
553	       dev->base + HSTIM_OFFSET);
554}
555
556static int bcm_kona_i2c_switch_to_hs(struct bcm_kona_i2c_dev *dev)
557{
558	int rc;
559
560	/* Send mastercode at standard speed */
561	rc = bcm_kona_i2c_write_byte(dev, MASTERCODE, 1);
562	if (rc < 0) {
563		pr_err("High speed handshake failed\n");
564		return rc;
565	}
566
567	/* Configure external clock to higher frequency */
568	rc = clk_set_rate(dev->external_clk, HS_EXT_CLK_FREQ);
569	if (rc) {
570		dev_err(dev->device, "%s: clk_set_rate returned %d\n",
571			__func__, rc);
572		return rc;
573	}
574
575	/* Reconfigure internal dividers */
576	bcm_kona_i2c_config_timing_hs(dev);
577
578	/* Send a restart command */
579	rc = bcm_kona_send_i2c_cmd(dev, BCM_CMD_RESTART);
580	if (rc < 0)
581		dev_err(dev->device, "High speed restart command failed\n");
582
583	return rc;
584}
585
586static int bcm_kona_i2c_switch_to_std(struct bcm_kona_i2c_dev *dev)
587{
588	int rc;
589
590	/* Reconfigure internal dividers */
591	bcm_kona_i2c_config_timing(dev);
592
593	/* Configure external clock to lower frequency */
594	rc = clk_set_rate(dev->external_clk, STD_EXT_CLK_FREQ);
595	if (rc) {
596		dev_err(dev->device, "%s: clk_set_rate returned %d\n",
597			__func__, rc);
598	}
599
600	return rc;
601}
602
603/* Master transfer function */
604static int bcm_kona_i2c_xfer(struct i2c_adapter *adapter,
605			     struct i2c_msg msgs[], int num)
606{
607	struct bcm_kona_i2c_dev *dev = i2c_get_adapdata(adapter);
608	struct i2c_msg *pmsg;
609	int rc = 0;
610	int i;
611
612	rc = clk_prepare_enable(dev->external_clk);
613	if (rc) {
614		dev_err(dev->device, "%s: peri clock enable failed. err %d\n",
615			__func__, rc);
616		return rc;
617	}
618
619	/* Enable pad output */
620	writel(0, dev->base + PADCTL_OFFSET);
621
622	/* Enable internal clocks */
623	bcm_kona_i2c_enable_clock(dev);
624
625	/* Send start command */
626	rc = bcm_kona_send_i2c_cmd(dev, BCM_CMD_START);
627	if (rc < 0) {
628		dev_err(dev->device, "Start command failed rc = %d\n", rc);
629		goto xfer_disable_pad;
630	}
631
632	/* Switch to high speed if applicable */
633	if (dev->hs_cfg) {
634		rc = bcm_kona_i2c_switch_to_hs(dev);
635		if (rc < 0)
636			goto xfer_send_stop;
637	}
638
639	/* Loop through all messages */
640	for (i = 0; i < num; i++) {
641		pmsg = &msgs[i];
642
643		/* Send restart for subsequent messages */
644		if ((i != 0) && ((pmsg->flags & I2C_M_NOSTART) == 0)) {
645			rc = bcm_kona_send_i2c_cmd(dev, BCM_CMD_RESTART);
646			if (rc < 0) {
647				dev_err(dev->device,
648					"restart cmd failed rc = %d\n", rc);
649					goto xfer_send_stop;
650			}
651		}
652
653		/* Send slave address */
654		if (!(pmsg->flags & I2C_M_NOSTART)) {
655			rc = bcm_kona_i2c_do_addr(dev, pmsg);
656			if (rc < 0) {
657				dev_err(dev->device,
658					"NAK from addr %2.2x msg#%d rc = %d\n",
659					pmsg->addr, i, rc);
660				goto xfer_send_stop;
661			}
662		}
663
664		/* Perform data transfer */
665		if (pmsg->flags & I2C_M_RD) {
666			rc = bcm_kona_i2c_read_fifo(dev, pmsg);
667			if (rc < 0) {
668				dev_err(dev->device, "read failure\n");
669				goto xfer_send_stop;
670			}
671		} else {
672			rc = bcm_kona_i2c_write_fifo(dev, pmsg);
673			if (rc < 0) {
674				dev_err(dev->device, "write failure");
675				goto xfer_send_stop;
676			}
677		}
678	}
679
680	rc = num;
681
682xfer_send_stop:
683	/* Send a STOP command */
684	bcm_kona_send_i2c_cmd(dev, BCM_CMD_STOP);
685
686	/* Return from high speed if applicable */
687	if (dev->hs_cfg) {
688		int hs_rc = bcm_kona_i2c_switch_to_std(dev);
689
690		if (hs_rc)
691			rc = hs_rc;
692	}
693
694xfer_disable_pad:
695	/* Disable pad output */
696	writel(PADCTL_PAD_OUT_EN_MASK, dev->base + PADCTL_OFFSET);
697
698	/* Stop internal clock */
699	bcm_kona_i2c_disable_clock(dev);
700
701	clk_disable_unprepare(dev->external_clk);
702
703	return rc;
704}
705
706static uint32_t bcm_kona_i2c_functionality(struct i2c_adapter *adap)
707{
708	return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL | I2C_FUNC_10BIT_ADDR |
709	    I2C_FUNC_NOSTART;
710}
711
712static const struct i2c_algorithm bcm_algo = {
713	.master_xfer = bcm_kona_i2c_xfer,
714	.functionality = bcm_kona_i2c_functionality,
715};
716
717static int bcm_kona_i2c_assign_bus_speed(struct bcm_kona_i2c_dev *dev)
718{
719	unsigned int bus_speed;
720	int ret = of_property_read_u32(dev->device->of_node, "clock-frequency",
721				       &bus_speed);
722	if (ret < 0) {
723		dev_err(dev->device, "missing clock-frequency property\n");
724		return -ENODEV;
725	}
726
727	switch (bus_speed) {
728	case 100000:
729		dev->std_cfg = &std_cfg_table[BCM_SPD_100K];
730		break;
731	case 400000:
732		dev->std_cfg = &std_cfg_table[BCM_SPD_400K];
733		break;
734	case 1000000:
735		dev->std_cfg = &std_cfg_table[BCM_SPD_1MHZ];
736		break;
737	case 3400000:
738		/* Send mastercode at 100k */
739		dev->std_cfg = &std_cfg_table[BCM_SPD_100K];
740		dev->hs_cfg = &hs_cfg_table[BCM_SPD_3P4MHZ];
741		break;
742	default:
743		pr_err("%d hz bus speed not supported\n", bus_speed);
744		pr_err("Valid speeds are 100khz, 400khz, 1mhz, and 3.4mhz\n");
745		return -EINVAL;
746	}
747
748	return 0;
749}
750
751static int bcm_kona_i2c_probe(struct platform_device *pdev)
752{
753	int rc = 0;
754	struct bcm_kona_i2c_dev *dev;
755	struct i2c_adapter *adap;
756	struct resource *iomem;
757
758	/* Allocate memory for private data structure */
759	dev = devm_kzalloc(&pdev->dev, sizeof(*dev), GFP_KERNEL);
760	if (!dev)
761		return -ENOMEM;
762
763	platform_set_drvdata(pdev, dev);
764	dev->device = &pdev->dev;
765	init_completion(&dev->done);
766
767	/* Map hardware registers */
768	iomem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
769	dev->base = devm_ioremap_resource(dev->device, iomem);
770	if (IS_ERR(dev->base))
771		return -ENOMEM;
772
773	/* Get and enable external clock */
774	dev->external_clk = devm_clk_get(dev->device, NULL);
775	if (IS_ERR(dev->external_clk)) {
776		dev_err(dev->device, "couldn't get clock\n");
777		return -ENODEV;
778	}
779
780	rc = clk_set_rate(dev->external_clk, STD_EXT_CLK_FREQ);
781	if (rc) {
782		dev_err(dev->device, "%s: clk_set_rate returned %d\n",
783			__func__, rc);
784		return rc;
785	}
786
787	rc = clk_prepare_enable(dev->external_clk);
788	if (rc) {
789		dev_err(dev->device, "couldn't enable clock\n");
790		return rc;
791	}
792
793	/* Parse bus speed */
794	rc = bcm_kona_i2c_assign_bus_speed(dev);
795	if (rc)
796		goto probe_disable_clk;
797
798	/* Enable internal clocks */
799	bcm_kona_i2c_enable_clock(dev);
800
801	/* Configure internal dividers */
802	bcm_kona_i2c_config_timing(dev);
803
804	/* Disable timeout */
805	writel(0, dev->base + TOUT_OFFSET);
806
807	/* Enable autosense */
808	bcm_kona_i2c_enable_autosense(dev);
809
810	/* Enable TX FIFO */
811	writel(TXFCR_FIFO_FLUSH_MASK | TXFCR_FIFO_EN_MASK,
812	       dev->base + TXFCR_OFFSET);
813
814	/* Mask all interrupts */
815	writel(0, dev->base + IER_OFFSET);
816
817	/* Clear all pending interrupts */
818	writel(ISR_CMDBUSY_MASK |
819	       ISR_READ_COMPLETE_MASK |
820	       ISR_SES_DONE_MASK |
821	       ISR_ERR_MASK |
822	       ISR_TXFIFOEMPTY_MASK |
823	       ISR_NOACK_MASK,
824	       dev->base + ISR_OFFSET);
825
826	/* Get the interrupt number */
827	dev->irq = platform_get_irq(pdev, 0);
828	if (dev->irq < 0) {
829		dev_err(dev->device, "no irq resource\n");
830		rc = -ENODEV;
831		goto probe_disable_clk;
832	}
833
834	/* register the ISR handler */
835	rc = devm_request_irq(&pdev->dev, dev->irq, bcm_kona_i2c_isr,
836			      IRQF_SHARED, pdev->name, dev);
837	if (rc) {
838		dev_err(dev->device, "failed to request irq %i\n", dev->irq);
839		goto probe_disable_clk;
840	}
841
842	/* Enable the controller but leave it idle */
843	bcm_kona_i2c_send_cmd_to_ctrl(dev, BCM_CMD_NOACTION);
844
845	/* Disable pad output */
846	writel(PADCTL_PAD_OUT_EN_MASK, dev->base + PADCTL_OFFSET);
847
848	/* Disable internal clock */
849	bcm_kona_i2c_disable_clock(dev);
850
851	/* Disable external clock */
852	clk_disable_unprepare(dev->external_clk);
853
854	/* Add the i2c adapter */
855	adap = &dev->adapter;
856	i2c_set_adapdata(adap, dev);
857	adap->owner = THIS_MODULE;
858	strlcpy(adap->name, "Broadcom I2C adapter", sizeof(adap->name));
859	adap->algo = &bcm_algo;
860	adap->dev.parent = &pdev->dev;
861	adap->dev.of_node = pdev->dev.of_node;
862
863	rc = i2c_add_adapter(adap);
864	if (rc) {
865		dev_err(dev->device, "failed to add adapter\n");
866		return rc;
867	}
868
869	dev_info(dev->device, "device registered successfully\n");
870
871	return 0;
872
873probe_disable_clk:
874	bcm_kona_i2c_disable_clock(dev);
875	clk_disable_unprepare(dev->external_clk);
876
877	return rc;
878}
879
880static int bcm_kona_i2c_remove(struct platform_device *pdev)
881{
882	struct bcm_kona_i2c_dev *dev = platform_get_drvdata(pdev);
883
884	i2c_del_adapter(&dev->adapter);
885
886	return 0;
887}
888
889static const struct of_device_id bcm_kona_i2c_of_match[] = {
890	{.compatible = "brcm,kona-i2c",},
891	{},
892};
893MODULE_DEVICE_TABLE(of, bcm_kona_i2c_of_match);
894
895static struct platform_driver bcm_kona_i2c_driver = {
896	.driver = {
897		   .name = "bcm-kona-i2c",
898		   .of_match_table = bcm_kona_i2c_of_match,
899		   },
900	.probe = bcm_kona_i2c_probe,
901	.remove = bcm_kona_i2c_remove,
902};
903module_platform_driver(bcm_kona_i2c_driver);
904
905MODULE_AUTHOR("Tim Kryger <tkryger@broadcom.com>");
906MODULE_DESCRIPTION("Broadcom Kona I2C Driver");
907MODULE_LICENSE("GPL v2");
908