Lines Matching refs:dev
33 void at91_init_twi_bus_master(struct at91_twi_dev *dev) in at91_init_twi_bus_master() argument
35 struct at91_twi_pdata *pdata = dev->pdata; in at91_init_twi_bus_master()
39 if (dev->fifo_size) in at91_init_twi_bus_master()
40 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_FIFOEN); in at91_init_twi_bus_master()
41 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_MSEN); in at91_init_twi_bus_master()
42 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_SVDIS); in at91_init_twi_bus_master()
43 at91_twi_write(dev, AT91_TWI_CWGR, dev->twi_cwgr_reg); in at91_init_twi_bus_master()
46 if (pdata->has_dig_filtr && dev->enable_dig_filt) in at91_init_twi_bus_master()
50 if (pdata->has_adv_dig_filtr && dev->enable_dig_filt) in at91_init_twi_bus_master()
52 (AT91_TWI_FILTR_THRES(dev->filter_width) & in at91_init_twi_bus_master()
56 if (pdata->has_ana_filtr && dev->enable_ana_filt) in at91_init_twi_bus_master()
60 at91_twi_write(dev, AT91_TWI_FILTR, filtr); in at91_init_twi_bus_master()
67 static void at91_calc_twi_clock(struct at91_twi_dev *dev) in at91_calc_twi_clock() argument
70 struct at91_twi_pdata *pdata = dev->pdata; in at91_calc_twi_clock()
75 i2c_parse_fw_timings(dev->dev, t, true); in at91_calc_twi_clock()
77 div = max(0, (int)DIV_ROUND_UP(clk_get_rate(dev->clk), in at91_calc_twi_clock()
83 dev_warn(dev->dev, "%d exceeds ckdiv max value which is %d.\n", in at91_calc_twi_clock()
96 * (clk_get_rate(dev->clk) / 1000), 1000000); in at91_calc_twi_clock()
101 dev_warn(dev->dev, in at91_calc_twi_clock()
114 * (clk_get_rate(dev->clk) / 1000), 1000000); in at91_calc_twi_clock()
116 dev_warn(dev->dev, in at91_calc_twi_clock()
123 dev->twi_cwgr_reg = (ckdiv << 16) | (cdiv << 8) | cdiv in at91_calc_twi_clock()
126 dev->filter_width = filter_width; in at91_calc_twi_clock()
128 dev_dbg(dev->dev, "cdiv %d ckdiv %d hold %d (%d ns), filter_width %d (%d ns)\n", in at91_calc_twi_clock()
133 static void at91_twi_dma_cleanup(struct at91_twi_dev *dev) in at91_twi_dma_cleanup() argument
135 struct at91_twi_dma *dma = &dev->dma; in at91_twi_dma_cleanup()
137 at91_twi_irq_save(dev); in at91_twi_dma_cleanup()
147 dma_unmap_single(dev->dev, sg_dma_address(&dma->sg[0]), in at91_twi_dma_cleanup()
148 dev->buf_len, dma->direction); in at91_twi_dma_cleanup()
152 at91_twi_irq_restore(dev); in at91_twi_dma_cleanup()
155 static void at91_twi_write_next_byte(struct at91_twi_dev *dev) in at91_twi_write_next_byte() argument
157 if (!dev->buf_len) in at91_twi_write_next_byte()
161 writeb_relaxed(*dev->buf, dev->base + AT91_TWI_THR); in at91_twi_write_next_byte()
164 if (--dev->buf_len == 0) { in at91_twi_write_next_byte()
165 if (!dev->use_alt_cmd) in at91_twi_write_next_byte()
166 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_STOP); in at91_twi_write_next_byte()
167 at91_twi_write(dev, AT91_TWI_IDR, AT91_TWI_TXRDY); in at91_twi_write_next_byte()
170 dev_dbg(dev->dev, "wrote 0x%x, to go %zu\n", *dev->buf, dev->buf_len); in at91_twi_write_next_byte()
172 ++dev->buf; in at91_twi_write_next_byte()
177 struct at91_twi_dev *dev = (struct at91_twi_dev *)data; in at91_twi_write_data_dma_callback() local
179 dma_unmap_single(dev->dev, sg_dma_address(&dev->dma.sg[0]), in at91_twi_write_data_dma_callback()
180 dev->buf_len, DMA_TO_DEVICE); in at91_twi_write_data_dma_callback()
189 at91_twi_write(dev, AT91_TWI_IER, AT91_TWI_TXCOMP); in at91_twi_write_data_dma_callback()
190 if (!dev->use_alt_cmd) in at91_twi_write_data_dma_callback()
191 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_STOP); in at91_twi_write_data_dma_callback()
194 static void at91_twi_write_data_dma(struct at91_twi_dev *dev) in at91_twi_write_data_dma() argument
198 struct at91_twi_dma *dma = &dev->dma; in at91_twi_write_data_dma()
202 if (!dev->buf_len) in at91_twi_write_data_dma()
207 at91_twi_irq_save(dev); in at91_twi_write_data_dma()
208 dma_addr = dma_map_single(dev->dev, dev->buf, dev->buf_len, in at91_twi_write_data_dma()
210 if (dma_mapping_error(dev->dev, dma_addr)) { in at91_twi_write_data_dma()
211 dev_err(dev->dev, "dma map failed\n"); in at91_twi_write_data_dma()
215 at91_twi_irq_restore(dev); in at91_twi_write_data_dma()
217 if (dev->fifo_size) { in at91_twi_write_data_dma()
224 part1_len = dev->buf_len & ~0x3; in at91_twi_write_data_dma()
231 part2_len = dev->buf_len & 0x3; in at91_twi_write_data_dma()
242 fifo_mr = at91_twi_read(dev, AT91_TWI_FMR); in at91_twi_write_data_dma()
245 at91_twi_write(dev, AT91_TWI_FMR, fifo_mr); in at91_twi_write_data_dma()
247 sg_dma_len(&dma->sg[0]) = dev->buf_len; in at91_twi_write_data_dma()
255 dev_err(dev->dev, "dma prep slave sg failed\n"); in at91_twi_write_data_dma()
260 txdesc->callback_param = dev; in at91_twi_write_data_dma()
269 at91_twi_dma_cleanup(dev); in at91_twi_write_data_dma()
272 static void at91_twi_read_next_byte(struct at91_twi_dev *dev) in at91_twi_read_next_byte() argument
278 if (!dev->buf_len) { in at91_twi_read_next_byte()
279 at91_twi_read(dev, AT91_TWI_RHR); in at91_twi_read_next_byte()
284 *dev->buf = readb_relaxed(dev->base + AT91_TWI_RHR); in at91_twi_read_next_byte()
285 --dev->buf_len; in at91_twi_read_next_byte()
288 if (dev->recv_len_abort) in at91_twi_read_next_byte()
292 if (unlikely(dev->msg->flags & I2C_M_RECV_LEN)) { in at91_twi_read_next_byte()
294 if (*dev->buf <= I2C_SMBUS_BLOCK_MAX && *dev->buf > 0) { in at91_twi_read_next_byte()
295 dev->msg->flags &= ~I2C_M_RECV_LEN; in at91_twi_read_next_byte()
296 dev->buf_len += *dev->buf; in at91_twi_read_next_byte()
297 dev->msg->len = dev->buf_len + 1; in at91_twi_read_next_byte()
298 dev_dbg(dev->dev, "received block length %zu\n", in at91_twi_read_next_byte()
299 dev->buf_len); in at91_twi_read_next_byte()
302 dev->recv_len_abort = true; in at91_twi_read_next_byte()
303 dev->buf_len = 1; in at91_twi_read_next_byte()
308 if (!dev->use_alt_cmd && dev->buf_len == 1) in at91_twi_read_next_byte()
309 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_STOP); in at91_twi_read_next_byte()
311 dev_dbg(dev->dev, "read 0x%x, to go %zu\n", *dev->buf, dev->buf_len); in at91_twi_read_next_byte()
313 ++dev->buf; in at91_twi_read_next_byte()
318 struct at91_twi_dev *dev = (struct at91_twi_dev *)data; in at91_twi_read_data_dma_callback() local
321 dma_unmap_single(dev->dev, sg_dma_address(&dev->dma.sg[0]), in at91_twi_read_data_dma_callback()
322 dev->buf_len, DMA_FROM_DEVICE); in at91_twi_read_data_dma_callback()
324 if (!dev->use_alt_cmd) { in at91_twi_read_data_dma_callback()
326 dev->buf += dev->buf_len - 2; in at91_twi_read_data_dma_callback()
327 dev->buf_len = 2; in at91_twi_read_data_dma_callback()
330 at91_twi_write(dev, AT91_TWI_IER, ier); in at91_twi_read_data_dma_callback()
333 static void at91_twi_read_data_dma(struct at91_twi_dev *dev) in at91_twi_read_data_dma() argument
337 struct at91_twi_dma *dma = &dev->dma; in at91_twi_read_data_dma()
341 buf_len = (dev->use_alt_cmd) ? dev->buf_len : dev->buf_len - 2; in at91_twi_read_data_dma()
345 at91_twi_irq_save(dev); in at91_twi_read_data_dma()
346 dma_addr = dma_map_single(dev->dev, dev->buf, buf_len, DMA_FROM_DEVICE); in at91_twi_read_data_dma()
347 if (dma_mapping_error(dev->dev, dma_addr)) { in at91_twi_read_data_dma()
348 dev_err(dev->dev, "dma map failed\n"); in at91_twi_read_data_dma()
352 at91_twi_irq_restore(dev); in at91_twi_read_data_dma()
354 if (dev->fifo_size && IS_ALIGNED(buf_len, 4)) { in at91_twi_read_data_dma()
361 fifo_mr = at91_twi_read(dev, AT91_TWI_FMR); in at91_twi_read_data_dma()
364 at91_twi_write(dev, AT91_TWI_FMR, fifo_mr); in at91_twi_read_data_dma()
373 dev_err(dev->dev, "dma prep slave sg failed\n"); in at91_twi_read_data_dma()
378 rxdesc->callback_param = dev; in at91_twi_read_data_dma()
387 at91_twi_dma_cleanup(dev); in at91_twi_read_data_dma()
392 struct at91_twi_dev *dev = dev_id; in atmel_twi_interrupt() local
393 const unsigned status = at91_twi_read(dev, AT91_TWI_SR); in atmel_twi_interrupt()
394 const unsigned irqstatus = status & at91_twi_read(dev, AT91_TWI_IMR); in atmel_twi_interrupt()
421 at91_twi_read_next_byte(dev); in atmel_twi_interrupt()
422 } while (at91_twi_read(dev, AT91_TWI_SR) & AT91_TWI_RXRDY); in atmel_twi_interrupt()
464 at91_disable_twi_interrupts(dev); in atmel_twi_interrupt()
465 complete(&dev->cmd_complete); in atmel_twi_interrupt()
467 at91_twi_write_next_byte(dev); in atmel_twi_interrupt()
471 dev->transfer_status |= status; in atmel_twi_interrupt()
476 static int at91_do_twi_transfer(struct at91_twi_dev *dev) in at91_do_twi_transfer() argument
480 bool has_unre_flag = dev->pdata->has_unre_flag; in at91_do_twi_transfer()
481 bool has_alt_cmd = dev->pdata->has_alt_cmd; in at91_do_twi_transfer()
526 dev_dbg(dev->dev, "transfer: %s %zu bytes.\n", in at91_do_twi_transfer()
527 (dev->msg->flags & I2C_M_RD) ? "read" : "write", dev->buf_len); in at91_do_twi_transfer()
529 reinit_completion(&dev->cmd_complete); in at91_do_twi_transfer()
530 dev->transfer_status = 0; in at91_do_twi_transfer()
533 at91_twi_read(dev, AT91_TWI_SR); in at91_do_twi_transfer()
535 if (dev->fifo_size) { in at91_do_twi_transfer()
536 unsigned fifo_mr = at91_twi_read(dev, AT91_TWI_FMR); in at91_do_twi_transfer()
543 at91_twi_write(dev, AT91_TWI_FMR, fifo_mr); in at91_do_twi_transfer()
546 at91_twi_write(dev, AT91_TWI_CR, in at91_do_twi_transfer()
550 if (!dev->buf_len) { in at91_do_twi_transfer()
551 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_QUICK); in at91_do_twi_transfer()
552 at91_twi_write(dev, AT91_TWI_IER, AT91_TWI_TXCOMP); in at91_do_twi_transfer()
553 } else if (dev->msg->flags & I2C_M_RD) { in at91_do_twi_transfer()
557 if (!dev->use_alt_cmd && dev->buf_len <= 1 && in at91_do_twi_transfer()
558 !(dev->msg->flags & I2C_M_RECV_LEN)) in at91_do_twi_transfer()
560 at91_twi_write(dev, AT91_TWI_CR, start_flags); in at91_do_twi_transfer()
570 if (dev->use_dma && (dev->buf_len > AT91_I2C_DMA_THRESHOLD)) { in at91_do_twi_transfer()
571 at91_twi_write(dev, AT91_TWI_IER, AT91_TWI_NACK); in at91_do_twi_transfer()
572 at91_twi_read_data_dma(dev); in at91_do_twi_transfer()
574 at91_twi_write(dev, AT91_TWI_IER, in at91_do_twi_transfer()
580 if (dev->use_dma && (dev->buf_len > AT91_I2C_DMA_THRESHOLD)) { in at91_do_twi_transfer()
581 at91_twi_write(dev, AT91_TWI_IER, AT91_TWI_NACK); in at91_do_twi_transfer()
582 at91_twi_write_data_dma(dev); in at91_do_twi_transfer()
584 at91_twi_write_next_byte(dev); in at91_do_twi_transfer()
585 at91_twi_write(dev, AT91_TWI_IER, in at91_do_twi_transfer()
587 (dev->buf_len ? AT91_TWI_TXRDY : 0)); in at91_do_twi_transfer()
591 time_left = wait_for_completion_timeout(&dev->cmd_complete, in at91_do_twi_transfer()
592 dev->adapter.timeout); in at91_do_twi_transfer()
594 dev->transfer_status |= at91_twi_read(dev, AT91_TWI_SR); in at91_do_twi_transfer()
595 dev_err(dev->dev, "controller timed out\n"); in at91_do_twi_transfer()
596 at91_init_twi_bus(dev); in at91_do_twi_transfer()
600 if (dev->transfer_status & AT91_TWI_NACK) { in at91_do_twi_transfer()
601 dev_dbg(dev->dev, "received nack\n"); in at91_do_twi_transfer()
605 if (dev->transfer_status & AT91_TWI_OVRE) { in at91_do_twi_transfer()
606 dev_err(dev->dev, "overrun while reading\n"); in at91_do_twi_transfer()
610 if (has_unre_flag && dev->transfer_status & AT91_TWI_UNRE) { in at91_do_twi_transfer()
611 dev_err(dev->dev, "underrun while writing\n"); in at91_do_twi_transfer()
615 if ((has_alt_cmd || dev->fifo_size) && in at91_do_twi_transfer()
616 (dev->transfer_status & AT91_TWI_LOCK)) { in at91_do_twi_transfer()
617 dev_err(dev->dev, "tx locked\n"); in at91_do_twi_transfer()
621 if (dev->recv_len_abort) { in at91_do_twi_transfer()
622 dev_err(dev->dev, "invalid smbus block length recvd\n"); in at91_do_twi_transfer()
627 dev_dbg(dev->dev, "transfer complete\n"); in at91_do_twi_transfer()
633 at91_twi_dma_cleanup(dev); in at91_do_twi_transfer()
635 if ((has_alt_cmd || dev->fifo_size) && in at91_do_twi_transfer()
636 (dev->transfer_status & AT91_TWI_LOCK)) { in at91_do_twi_transfer()
637 dev_dbg(dev->dev, "unlock tx\n"); in at91_do_twi_transfer()
638 at91_twi_write(dev, AT91_TWI_CR, in at91_do_twi_transfer()
647 i2c_recover_bus(&dev->adapter); in at91_do_twi_transfer()
654 struct at91_twi_dev *dev = i2c_get_adapdata(adap); in at91_twi_xfer() local
661 dev_dbg(&adap->dev, "at91_xfer: processing %d messages:\n", num); in at91_twi_xfer()
663 ret = pm_runtime_get_sync(dev->dev); in at91_twi_xfer()
679 at91_twi_write(dev, AT91_TWI_IADR, internal_address); in at91_twi_xfer()
682 dev->use_alt_cmd = false; in at91_twi_xfer()
684 if (dev->pdata->has_alt_cmd) { in at91_twi_xfer()
687 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_ACMEN); in at91_twi_xfer()
688 at91_twi_write(dev, AT91_TWI_ACR, in at91_twi_xfer()
691 dev->use_alt_cmd = true; in at91_twi_xfer()
693 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_ACMDIS); in at91_twi_xfer()
697 at91_twi_write(dev, AT91_TWI_MMR, in at91_twi_xfer()
700 ((!dev->use_alt_cmd && is_read) ? AT91_TWI_MREAD : 0)); in at91_twi_xfer()
702 dev->buf_len = m_start->len; in at91_twi_xfer()
703 dev->buf = m_start->buf; in at91_twi_xfer()
704 dev->msg = m_start; in at91_twi_xfer()
705 dev->recv_len_abort = false; in at91_twi_xfer()
707 if (dev->use_dma) { in at91_twi_xfer()
713 dev->buf = dma_buf; in at91_twi_xfer()
716 ret = at91_do_twi_transfer(dev); in at91_twi_xfer()
721 pm_runtime_mark_last_busy(dev->dev); in at91_twi_xfer()
722 pm_runtime_put_autosuspend(dev->dev); in at91_twi_xfer()
747 static int at91_twi_configure_dma(struct at91_twi_dev *dev, u32 phy_addr) in at91_twi_configure_dma() argument
751 struct at91_twi_dma *dma = &dev->dma; in at91_twi_configure_dma()
769 if (dev->fifo_size) in at91_twi_configure_dma()
781 dma->chan_tx = dma_request_chan(dev->dev, "tx"); in at91_twi_configure_dma()
788 dma->chan_rx = dma_request_chan(dev->dev, "rx"); in at91_twi_configure_dma()
797 dev_err(dev->dev, "failed to configure tx channel\n"); in at91_twi_configure_dma()
804 dev_err(dev->dev, "failed to configure rx channel\n"); in at91_twi_configure_dma()
812 dev->use_dma = true; in at91_twi_configure_dma()
814 dev_info(dev->dev, "using %s (tx) and %s (rx) for DMA transfers\n", in at91_twi_configure_dma()
821 dev_info(dev->dev, "can't get DMA channel, continue without DMA support\n"); in at91_twi_configure_dma()
830 struct at91_twi_dev *dev) in at91_init_twi_recovery_gpio() argument
832 struct i2c_bus_recovery_info *rinfo = &dev->rinfo; in at91_init_twi_recovery_gpio()
834 rinfo->pinctrl = devm_pinctrl_get(&pdev->dev); in at91_init_twi_recovery_gpio()
836 dev_info(dev->dev, "can't get pinctrl, bus recovery not supported\n"); in at91_init_twi_recovery_gpio()
839 dev->adapter.bus_recovery_info = rinfo; in at91_init_twi_recovery_gpio()
846 struct at91_twi_dev *dev = i2c_get_adapdata(adap); in at91_twi_recover_bus_cmd() local
848 dev->transfer_status |= at91_twi_read(dev, AT91_TWI_SR); in at91_twi_recover_bus_cmd()
849 if (!(dev->transfer_status & AT91_TWI_SDA)) { in at91_twi_recover_bus_cmd()
850 dev_dbg(dev->dev, "SDA is down; sending bus clear command\n"); in at91_twi_recover_bus_cmd()
851 if (dev->use_alt_cmd) { in at91_twi_recover_bus_cmd()
854 acr = at91_twi_read(dev, AT91_TWI_ACR); in at91_twi_recover_bus_cmd()
856 at91_twi_write(dev, AT91_TWI_ACR, acr); in at91_twi_recover_bus_cmd()
858 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_CLEAR); in at91_twi_recover_bus_cmd()
865 struct at91_twi_dev *dev) in at91_init_twi_recovery_info() argument
867 struct i2c_bus_recovery_info *rinfo = &dev->rinfo; in at91_init_twi_recovery_info()
868 bool has_clear_cmd = dev->pdata->has_clear_cmd; in at91_init_twi_recovery_info()
871 return at91_init_twi_recovery_gpio(pdev, dev); in at91_init_twi_recovery_info()
874 dev->adapter.bus_recovery_info = rinfo; in at91_init_twi_recovery_info()
880 u32 phy_addr, struct at91_twi_dev *dev) in at91_twi_probe_master() argument
884 init_completion(&dev->cmd_complete); in at91_twi_probe_master()
886 rc = devm_request_irq(&pdev->dev, dev->irq, atmel_twi_interrupt, 0, in at91_twi_probe_master()
887 dev_name(dev->dev), dev); in at91_twi_probe_master()
889 dev_err(dev->dev, "Cannot get irq %d: %d\n", dev->irq, rc); in at91_twi_probe_master()
893 if (dev->dev->of_node) { in at91_twi_probe_master()
894 rc = at91_twi_configure_dma(dev, phy_addr); in at91_twi_probe_master()
899 if (!of_property_read_u32(pdev->dev.of_node, "atmel,fifo-size", in at91_twi_probe_master()
900 &dev->fifo_size)) { in at91_twi_probe_master()
901 dev_info(dev->dev, "Using FIFO (%u data)\n", dev->fifo_size); in at91_twi_probe_master()
904 dev->enable_dig_filt = of_property_read_bool(pdev->dev.of_node, in at91_twi_probe_master()
907 dev->enable_ana_filt = of_property_read_bool(pdev->dev.of_node, in at91_twi_probe_master()
909 at91_calc_twi_clock(dev); in at91_twi_probe_master()
911 rc = at91_init_twi_recovery_info(pdev, dev); in at91_twi_probe_master()
915 dev->adapter.algo = &at91_twi_algorithm; in at91_twi_probe_master()
916 dev->adapter.quirks = &at91_twi_quirks; in at91_twi_probe_master()