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()
39 static bool octeon_i2c_test_ready(struct octeon_i2c *i2c, bool *first) in octeon_i2c_test_ready() argument
41 if (octeon_i2c_test_iflg(i2c)) in octeon_i2c_test_ready()
54 return octeon_i2c_test_iflg(i2c); in octeon_i2c_test_ready()
63 static int octeon_i2c_wait(struct octeon_i2c *i2c) in octeon_i2c_wait() argument
72 if (i2c->broken_irq_mode) { in octeon_i2c_wait()
73 u64 end = get_jiffies_64() + i2c->adap.timeout; in octeon_i2c_wait()
75 while (!octeon_i2c_test_iflg(i2c) && in octeon_i2c_wait()
79 return octeon_i2c_test_iflg(i2c) ? 0 : -ETIMEDOUT; in octeon_i2c_wait()
82 i2c->int_enable(i2c); in octeon_i2c_wait()
83 time_left = wait_event_timeout(i2c->queue, octeon_i2c_test_ready(i2c, &first), in octeon_i2c_wait()
84 i2c->adap.timeout); in octeon_i2c_wait()
85 i2c->int_disable(i2c); in octeon_i2c_wait()
87 if (i2c->broken_irq_check && !time_left && in octeon_i2c_wait()
88 octeon_i2c_test_iflg(i2c)) { in octeon_i2c_wait()
89 dev_err(i2c->dev, "broken irq connection detected, switching to polling mode.\n"); in octeon_i2c_wait()
90 i2c->broken_irq_mode = true; in octeon_i2c_wait()
100 static bool octeon_i2c_hlc_test_valid(struct octeon_i2c *i2c) in octeon_i2c_hlc_test_valid() argument
102 return (__raw_readq(i2c->twsi_base + SW_TWSI(i2c)) & SW_TWSI_V) == 0; in octeon_i2c_hlc_test_valid()
105 static bool octeon_i2c_hlc_test_ready(struct octeon_i2c *i2c, bool *first) in octeon_i2c_hlc_test_ready() argument
108 if (octeon_i2c_hlc_test_valid(i2c)) in octeon_i2c_hlc_test_ready()
121 return octeon_i2c_hlc_test_valid(i2c); in octeon_i2c_hlc_test_ready()
124 static void octeon_i2c_hlc_int_clear(struct octeon_i2c *i2c) in octeon_i2c_hlc_int_clear() argument
127 octeon_i2c_write_int(i2c, TWSI_INT_ST_INT | TWSI_INT_TS_INT); in octeon_i2c_hlc_int_clear()
133 static void octeon_i2c_hlc_enable(struct octeon_i2c *i2c) in octeon_i2c_hlc_enable() argument
138 if (i2c->hlc_enabled) in octeon_i2c_hlc_enable()
140 i2c->hlc_enabled = true; in octeon_i2c_hlc_enable()
143 val = octeon_i2c_ctl_read(i2c); in octeon_i2c_hlc_enable()
149 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB); in octeon_i2c_hlc_enable()
159 octeon_i2c_ctl_write(i2c, TWSI_CTL_CE | TWSI_CTL_AAK | TWSI_CTL_ENAB); in octeon_i2c_hlc_enable()
162 static void octeon_i2c_hlc_disable(struct octeon_i2c *i2c) in octeon_i2c_hlc_disable() argument
164 if (!i2c->hlc_enabled) in octeon_i2c_hlc_disable()
167 i2c->hlc_enabled = false; in octeon_i2c_hlc_disable()
168 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB); in octeon_i2c_hlc_disable()
177 static int octeon_i2c_hlc_wait(struct octeon_i2c *i2c) in octeon_i2c_hlc_wait() argument
186 if (i2c->broken_irq_mode) { in octeon_i2c_hlc_wait()
187 u64 end = get_jiffies_64() + i2c->adap.timeout; in octeon_i2c_hlc_wait()
189 while (!octeon_i2c_hlc_test_valid(i2c) && in octeon_i2c_hlc_wait()
193 return octeon_i2c_hlc_test_valid(i2c) ? 0 : -ETIMEDOUT; in octeon_i2c_hlc_wait()
196 i2c->hlc_int_enable(i2c); in octeon_i2c_hlc_wait()
197 time_left = wait_event_timeout(i2c->queue, in octeon_i2c_hlc_wait()
198 octeon_i2c_hlc_test_ready(i2c, &first), in octeon_i2c_hlc_wait()
199 i2c->adap.timeout); in octeon_i2c_hlc_wait()
200 i2c->hlc_int_disable(i2c); in octeon_i2c_hlc_wait()
202 octeon_i2c_hlc_int_clear(i2c); in octeon_i2c_hlc_wait()
204 if (i2c->broken_irq_check && !time_left && in octeon_i2c_hlc_wait()
205 octeon_i2c_hlc_test_valid(i2c)) { in octeon_i2c_hlc_wait()
206 dev_err(i2c->dev, "broken irq connection detected, switching to polling mode.\n"); in octeon_i2c_hlc_wait()
207 i2c->broken_irq_mode = true; in octeon_i2c_hlc_wait()
216 static int octeon_i2c_check_status(struct octeon_i2c *i2c, int final_read) in octeon_i2c_check_status() argument
224 if (i2c->hlc_enabled) in octeon_i2c_check_status()
225 stat = __raw_readq(i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_check_status()
227 stat = octeon_i2c_stat_read(i2c); in octeon_i2c_check_status()
281 dev_err(i2c->dev, "unhandled state: %d\n", stat); in octeon_i2c_check_status()
286 static int octeon_i2c_recovery(struct octeon_i2c *i2c) in octeon_i2c_recovery() argument
290 ret = i2c_recover_bus(&i2c->adap); in octeon_i2c_recovery()
293 ret = octeon_i2c_init_lowlevel(i2c); in octeon_i2c_recovery()
303 static int octeon_i2c_start(struct octeon_i2c *i2c) in octeon_i2c_start() argument
308 octeon_i2c_hlc_disable(i2c); in octeon_i2c_start()
310 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB | TWSI_CTL_STA); in octeon_i2c_start()
311 ret = octeon_i2c_wait(i2c); in octeon_i2c_start()
315 stat = octeon_i2c_stat_read(i2c); in octeon_i2c_start()
322 ret = octeon_i2c_recovery(i2c); in octeon_i2c_start()
327 static void octeon_i2c_stop(struct octeon_i2c *i2c) in octeon_i2c_stop() argument
329 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB | TWSI_CTL_STP); in octeon_i2c_stop()
344 static int octeon_i2c_read(struct octeon_i2c *i2c, int target, in octeon_i2c_read() argument
350 octeon_i2c_data_write(i2c, (target << 1) | 1); in octeon_i2c_read()
351 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB); in octeon_i2c_read()
353 result = octeon_i2c_wait(i2c); in octeon_i2c_read()
358 result = octeon_i2c_check_status(i2c, false); in octeon_i2c_read()
376 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB); in octeon_i2c_read()
378 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB | TWSI_CTL_AAK); in octeon_i2c_read()
380 result = octeon_i2c_wait(i2c); in octeon_i2c_read()
384 data[i] = octeon_i2c_data_read(i2c); in octeon_i2c_read()
391 result = octeon_i2c_check_status(i2c, final_read); in octeon_i2c_read()
410 static int octeon_i2c_write(struct octeon_i2c *i2c, int target, in octeon_i2c_write() argument
415 octeon_i2c_data_write(i2c, target << 1); in octeon_i2c_write()
416 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB); in octeon_i2c_write()
418 result = octeon_i2c_wait(i2c); in octeon_i2c_write()
423 result = octeon_i2c_check_status(i2c, false); in octeon_i2c_write()
427 octeon_i2c_data_write(i2c, data[i]); in octeon_i2c_write()
428 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB); in octeon_i2c_write()
430 result = octeon_i2c_wait(i2c); in octeon_i2c_write()
439 static int octeon_i2c_hlc_read(struct octeon_i2c *i2c, struct i2c_msg *msgs) in octeon_i2c_hlc_read() argument
444 octeon_i2c_hlc_enable(i2c); in octeon_i2c_hlc_read()
445 octeon_i2c_hlc_int_clear(i2c); in octeon_i2c_hlc_read()
458 octeon_i2c_writeq_flush(cmd, i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_read()
459 ret = octeon_i2c_hlc_wait(i2c); in octeon_i2c_hlc_read()
463 cmd = __raw_readq(i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_read()
465 return octeon_i2c_check_status(i2c, false); in octeon_i2c_hlc_read()
471 cmd = __raw_readq(i2c->twsi_base + SW_TWSI_EXT(i2c)); in octeon_i2c_hlc_read()
481 static int octeon_i2c_hlc_write(struct octeon_i2c *i2c, struct i2c_msg *msgs) in octeon_i2c_hlc_write() argument
486 octeon_i2c_hlc_enable(i2c); in octeon_i2c_hlc_write()
487 octeon_i2c_hlc_int_clear(i2c); in octeon_i2c_hlc_write()
508 octeon_i2c_writeq_flush(ext, i2c->twsi_base + SW_TWSI_EXT(i2c)); in octeon_i2c_hlc_write()
511 octeon_i2c_writeq_flush(cmd, i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_write()
512 ret = octeon_i2c_hlc_wait(i2c); in octeon_i2c_hlc_write()
516 cmd = __raw_readq(i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_write()
518 return octeon_i2c_check_status(i2c, false); in octeon_i2c_hlc_write()
525 static int octeon_i2c_hlc_comp_read(struct octeon_i2c *i2c, struct i2c_msg *msgs) in octeon_i2c_hlc_comp_read() argument
530 octeon_i2c_hlc_enable(i2c); in octeon_i2c_hlc_comp_read()
549 octeon_i2c_writeq_flush(ext, i2c->twsi_base + SW_TWSI_EXT(i2c)); in octeon_i2c_hlc_comp_read()
554 octeon_i2c_hlc_int_clear(i2c); in octeon_i2c_hlc_comp_read()
555 octeon_i2c_writeq_flush(cmd, i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_comp_read()
557 ret = octeon_i2c_hlc_wait(i2c); in octeon_i2c_hlc_comp_read()
561 cmd = __raw_readq(i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_comp_read()
563 return octeon_i2c_check_status(i2c, false); in octeon_i2c_hlc_comp_read()
569 cmd = __raw_readq(i2c->twsi_base + SW_TWSI_EXT(i2c)); in octeon_i2c_hlc_comp_read()
579 static int octeon_i2c_hlc_comp_write(struct octeon_i2c *i2c, struct i2c_msg *msgs) in octeon_i2c_hlc_comp_write() argument
585 octeon_i2c_hlc_enable(i2c); in octeon_i2c_hlc_comp_write()
616 octeon_i2c_writeq_flush(ext, i2c->twsi_base + SW_TWSI_EXT(i2c)); in octeon_i2c_hlc_comp_write()
618 octeon_i2c_hlc_int_clear(i2c); in octeon_i2c_hlc_comp_write()
619 octeon_i2c_writeq_flush(cmd, i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_comp_write()
621 ret = octeon_i2c_hlc_wait(i2c); in octeon_i2c_hlc_comp_write()
625 cmd = __raw_readq(i2c->twsi_base + SW_TWSI(i2c)); in octeon_i2c_hlc_comp_write()
627 return octeon_i2c_check_status(i2c, false); in octeon_i2c_hlc_comp_write()
643 struct octeon_i2c *i2c = i2c_get_adapdata(adap); in octeon_i2c_xfer() local
649 ret = octeon_i2c_hlc_read(i2c, msgs); in octeon_i2c_xfer()
651 ret = octeon_i2c_hlc_write(i2c, msgs); in octeon_i2c_xfer()
661 ret = octeon_i2c_hlc_comp_read(i2c, msgs); in octeon_i2c_xfer()
663 ret = octeon_i2c_hlc_comp_write(i2c, msgs); in octeon_i2c_xfer()
677 ret = octeon_i2c_start(i2c); in octeon_i2c_xfer()
682 ret = octeon_i2c_read(i2c, pmsg->addr, pmsg->buf, in octeon_i2c_xfer()
685 ret = octeon_i2c_write(i2c, pmsg->addr, pmsg->buf, in octeon_i2c_xfer()
688 octeon_i2c_stop(i2c); in octeon_i2c_xfer()
694 void octeon_i2c_set_clock(struct octeon_i2c *i2c) in octeon_i2c_set_clock() argument
709 tclk = i2c->twsi_freq * (mdiv_idx + 1) * 10; in octeon_i2c_set_clock()
711 thp_base = (i2c->sys_freq / (tclk * 2)) - 1; in octeon_i2c_set_clock()
718 foscl = i2c->sys_freq / (2 * (thp_idx + 1)); in octeon_i2c_set_clock()
721 diff = abs(foscl - i2c->twsi_freq); in octeon_i2c_set_clock()
731 octeon_i2c_reg_write(i2c, SW_TWSI_OP_TWSI_CLK, thp); in octeon_i2c_set_clock()
732 octeon_i2c_reg_write(i2c, SW_TWSI_EOP_TWSI_CLKCTL, (mdiv << 3) | ndiv); in octeon_i2c_set_clock()
735 int octeon_i2c_init_lowlevel(struct octeon_i2c *i2c) in octeon_i2c_init_lowlevel() argument
741 octeon_i2c_reg_write(i2c, SW_TWSI_EOP_TWSI_RST, 0); in octeon_i2c_init_lowlevel()
745 status = octeon_i2c_stat_read(i2c); in octeon_i2c_init_lowlevel()
751 dev_err(i2c->dev, "%s: TWSI_RST failed! (0x%x)\n", in octeon_i2c_init_lowlevel()
757 octeon_i2c_hlc_enable(i2c); in octeon_i2c_init_lowlevel()
758 octeon_i2c_hlc_disable(i2c); in octeon_i2c_init_lowlevel()
764 struct octeon_i2c *i2c = i2c_get_adapdata(adap); in octeon_i2c_get_scl() local
767 state = octeon_i2c_read_int(i2c); in octeon_i2c_get_scl()
773 struct octeon_i2c *i2c = i2c_get_adapdata(adap); in octeon_i2c_set_scl() local
775 octeon_i2c_write_int(i2c, val ? 0 : TWSI_INT_SCL_OVR); in octeon_i2c_set_scl()
780 struct octeon_i2c *i2c = i2c_get_adapdata(adap); in octeon_i2c_get_sda() local
783 state = octeon_i2c_read_int(i2c); in octeon_i2c_get_sda()
789 struct octeon_i2c *i2c = i2c_get_adapdata(adap); in octeon_i2c_prepare_recovery() local
791 octeon_i2c_hlc_disable(i2c); in octeon_i2c_prepare_recovery()
797 octeon_i2c_ctl_write(i2c, TWSI_CTL_ENAB); in octeon_i2c_prepare_recovery()
799 octeon_i2c_write_int(i2c, 0); in octeon_i2c_prepare_recovery()
804 struct octeon_i2c *i2c = i2c_get_adapdata(adap); in octeon_i2c_unprepare_recovery() local
811 octeon_i2c_write_int(i2c, TWSI_INT_SDA_OVR | TWSI_INT_SCL_OVR); in octeon_i2c_unprepare_recovery()
813 octeon_i2c_write_int(i2c, TWSI_INT_SDA_OVR); in octeon_i2c_unprepare_recovery()
815 octeon_i2c_write_int(i2c, 0); in octeon_i2c_unprepare_recovery()