Lines Matching full:pd
144 int (*setup)(struct sh_mobile_i2c_data *pd);
188 static void iic_wr(struct sh_mobile_i2c_data *pd, int offs, unsigned char data) in iic_wr() argument
191 data |= pd->icic; in iic_wr()
193 iowrite8(data, pd->reg + offs); in iic_wr()
196 static unsigned char iic_rd(struct sh_mobile_i2c_data *pd, int offs) in iic_rd() argument
198 return ioread8(pd->reg + offs); in iic_rd()
201 static void iic_set_clr(struct sh_mobile_i2c_data *pd, int offs, in iic_set_clr() argument
204 iic_wr(pd, offs, (iic_rd(pd, offs) | set) & ~clr); in iic_set_clr()
241 static int sh_mobile_i2c_check_timing(struct sh_mobile_i2c_data *pd) in sh_mobile_i2c_check_timing() argument
243 u16 max_val = pd->flags & IIC_FLAG_HAS_ICIC67 ? 0x1ff : 0xff; in sh_mobile_i2c_check_timing()
245 if (pd->iccl > max_val || pd->icch > max_val) { in sh_mobile_i2c_check_timing()
246 dev_err(pd->dev, "timing values out of range: L/H=0x%x/0x%x\n", in sh_mobile_i2c_check_timing()
247 pd->iccl, pd->icch); in sh_mobile_i2c_check_timing()
252 if (pd->iccl & 0x100) in sh_mobile_i2c_check_timing()
253 pd->icic |= ICIC_ICCLB8; in sh_mobile_i2c_check_timing()
255 pd->icic &= ~ICIC_ICCLB8; in sh_mobile_i2c_check_timing()
258 if (pd->icch & 0x100) in sh_mobile_i2c_check_timing()
259 pd->icic |= ICIC_ICCHB8; in sh_mobile_i2c_check_timing()
261 pd->icic &= ~ICIC_ICCHB8; in sh_mobile_i2c_check_timing()
263 dev_dbg(pd->dev, "timing values: L/H=0x%x/0x%x\n", pd->iccl, pd->icch); in sh_mobile_i2c_check_timing()
267 static int sh_mobile_i2c_init(struct sh_mobile_i2c_data *pd) in sh_mobile_i2c_init() argument
272 i2c_clk_khz = clk_get_rate(pd->clk) / 1000 / pd->clks_per_count; in sh_mobile_i2c_init()
274 if (pd->bus_speed == STANDARD_MODE) { in sh_mobile_i2c_init()
278 } else if (pd->bus_speed == FAST_MODE) { in sh_mobile_i2c_init()
283 dev_err(pd->dev, "unrecognized bus speed %lu Hz\n", in sh_mobile_i2c_init()
284 pd->bus_speed); in sh_mobile_i2c_init()
288 pd->iccl = sh_mobile_i2c_iccl(i2c_clk_khz, tLOW, tf); in sh_mobile_i2c_init()
289 pd->icch = sh_mobile_i2c_icch(i2c_clk_khz, tHIGH, tf); in sh_mobile_i2c_init()
291 return sh_mobile_i2c_check_timing(pd); in sh_mobile_i2c_init()
294 static int sh_mobile_i2c_v2_init(struct sh_mobile_i2c_data *pd) in sh_mobile_i2c_v2_init() argument
299 clks_per_cycle = clk_get_rate(pd->clk) / pd->bus_speed; in sh_mobile_i2c_v2_init()
300 pd->iccl = DIV_ROUND_UP(clks_per_cycle * 5 / 9 - 1, pd->clks_per_count); in sh_mobile_i2c_v2_init()
301 pd->icch = DIV_ROUND_UP(clks_per_cycle * 4 / 9 - 5, pd->clks_per_count); in sh_mobile_i2c_v2_init()
303 return sh_mobile_i2c_check_timing(pd); in sh_mobile_i2c_v2_init()
306 static unsigned char i2c_op(struct sh_mobile_i2c_data *pd, in i2c_op() argument
312 dev_dbg(pd->dev, "op %d, data in 0x%02x\n", op, data); in i2c_op()
314 spin_lock_irqsave(&pd->lock, flags); in i2c_op()
318 iic_wr(pd, ICCR, ICCR_ICE | ICCR_TRS | ICCR_BBSY); in i2c_op()
321 iic_wr(pd, ICIC, ICIC_WAITE | ICIC_ALE | ICIC_TACKE); in i2c_op()
322 iic_wr(pd, ICDR, data); in i2c_op()
325 iic_wr(pd, ICDR, data); in i2c_op()
328 iic_wr(pd, ICCR, pd->send_stop ? ICCR_ICE | ICCR_TRS in i2c_op()
332 iic_wr(pd, ICCR, ICCR_ICE | ICCR_SCP); in i2c_op()
335 ret = iic_rd(pd, ICDR); in i2c_op()
338 iic_wr(pd, ICIC, in i2c_op()
340 iic_wr(pd, ICCR, ICCR_ICE | ICCR_RACK); in i2c_op()
343 iic_wr(pd, ICIC, in i2c_op()
345 ret = iic_rd(pd, ICDR); in i2c_op()
346 iic_wr(pd, ICCR, ICCR_ICE | ICCR_RACK); in i2c_op()
350 spin_unlock_irqrestore(&pd->lock, flags); in i2c_op()
352 dev_dbg(pd->dev, "op %d, data out 0x%02x\n", op, ret); in i2c_op()
356 static bool sh_mobile_i2c_is_first_byte(struct sh_mobile_i2c_data *pd) in sh_mobile_i2c_is_first_byte() argument
358 return pd->pos == -1; in sh_mobile_i2c_is_first_byte()
361 static void sh_mobile_i2c_get_data(struct sh_mobile_i2c_data *pd, in sh_mobile_i2c_get_data() argument
364 switch (pd->pos) { in sh_mobile_i2c_get_data()
366 *buf = i2c_8bit_addr_from_msg(pd->msg); in sh_mobile_i2c_get_data()
369 *buf = pd->msg->buf[pd->pos]; in sh_mobile_i2c_get_data()
373 static int sh_mobile_i2c_isr_tx(struct sh_mobile_i2c_data *pd) in sh_mobile_i2c_isr_tx() argument
377 if (pd->pos == pd->msg->len) { in sh_mobile_i2c_isr_tx()
378 i2c_op(pd, OP_TX_STOP, 0); in sh_mobile_i2c_isr_tx()
382 sh_mobile_i2c_get_data(pd, &data); in sh_mobile_i2c_isr_tx()
383 i2c_op(pd, sh_mobile_i2c_is_first_byte(pd) ? OP_TX_FIRST : OP_TX, data); in sh_mobile_i2c_isr_tx()
385 pd->pos++; in sh_mobile_i2c_isr_tx()
389 static int sh_mobile_i2c_isr_rx(struct sh_mobile_i2c_data *pd) in sh_mobile_i2c_isr_rx() argument
395 if (pd->pos <= -1) { in sh_mobile_i2c_isr_rx()
396 sh_mobile_i2c_get_data(pd, &data); in sh_mobile_i2c_isr_rx()
398 if (sh_mobile_i2c_is_first_byte(pd)) in sh_mobile_i2c_isr_rx()
399 i2c_op(pd, OP_TX_FIRST, data); in sh_mobile_i2c_isr_rx()
401 i2c_op(pd, OP_TX, data); in sh_mobile_i2c_isr_rx()
405 if (pd->pos == 0) { in sh_mobile_i2c_isr_rx()
406 i2c_op(pd, OP_TX_TO_RX, 0); in sh_mobile_i2c_isr_rx()
410 real_pos = pd->pos - 2; in sh_mobile_i2c_isr_rx()
412 if (pd->pos == pd->msg->len) { in sh_mobile_i2c_isr_rx()
413 if (pd->stop_after_dma) { in sh_mobile_i2c_isr_rx()
415 i2c_op(pd, OP_RX_STOP, 0); in sh_mobile_i2c_isr_rx()
416 pd->pos++; in sh_mobile_i2c_isr_rx()
421 i2c_op(pd, OP_RX_STOP, 0); in sh_mobile_i2c_isr_rx()
424 data = i2c_op(pd, OP_RX_STOP_DATA, 0); in sh_mobile_i2c_isr_rx()
426 data = i2c_op(pd, OP_RX, 0); in sh_mobile_i2c_isr_rx()
430 pd->msg->buf[real_pos] = data; in sh_mobile_i2c_isr_rx()
433 pd->pos++; in sh_mobile_i2c_isr_rx()
434 return pd->pos == (pd->msg->len + 2); in sh_mobile_i2c_isr_rx()
439 struct sh_mobile_i2c_data *pd = dev_id; in sh_mobile_i2c_isr() local
443 sr = iic_rd(pd, ICSR); in sh_mobile_i2c_isr()
444 pd->sr |= sr; /* remember state */ in sh_mobile_i2c_isr()
446 dev_dbg(pd->dev, "i2c_isr 0x%02x 0x%02x %s %d %d!\n", sr, pd->sr, in sh_mobile_i2c_isr()
447 (pd->msg->flags & I2C_M_RD) ? "read" : "write", in sh_mobile_i2c_isr()
448 pd->pos, pd->msg->len); in sh_mobile_i2c_isr()
451 if (pd->dma_direction == DMA_TO_DEVICE && pd->pos == 0) in sh_mobile_i2c_isr()
452 iic_set_clr(pd, ICIC, ICIC_TDMAE, 0); in sh_mobile_i2c_isr()
455 iic_wr(pd, ICSR, sr & ~(ICSR_AL | ICSR_TACK)); in sh_mobile_i2c_isr()
456 else if (pd->msg->flags & I2C_M_RD) in sh_mobile_i2c_isr()
457 wakeup = sh_mobile_i2c_isr_rx(pd); in sh_mobile_i2c_isr()
459 wakeup = sh_mobile_i2c_isr_tx(pd); in sh_mobile_i2c_isr()
462 if (pd->dma_direction == DMA_FROM_DEVICE && pd->pos == 1) in sh_mobile_i2c_isr()
463 iic_set_clr(pd, ICIC, ICIC_RDMAE, 0); in sh_mobile_i2c_isr()
466 iic_wr(pd, ICSR, sr & ~ICSR_WAIT); in sh_mobile_i2c_isr()
469 pd->sr |= SW_DONE; in sh_mobile_i2c_isr()
470 wake_up(&pd->wait); in sh_mobile_i2c_isr()
474 iic_rd(pd, ICSR); in sh_mobile_i2c_isr()
479 static void sh_mobile_i2c_dma_unmap(struct sh_mobile_i2c_data *pd) in sh_mobile_i2c_dma_unmap() argument
481 struct dma_chan *chan = pd->dma_direction == DMA_FROM_DEVICE in sh_mobile_i2c_dma_unmap()
482 ? pd->dma_rx : pd->dma_tx; in sh_mobile_i2c_dma_unmap()
484 dma_unmap_single(chan->device->dev, sg_dma_address(&pd->sg), in sh_mobile_i2c_dma_unmap()
485 pd->msg->len, pd->dma_direction); in sh_mobile_i2c_dma_unmap()
487 pd->dma_direction = DMA_NONE; in sh_mobile_i2c_dma_unmap()
490 static void sh_mobile_i2c_cleanup_dma(struct sh_mobile_i2c_data *pd) in sh_mobile_i2c_cleanup_dma() argument
492 if (pd->dma_direction == DMA_NONE) in sh_mobile_i2c_cleanup_dma()
494 else if (pd->dma_direction == DMA_FROM_DEVICE) in sh_mobile_i2c_cleanup_dma()
495 dmaengine_terminate_all(pd->dma_rx); in sh_mobile_i2c_cleanup_dma()
496 else if (pd->dma_direction == DMA_TO_DEVICE) in sh_mobile_i2c_cleanup_dma()
497 dmaengine_terminate_all(pd->dma_tx); in sh_mobile_i2c_cleanup_dma()
499 sh_mobile_i2c_dma_unmap(pd); in sh_mobile_i2c_cleanup_dma()
504 struct sh_mobile_i2c_data *pd = data; in sh_mobile_i2c_dma_callback() local
506 sh_mobile_i2c_dma_unmap(pd); in sh_mobile_i2c_dma_callback()
507 pd->pos = pd->msg->len; in sh_mobile_i2c_dma_callback()
508 pd->stop_after_dma = true; in sh_mobile_i2c_dma_callback()
510 iic_set_clr(pd, ICIC, 0, ICIC_TDMAE | ICIC_RDMAE); in sh_mobile_i2c_dma_callback()
549 static void sh_mobile_i2c_xfer_dma(struct sh_mobile_i2c_data *pd) in sh_mobile_i2c_xfer_dma() argument
551 bool read = pd->msg->flags & I2C_M_RD; in sh_mobile_i2c_xfer_dma()
553 struct dma_chan *chan = read ? pd->dma_rx : pd->dma_tx; in sh_mobile_i2c_xfer_dma()
560 chan = pd->dma_rx = sh_mobile_i2c_request_dma_chan(pd->dev, DMA_DEV_TO_MEM, in sh_mobile_i2c_xfer_dma()
561 pd->res->start + ICDR); in sh_mobile_i2c_xfer_dma()
563 chan = pd->dma_tx = sh_mobile_i2c_request_dma_chan(pd->dev, DMA_MEM_TO_DEV, in sh_mobile_i2c_xfer_dma()
564 pd->res->start + ICDR); in sh_mobile_i2c_xfer_dma()
570 dma_addr = dma_map_single(chan->device->dev, pd->dma_buf, pd->msg->len, dir); in sh_mobile_i2c_xfer_dma()
572 dev_dbg(pd->dev, "dma map failed, using PIO\n"); in sh_mobile_i2c_xfer_dma()
576 sg_dma_len(&pd->sg) = pd->msg->len; in sh_mobile_i2c_xfer_dma()
577 sg_dma_address(&pd->sg) = dma_addr; in sh_mobile_i2c_xfer_dma()
579 pd->dma_direction = dir; in sh_mobile_i2c_xfer_dma()
581 txdesc = dmaengine_prep_slave_sg(chan, &pd->sg, 1, in sh_mobile_i2c_xfer_dma()
585 dev_dbg(pd->dev, "dma prep slave sg failed, using PIO\n"); in sh_mobile_i2c_xfer_dma()
586 sh_mobile_i2c_cleanup_dma(pd); in sh_mobile_i2c_xfer_dma()
591 txdesc->callback_param = pd; in sh_mobile_i2c_xfer_dma()
595 dev_dbg(pd->dev, "submitting dma failed, using PIO\n"); in sh_mobile_i2c_xfer_dma()
596 sh_mobile_i2c_cleanup_dma(pd); in sh_mobile_i2c_xfer_dma()
603 static void start_ch(struct sh_mobile_i2c_data *pd, struct i2c_msg *usr_msg, in start_ch() argument
608 iic_wr(pd, ICCR, ICCR_SCP); in start_ch()
611 iic_wr(pd, ICCR, ICCR_ICE | ICCR_SCP); in start_ch()
614 iic_wr(pd, ICCL, pd->iccl & 0xff); in start_ch()
615 iic_wr(pd, ICCH, pd->icch & 0xff); in start_ch()
618 pd->msg = usr_msg; in start_ch()
619 pd->pos = -1; in start_ch()
620 pd->sr = 0; in start_ch()
622 pd->dma_buf = i2c_get_dma_safe_msg_buf(pd->msg, 8); in start_ch()
623 if (pd->dma_buf) in start_ch()
624 sh_mobile_i2c_xfer_dma(pd); in start_ch()
627 iic_wr(pd, ICIC, ICIC_DTEE | ICIC_WAITE | ICIC_ALE | ICIC_TACKE); in start_ch()
630 static int poll_dte(struct sh_mobile_i2c_data *pd) in poll_dte() argument
635 u_int8_t val = iic_rd(pd, ICSR); in poll_dte()
649 static int poll_busy(struct sh_mobile_i2c_data *pd) in poll_busy() argument
654 u_int8_t val = iic_rd(pd, ICSR); in poll_busy()
656 dev_dbg(pd->dev, "val 0x%02x pd->sr 0x%02x\n", val, pd->sr); in poll_busy()
664 val |= pd->sr; in poll_busy()
682 struct sh_mobile_i2c_data *pd = i2c_get_adapdata(adapter); in sh_mobile_i2c_xfer() local
689 pm_runtime_get_sync(pd->dev); in sh_mobile_i2c_xfer()
693 bool do_start = pd->send_stop || !i; in sh_mobile_i2c_xfer()
695 pd->send_stop = i == num - 1 || msg->flags & I2C_M_STOP; in sh_mobile_i2c_xfer()
696 pd->stop_after_dma = false; in sh_mobile_i2c_xfer()
698 start_ch(pd, msg, do_start); in sh_mobile_i2c_xfer()
701 i2c_op(pd, OP_START, 0); in sh_mobile_i2c_xfer()
704 timeout = wait_event_timeout(pd->wait, in sh_mobile_i2c_xfer()
705 pd->sr & (ICSR_TACK | SW_DONE), in sh_mobile_i2c_xfer()
709 i2c_put_dma_safe_msg_buf(pd->dma_buf, pd->msg, pd->stop_after_dma); in sh_mobile_i2c_xfer()
712 dev_err(pd->dev, "Transfer request timed out\n"); in sh_mobile_i2c_xfer()
713 if (pd->dma_direction != DMA_NONE) in sh_mobile_i2c_xfer()
714 sh_mobile_i2c_cleanup_dma(pd); in sh_mobile_i2c_xfer()
720 if (pd->send_stop) in sh_mobile_i2c_xfer()
721 err = poll_busy(pd); in sh_mobile_i2c_xfer()
723 err = poll_dte(pd); in sh_mobile_i2c_xfer()
729 iic_wr(pd, ICCR, ICCR_SCP); in sh_mobile_i2c_xfer()
732 pm_runtime_put_sync(pd->dev); in sh_mobile_i2c_xfer()
755 static int sh_mobile_i2c_r8a7740_workaround(struct sh_mobile_i2c_data *pd) in sh_mobile_i2c_r8a7740_workaround() argument
757 iic_set_clr(pd, ICCR, ICCR_ICE, 0); in sh_mobile_i2c_r8a7740_workaround()
758 iic_rd(pd, ICCR); /* dummy read */ in sh_mobile_i2c_r8a7740_workaround()
760 iic_set_clr(pd, ICSTART, ICSTART_ICSTART, 0); in sh_mobile_i2c_r8a7740_workaround()
761 iic_rd(pd, ICSTART); /* dummy read */ in sh_mobile_i2c_r8a7740_workaround()
765 iic_wr(pd, ICCR, ICCR_SCP); in sh_mobile_i2c_r8a7740_workaround()
766 iic_wr(pd, ICSTART, 0); in sh_mobile_i2c_r8a7740_workaround()
770 iic_wr(pd, ICCR, ICCR_TRS); in sh_mobile_i2c_r8a7740_workaround()
772 iic_wr(pd, ICCR, 0); in sh_mobile_i2c_r8a7740_workaround()
774 iic_wr(pd, ICCR, ICCR_TRS); in sh_mobile_i2c_r8a7740_workaround()
777 return sh_mobile_i2c_init(pd); in sh_mobile_i2c_r8a7740_workaround()
819 static void sh_mobile_i2c_release_dma(struct sh_mobile_i2c_data *pd) in sh_mobile_i2c_release_dma() argument
821 if (!IS_ERR(pd->dma_tx)) { in sh_mobile_i2c_release_dma()
822 dma_release_channel(pd->dma_tx); in sh_mobile_i2c_release_dma()
823 pd->dma_tx = ERR_PTR(-EPROBE_DEFER); in sh_mobile_i2c_release_dma()
826 if (!IS_ERR(pd->dma_rx)) { in sh_mobile_i2c_release_dma()
827 dma_release_channel(pd->dma_rx); in sh_mobile_i2c_release_dma()
828 pd->dma_rx = ERR_PTR(-EPROBE_DEFER); in sh_mobile_i2c_release_dma()
832 static int sh_mobile_i2c_hook_irqs(struct platform_device *dev, struct sh_mobile_i2c_data *pd) in sh_mobile_i2c_hook_irqs() argument
841 0, dev_name(&dev->dev), pd); in sh_mobile_i2c_hook_irqs()
855 struct sh_mobile_i2c_data *pd; in sh_mobile_i2c_probe() local
862 pd = devm_kzalloc(&dev->dev, sizeof(struct sh_mobile_i2c_data), GFP_KERNEL); in sh_mobile_i2c_probe()
863 if (!pd) in sh_mobile_i2c_probe()
866 pd->clk = devm_clk_get(&dev->dev, NULL); in sh_mobile_i2c_probe()
867 if (IS_ERR(pd->clk)) { in sh_mobile_i2c_probe()
869 return PTR_ERR(pd->clk); in sh_mobile_i2c_probe()
872 ret = sh_mobile_i2c_hook_irqs(dev, pd); in sh_mobile_i2c_probe()
876 pd->dev = &dev->dev; in sh_mobile_i2c_probe()
877 platform_set_drvdata(dev, pd); in sh_mobile_i2c_probe()
881 pd->res = res; in sh_mobile_i2c_probe()
882 pd->reg = devm_ioremap_resource(&dev->dev, res); in sh_mobile_i2c_probe()
883 if (IS_ERR(pd->reg)) in sh_mobile_i2c_probe()
884 return PTR_ERR(pd->reg); in sh_mobile_i2c_probe()
887 pd->bus_speed = (ret || !bus_speed) ? STANDARD_MODE : bus_speed; in sh_mobile_i2c_probe()
888 pd->clks_per_count = 1; in sh_mobile_i2c_probe()
892 pd->flags |= IIC_FLAG_HAS_ICIC67; in sh_mobile_i2c_probe()
899 pd->clks_per_count = config->clks_per_count; in sh_mobile_i2c_probe()
900 ret = config->setup(pd); in sh_mobile_i2c_probe()
902 ret = sh_mobile_i2c_init(pd); in sh_mobile_i2c_probe()
910 sg_init_table(&pd->sg, 1); in sh_mobile_i2c_probe()
911 pd->dma_direction = DMA_NONE; in sh_mobile_i2c_probe()
912 pd->dma_rx = pd->dma_tx = ERR_PTR(-EPROBE_DEFER); in sh_mobile_i2c_probe()
915 adap = &pd->adap; in sh_mobile_i2c_probe()
916 i2c_set_adapdata(adap, pd); in sh_mobile_i2c_probe()
928 spin_lock_init(&pd->lock); in sh_mobile_i2c_probe()
929 init_waitqueue_head(&pd->wait); in sh_mobile_i2c_probe()
933 sh_mobile_i2c_release_dma(pd); in sh_mobile_i2c_probe()
937 dev_info(&dev->dev, "I2C adapter %d, bus speed %lu Hz\n", adap->nr, pd->bus_speed); in sh_mobile_i2c_probe()
944 struct sh_mobile_i2c_data *pd = platform_get_drvdata(dev); in sh_mobile_i2c_remove() local
946 i2c_del_adapter(&pd->adap); in sh_mobile_i2c_remove()
947 sh_mobile_i2c_release_dma(pd); in sh_mobile_i2c_remove()