Lines Matching refs:dev
34 void at91_init_twi_bus_master(struct at91_twi_dev *dev) in at91_init_twi_bus_master() argument
36 struct at91_twi_pdata *pdata = dev->pdata; in at91_init_twi_bus_master()
40 if (dev->fifo_size) in at91_init_twi_bus_master()
41 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_FIFOEN); in at91_init_twi_bus_master()
42 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_MSEN); in at91_init_twi_bus_master()
43 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_SVDIS); in at91_init_twi_bus_master()
44 at91_twi_write(dev, AT91_TWI_CWGR, dev->twi_cwgr_reg); in at91_init_twi_bus_master()
47 if (pdata->has_dig_filtr && dev->enable_dig_filt) in at91_init_twi_bus_master()
51 if (pdata->has_adv_dig_filtr && dev->enable_dig_filt) in at91_init_twi_bus_master()
53 (AT91_TWI_FILTR_THRES(dev->filter_width) & in at91_init_twi_bus_master()
57 if (pdata->has_ana_filtr && dev->enable_ana_filt) in at91_init_twi_bus_master()
61 at91_twi_write(dev, AT91_TWI_FILTR, filtr); in at91_init_twi_bus_master()
68 static void at91_calc_twi_clock(struct at91_twi_dev *dev) in at91_calc_twi_clock() argument
71 struct at91_twi_pdata *pdata = dev->pdata; in at91_calc_twi_clock()
76 i2c_parse_fw_timings(dev->dev, t, true); in at91_calc_twi_clock()
78 div = max(0, (int)DIV_ROUND_UP(clk_get_rate(dev->clk), in at91_calc_twi_clock()
84 dev_warn(dev->dev, "%d exceeds ckdiv max value which is %d.\n", in at91_calc_twi_clock()
97 * (clk_get_rate(dev->clk) / 1000), 1000000); in at91_calc_twi_clock()
102 dev_warn(dev->dev, in at91_calc_twi_clock()
115 * (clk_get_rate(dev->clk) / 1000), 1000000); in at91_calc_twi_clock()
117 dev_warn(dev->dev, in at91_calc_twi_clock()
124 dev->twi_cwgr_reg = (ckdiv << 16) | (cdiv << 8) | cdiv in at91_calc_twi_clock()
127 dev->filter_width = filter_width; in at91_calc_twi_clock()
129 dev_dbg(dev->dev, "cdiv %d ckdiv %d hold %d (%d ns), filter_width %d (%d ns)\n", in at91_calc_twi_clock()
134 static void at91_twi_dma_cleanup(struct at91_twi_dev *dev) in at91_twi_dma_cleanup() argument
136 struct at91_twi_dma *dma = &dev->dma; in at91_twi_dma_cleanup()
138 at91_twi_irq_save(dev); in at91_twi_dma_cleanup()
148 dma_unmap_single(dev->dev, sg_dma_address(&dma->sg[0]), in at91_twi_dma_cleanup()
149 dev->buf_len, dma->direction); in at91_twi_dma_cleanup()
153 at91_twi_irq_restore(dev); in at91_twi_dma_cleanup()
156 static void at91_twi_write_next_byte(struct at91_twi_dev *dev) in at91_twi_write_next_byte() argument
158 if (!dev->buf_len) in at91_twi_write_next_byte()
162 writeb_relaxed(*dev->buf, dev->base + AT91_TWI_THR); in at91_twi_write_next_byte()
165 if (--dev->buf_len == 0) { in at91_twi_write_next_byte()
166 if (!dev->use_alt_cmd) in at91_twi_write_next_byte()
167 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_STOP); in at91_twi_write_next_byte()
168 at91_twi_write(dev, AT91_TWI_IDR, AT91_TWI_TXRDY); in at91_twi_write_next_byte()
171 dev_dbg(dev->dev, "wrote 0x%x, to go %zu\n", *dev->buf, dev->buf_len); in at91_twi_write_next_byte()
173 ++dev->buf; in at91_twi_write_next_byte()
178 struct at91_twi_dev *dev = (struct at91_twi_dev *)data; in at91_twi_write_data_dma_callback() local
180 dma_unmap_single(dev->dev, sg_dma_address(&dev->dma.sg[0]), in at91_twi_write_data_dma_callback()
181 dev->buf_len, DMA_TO_DEVICE); in at91_twi_write_data_dma_callback()
190 at91_twi_write(dev, AT91_TWI_IER, AT91_TWI_TXCOMP); in at91_twi_write_data_dma_callback()
191 if (!dev->use_alt_cmd) in at91_twi_write_data_dma_callback()
192 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_STOP); in at91_twi_write_data_dma_callback()
195 static void at91_twi_write_data_dma(struct at91_twi_dev *dev) in at91_twi_write_data_dma() argument
199 struct at91_twi_dma *dma = &dev->dma; in at91_twi_write_data_dma()
203 if (!dev->buf_len) in at91_twi_write_data_dma()
208 at91_twi_irq_save(dev); in at91_twi_write_data_dma()
209 dma_addr = dma_map_single(dev->dev, dev->buf, dev->buf_len, in at91_twi_write_data_dma()
211 if (dma_mapping_error(dev->dev, dma_addr)) { in at91_twi_write_data_dma()
212 dev_err(dev->dev, "dma map failed\n"); in at91_twi_write_data_dma()
216 at91_twi_irq_restore(dev); in at91_twi_write_data_dma()
218 if (dev->fifo_size) { in at91_twi_write_data_dma()
225 part1_len = dev->buf_len & ~0x3; in at91_twi_write_data_dma()
232 part2_len = dev->buf_len & 0x3; in at91_twi_write_data_dma()
243 fifo_mr = at91_twi_read(dev, AT91_TWI_FMR); in at91_twi_write_data_dma()
246 at91_twi_write(dev, AT91_TWI_FMR, fifo_mr); in at91_twi_write_data_dma()
248 sg_dma_len(&dma->sg[0]) = dev->buf_len; in at91_twi_write_data_dma()
256 dev_err(dev->dev, "dma prep slave sg failed\n"); in at91_twi_write_data_dma()
261 txdesc->callback_param = dev; in at91_twi_write_data_dma()
270 at91_twi_dma_cleanup(dev); in at91_twi_write_data_dma()
273 static void at91_twi_read_next_byte(struct at91_twi_dev *dev) in at91_twi_read_next_byte() argument
279 if (!dev->buf_len) { in at91_twi_read_next_byte()
280 at91_twi_read(dev, AT91_TWI_RHR); in at91_twi_read_next_byte()
285 *dev->buf = readb_relaxed(dev->base + AT91_TWI_RHR); in at91_twi_read_next_byte()
286 --dev->buf_len; in at91_twi_read_next_byte()
289 if (dev->recv_len_abort) in at91_twi_read_next_byte()
293 if (unlikely(dev->msg->flags & I2C_M_RECV_LEN)) { in at91_twi_read_next_byte()
295 if (*dev->buf <= I2C_SMBUS_BLOCK_MAX && *dev->buf > 0) { in at91_twi_read_next_byte()
296 dev->msg->flags &= ~I2C_M_RECV_LEN; in at91_twi_read_next_byte()
297 dev->buf_len += *dev->buf; in at91_twi_read_next_byte()
298 dev->msg->len = dev->buf_len + 1; in at91_twi_read_next_byte()
299 dev_dbg(dev->dev, "received block length %zu\n", in at91_twi_read_next_byte()
300 dev->buf_len); in at91_twi_read_next_byte()
303 dev->recv_len_abort = true; in at91_twi_read_next_byte()
304 dev->buf_len = 1; in at91_twi_read_next_byte()
309 if (!dev->use_alt_cmd && dev->buf_len == 1) in at91_twi_read_next_byte()
310 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_STOP); in at91_twi_read_next_byte()
312 dev_dbg(dev->dev, "read 0x%x, to go %zu\n", *dev->buf, dev->buf_len); in at91_twi_read_next_byte()
314 ++dev->buf; in at91_twi_read_next_byte()
319 struct at91_twi_dev *dev = (struct at91_twi_dev *)data; in at91_twi_read_data_dma_callback() local
322 dma_unmap_single(dev->dev, sg_dma_address(&dev->dma.sg[0]), in at91_twi_read_data_dma_callback()
323 dev->buf_len, DMA_FROM_DEVICE); in at91_twi_read_data_dma_callback()
325 if (!dev->use_alt_cmd) { in at91_twi_read_data_dma_callback()
327 dev->buf += dev->buf_len - 2; in at91_twi_read_data_dma_callback()
328 dev->buf_len = 2; in at91_twi_read_data_dma_callback()
331 at91_twi_write(dev, AT91_TWI_IER, ier); in at91_twi_read_data_dma_callback()
334 static void at91_twi_read_data_dma(struct at91_twi_dev *dev) in at91_twi_read_data_dma() argument
338 struct at91_twi_dma *dma = &dev->dma; in at91_twi_read_data_dma()
342 buf_len = (dev->use_alt_cmd) ? dev->buf_len : dev->buf_len - 2; in at91_twi_read_data_dma()
346 at91_twi_irq_save(dev); in at91_twi_read_data_dma()
347 dma_addr = dma_map_single(dev->dev, dev->buf, buf_len, DMA_FROM_DEVICE); in at91_twi_read_data_dma()
348 if (dma_mapping_error(dev->dev, dma_addr)) { in at91_twi_read_data_dma()
349 dev_err(dev->dev, "dma map failed\n"); in at91_twi_read_data_dma()
353 at91_twi_irq_restore(dev); in at91_twi_read_data_dma()
355 if (dev->fifo_size && IS_ALIGNED(buf_len, 4)) { in at91_twi_read_data_dma()
362 fifo_mr = at91_twi_read(dev, AT91_TWI_FMR); in at91_twi_read_data_dma()
365 at91_twi_write(dev, AT91_TWI_FMR, fifo_mr); in at91_twi_read_data_dma()
374 dev_err(dev->dev, "dma prep slave sg failed\n"); in at91_twi_read_data_dma()
379 rxdesc->callback_param = dev; in at91_twi_read_data_dma()
388 at91_twi_dma_cleanup(dev); in at91_twi_read_data_dma()
393 struct at91_twi_dev *dev = dev_id; in atmel_twi_interrupt() local
394 const unsigned status = at91_twi_read(dev, AT91_TWI_SR); in atmel_twi_interrupt()
395 const unsigned irqstatus = status & at91_twi_read(dev, AT91_TWI_IMR); in atmel_twi_interrupt()
422 at91_twi_read_next_byte(dev); in atmel_twi_interrupt()
423 } while (at91_twi_read(dev, AT91_TWI_SR) & AT91_TWI_RXRDY); in atmel_twi_interrupt()
465 at91_disable_twi_interrupts(dev); in atmel_twi_interrupt()
466 complete(&dev->cmd_complete); in atmel_twi_interrupt()
468 at91_twi_write_next_byte(dev); in atmel_twi_interrupt()
472 dev->transfer_status |= status; in atmel_twi_interrupt()
477 static int at91_do_twi_transfer(struct at91_twi_dev *dev) in at91_do_twi_transfer() argument
481 bool has_unre_flag = dev->pdata->has_unre_flag; in at91_do_twi_transfer()
482 bool has_alt_cmd = dev->pdata->has_alt_cmd; in at91_do_twi_transfer()
527 dev_dbg(dev->dev, "transfer: %s %zu bytes.\n", in at91_do_twi_transfer()
528 (dev->msg->flags & I2C_M_RD) ? "read" : "write", dev->buf_len); in at91_do_twi_transfer()
530 reinit_completion(&dev->cmd_complete); in at91_do_twi_transfer()
531 dev->transfer_status = 0; in at91_do_twi_transfer()
534 at91_twi_read(dev, AT91_TWI_SR); in at91_do_twi_transfer()
536 if (dev->fifo_size) { in at91_do_twi_transfer()
537 unsigned fifo_mr = at91_twi_read(dev, AT91_TWI_FMR); in at91_do_twi_transfer()
544 at91_twi_write(dev, AT91_TWI_FMR, fifo_mr); in at91_do_twi_transfer()
547 at91_twi_write(dev, AT91_TWI_CR, in at91_do_twi_transfer()
551 if (!dev->buf_len) { in at91_do_twi_transfer()
552 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_QUICK); in at91_do_twi_transfer()
553 at91_twi_write(dev, AT91_TWI_IER, AT91_TWI_TXCOMP); in at91_do_twi_transfer()
554 } else if (dev->msg->flags & I2C_M_RD) { in at91_do_twi_transfer()
558 if (!dev->use_alt_cmd && dev->buf_len <= 1 && in at91_do_twi_transfer()
559 !(dev->msg->flags & I2C_M_RECV_LEN)) in at91_do_twi_transfer()
561 at91_twi_write(dev, AT91_TWI_CR, start_flags); in at91_do_twi_transfer()
571 if (dev->use_dma && (dev->buf_len > AT91_I2C_DMA_THRESHOLD)) { in at91_do_twi_transfer()
572 at91_twi_write(dev, AT91_TWI_IER, AT91_TWI_NACK); in at91_do_twi_transfer()
573 at91_twi_read_data_dma(dev); in at91_do_twi_transfer()
575 at91_twi_write(dev, AT91_TWI_IER, in at91_do_twi_transfer()
581 if (dev->use_dma && (dev->buf_len > AT91_I2C_DMA_THRESHOLD)) { in at91_do_twi_transfer()
582 at91_twi_write(dev, AT91_TWI_IER, AT91_TWI_NACK); in at91_do_twi_transfer()
583 at91_twi_write_data_dma(dev); in at91_do_twi_transfer()
585 at91_twi_write_next_byte(dev); in at91_do_twi_transfer()
586 at91_twi_write(dev, AT91_TWI_IER, in at91_do_twi_transfer()
588 (dev->buf_len ? AT91_TWI_TXRDY : 0)); in at91_do_twi_transfer()
592 time_left = wait_for_completion_timeout(&dev->cmd_complete, in at91_do_twi_transfer()
593 dev->adapter.timeout); in at91_do_twi_transfer()
595 dev->transfer_status |= at91_twi_read(dev, AT91_TWI_SR); in at91_do_twi_transfer()
596 dev_err(dev->dev, "controller timed out\n"); in at91_do_twi_transfer()
597 at91_init_twi_bus(dev); in at91_do_twi_transfer()
601 if (dev->transfer_status & AT91_TWI_NACK) { in at91_do_twi_transfer()
602 dev_dbg(dev->dev, "received nack\n"); in at91_do_twi_transfer()
606 if (dev->transfer_status & AT91_TWI_OVRE) { in at91_do_twi_transfer()
607 dev_err(dev->dev, "overrun while reading\n"); in at91_do_twi_transfer()
611 if (has_unre_flag && dev->transfer_status & AT91_TWI_UNRE) { in at91_do_twi_transfer()
612 dev_err(dev->dev, "underrun while writing\n"); in at91_do_twi_transfer()
616 if ((has_alt_cmd || dev->fifo_size) && in at91_do_twi_transfer()
617 (dev->transfer_status & AT91_TWI_LOCK)) { in at91_do_twi_transfer()
618 dev_err(dev->dev, "tx locked\n"); in at91_do_twi_transfer()
622 if (dev->recv_len_abort) { in at91_do_twi_transfer()
623 dev_err(dev->dev, "invalid smbus block length recvd\n"); in at91_do_twi_transfer()
628 dev_dbg(dev->dev, "transfer complete\n"); in at91_do_twi_transfer()
634 at91_twi_dma_cleanup(dev); in at91_do_twi_transfer()
636 if ((has_alt_cmd || dev->fifo_size) && in at91_do_twi_transfer()
637 (dev->transfer_status & AT91_TWI_LOCK)) { in at91_do_twi_transfer()
638 dev_dbg(dev->dev, "unlock tx\n"); in at91_do_twi_transfer()
639 at91_twi_write(dev, AT91_TWI_CR, in at91_do_twi_transfer()
648 i2c_recover_bus(&dev->adapter); in at91_do_twi_transfer()
655 struct at91_twi_dev *dev = i2c_get_adapdata(adap); in at91_twi_xfer() local
662 dev_dbg(&adap->dev, "at91_xfer: processing %d messages:\n", num); in at91_twi_xfer()
664 ret = pm_runtime_get_sync(dev->dev); in at91_twi_xfer()
680 at91_twi_write(dev, AT91_TWI_IADR, internal_address); in at91_twi_xfer()
683 dev->use_alt_cmd = false; in at91_twi_xfer()
685 if (dev->pdata->has_alt_cmd) { in at91_twi_xfer()
688 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_ACMEN); in at91_twi_xfer()
689 at91_twi_write(dev, AT91_TWI_ACR, in at91_twi_xfer()
692 dev->use_alt_cmd = true; in at91_twi_xfer()
694 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_ACMDIS); in at91_twi_xfer()
698 at91_twi_write(dev, AT91_TWI_MMR, in at91_twi_xfer()
701 ((!dev->use_alt_cmd && is_read) ? AT91_TWI_MREAD : 0)); in at91_twi_xfer()
703 dev->buf_len = m_start->len; in at91_twi_xfer()
704 dev->buf = m_start->buf; in at91_twi_xfer()
705 dev->msg = m_start; in at91_twi_xfer()
706 dev->recv_len_abort = false; in at91_twi_xfer()
708 if (dev->use_dma) { in at91_twi_xfer()
714 dev->buf = dma_buf; in at91_twi_xfer()
717 ret = at91_do_twi_transfer(dev); in at91_twi_xfer()
722 pm_runtime_mark_last_busy(dev->dev); in at91_twi_xfer()
723 pm_runtime_put_autosuspend(dev->dev); in at91_twi_xfer()
748 static int at91_twi_configure_dma(struct at91_twi_dev *dev, u32 phy_addr) in at91_twi_configure_dma() argument
752 struct at91_twi_dma *dma = &dev->dma; in at91_twi_configure_dma()
770 if (dev->fifo_size) in at91_twi_configure_dma()
782 dma->chan_tx = dma_request_chan(dev->dev, "tx"); in at91_twi_configure_dma()
789 dma->chan_rx = dma_request_chan(dev->dev, "rx"); in at91_twi_configure_dma()
798 dev_err(dev->dev, "failed to configure tx channel\n"); in at91_twi_configure_dma()
805 dev_err(dev->dev, "failed to configure rx channel\n"); in at91_twi_configure_dma()
813 dev->use_dma = true; in at91_twi_configure_dma()
815 dev_info(dev->dev, "using %s (tx) and %s (rx) for DMA transfers\n", in at91_twi_configure_dma()
822 dev_info(dev->dev, "can't get DMA channel, continue without DMA support\n"); in at91_twi_configure_dma()
831 struct at91_twi_dev *dev) in at91_init_twi_recovery_gpio() argument
833 struct i2c_bus_recovery_info *rinfo = &dev->rinfo; in at91_init_twi_recovery_gpio()
835 rinfo->pinctrl = devm_pinctrl_get(&pdev->dev); in at91_init_twi_recovery_gpio()
837 dev_info(dev->dev, "can't get pinctrl, bus recovery not supported\n"); in at91_init_twi_recovery_gpio()
840 dev->adapter.bus_recovery_info = rinfo; in at91_init_twi_recovery_gpio()
847 struct at91_twi_dev *dev = i2c_get_adapdata(adap); in at91_twi_recover_bus_cmd() local
849 dev->transfer_status |= at91_twi_read(dev, AT91_TWI_SR); in at91_twi_recover_bus_cmd()
850 if (!(dev->transfer_status & AT91_TWI_SDA)) { in at91_twi_recover_bus_cmd()
851 dev_dbg(dev->dev, "SDA is down; sending bus clear command\n"); in at91_twi_recover_bus_cmd()
852 if (dev->use_alt_cmd) { in at91_twi_recover_bus_cmd()
855 acr = at91_twi_read(dev, AT91_TWI_ACR); in at91_twi_recover_bus_cmd()
857 at91_twi_write(dev, AT91_TWI_ACR, acr); in at91_twi_recover_bus_cmd()
859 at91_twi_write(dev, AT91_TWI_CR, AT91_TWI_CLEAR); in at91_twi_recover_bus_cmd()
866 struct at91_twi_dev *dev) in at91_init_twi_recovery_info() argument
868 struct i2c_bus_recovery_info *rinfo = &dev->rinfo; in at91_init_twi_recovery_info()
869 bool has_clear_cmd = dev->pdata->has_clear_cmd; in at91_init_twi_recovery_info()
872 return at91_init_twi_recovery_gpio(pdev, dev); in at91_init_twi_recovery_info()
875 dev->adapter.bus_recovery_info = rinfo; in at91_init_twi_recovery_info()
881 u32 phy_addr, struct at91_twi_dev *dev) in at91_twi_probe_master() argument
885 init_completion(&dev->cmd_complete); in at91_twi_probe_master()
887 rc = devm_request_irq(&pdev->dev, dev->irq, atmel_twi_interrupt, 0, in at91_twi_probe_master()
888 dev_name(dev->dev), dev); in at91_twi_probe_master()
890 dev_err(dev->dev, "Cannot get irq %d: %d\n", dev->irq, rc); in at91_twi_probe_master()
894 if (dev->dev->of_node) { in at91_twi_probe_master()
895 rc = at91_twi_configure_dma(dev, phy_addr); in at91_twi_probe_master()
900 if (!of_property_read_u32(pdev->dev.of_node, "atmel,fifo-size", in at91_twi_probe_master()
901 &dev->fifo_size)) { in at91_twi_probe_master()
902 dev_info(dev->dev, "Using FIFO (%u data)\n", dev->fifo_size); in at91_twi_probe_master()
905 dev->enable_dig_filt = of_property_read_bool(pdev->dev.of_node, in at91_twi_probe_master()
908 dev->enable_ana_filt = of_property_read_bool(pdev->dev.of_node, in at91_twi_probe_master()
910 at91_calc_twi_clock(dev); in at91_twi_probe_master()
912 rc = at91_init_twi_recovery_info(pdev, dev); in at91_twi_probe_master()
916 dev->adapter.algo = &at91_twi_algorithm; in at91_twi_probe_master()
917 dev->adapter.quirks = &at91_twi_quirks; in at91_twi_probe_master()