Lines Matching refs:i2c
26 struct octeon_i2c *i2c = dev_id; in octeon_i2c_isr() local
28 i2c->int_disable(i2c); in octeon_i2c_isr()
29 wake_up(&i2c->queue); in octeon_i2c_isr()
34 static bool octeon_i2c_test_iflg(struct octeon_i2c *i2c) in octeon_i2c_test_iflg() argument
36 return (octeon_i2c_ctl_read(i2c) & TWSI_CTL_IFLG); in octeon_i2c_test_iflg()
45 static int octeon_i2c_wait(struct octeon_i2c *i2c) in octeon_i2c_wait() argument
53 if (i2c->broken_irq_mode) { in octeon_i2c_wait()
54 u64 end = get_jiffies_64() + i2c->adap.timeout; in octeon_i2c_wait()
56 while (!octeon_i2c_test_iflg(i2c) && in octeon_i2c_wait()
60 return octeon_i2c_test_iflg(i2c) ? 0 : -ETIMEDOUT; in octeon_i2c_wait()
63 i2c->int_enable(i2c); in octeon_i2c_wait()
64 time_left = wait_event_timeout(i2c->queue, octeon_i2c_test_iflg(i2c), in octeon_i2c_wait()
65 i2c->adap.timeout); in octeon_i2c_wait()
66 i2c->int_disable(i2c); in octeon_i2c_wait()
68 if (i2c->broken_irq_check && !time_left && in octeon_i2c_wait()
69 octeon_i2c_test_iflg(i2c)) { in octeon_i2c_wait()
70 dev_err(i2c->dev, "broken irq connection detected, switching to polling mode.\n"); in octeon_i2c_wait()
71 i2c->broken_irq_mode = true; in octeon_i2c_wait()
81 static bool octeon_i2c_hlc_test_valid(struct octeon_i2c *i2c) in octeon_i2c_hlc_test_valid() argument
83 return (__raw_readq(i2c->twsi_base + SW_TWSI(i2c)) & SW_TWSI_V) == 0; in octeon_i2c_hlc_test_valid()
86 static void octeon_i2c_hlc_int_clear(struct octeon_i2c *i2c) in octeon_i2c_hlc_int_clear() argument
89 octeon_i2c_write_int(i2c, TWSI_INT_ST_INT | TWSI_INT_TS_INT); in octeon_i2c_hlc_int_clear()
95 static void octeon_i2c_hlc_enable(struct octeon_i2c *i2c) in octeon_i2c_hlc_enable() argument
100 if (i2c->hlc_enabled) in octeon_i2c_hlc_enable()
102 i2c->hlc_enabled = true; in octeon_i2c_hlc_enable()
105 val = octeon_i2c_ctl_read(i2c); in octeon_i2c_hlc_enable()
111 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB); in octeon_i2c_hlc_enable()
121 octeon_i2c_ctl_write(i2c, TWSI_CTL_CE | TWSI_CTL_AAK | TWSI_CTL_ENAB); in octeon_i2c_hlc_enable()
124 static void octeon_i2c_hlc_disable(struct octeon_i2c *i2c) in octeon_i2c_hlc_disable() argument
126 if (!i2c->hlc_enabled) in octeon_i2c_hlc_disable()
129 i2c->hlc_enabled = false; in octeon_i2c_hlc_disable()
130 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB); in octeon_i2c_hlc_disable()
139 static int octeon_i2c_hlc_wait(struct octeon_i2c *i2c) in octeon_i2c_hlc_wait() argument
147 if (i2c->broken_irq_mode) { in octeon_i2c_hlc_wait()
148 u64 end = get_jiffies_64() + i2c->adap.timeout; in octeon_i2c_hlc_wait()
150 while (!octeon_i2c_hlc_test_valid(i2c) && in octeon_i2c_hlc_wait()
154 return octeon_i2c_hlc_test_valid(i2c) ? 0 : -ETIMEDOUT; in octeon_i2c_hlc_wait()
157 i2c->hlc_int_enable(i2c); in octeon_i2c_hlc_wait()
158 time_left = wait_event_timeout(i2c->queue, in octeon_i2c_hlc_wait()
159 octeon_i2c_hlc_test_valid(i2c), in octeon_i2c_hlc_wait()
160 i2c->adap.timeout); in octeon_i2c_hlc_wait()
161 i2c->hlc_int_disable(i2c); in octeon_i2c_hlc_wait()
163 octeon_i2c_hlc_int_clear(i2c); in octeon_i2c_hlc_wait()
165 if (i2c->broken_irq_check && !time_left && in octeon_i2c_hlc_wait()
166 octeon_i2c_hlc_test_valid(i2c)) { in octeon_i2c_hlc_wait()
167 dev_err(i2c->dev, "broken irq connection detected, switching to polling mode.\n"); in octeon_i2c_hlc_wait()
168 i2c->broken_irq_mode = true; in octeon_i2c_hlc_wait()
177 static int octeon_i2c_check_status(struct octeon_i2c *i2c, int final_read) in octeon_i2c_check_status() argument
185 if (i2c->hlc_enabled) in octeon_i2c_check_status()
186 stat = __raw_readq(i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_check_status()
188 stat = octeon_i2c_stat_read(i2c); in octeon_i2c_check_status()
242 dev_err(i2c->dev, "unhandled state: %d\n", stat); in octeon_i2c_check_status()
247 static int octeon_i2c_recovery(struct octeon_i2c *i2c) in octeon_i2c_recovery() argument
251 ret = i2c_recover_bus(&i2c->adap); in octeon_i2c_recovery()
254 ret = octeon_i2c_init_lowlevel(i2c); in octeon_i2c_recovery()
264 static int octeon_i2c_start(struct octeon_i2c *i2c) in octeon_i2c_start() argument
269 octeon_i2c_hlc_disable(i2c); in octeon_i2c_start()
271 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB | TWSI_CTL_STA); in octeon_i2c_start()
272 ret = octeon_i2c_wait(i2c); in octeon_i2c_start()
276 stat = octeon_i2c_stat_read(i2c); in octeon_i2c_start()
283 ret = octeon_i2c_recovery(i2c); in octeon_i2c_start()
288 static void octeon_i2c_stop(struct octeon_i2c *i2c) in octeon_i2c_stop() argument
290 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB | TWSI_CTL_STP); in octeon_i2c_stop()
305 static int octeon_i2c_read(struct octeon_i2c *i2c, int target, in octeon_i2c_read() argument
311 octeon_i2c_data_write(i2c, (target << 1) | 1); in octeon_i2c_read()
312 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB); in octeon_i2c_read()
314 result = octeon_i2c_wait(i2c); in octeon_i2c_read()
319 result = octeon_i2c_check_status(i2c, false); in octeon_i2c_read()
337 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB); in octeon_i2c_read()
339 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB | TWSI_CTL_AAK); in octeon_i2c_read()
341 result = octeon_i2c_wait(i2c); in octeon_i2c_read()
345 data[i] = octeon_i2c_data_read(i2c, &result); in octeon_i2c_read()
354 result = octeon_i2c_check_status(i2c, final_read); in octeon_i2c_read()
373 static int octeon_i2c_write(struct octeon_i2c *i2c, int target, in octeon_i2c_write() argument
378 octeon_i2c_data_write(i2c, target << 1); in octeon_i2c_write()
379 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB); in octeon_i2c_write()
381 result = octeon_i2c_wait(i2c); in octeon_i2c_write()
386 result = octeon_i2c_check_status(i2c, false); in octeon_i2c_write()
390 octeon_i2c_data_write(i2c, data[i]); in octeon_i2c_write()
391 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB); in octeon_i2c_write()
393 result = octeon_i2c_wait(i2c); in octeon_i2c_write()
402 static int octeon_i2c_hlc_read(struct octeon_i2c *i2c, struct i2c_msg *msgs) in octeon_i2c_hlc_read() argument
407 octeon_i2c_hlc_enable(i2c); in octeon_i2c_hlc_read()
408 octeon_i2c_hlc_int_clear(i2c); in octeon_i2c_hlc_read()
421 octeon_i2c_writeq_flush(cmd, i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_read()
422 ret = octeon_i2c_hlc_wait(i2c); in octeon_i2c_hlc_read()
426 cmd = __raw_readq(i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_read()
428 return octeon_i2c_check_status(i2c, false); in octeon_i2c_hlc_read()
434 cmd = __raw_readq(i2c->twsi_base + SW_TWSI_EXT(i2c)); in octeon_i2c_hlc_read()
444 static int octeon_i2c_hlc_write(struct octeon_i2c *i2c, struct i2c_msg *msgs) in octeon_i2c_hlc_write() argument
449 octeon_i2c_hlc_enable(i2c); in octeon_i2c_hlc_write()
450 octeon_i2c_hlc_int_clear(i2c); in octeon_i2c_hlc_write()
471 octeon_i2c_writeq_flush(ext, i2c->twsi_base + SW_TWSI_EXT(i2c)); in octeon_i2c_hlc_write()
474 octeon_i2c_writeq_flush(cmd, i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_write()
475 ret = octeon_i2c_hlc_wait(i2c); in octeon_i2c_hlc_write()
479 cmd = __raw_readq(i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_write()
481 return octeon_i2c_check_status(i2c, false); in octeon_i2c_hlc_write()
488 static int octeon_i2c_hlc_comp_read(struct octeon_i2c *i2c, struct i2c_msg *msgs) in octeon_i2c_hlc_comp_read() argument
493 octeon_i2c_hlc_enable(i2c); in octeon_i2c_hlc_comp_read()
512 octeon_i2c_writeq_flush(ext, i2c->twsi_base + SW_TWSI_EXT(i2c)); in octeon_i2c_hlc_comp_read()
517 octeon_i2c_hlc_int_clear(i2c); in octeon_i2c_hlc_comp_read()
518 octeon_i2c_writeq_flush(cmd, i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_comp_read()
520 ret = octeon_i2c_hlc_wait(i2c); in octeon_i2c_hlc_comp_read()
524 cmd = __raw_readq(i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_comp_read()
526 return octeon_i2c_check_status(i2c, false); in octeon_i2c_hlc_comp_read()
532 cmd = __raw_readq(i2c->twsi_base + SW_TWSI_EXT(i2c)); in octeon_i2c_hlc_comp_read()
542 static int octeon_i2c_hlc_comp_write(struct octeon_i2c *i2c, struct i2c_msg *msgs) in octeon_i2c_hlc_comp_write() argument
548 octeon_i2c_hlc_enable(i2c); in octeon_i2c_hlc_comp_write()
579 octeon_i2c_writeq_flush(ext, i2c->twsi_base + SW_TWSI_EXT(i2c)); in octeon_i2c_hlc_comp_write()
581 octeon_i2c_hlc_int_clear(i2c); in octeon_i2c_hlc_comp_write()
582 octeon_i2c_writeq_flush(cmd, i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_comp_write()
584 ret = octeon_i2c_hlc_wait(i2c); in octeon_i2c_hlc_comp_write()
588 cmd = __raw_readq(i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_comp_write()
590 return octeon_i2c_check_status(i2c, false); in octeon_i2c_hlc_comp_write()
606 struct octeon_i2c *i2c = i2c_get_adapdata(adap); in octeon_i2c_xfer() local
612 ret = octeon_i2c_hlc_read(i2c, msgs); in octeon_i2c_xfer()
614 ret = octeon_i2c_hlc_write(i2c, msgs); in octeon_i2c_xfer()
624 ret = octeon_i2c_hlc_comp_read(i2c, msgs); in octeon_i2c_xfer()
626 ret = octeon_i2c_hlc_comp_write(i2c, msgs); in octeon_i2c_xfer()
640 ret = octeon_i2c_start(i2c); in octeon_i2c_xfer()
645 ret = octeon_i2c_read(i2c, pmsg->addr, pmsg->buf, in octeon_i2c_xfer()
648 ret = octeon_i2c_write(i2c, pmsg->addr, pmsg->buf, in octeon_i2c_xfer()
651 octeon_i2c_stop(i2c); in octeon_i2c_xfer()
657 void octeon_i2c_set_clock(struct octeon_i2c *i2c) in octeon_i2c_set_clock() argument
672 tclk = i2c->twsi_freq * (mdiv_idx + 1) * 10; in octeon_i2c_set_clock()
674 thp_base = (i2c->sys_freq / (tclk * 2)) - 1; in octeon_i2c_set_clock()
681 foscl = i2c->sys_freq / (2 * (thp_idx + 1)); in octeon_i2c_set_clock()
684 diff = abs(foscl - i2c->twsi_freq); in octeon_i2c_set_clock()
694 octeon_i2c_reg_write(i2c, SW_TWSI_OP_TWSI_CLK, thp); in octeon_i2c_set_clock()
695 octeon_i2c_reg_write(i2c, SW_TWSI_EOP_TWSI_CLKCTL, (mdiv << 3) | ndiv); in octeon_i2c_set_clock()
698 int octeon_i2c_init_lowlevel(struct octeon_i2c *i2c) in octeon_i2c_init_lowlevel() argument
704 octeon_i2c_reg_write(i2c, SW_TWSI_EOP_TWSI_RST, 0); in octeon_i2c_init_lowlevel()
708 status = octeon_i2c_stat_read(i2c); in octeon_i2c_init_lowlevel()
714 dev_err(i2c->dev, "%s: TWSI_RST failed! (0x%x)\n", in octeon_i2c_init_lowlevel()
720 octeon_i2c_hlc_enable(i2c); in octeon_i2c_init_lowlevel()
721 octeon_i2c_hlc_disable(i2c); in octeon_i2c_init_lowlevel()
727 struct octeon_i2c *i2c = i2c_get_adapdata(adap); in octeon_i2c_get_scl() local
730 state = octeon_i2c_read_int(i2c); in octeon_i2c_get_scl()
736 struct octeon_i2c *i2c = i2c_get_adapdata(adap); in octeon_i2c_set_scl() local
738 octeon_i2c_write_int(i2c, val ? 0 : TWSI_INT_SCL_OVR); in octeon_i2c_set_scl()
743 struct octeon_i2c *i2c = i2c_get_adapdata(adap); in octeon_i2c_get_sda() local
746 state = octeon_i2c_read_int(i2c); in octeon_i2c_get_sda()
752 struct octeon_i2c *i2c = i2c_get_adapdata(adap); in octeon_i2c_prepare_recovery() local
754 octeon_i2c_hlc_disable(i2c); in octeon_i2c_prepare_recovery()
755 octeon_i2c_reg_write(i2c, SW_TWSI_EOP_TWSI_RST, 0); in octeon_i2c_prepare_recovery()
763 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB); in octeon_i2c_prepare_recovery()
765 octeon_i2c_write_int(i2c, 0); in octeon_i2c_prepare_recovery()
770 struct octeon_i2c *i2c = i2c_get_adapdata(adap); in octeon_i2c_unprepare_recovery() local
777 octeon_i2c_write_int(i2c, TWSI_INT_SDA_OVR | TWSI_INT_SCL_OVR); in octeon_i2c_unprepare_recovery()
779 octeon_i2c_write_int(i2c, TWSI_INT_SDA_OVR); in octeon_i2c_unprepare_recovery()
781 octeon_i2c_write_int(i2c, 0); in octeon_i2c_unprepare_recovery()