1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Copyright (C) 2012 FUJITSU SEMICONDUCTOR LIMITED
4*4882a593Smuzhiyun */
5*4882a593Smuzhiyun
6*4882a593Smuzhiyun #include <linux/acpi.h>
7*4882a593Smuzhiyun #include <linux/clk.h>
8*4882a593Smuzhiyun #include <linux/delay.h>
9*4882a593Smuzhiyun #include <linux/device.h>
10*4882a593Smuzhiyun #include <linux/err.h>
11*4882a593Smuzhiyun #include <linux/errno.h>
12*4882a593Smuzhiyun #include <linux/i2c.h>
13*4882a593Smuzhiyun #include <linux/interrupt.h>
14*4882a593Smuzhiyun #include <linux/io.h>
15*4882a593Smuzhiyun #include <linux/kernel.h>
16*4882a593Smuzhiyun #include <linux/module.h>
17*4882a593Smuzhiyun #include <linux/platform_device.h>
18*4882a593Smuzhiyun #include <linux/sched.h>
19*4882a593Smuzhiyun #include <linux/slab.h>
20*4882a593Smuzhiyun #include <linux/spinlock.h>
21*4882a593Smuzhiyun
22*4882a593Smuzhiyun #define WAIT_PCLK(n, rate) \
23*4882a593Smuzhiyun ndelay(DIV_ROUND_UP(DIV_ROUND_UP(1000000000, rate), n) + 10)
24*4882a593Smuzhiyun
25*4882a593Smuzhiyun /* I2C register address definitions */
26*4882a593Smuzhiyun #define SYNQUACER_I2C_REG_BSR (0x00 << 2) // Bus Status
27*4882a593Smuzhiyun #define SYNQUACER_I2C_REG_BCR (0x01 << 2) // Bus Control
28*4882a593Smuzhiyun #define SYNQUACER_I2C_REG_CCR (0x02 << 2) // Clock Control
29*4882a593Smuzhiyun #define SYNQUACER_I2C_REG_ADR (0x03 << 2) // Address
30*4882a593Smuzhiyun #define SYNQUACER_I2C_REG_DAR (0x04 << 2) // Data
31*4882a593Smuzhiyun #define SYNQUACER_I2C_REG_CSR (0x05 << 2) // Expansion CS
32*4882a593Smuzhiyun #define SYNQUACER_I2C_REG_FSR (0x06 << 2) // Bus Clock Freq
33*4882a593Smuzhiyun #define SYNQUACER_I2C_REG_BC2R (0x07 << 2) // Bus Control 2
34*4882a593Smuzhiyun
35*4882a593Smuzhiyun /* I2C register bit definitions */
36*4882a593Smuzhiyun #define SYNQUACER_I2C_BSR_FBT BIT(0) // First Byte Transfer
37*4882a593Smuzhiyun #define SYNQUACER_I2C_BSR_GCA BIT(1) // General Call Address
38*4882a593Smuzhiyun #define SYNQUACER_I2C_BSR_AAS BIT(2) // Address as Slave
39*4882a593Smuzhiyun #define SYNQUACER_I2C_BSR_TRX BIT(3) // Transfer/Receive
40*4882a593Smuzhiyun #define SYNQUACER_I2C_BSR_LRB BIT(4) // Last Received Bit
41*4882a593Smuzhiyun #define SYNQUACER_I2C_BSR_AL BIT(5) // Arbitration Lost
42*4882a593Smuzhiyun #define SYNQUACER_I2C_BSR_RSC BIT(6) // Repeated Start Cond.
43*4882a593Smuzhiyun #define SYNQUACER_I2C_BSR_BB BIT(7) // Bus Busy
44*4882a593Smuzhiyun
45*4882a593Smuzhiyun #define SYNQUACER_I2C_BCR_INT BIT(0) // Interrupt
46*4882a593Smuzhiyun #define SYNQUACER_I2C_BCR_INTE BIT(1) // Interrupt Enable
47*4882a593Smuzhiyun #define SYNQUACER_I2C_BCR_GCAA BIT(2) // Gen. Call Access Ack.
48*4882a593Smuzhiyun #define SYNQUACER_I2C_BCR_ACK BIT(3) // Acknowledge
49*4882a593Smuzhiyun #define SYNQUACER_I2C_BCR_MSS BIT(4) // Master Slave Select
50*4882a593Smuzhiyun #define SYNQUACER_I2C_BCR_SCC BIT(5) // Start Condition Cont.
51*4882a593Smuzhiyun #define SYNQUACER_I2C_BCR_BEIE BIT(6) // Bus Error Int Enable
52*4882a593Smuzhiyun #define SYNQUACER_I2C_BCR_BER BIT(7) // Bus Error
53*4882a593Smuzhiyun
54*4882a593Smuzhiyun #define SYNQUACER_I2C_CCR_CS_MASK (0x1f) // CCR Clock Period Sel.
55*4882a593Smuzhiyun #define SYNQUACER_I2C_CCR_EN BIT(5) // Enable
56*4882a593Smuzhiyun #define SYNQUACER_I2C_CCR_FM BIT(6) // Speed Mode Select
57*4882a593Smuzhiyun
58*4882a593Smuzhiyun #define SYNQUACER_I2C_CSR_CS_MASK (0x3f) // CSR Clock Period Sel.
59*4882a593Smuzhiyun
60*4882a593Smuzhiyun #define SYNQUACER_I2C_BC2R_SCLL BIT(0) // SCL Low Drive
61*4882a593Smuzhiyun #define SYNQUACER_I2C_BC2R_SDAL BIT(1) // SDA Low Drive
62*4882a593Smuzhiyun #define SYNQUACER_I2C_BC2R_SCLS BIT(4) // SCL Status
63*4882a593Smuzhiyun #define SYNQUACER_I2C_BC2R_SDAS BIT(5) // SDA Status
64*4882a593Smuzhiyun
65*4882a593Smuzhiyun /* PCLK frequency */
66*4882a593Smuzhiyun #define SYNQUACER_I2C_BUS_CLK_FR(rate) (((rate) / 20000000) + 1)
67*4882a593Smuzhiyun
68*4882a593Smuzhiyun /* STANDARD MODE frequency */
69*4882a593Smuzhiyun #define SYNQUACER_I2C_CLK_MASTER_STD(rate) \
70*4882a593Smuzhiyun DIV_ROUND_UP(DIV_ROUND_UP((rate), I2C_MAX_STANDARD_MODE_FREQ) - 2, 2)
71*4882a593Smuzhiyun /* FAST MODE frequency */
72*4882a593Smuzhiyun #define SYNQUACER_I2C_CLK_MASTER_FAST(rate) \
73*4882a593Smuzhiyun DIV_ROUND_UP((DIV_ROUND_UP((rate), I2C_MAX_FAST_MODE_FREQ) - 2) * 2, 3)
74*4882a593Smuzhiyun
75*4882a593Smuzhiyun /* (clkrate <= 18000000) */
76*4882a593Smuzhiyun /* calculate the value of CS bits in CCR register on standard mode */
77*4882a593Smuzhiyun #define SYNQUACER_I2C_CCR_CS_STD_MAX_18M(rate) \
78*4882a593Smuzhiyun ((SYNQUACER_I2C_CLK_MASTER_STD(rate) - 65) \
79*4882a593Smuzhiyun & SYNQUACER_I2C_CCR_CS_MASK)
80*4882a593Smuzhiyun
81*4882a593Smuzhiyun /* calculate the value of CS bits in CSR register on standard mode */
82*4882a593Smuzhiyun #define SYNQUACER_I2C_CSR_CS_STD_MAX_18M(rate) 0x00
83*4882a593Smuzhiyun
84*4882a593Smuzhiyun /* calculate the value of CS bits in CCR register on fast mode */
85*4882a593Smuzhiyun #define SYNQUACER_I2C_CCR_CS_FAST_MAX_18M(rate) \
86*4882a593Smuzhiyun ((SYNQUACER_I2C_CLK_MASTER_FAST(rate) - 1) \
87*4882a593Smuzhiyun & SYNQUACER_I2C_CCR_CS_MASK)
88*4882a593Smuzhiyun
89*4882a593Smuzhiyun /* calculate the value of CS bits in CSR register on fast mode */
90*4882a593Smuzhiyun #define SYNQUACER_I2C_CSR_CS_FAST_MAX_18M(rate) 0x00
91*4882a593Smuzhiyun
92*4882a593Smuzhiyun /* (clkrate > 18000000) */
93*4882a593Smuzhiyun /* calculate the value of CS bits in CCR register on standard mode */
94*4882a593Smuzhiyun #define SYNQUACER_I2C_CCR_CS_STD_MIN_18M(rate) \
95*4882a593Smuzhiyun ((SYNQUACER_I2C_CLK_MASTER_STD(rate) - 1) \
96*4882a593Smuzhiyun & SYNQUACER_I2C_CCR_CS_MASK)
97*4882a593Smuzhiyun
98*4882a593Smuzhiyun /* calculate the value of CS bits in CSR register on standard mode */
99*4882a593Smuzhiyun #define SYNQUACER_I2C_CSR_CS_STD_MIN_18M(rate) \
100*4882a593Smuzhiyun (((SYNQUACER_I2C_CLK_MASTER_STD(rate) - 1) >> 5) \
101*4882a593Smuzhiyun & SYNQUACER_I2C_CSR_CS_MASK)
102*4882a593Smuzhiyun
103*4882a593Smuzhiyun /* calculate the value of CS bits in CCR register on fast mode */
104*4882a593Smuzhiyun #define SYNQUACER_I2C_CCR_CS_FAST_MIN_18M(rate) \
105*4882a593Smuzhiyun ((SYNQUACER_I2C_CLK_MASTER_FAST(rate) - 1) \
106*4882a593Smuzhiyun & SYNQUACER_I2C_CCR_CS_MASK)
107*4882a593Smuzhiyun
108*4882a593Smuzhiyun /* calculate the value of CS bits in CSR register on fast mode */
109*4882a593Smuzhiyun #define SYNQUACER_I2C_CSR_CS_FAST_MIN_18M(rate) \
110*4882a593Smuzhiyun (((SYNQUACER_I2C_CLK_MASTER_FAST(rate) - 1) >> 5) \
111*4882a593Smuzhiyun & SYNQUACER_I2C_CSR_CS_MASK)
112*4882a593Smuzhiyun
113*4882a593Smuzhiyun /* min I2C clock frequency 14M */
114*4882a593Smuzhiyun #define SYNQUACER_I2C_MIN_CLK_RATE (14 * 1000000)
115*4882a593Smuzhiyun /* max I2C clock frequency 200M */
116*4882a593Smuzhiyun #define SYNQUACER_I2C_MAX_CLK_RATE (200 * 1000000)
117*4882a593Smuzhiyun /* I2C clock frequency 18M */
118*4882a593Smuzhiyun #define SYNQUACER_I2C_CLK_RATE_18M (18 * 1000000)
119*4882a593Smuzhiyun
120*4882a593Smuzhiyun #define SYNQUACER_I2C_SPEED_FM 400 // Fast Mode
121*4882a593Smuzhiyun #define SYNQUACER_I2C_SPEED_SM 100 // Standard Mode
122*4882a593Smuzhiyun
123*4882a593Smuzhiyun enum i2c_state {
124*4882a593Smuzhiyun STATE_IDLE,
125*4882a593Smuzhiyun STATE_START,
126*4882a593Smuzhiyun STATE_READ,
127*4882a593Smuzhiyun STATE_WRITE
128*4882a593Smuzhiyun };
129*4882a593Smuzhiyun
130*4882a593Smuzhiyun struct synquacer_i2c {
131*4882a593Smuzhiyun struct completion completion;
132*4882a593Smuzhiyun
133*4882a593Smuzhiyun struct i2c_msg *msg;
134*4882a593Smuzhiyun u32 msg_num;
135*4882a593Smuzhiyun u32 msg_idx;
136*4882a593Smuzhiyun u32 msg_ptr;
137*4882a593Smuzhiyun
138*4882a593Smuzhiyun int irq;
139*4882a593Smuzhiyun struct device *dev;
140*4882a593Smuzhiyun void __iomem *base;
141*4882a593Smuzhiyun struct clk *pclk;
142*4882a593Smuzhiyun u32 pclkrate;
143*4882a593Smuzhiyun u32 speed_khz;
144*4882a593Smuzhiyun u32 timeout_ms;
145*4882a593Smuzhiyun enum i2c_state state;
146*4882a593Smuzhiyun struct i2c_adapter adapter;
147*4882a593Smuzhiyun };
148*4882a593Smuzhiyun
is_lastmsg(struct synquacer_i2c * i2c)149*4882a593Smuzhiyun static inline int is_lastmsg(struct synquacer_i2c *i2c)
150*4882a593Smuzhiyun {
151*4882a593Smuzhiyun return i2c->msg_idx >= (i2c->msg_num - 1);
152*4882a593Smuzhiyun }
153*4882a593Smuzhiyun
is_msglast(struct synquacer_i2c * i2c)154*4882a593Smuzhiyun static inline int is_msglast(struct synquacer_i2c *i2c)
155*4882a593Smuzhiyun {
156*4882a593Smuzhiyun return i2c->msg_ptr == (i2c->msg->len - 1);
157*4882a593Smuzhiyun }
158*4882a593Smuzhiyun
is_msgend(struct synquacer_i2c * i2c)159*4882a593Smuzhiyun static inline int is_msgend(struct synquacer_i2c *i2c)
160*4882a593Smuzhiyun {
161*4882a593Smuzhiyun return i2c->msg_ptr >= i2c->msg->len;
162*4882a593Smuzhiyun }
163*4882a593Smuzhiyun
calc_timeout_ms(struct synquacer_i2c * i2c,struct i2c_msg * msgs,int num)164*4882a593Smuzhiyun static inline unsigned long calc_timeout_ms(struct synquacer_i2c *i2c,
165*4882a593Smuzhiyun struct i2c_msg *msgs,
166*4882a593Smuzhiyun int num)
167*4882a593Smuzhiyun {
168*4882a593Smuzhiyun unsigned long bit_count = 0;
169*4882a593Smuzhiyun int i;
170*4882a593Smuzhiyun
171*4882a593Smuzhiyun for (i = 0; i < num; i++, msgs++)
172*4882a593Smuzhiyun bit_count += msgs->len;
173*4882a593Smuzhiyun
174*4882a593Smuzhiyun return DIV_ROUND_UP((bit_count * 9 + num * 10) * 3, 200) + 10;
175*4882a593Smuzhiyun }
176*4882a593Smuzhiyun
synquacer_i2c_stop(struct synquacer_i2c * i2c,int ret)177*4882a593Smuzhiyun static void synquacer_i2c_stop(struct synquacer_i2c *i2c, int ret)
178*4882a593Smuzhiyun {
179*4882a593Smuzhiyun /*
180*4882a593Smuzhiyun * clear IRQ (INT=0, BER=0)
181*4882a593Smuzhiyun * set Stop Condition (MSS=0)
182*4882a593Smuzhiyun * Interrupt Disable
183*4882a593Smuzhiyun */
184*4882a593Smuzhiyun writeb(0, i2c->base + SYNQUACER_I2C_REG_BCR);
185*4882a593Smuzhiyun
186*4882a593Smuzhiyun i2c->state = STATE_IDLE;
187*4882a593Smuzhiyun
188*4882a593Smuzhiyun i2c->msg_ptr = 0;
189*4882a593Smuzhiyun i2c->msg = NULL;
190*4882a593Smuzhiyun i2c->msg_idx++;
191*4882a593Smuzhiyun i2c->msg_num = 0;
192*4882a593Smuzhiyun if (ret)
193*4882a593Smuzhiyun i2c->msg_idx = ret;
194*4882a593Smuzhiyun
195*4882a593Smuzhiyun complete(&i2c->completion);
196*4882a593Smuzhiyun }
197*4882a593Smuzhiyun
synquacer_i2c_hw_init(struct synquacer_i2c * i2c)198*4882a593Smuzhiyun static void synquacer_i2c_hw_init(struct synquacer_i2c *i2c)
199*4882a593Smuzhiyun {
200*4882a593Smuzhiyun unsigned char ccr_cs, csr_cs;
201*4882a593Smuzhiyun u32 rt = i2c->pclkrate;
202*4882a593Smuzhiyun
203*4882a593Smuzhiyun /* Set own Address */
204*4882a593Smuzhiyun writeb(0, i2c->base + SYNQUACER_I2C_REG_ADR);
205*4882a593Smuzhiyun
206*4882a593Smuzhiyun /* Set PCLK frequency */
207*4882a593Smuzhiyun writeb(SYNQUACER_I2C_BUS_CLK_FR(i2c->pclkrate),
208*4882a593Smuzhiyun i2c->base + SYNQUACER_I2C_REG_FSR);
209*4882a593Smuzhiyun
210*4882a593Smuzhiyun switch (i2c->speed_khz) {
211*4882a593Smuzhiyun case SYNQUACER_I2C_SPEED_FM:
212*4882a593Smuzhiyun if (i2c->pclkrate <= SYNQUACER_I2C_CLK_RATE_18M) {
213*4882a593Smuzhiyun ccr_cs = SYNQUACER_I2C_CCR_CS_FAST_MAX_18M(rt);
214*4882a593Smuzhiyun csr_cs = SYNQUACER_I2C_CSR_CS_FAST_MAX_18M(rt);
215*4882a593Smuzhiyun } else {
216*4882a593Smuzhiyun ccr_cs = SYNQUACER_I2C_CCR_CS_FAST_MIN_18M(rt);
217*4882a593Smuzhiyun csr_cs = SYNQUACER_I2C_CSR_CS_FAST_MIN_18M(rt);
218*4882a593Smuzhiyun }
219*4882a593Smuzhiyun
220*4882a593Smuzhiyun /* Set Clock and enable, Set fast mode */
221*4882a593Smuzhiyun writeb(ccr_cs | SYNQUACER_I2C_CCR_FM |
222*4882a593Smuzhiyun SYNQUACER_I2C_CCR_EN,
223*4882a593Smuzhiyun i2c->base + SYNQUACER_I2C_REG_CCR);
224*4882a593Smuzhiyun writeb(csr_cs, i2c->base + SYNQUACER_I2C_REG_CSR);
225*4882a593Smuzhiyun break;
226*4882a593Smuzhiyun case SYNQUACER_I2C_SPEED_SM:
227*4882a593Smuzhiyun if (i2c->pclkrate <= SYNQUACER_I2C_CLK_RATE_18M) {
228*4882a593Smuzhiyun ccr_cs = SYNQUACER_I2C_CCR_CS_STD_MAX_18M(rt);
229*4882a593Smuzhiyun csr_cs = SYNQUACER_I2C_CSR_CS_STD_MAX_18M(rt);
230*4882a593Smuzhiyun } else {
231*4882a593Smuzhiyun ccr_cs = SYNQUACER_I2C_CCR_CS_STD_MIN_18M(rt);
232*4882a593Smuzhiyun csr_cs = SYNQUACER_I2C_CSR_CS_STD_MIN_18M(rt);
233*4882a593Smuzhiyun }
234*4882a593Smuzhiyun
235*4882a593Smuzhiyun /* Set Clock and enable, Set standard mode */
236*4882a593Smuzhiyun writeb(ccr_cs | SYNQUACER_I2C_CCR_EN,
237*4882a593Smuzhiyun i2c->base + SYNQUACER_I2C_REG_CCR);
238*4882a593Smuzhiyun writeb(csr_cs, i2c->base + SYNQUACER_I2C_REG_CSR);
239*4882a593Smuzhiyun break;
240*4882a593Smuzhiyun default:
241*4882a593Smuzhiyun WARN_ON(1);
242*4882a593Smuzhiyun }
243*4882a593Smuzhiyun
244*4882a593Smuzhiyun /* clear IRQ (INT=0, BER=0), Interrupt Disable */
245*4882a593Smuzhiyun writeb(0, i2c->base + SYNQUACER_I2C_REG_BCR);
246*4882a593Smuzhiyun writeb(0, i2c->base + SYNQUACER_I2C_REG_BC2R);
247*4882a593Smuzhiyun }
248*4882a593Smuzhiyun
synquacer_i2c_hw_reset(struct synquacer_i2c * i2c)249*4882a593Smuzhiyun static void synquacer_i2c_hw_reset(struct synquacer_i2c *i2c)
250*4882a593Smuzhiyun {
251*4882a593Smuzhiyun /* Disable clock */
252*4882a593Smuzhiyun writeb(0, i2c->base + SYNQUACER_I2C_REG_CCR);
253*4882a593Smuzhiyun writeb(0, i2c->base + SYNQUACER_I2C_REG_CSR);
254*4882a593Smuzhiyun
255*4882a593Smuzhiyun WAIT_PCLK(100, i2c->pclkrate);
256*4882a593Smuzhiyun }
257*4882a593Smuzhiyun
synquacer_i2c_master_start(struct synquacer_i2c * i2c,struct i2c_msg * pmsg)258*4882a593Smuzhiyun static int synquacer_i2c_master_start(struct synquacer_i2c *i2c,
259*4882a593Smuzhiyun struct i2c_msg *pmsg)
260*4882a593Smuzhiyun {
261*4882a593Smuzhiyun unsigned char bsr, bcr;
262*4882a593Smuzhiyun
263*4882a593Smuzhiyun writeb(i2c_8bit_addr_from_msg(pmsg), i2c->base + SYNQUACER_I2C_REG_DAR);
264*4882a593Smuzhiyun
265*4882a593Smuzhiyun dev_dbg(i2c->dev, "slave:0x%02x\n", pmsg->addr);
266*4882a593Smuzhiyun
267*4882a593Smuzhiyun /* Generate Start Condition */
268*4882a593Smuzhiyun bsr = readb(i2c->base + SYNQUACER_I2C_REG_BSR);
269*4882a593Smuzhiyun bcr = readb(i2c->base + SYNQUACER_I2C_REG_BCR);
270*4882a593Smuzhiyun dev_dbg(i2c->dev, "bsr:0x%02x, bcr:0x%02x\n", bsr, bcr);
271*4882a593Smuzhiyun
272*4882a593Smuzhiyun if ((bsr & SYNQUACER_I2C_BSR_BB) &&
273*4882a593Smuzhiyun !(bcr & SYNQUACER_I2C_BCR_MSS)) {
274*4882a593Smuzhiyun dev_dbg(i2c->dev, "bus is busy");
275*4882a593Smuzhiyun return -EBUSY;
276*4882a593Smuzhiyun }
277*4882a593Smuzhiyun
278*4882a593Smuzhiyun if (bsr & SYNQUACER_I2C_BSR_BB) { /* Bus is busy */
279*4882a593Smuzhiyun dev_dbg(i2c->dev, "Continuous Start");
280*4882a593Smuzhiyun writeb(bcr | SYNQUACER_I2C_BCR_SCC,
281*4882a593Smuzhiyun i2c->base + SYNQUACER_I2C_REG_BCR);
282*4882a593Smuzhiyun } else {
283*4882a593Smuzhiyun if (bcr & SYNQUACER_I2C_BCR_MSS) {
284*4882a593Smuzhiyun dev_dbg(i2c->dev, "not in master mode");
285*4882a593Smuzhiyun return -EAGAIN;
286*4882a593Smuzhiyun }
287*4882a593Smuzhiyun dev_dbg(i2c->dev, "Start Condition");
288*4882a593Smuzhiyun /* Start Condition + Enable Interrupts */
289*4882a593Smuzhiyun writeb(bcr | SYNQUACER_I2C_BCR_MSS |
290*4882a593Smuzhiyun SYNQUACER_I2C_BCR_INTE | SYNQUACER_I2C_BCR_BEIE,
291*4882a593Smuzhiyun i2c->base + SYNQUACER_I2C_REG_BCR);
292*4882a593Smuzhiyun }
293*4882a593Smuzhiyun
294*4882a593Smuzhiyun WAIT_PCLK(10, i2c->pclkrate);
295*4882a593Smuzhiyun
296*4882a593Smuzhiyun /* get BSR & BCR registers */
297*4882a593Smuzhiyun bsr = readb(i2c->base + SYNQUACER_I2C_REG_BSR);
298*4882a593Smuzhiyun bcr = readb(i2c->base + SYNQUACER_I2C_REG_BCR);
299*4882a593Smuzhiyun dev_dbg(i2c->dev, "bsr:0x%02x, bcr:0x%02x\n", bsr, bcr);
300*4882a593Smuzhiyun
301*4882a593Smuzhiyun if ((bsr & SYNQUACER_I2C_BSR_AL) ||
302*4882a593Smuzhiyun !(bcr & SYNQUACER_I2C_BCR_MSS)) {
303*4882a593Smuzhiyun dev_dbg(i2c->dev, "arbitration lost\n");
304*4882a593Smuzhiyun return -EAGAIN;
305*4882a593Smuzhiyun }
306*4882a593Smuzhiyun
307*4882a593Smuzhiyun return 0;
308*4882a593Smuzhiyun }
309*4882a593Smuzhiyun
synquacer_i2c_doxfer(struct synquacer_i2c * i2c,struct i2c_msg * msgs,int num)310*4882a593Smuzhiyun static int synquacer_i2c_doxfer(struct synquacer_i2c *i2c,
311*4882a593Smuzhiyun struct i2c_msg *msgs, int num)
312*4882a593Smuzhiyun {
313*4882a593Smuzhiyun unsigned char bsr;
314*4882a593Smuzhiyun unsigned long timeout;
315*4882a593Smuzhiyun int ret;
316*4882a593Smuzhiyun
317*4882a593Smuzhiyun synquacer_i2c_hw_init(i2c);
318*4882a593Smuzhiyun bsr = readb(i2c->base + SYNQUACER_I2C_REG_BSR);
319*4882a593Smuzhiyun if (bsr & SYNQUACER_I2C_BSR_BB) {
320*4882a593Smuzhiyun dev_err(i2c->dev, "cannot get bus (bus busy)\n");
321*4882a593Smuzhiyun return -EBUSY;
322*4882a593Smuzhiyun }
323*4882a593Smuzhiyun
324*4882a593Smuzhiyun reinit_completion(&i2c->completion);
325*4882a593Smuzhiyun
326*4882a593Smuzhiyun i2c->msg = msgs;
327*4882a593Smuzhiyun i2c->msg_num = num;
328*4882a593Smuzhiyun i2c->msg_ptr = 0;
329*4882a593Smuzhiyun i2c->msg_idx = 0;
330*4882a593Smuzhiyun i2c->state = STATE_START;
331*4882a593Smuzhiyun
332*4882a593Smuzhiyun ret = synquacer_i2c_master_start(i2c, i2c->msg);
333*4882a593Smuzhiyun if (ret < 0) {
334*4882a593Smuzhiyun dev_dbg(i2c->dev, "Address failed: (%d)\n", ret);
335*4882a593Smuzhiyun return ret;
336*4882a593Smuzhiyun }
337*4882a593Smuzhiyun
338*4882a593Smuzhiyun timeout = wait_for_completion_timeout(&i2c->completion,
339*4882a593Smuzhiyun msecs_to_jiffies(i2c->timeout_ms));
340*4882a593Smuzhiyun if (timeout == 0) {
341*4882a593Smuzhiyun dev_dbg(i2c->dev, "timeout\n");
342*4882a593Smuzhiyun return -EAGAIN;
343*4882a593Smuzhiyun }
344*4882a593Smuzhiyun
345*4882a593Smuzhiyun ret = i2c->msg_idx;
346*4882a593Smuzhiyun if (ret != num) {
347*4882a593Smuzhiyun dev_dbg(i2c->dev, "incomplete xfer (%d)\n", ret);
348*4882a593Smuzhiyun return -EAGAIN;
349*4882a593Smuzhiyun }
350*4882a593Smuzhiyun
351*4882a593Smuzhiyun /* wait 2 clock periods to ensure the stop has been through the bus */
352*4882a593Smuzhiyun udelay(DIV_ROUND_UP(2 * 1000, i2c->speed_khz));
353*4882a593Smuzhiyun
354*4882a593Smuzhiyun return ret;
355*4882a593Smuzhiyun }
356*4882a593Smuzhiyun
synquacer_i2c_isr(int irq,void * dev_id)357*4882a593Smuzhiyun static irqreturn_t synquacer_i2c_isr(int irq, void *dev_id)
358*4882a593Smuzhiyun {
359*4882a593Smuzhiyun struct synquacer_i2c *i2c = dev_id;
360*4882a593Smuzhiyun
361*4882a593Smuzhiyun unsigned char byte;
362*4882a593Smuzhiyun unsigned char bsr, bcr;
363*4882a593Smuzhiyun int ret;
364*4882a593Smuzhiyun
365*4882a593Smuzhiyun bcr = readb(i2c->base + SYNQUACER_I2C_REG_BCR);
366*4882a593Smuzhiyun bsr = readb(i2c->base + SYNQUACER_I2C_REG_BSR);
367*4882a593Smuzhiyun dev_dbg(i2c->dev, "bsr:0x%02x, bcr:0x%02x\n", bsr, bcr);
368*4882a593Smuzhiyun
369*4882a593Smuzhiyun if (bcr & SYNQUACER_I2C_BCR_BER) {
370*4882a593Smuzhiyun dev_err(i2c->dev, "bus error\n");
371*4882a593Smuzhiyun synquacer_i2c_stop(i2c, -EAGAIN);
372*4882a593Smuzhiyun goto out;
373*4882a593Smuzhiyun }
374*4882a593Smuzhiyun if ((bsr & SYNQUACER_I2C_BSR_AL) ||
375*4882a593Smuzhiyun !(bcr & SYNQUACER_I2C_BCR_MSS)) {
376*4882a593Smuzhiyun dev_dbg(i2c->dev, "arbitration lost\n");
377*4882a593Smuzhiyun synquacer_i2c_stop(i2c, -EAGAIN);
378*4882a593Smuzhiyun goto out;
379*4882a593Smuzhiyun }
380*4882a593Smuzhiyun
381*4882a593Smuzhiyun switch (i2c->state) {
382*4882a593Smuzhiyun case STATE_START:
383*4882a593Smuzhiyun if (bsr & SYNQUACER_I2C_BSR_LRB) {
384*4882a593Smuzhiyun dev_dbg(i2c->dev, "ack was not received\n");
385*4882a593Smuzhiyun synquacer_i2c_stop(i2c, -EAGAIN);
386*4882a593Smuzhiyun goto out;
387*4882a593Smuzhiyun }
388*4882a593Smuzhiyun
389*4882a593Smuzhiyun if (i2c->msg->flags & I2C_M_RD)
390*4882a593Smuzhiyun i2c->state = STATE_READ;
391*4882a593Smuzhiyun else
392*4882a593Smuzhiyun i2c->state = STATE_WRITE;
393*4882a593Smuzhiyun
394*4882a593Smuzhiyun if (is_lastmsg(i2c) && i2c->msg->len == 0) {
395*4882a593Smuzhiyun synquacer_i2c_stop(i2c, 0);
396*4882a593Smuzhiyun goto out;
397*4882a593Smuzhiyun }
398*4882a593Smuzhiyun
399*4882a593Smuzhiyun if (i2c->state == STATE_READ)
400*4882a593Smuzhiyun goto prepare_read;
401*4882a593Smuzhiyun fallthrough;
402*4882a593Smuzhiyun
403*4882a593Smuzhiyun case STATE_WRITE:
404*4882a593Smuzhiyun if (bsr & SYNQUACER_I2C_BSR_LRB) {
405*4882a593Smuzhiyun dev_dbg(i2c->dev, "WRITE: No Ack\n");
406*4882a593Smuzhiyun synquacer_i2c_stop(i2c, -EAGAIN);
407*4882a593Smuzhiyun goto out;
408*4882a593Smuzhiyun }
409*4882a593Smuzhiyun
410*4882a593Smuzhiyun if (!is_msgend(i2c)) {
411*4882a593Smuzhiyun writeb(i2c->msg->buf[i2c->msg_ptr++],
412*4882a593Smuzhiyun i2c->base + SYNQUACER_I2C_REG_DAR);
413*4882a593Smuzhiyun
414*4882a593Smuzhiyun /* clear IRQ, and continue */
415*4882a593Smuzhiyun writeb(SYNQUACER_I2C_BCR_BEIE |
416*4882a593Smuzhiyun SYNQUACER_I2C_BCR_MSS |
417*4882a593Smuzhiyun SYNQUACER_I2C_BCR_INTE,
418*4882a593Smuzhiyun i2c->base + SYNQUACER_I2C_REG_BCR);
419*4882a593Smuzhiyun break;
420*4882a593Smuzhiyun }
421*4882a593Smuzhiyun if (is_lastmsg(i2c)) {
422*4882a593Smuzhiyun synquacer_i2c_stop(i2c, 0);
423*4882a593Smuzhiyun break;
424*4882a593Smuzhiyun }
425*4882a593Smuzhiyun dev_dbg(i2c->dev, "WRITE: Next Message\n");
426*4882a593Smuzhiyun
427*4882a593Smuzhiyun i2c->msg_ptr = 0;
428*4882a593Smuzhiyun i2c->msg_idx++;
429*4882a593Smuzhiyun i2c->msg++;
430*4882a593Smuzhiyun
431*4882a593Smuzhiyun /* send the new start */
432*4882a593Smuzhiyun ret = synquacer_i2c_master_start(i2c, i2c->msg);
433*4882a593Smuzhiyun if (ret < 0) {
434*4882a593Smuzhiyun dev_dbg(i2c->dev, "restart error (%d)\n", ret);
435*4882a593Smuzhiyun synquacer_i2c_stop(i2c, -EAGAIN);
436*4882a593Smuzhiyun break;
437*4882a593Smuzhiyun }
438*4882a593Smuzhiyun i2c->state = STATE_START;
439*4882a593Smuzhiyun break;
440*4882a593Smuzhiyun
441*4882a593Smuzhiyun case STATE_READ:
442*4882a593Smuzhiyun byte = readb(i2c->base + SYNQUACER_I2C_REG_DAR);
443*4882a593Smuzhiyun if (!(bsr & SYNQUACER_I2C_BSR_FBT)) /* data */
444*4882a593Smuzhiyun i2c->msg->buf[i2c->msg_ptr++] = byte;
445*4882a593Smuzhiyun else /* address */
446*4882a593Smuzhiyun dev_dbg(i2c->dev, "address:0x%02x. ignore it.\n", byte);
447*4882a593Smuzhiyun
448*4882a593Smuzhiyun prepare_read:
449*4882a593Smuzhiyun if (is_msglast(i2c)) {
450*4882a593Smuzhiyun writeb(SYNQUACER_I2C_BCR_MSS |
451*4882a593Smuzhiyun SYNQUACER_I2C_BCR_BEIE |
452*4882a593Smuzhiyun SYNQUACER_I2C_BCR_INTE,
453*4882a593Smuzhiyun i2c->base + SYNQUACER_I2C_REG_BCR);
454*4882a593Smuzhiyun break;
455*4882a593Smuzhiyun }
456*4882a593Smuzhiyun if (!is_msgend(i2c)) {
457*4882a593Smuzhiyun writeb(SYNQUACER_I2C_BCR_MSS |
458*4882a593Smuzhiyun SYNQUACER_I2C_BCR_BEIE |
459*4882a593Smuzhiyun SYNQUACER_I2C_BCR_INTE |
460*4882a593Smuzhiyun SYNQUACER_I2C_BCR_ACK,
461*4882a593Smuzhiyun i2c->base + SYNQUACER_I2C_REG_BCR);
462*4882a593Smuzhiyun break;
463*4882a593Smuzhiyun }
464*4882a593Smuzhiyun if (is_lastmsg(i2c)) {
465*4882a593Smuzhiyun /* last message, send stop and complete */
466*4882a593Smuzhiyun dev_dbg(i2c->dev, "READ: Send Stop\n");
467*4882a593Smuzhiyun synquacer_i2c_stop(i2c, 0);
468*4882a593Smuzhiyun break;
469*4882a593Smuzhiyun }
470*4882a593Smuzhiyun dev_dbg(i2c->dev, "READ: Next Transfer\n");
471*4882a593Smuzhiyun
472*4882a593Smuzhiyun i2c->msg_ptr = 0;
473*4882a593Smuzhiyun i2c->msg_idx++;
474*4882a593Smuzhiyun i2c->msg++;
475*4882a593Smuzhiyun
476*4882a593Smuzhiyun ret = synquacer_i2c_master_start(i2c, i2c->msg);
477*4882a593Smuzhiyun if (ret < 0) {
478*4882a593Smuzhiyun dev_dbg(i2c->dev, "restart error (%d)\n", ret);
479*4882a593Smuzhiyun synquacer_i2c_stop(i2c, -EAGAIN);
480*4882a593Smuzhiyun } else {
481*4882a593Smuzhiyun i2c->state = STATE_START;
482*4882a593Smuzhiyun }
483*4882a593Smuzhiyun break;
484*4882a593Smuzhiyun default:
485*4882a593Smuzhiyun dev_err(i2c->dev, "called in err STATE (%d)\n", i2c->state);
486*4882a593Smuzhiyun break;
487*4882a593Smuzhiyun }
488*4882a593Smuzhiyun
489*4882a593Smuzhiyun out:
490*4882a593Smuzhiyun WAIT_PCLK(10, i2c->pclkrate);
491*4882a593Smuzhiyun return IRQ_HANDLED;
492*4882a593Smuzhiyun }
493*4882a593Smuzhiyun
synquacer_i2c_xfer(struct i2c_adapter * adap,struct i2c_msg * msgs,int num)494*4882a593Smuzhiyun static int synquacer_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs,
495*4882a593Smuzhiyun int num)
496*4882a593Smuzhiyun {
497*4882a593Smuzhiyun struct synquacer_i2c *i2c;
498*4882a593Smuzhiyun int retry;
499*4882a593Smuzhiyun int ret;
500*4882a593Smuzhiyun
501*4882a593Smuzhiyun i2c = i2c_get_adapdata(adap);
502*4882a593Smuzhiyun i2c->timeout_ms = calc_timeout_ms(i2c, msgs, num);
503*4882a593Smuzhiyun
504*4882a593Smuzhiyun dev_dbg(i2c->dev, "calculated timeout %d ms\n", i2c->timeout_ms);
505*4882a593Smuzhiyun
506*4882a593Smuzhiyun for (retry = 0; retry <= adap->retries; retry++) {
507*4882a593Smuzhiyun ret = synquacer_i2c_doxfer(i2c, msgs, num);
508*4882a593Smuzhiyun if (ret != -EAGAIN)
509*4882a593Smuzhiyun return ret;
510*4882a593Smuzhiyun
511*4882a593Smuzhiyun dev_dbg(i2c->dev, "Retrying transmission (%d)\n", retry);
512*4882a593Smuzhiyun
513*4882a593Smuzhiyun synquacer_i2c_hw_reset(i2c);
514*4882a593Smuzhiyun }
515*4882a593Smuzhiyun return -EIO;
516*4882a593Smuzhiyun }
517*4882a593Smuzhiyun
synquacer_i2c_functionality(struct i2c_adapter * adap)518*4882a593Smuzhiyun static u32 synquacer_i2c_functionality(struct i2c_adapter *adap)
519*4882a593Smuzhiyun {
520*4882a593Smuzhiyun return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
521*4882a593Smuzhiyun }
522*4882a593Smuzhiyun
523*4882a593Smuzhiyun static const struct i2c_algorithm synquacer_i2c_algo = {
524*4882a593Smuzhiyun .master_xfer = synquacer_i2c_xfer,
525*4882a593Smuzhiyun .functionality = synquacer_i2c_functionality,
526*4882a593Smuzhiyun };
527*4882a593Smuzhiyun
528*4882a593Smuzhiyun static const struct i2c_adapter synquacer_i2c_ops = {
529*4882a593Smuzhiyun .owner = THIS_MODULE,
530*4882a593Smuzhiyun .name = "synquacer_i2c-adapter",
531*4882a593Smuzhiyun .algo = &synquacer_i2c_algo,
532*4882a593Smuzhiyun .retries = 5,
533*4882a593Smuzhiyun };
534*4882a593Smuzhiyun
synquacer_i2c_probe(struct platform_device * pdev)535*4882a593Smuzhiyun static int synquacer_i2c_probe(struct platform_device *pdev)
536*4882a593Smuzhiyun {
537*4882a593Smuzhiyun struct synquacer_i2c *i2c;
538*4882a593Smuzhiyun u32 bus_speed;
539*4882a593Smuzhiyun int ret;
540*4882a593Smuzhiyun
541*4882a593Smuzhiyun i2c = devm_kzalloc(&pdev->dev, sizeof(*i2c), GFP_KERNEL);
542*4882a593Smuzhiyun if (!i2c)
543*4882a593Smuzhiyun return -ENOMEM;
544*4882a593Smuzhiyun
545*4882a593Smuzhiyun bus_speed = i2c_acpi_find_bus_speed(&pdev->dev);
546*4882a593Smuzhiyun if (!bus_speed)
547*4882a593Smuzhiyun device_property_read_u32(&pdev->dev, "clock-frequency",
548*4882a593Smuzhiyun &bus_speed);
549*4882a593Smuzhiyun
550*4882a593Smuzhiyun device_property_read_u32(&pdev->dev, "socionext,pclk-rate",
551*4882a593Smuzhiyun &i2c->pclkrate);
552*4882a593Smuzhiyun
553*4882a593Smuzhiyun i2c->pclk = devm_clk_get(&pdev->dev, "pclk");
554*4882a593Smuzhiyun if (PTR_ERR(i2c->pclk) == -EPROBE_DEFER)
555*4882a593Smuzhiyun return -EPROBE_DEFER;
556*4882a593Smuzhiyun if (!IS_ERR_OR_NULL(i2c->pclk)) {
557*4882a593Smuzhiyun dev_dbg(&pdev->dev, "clock source %p\n", i2c->pclk);
558*4882a593Smuzhiyun
559*4882a593Smuzhiyun ret = clk_prepare_enable(i2c->pclk);
560*4882a593Smuzhiyun if (ret) {
561*4882a593Smuzhiyun dev_err(&pdev->dev, "failed to enable clock (%d)\n",
562*4882a593Smuzhiyun ret);
563*4882a593Smuzhiyun return ret;
564*4882a593Smuzhiyun }
565*4882a593Smuzhiyun i2c->pclkrate = clk_get_rate(i2c->pclk);
566*4882a593Smuzhiyun }
567*4882a593Smuzhiyun
568*4882a593Smuzhiyun if (i2c->pclkrate < SYNQUACER_I2C_MIN_CLK_RATE ||
569*4882a593Smuzhiyun i2c->pclkrate > SYNQUACER_I2C_MAX_CLK_RATE) {
570*4882a593Smuzhiyun dev_err(&pdev->dev, "PCLK missing or out of range (%d)\n",
571*4882a593Smuzhiyun i2c->pclkrate);
572*4882a593Smuzhiyun return -EINVAL;
573*4882a593Smuzhiyun }
574*4882a593Smuzhiyun
575*4882a593Smuzhiyun i2c->base = devm_platform_ioremap_resource(pdev, 0);
576*4882a593Smuzhiyun if (IS_ERR(i2c->base))
577*4882a593Smuzhiyun return PTR_ERR(i2c->base);
578*4882a593Smuzhiyun
579*4882a593Smuzhiyun i2c->irq = platform_get_irq(pdev, 0);
580*4882a593Smuzhiyun if (i2c->irq < 0)
581*4882a593Smuzhiyun return i2c->irq;
582*4882a593Smuzhiyun
583*4882a593Smuzhiyun ret = devm_request_irq(&pdev->dev, i2c->irq, synquacer_i2c_isr,
584*4882a593Smuzhiyun 0, dev_name(&pdev->dev), i2c);
585*4882a593Smuzhiyun if (ret < 0) {
586*4882a593Smuzhiyun dev_err(&pdev->dev, "cannot claim IRQ %d\n", i2c->irq);
587*4882a593Smuzhiyun return ret;
588*4882a593Smuzhiyun }
589*4882a593Smuzhiyun
590*4882a593Smuzhiyun i2c->state = STATE_IDLE;
591*4882a593Smuzhiyun i2c->dev = &pdev->dev;
592*4882a593Smuzhiyun i2c->adapter = synquacer_i2c_ops;
593*4882a593Smuzhiyun i2c_set_adapdata(&i2c->adapter, i2c);
594*4882a593Smuzhiyun i2c->adapter.dev.parent = &pdev->dev;
595*4882a593Smuzhiyun i2c->adapter.dev.of_node = pdev->dev.of_node;
596*4882a593Smuzhiyun ACPI_COMPANION_SET(&i2c->adapter.dev, ACPI_COMPANION(&pdev->dev));
597*4882a593Smuzhiyun i2c->adapter.nr = pdev->id;
598*4882a593Smuzhiyun init_completion(&i2c->completion);
599*4882a593Smuzhiyun
600*4882a593Smuzhiyun if (bus_speed < I2C_MAX_FAST_MODE_FREQ)
601*4882a593Smuzhiyun i2c->speed_khz = SYNQUACER_I2C_SPEED_SM;
602*4882a593Smuzhiyun else
603*4882a593Smuzhiyun i2c->speed_khz = SYNQUACER_I2C_SPEED_FM;
604*4882a593Smuzhiyun
605*4882a593Smuzhiyun synquacer_i2c_hw_init(i2c);
606*4882a593Smuzhiyun
607*4882a593Smuzhiyun ret = i2c_add_numbered_adapter(&i2c->adapter);
608*4882a593Smuzhiyun if (ret) {
609*4882a593Smuzhiyun dev_err(&pdev->dev, "failed to add bus to i2c core\n");
610*4882a593Smuzhiyun return ret;
611*4882a593Smuzhiyun }
612*4882a593Smuzhiyun
613*4882a593Smuzhiyun platform_set_drvdata(pdev, i2c);
614*4882a593Smuzhiyun
615*4882a593Smuzhiyun dev_info(&pdev->dev, "%s: synquacer_i2c adapter\n",
616*4882a593Smuzhiyun dev_name(&i2c->adapter.dev));
617*4882a593Smuzhiyun
618*4882a593Smuzhiyun return 0;
619*4882a593Smuzhiyun }
620*4882a593Smuzhiyun
synquacer_i2c_remove(struct platform_device * pdev)621*4882a593Smuzhiyun static int synquacer_i2c_remove(struct platform_device *pdev)
622*4882a593Smuzhiyun {
623*4882a593Smuzhiyun struct synquacer_i2c *i2c = platform_get_drvdata(pdev);
624*4882a593Smuzhiyun
625*4882a593Smuzhiyun i2c_del_adapter(&i2c->adapter);
626*4882a593Smuzhiyun if (!IS_ERR(i2c->pclk))
627*4882a593Smuzhiyun clk_disable_unprepare(i2c->pclk);
628*4882a593Smuzhiyun
629*4882a593Smuzhiyun return 0;
630*4882a593Smuzhiyun };
631*4882a593Smuzhiyun
632*4882a593Smuzhiyun static const struct of_device_id synquacer_i2c_dt_ids[] = {
633*4882a593Smuzhiyun { .compatible = "socionext,synquacer-i2c" },
634*4882a593Smuzhiyun { /* sentinel */ }
635*4882a593Smuzhiyun };
636*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, synquacer_i2c_dt_ids);
637*4882a593Smuzhiyun
638*4882a593Smuzhiyun #ifdef CONFIG_ACPI
639*4882a593Smuzhiyun static const struct acpi_device_id synquacer_i2c_acpi_ids[] = {
640*4882a593Smuzhiyun { "SCX0003" },
641*4882a593Smuzhiyun { /* sentinel */ }
642*4882a593Smuzhiyun };
643*4882a593Smuzhiyun MODULE_DEVICE_TABLE(acpi, synquacer_i2c_acpi_ids);
644*4882a593Smuzhiyun #endif
645*4882a593Smuzhiyun
646*4882a593Smuzhiyun static struct platform_driver synquacer_i2c_driver = {
647*4882a593Smuzhiyun .probe = synquacer_i2c_probe,
648*4882a593Smuzhiyun .remove = synquacer_i2c_remove,
649*4882a593Smuzhiyun .driver = {
650*4882a593Smuzhiyun .name = "synquacer_i2c",
651*4882a593Smuzhiyun .of_match_table = of_match_ptr(synquacer_i2c_dt_ids),
652*4882a593Smuzhiyun .acpi_match_table = ACPI_PTR(synquacer_i2c_acpi_ids),
653*4882a593Smuzhiyun },
654*4882a593Smuzhiyun };
655*4882a593Smuzhiyun module_platform_driver(synquacer_i2c_driver);
656*4882a593Smuzhiyun
657*4882a593Smuzhiyun MODULE_AUTHOR("Fujitsu Semiconductor Ltd");
658*4882a593Smuzhiyun MODULE_DESCRIPTION("Socionext SynQuacer I2C Driver");
659*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
660