Lines Matching refs:drv_data
177 mv64xxx_i2c_prepare_for_io(struct mv64xxx_i2c_data *drv_data, in mv64xxx_i2c_prepare_for_io() argument
182 drv_data->cntl_bits = MV64XXX_I2C_REG_CONTROL_ACK | in mv64xxx_i2c_prepare_for_io()
185 if (!drv_data->atomic) in mv64xxx_i2c_prepare_for_io()
186 drv_data->cntl_bits |= MV64XXX_I2C_REG_CONTROL_INTEN; in mv64xxx_i2c_prepare_for_io()
192 drv_data->addr1 = 0xf0 | (((u32)msg->addr & 0x300) >> 7) | dir; in mv64xxx_i2c_prepare_for_io()
193 drv_data->addr2 = (u32)msg->addr & 0xff; in mv64xxx_i2c_prepare_for_io()
195 drv_data->addr1 = MV64XXX_I2C_ADDR_ADDR((u32)msg->addr) | dir; in mv64xxx_i2c_prepare_for_io()
196 drv_data->addr2 = 0; in mv64xxx_i2c_prepare_for_io()
210 mv64xxx_i2c_hw_init(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_hw_init() argument
212 if (drv_data->offload_enabled) { in mv64xxx_i2c_hw_init()
213 writel(0, drv_data->reg_base + MV64XXX_I2C_REG_BRIDGE_CONTROL); in mv64xxx_i2c_hw_init()
214 writel(0, drv_data->reg_base + MV64XXX_I2C_REG_BRIDGE_TIMING); in mv64xxx_i2c_hw_init()
215 writel(0, drv_data->reg_base + in mv64xxx_i2c_hw_init()
217 writel(0, drv_data->reg_base + in mv64xxx_i2c_hw_init()
221 writel(0, drv_data->reg_base + drv_data->reg_offsets.soft_reset); in mv64xxx_i2c_hw_init()
222 writel(MV64XXX_I2C_BAUD_DIV_M(drv_data->freq_m) | MV64XXX_I2C_BAUD_DIV_N(drv_data->freq_n), in mv64xxx_i2c_hw_init()
223 drv_data->reg_base + drv_data->reg_offsets.clock); in mv64xxx_i2c_hw_init()
224 writel(0, drv_data->reg_base + drv_data->reg_offsets.addr); in mv64xxx_i2c_hw_init()
225 writel(0, drv_data->reg_base + drv_data->reg_offsets.ext_addr); in mv64xxx_i2c_hw_init()
227 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_hw_init()
229 if (drv_data->errata_delay) in mv64xxx_i2c_hw_init()
232 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_hw_init()
236 mv64xxx_i2c_fsm(struct mv64xxx_i2c_data *drv_data, u32 status) in mv64xxx_i2c_fsm() argument
243 if (drv_data->state == MV64XXX_I2C_STATE_IDLE) { in mv64xxx_i2c_fsm()
244 drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP; in mv64xxx_i2c_fsm()
253 drv_data->action = MV64XXX_I2C_ACTION_SEND_ADDR_1; in mv64xxx_i2c_fsm()
254 drv_data->state = MV64XXX_I2C_STATE_WAITING_FOR_ADDR_1_ACK; in mv64xxx_i2c_fsm()
259 if (drv_data->msg->flags & I2C_M_TEN) { in mv64xxx_i2c_fsm()
260 drv_data->action = MV64XXX_I2C_ACTION_SEND_ADDR_2; in mv64xxx_i2c_fsm()
261 drv_data->state = in mv64xxx_i2c_fsm()
268 if ((drv_data->bytes_left == 0) in mv64xxx_i2c_fsm()
269 || (drv_data->aborting in mv64xxx_i2c_fsm()
270 && (drv_data->byte_posn != 0))) { in mv64xxx_i2c_fsm()
271 if (drv_data->send_stop || drv_data->aborting) { in mv64xxx_i2c_fsm()
272 drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP; in mv64xxx_i2c_fsm()
273 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_fsm()
275 drv_data->action = in mv64xxx_i2c_fsm()
277 drv_data->state = in mv64xxx_i2c_fsm()
281 drv_data->action = MV64XXX_I2C_ACTION_SEND_DATA; in mv64xxx_i2c_fsm()
282 drv_data->state = in mv64xxx_i2c_fsm()
284 drv_data->bytes_left--; in mv64xxx_i2c_fsm()
290 if (drv_data->msg->flags & I2C_M_TEN) { in mv64xxx_i2c_fsm()
291 drv_data->action = MV64XXX_I2C_ACTION_SEND_ADDR_2; in mv64xxx_i2c_fsm()
292 drv_data->state = in mv64xxx_i2c_fsm()
298 if (drv_data->bytes_left == 0) { in mv64xxx_i2c_fsm()
299 drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP; in mv64xxx_i2c_fsm()
300 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_fsm()
306 drv_data->action = MV64XXX_I2C_ACTION_CONTINUE; in mv64xxx_i2c_fsm()
308 drv_data->action = MV64XXX_I2C_ACTION_RCV_DATA; in mv64xxx_i2c_fsm()
309 drv_data->bytes_left--; in mv64xxx_i2c_fsm()
311 drv_data->state = MV64XXX_I2C_STATE_WAITING_FOR_SLAVE_DATA; in mv64xxx_i2c_fsm()
313 if ((drv_data->bytes_left == 1) || drv_data->aborting) in mv64xxx_i2c_fsm()
314 drv_data->cntl_bits &= ~MV64XXX_I2C_REG_CONTROL_ACK; in mv64xxx_i2c_fsm()
318 drv_data->action = MV64XXX_I2C_ACTION_RCV_DATA_STOP; in mv64xxx_i2c_fsm()
319 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_fsm()
326 drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP; in mv64xxx_i2c_fsm()
327 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_fsm()
328 drv_data->rc = -ENXIO; in mv64xxx_i2c_fsm()
332 dev_err(&drv_data->adapter.dev, in mv64xxx_i2c_fsm()
335 drv_data->state, status, drv_data->msg->addr, in mv64xxx_i2c_fsm()
336 drv_data->msg->flags); in mv64xxx_i2c_fsm()
337 drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP; in mv64xxx_i2c_fsm()
338 mv64xxx_i2c_hw_init(drv_data); in mv64xxx_i2c_fsm()
339 i2c_recover_bus(&drv_data->adapter); in mv64xxx_i2c_fsm()
340 drv_data->rc = -EAGAIN; in mv64xxx_i2c_fsm()
344 static void mv64xxx_i2c_send_start(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_send_start() argument
346 drv_data->msg = drv_data->msgs; in mv64xxx_i2c_send_start()
347 drv_data->byte_posn = 0; in mv64xxx_i2c_send_start()
348 drv_data->bytes_left = drv_data->msg->len; in mv64xxx_i2c_send_start()
349 drv_data->aborting = 0; in mv64xxx_i2c_send_start()
350 drv_data->rc = 0; in mv64xxx_i2c_send_start()
352 mv64xxx_i2c_prepare_for_io(drv_data, drv_data->msgs); in mv64xxx_i2c_send_start()
353 writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_START, in mv64xxx_i2c_send_start()
354 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_send_start()
358 mv64xxx_i2c_do_action(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_do_action() argument
360 switch(drv_data->action) { in mv64xxx_i2c_do_action()
363 BUG_ON(drv_data->num_msgs == 0); in mv64xxx_i2c_do_action()
365 drv_data->msgs++; in mv64xxx_i2c_do_action()
366 drv_data->num_msgs--; in mv64xxx_i2c_do_action()
367 mv64xxx_i2c_send_start(drv_data); in mv64xxx_i2c_do_action()
369 if (drv_data->errata_delay) in mv64xxx_i2c_do_action()
377 drv_data->send_stop = drv_data->num_msgs == 1; in mv64xxx_i2c_do_action()
381 writel(drv_data->cntl_bits, in mv64xxx_i2c_do_action()
382 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
386 writel(drv_data->addr1, in mv64xxx_i2c_do_action()
387 drv_data->reg_base + drv_data->reg_offsets.data); in mv64xxx_i2c_do_action()
388 writel(drv_data->cntl_bits, in mv64xxx_i2c_do_action()
389 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
393 writel(drv_data->addr2, in mv64xxx_i2c_do_action()
394 drv_data->reg_base + drv_data->reg_offsets.data); in mv64xxx_i2c_do_action()
395 writel(drv_data->cntl_bits, in mv64xxx_i2c_do_action()
396 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
400 writel(drv_data->msg->buf[drv_data->byte_posn++], in mv64xxx_i2c_do_action()
401 drv_data->reg_base + drv_data->reg_offsets.data); in mv64xxx_i2c_do_action()
402 writel(drv_data->cntl_bits, in mv64xxx_i2c_do_action()
403 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
407 drv_data->msg->buf[drv_data->byte_posn++] = in mv64xxx_i2c_do_action()
408 readl(drv_data->reg_base + drv_data->reg_offsets.data); in mv64xxx_i2c_do_action()
409 writel(drv_data->cntl_bits, in mv64xxx_i2c_do_action()
410 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
414 drv_data->msg->buf[drv_data->byte_posn++] = in mv64xxx_i2c_do_action()
415 readl(drv_data->reg_base + drv_data->reg_offsets.data); in mv64xxx_i2c_do_action()
416 if (!drv_data->atomic) in mv64xxx_i2c_do_action()
417 drv_data->cntl_bits &= ~MV64XXX_I2C_REG_CONTROL_INTEN; in mv64xxx_i2c_do_action()
418 writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_STOP, in mv64xxx_i2c_do_action()
419 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
420 drv_data->block = 0; in mv64xxx_i2c_do_action()
421 if (drv_data->errata_delay) in mv64xxx_i2c_do_action()
424 wake_up(&drv_data->waitq); in mv64xxx_i2c_do_action()
429 dev_err(&drv_data->adapter.dev, in mv64xxx_i2c_do_action()
431 drv_data->action); in mv64xxx_i2c_do_action()
432 drv_data->rc = -EIO; in mv64xxx_i2c_do_action()
435 if (!drv_data->atomic) in mv64xxx_i2c_do_action()
436 drv_data->cntl_bits &= ~MV64XXX_I2C_REG_CONTROL_INTEN; in mv64xxx_i2c_do_action()
437 writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_STOP, in mv64xxx_i2c_do_action()
438 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
439 drv_data->block = 0; in mv64xxx_i2c_do_action()
440 wake_up(&drv_data->waitq); in mv64xxx_i2c_do_action()
446 mv64xxx_i2c_read_offload_rx_data(struct mv64xxx_i2c_data *drv_data, in mv64xxx_i2c_read_offload_rx_data() argument
451 buf[0] = readl(drv_data->reg_base + MV64XXX_I2C_REG_RX_DATA_LO); in mv64xxx_i2c_read_offload_rx_data()
452 buf[1] = readl(drv_data->reg_base + MV64XXX_I2C_REG_RX_DATA_HI); in mv64xxx_i2c_read_offload_rx_data()
458 mv64xxx_i2c_intr_offload(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_intr_offload() argument
462 cause = readl(drv_data->reg_base + in mv64xxx_i2c_intr_offload()
467 status = readl(drv_data->reg_base + in mv64xxx_i2c_intr_offload()
471 drv_data->rc = -EIO; in mv64xxx_i2c_intr_offload()
475 drv_data->rc = 0; in mv64xxx_i2c_intr_offload()
481 if (drv_data->num_msgs == 1 && drv_data->msgs[0].flags & I2C_M_RD) { in mv64xxx_i2c_intr_offload()
482 mv64xxx_i2c_read_offload_rx_data(drv_data, drv_data->msgs); in mv64xxx_i2c_intr_offload()
483 drv_data->msgs++; in mv64xxx_i2c_intr_offload()
484 drv_data->num_msgs--; in mv64xxx_i2c_intr_offload()
490 else if (drv_data->num_msgs == 2 && in mv64xxx_i2c_intr_offload()
491 !(drv_data->msgs[0].flags & I2C_M_RD) && in mv64xxx_i2c_intr_offload()
492 drv_data->msgs[1].flags & I2C_M_RD) { in mv64xxx_i2c_intr_offload()
493 mv64xxx_i2c_read_offload_rx_data(drv_data, drv_data->msgs + 1); in mv64xxx_i2c_intr_offload()
494 drv_data->msgs += 2; in mv64xxx_i2c_intr_offload()
495 drv_data->num_msgs -= 2; in mv64xxx_i2c_intr_offload()
499 writel(0, drv_data->reg_base + MV64XXX_I2C_REG_BRIDGE_CONTROL); in mv64xxx_i2c_intr_offload()
500 writel(0, drv_data->reg_base + in mv64xxx_i2c_intr_offload()
502 drv_data->block = 0; in mv64xxx_i2c_intr_offload()
504 wake_up(&drv_data->waitq); in mv64xxx_i2c_intr_offload()
512 struct mv64xxx_i2c_data *drv_data = dev_id; in mv64xxx_i2c_intr() local
516 spin_lock(&drv_data->lock); in mv64xxx_i2c_intr()
518 if (drv_data->offload_enabled) in mv64xxx_i2c_intr()
519 rc = mv64xxx_i2c_intr_offload(drv_data); in mv64xxx_i2c_intr()
521 while (readl(drv_data->reg_base + drv_data->reg_offsets.control) & in mv64xxx_i2c_intr()
523 status = readl(drv_data->reg_base + drv_data->reg_offsets.status); in mv64xxx_i2c_intr()
524 mv64xxx_i2c_fsm(drv_data, status); in mv64xxx_i2c_intr()
525 mv64xxx_i2c_do_action(drv_data); in mv64xxx_i2c_intr()
527 if (drv_data->irq_clear_inverted) in mv64xxx_i2c_intr()
528 writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_IFLG, in mv64xxx_i2c_intr()
529 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_intr()
533 spin_unlock(&drv_data->lock); in mv64xxx_i2c_intr()
546 mv64xxx_i2c_wait_for_completion(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_wait_for_completion() argument
552 time_left = wait_event_timeout(drv_data->waitq, in mv64xxx_i2c_wait_for_completion()
553 !drv_data->block, drv_data->adapter.timeout); in mv64xxx_i2c_wait_for_completion()
555 spin_lock_irqsave(&drv_data->lock, flags); in mv64xxx_i2c_wait_for_completion()
557 drv_data->rc = -ETIMEDOUT; in mv64xxx_i2c_wait_for_completion()
560 drv_data->rc = time_left; /* errno value */ in mv64xxx_i2c_wait_for_completion()
564 if (abort && drv_data->block) { in mv64xxx_i2c_wait_for_completion()
565 drv_data->aborting = 1; in mv64xxx_i2c_wait_for_completion()
566 spin_unlock_irqrestore(&drv_data->lock, flags); in mv64xxx_i2c_wait_for_completion()
568 time_left = wait_event_timeout(drv_data->waitq, in mv64xxx_i2c_wait_for_completion()
569 !drv_data->block, drv_data->adapter.timeout); in mv64xxx_i2c_wait_for_completion()
571 if ((time_left <= 0) && drv_data->block) { in mv64xxx_i2c_wait_for_completion()
572 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_wait_for_completion()
573 dev_err(&drv_data->adapter.dev, in mv64xxx_i2c_wait_for_completion()
575 "time_left: %d\n", drv_data->block, in mv64xxx_i2c_wait_for_completion()
577 mv64xxx_i2c_hw_init(drv_data); in mv64xxx_i2c_wait_for_completion()
578 i2c_recover_bus(&drv_data->adapter); in mv64xxx_i2c_wait_for_completion()
581 spin_unlock_irqrestore(&drv_data->lock, flags); in mv64xxx_i2c_wait_for_completion()
584 static void mv64xxx_i2c_wait_polling(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_wait_polling() argument
586 ktime_t timeout = ktime_add_ms(ktime_get(), drv_data->adapter.timeout); in mv64xxx_i2c_wait_polling()
588 while (READ_ONCE(drv_data->block) && in mv64xxx_i2c_wait_polling()
591 mv64xxx_i2c_intr(0, drv_data); in mv64xxx_i2c_wait_polling()
596 mv64xxx_i2c_execute_msg(struct mv64xxx_i2c_data *drv_data, struct i2c_msg *msg, in mv64xxx_i2c_execute_msg() argument
601 spin_lock_irqsave(&drv_data->lock, flags); in mv64xxx_i2c_execute_msg()
603 drv_data->state = MV64XXX_I2C_STATE_WAITING_FOR_START_COND; in mv64xxx_i2c_execute_msg()
605 drv_data->send_stop = is_last; in mv64xxx_i2c_execute_msg()
606 drv_data->block = 1; in mv64xxx_i2c_execute_msg()
607 mv64xxx_i2c_send_start(drv_data); in mv64xxx_i2c_execute_msg()
608 spin_unlock_irqrestore(&drv_data->lock, flags); in mv64xxx_i2c_execute_msg()
610 if (!drv_data->atomic) in mv64xxx_i2c_execute_msg()
611 mv64xxx_i2c_wait_for_completion(drv_data); in mv64xxx_i2c_execute_msg()
613 mv64xxx_i2c_wait_polling(drv_data); in mv64xxx_i2c_execute_msg()
615 return drv_data->rc; in mv64xxx_i2c_execute_msg()
619 mv64xxx_i2c_prepare_tx(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_prepare_tx() argument
621 struct i2c_msg *msg = drv_data->msgs; in mv64xxx_i2c_prepare_tx()
626 writel(buf[0], drv_data->reg_base + MV64XXX_I2C_REG_TX_DATA_LO); in mv64xxx_i2c_prepare_tx()
627 writel(buf[1], drv_data->reg_base + MV64XXX_I2C_REG_TX_DATA_HI); in mv64xxx_i2c_prepare_tx()
631 mv64xxx_i2c_offload_xfer(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_offload_xfer() argument
633 struct i2c_msg *msgs = drv_data->msgs; in mv64xxx_i2c_offload_xfer()
634 int num = drv_data->num_msgs; in mv64xxx_i2c_offload_xfer()
638 spin_lock_irqsave(&drv_data->lock, flags); in mv64xxx_i2c_offload_xfer()
653 mv64xxx_i2c_prepare_tx(drv_data); in mv64xxx_i2c_offload_xfer()
676 mv64xxx_i2c_prepare_tx(drv_data); in mv64xxx_i2c_offload_xfer()
680 drv_data->block = 1; in mv64xxx_i2c_offload_xfer()
681 writel(ctrl_reg, drv_data->reg_base + MV64XXX_I2C_REG_BRIDGE_CONTROL); in mv64xxx_i2c_offload_xfer()
682 spin_unlock_irqrestore(&drv_data->lock, flags); in mv64xxx_i2c_offload_xfer()
684 mv64xxx_i2c_wait_for_completion(drv_data); in mv64xxx_i2c_offload_xfer()
686 return drv_data->rc; in mv64xxx_i2c_offload_xfer()
696 mv64xxx_i2c_can_offload(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_can_offload() argument
698 struct i2c_msg *msgs = drv_data->msgs; in mv64xxx_i2c_can_offload()
699 int num = drv_data->num_msgs; in mv64xxx_i2c_can_offload()
701 if (!drv_data->offload_enabled) in mv64xxx_i2c_can_offload()
743 struct mv64xxx_i2c_data *drv_data = i2c_get_adapdata(adap); in mv64xxx_i2c_xfer_core() local
750 BUG_ON(drv_data->msgs != NULL); in mv64xxx_i2c_xfer_core()
751 drv_data->msgs = msgs; in mv64xxx_i2c_xfer_core()
752 drv_data->num_msgs = num; in mv64xxx_i2c_xfer_core()
754 if (mv64xxx_i2c_can_offload(drv_data) && !drv_data->atomic) in mv64xxx_i2c_xfer_core()
755 rc = mv64xxx_i2c_offload_xfer(drv_data); in mv64xxx_i2c_xfer_core()
757 rc = mv64xxx_i2c_execute_msg(drv_data, &msgs[0], num == 1); in mv64xxx_i2c_xfer_core()
762 drv_data->num_msgs = 0; in mv64xxx_i2c_xfer_core()
763 drv_data->msgs = NULL; in mv64xxx_i2c_xfer_core()
774 struct mv64xxx_i2c_data *drv_data = i2c_get_adapdata(adap); in mv64xxx_i2c_xfer() local
776 drv_data->atomic = 0; in mv64xxx_i2c_xfer()
783 struct mv64xxx_i2c_data *drv_data = i2c_get_adapdata(adap); in mv64xxx_i2c_xfer_atomic() local
785 drv_data->atomic = 1; in mv64xxx_i2c_xfer_atomic()
814 mv64xxx_calc_freq(struct mv64xxx_i2c_data *drv_data, in mv64xxx_calc_freq() argument
817 if (drv_data->clk_n_base_0) in mv64xxx_calc_freq()
824 mv64xxx_find_baud_factors(struct mv64xxx_i2c_data *drv_data, in mv64xxx_find_baud_factors() argument
832 freq = mv64xxx_calc_freq(drv_data, tclk, n, m); in mv64xxx_find_baud_factors()
835 drv_data->freq_m = m; in mv64xxx_find_baud_factors()
836 drv_data->freq_n = n; in mv64xxx_find_baud_factors()
848 mv64xxx_of_config(struct mv64xxx_i2c_data *drv_data, in mv64xxx_of_config() argument
860 if (!drv_data->clk) { in mv64xxx_of_config()
864 tclk = clk_get_rate(drv_data->clk); in mv64xxx_of_config()
871 drv_data->clk_n_base_0 = true; in mv64xxx_of_config()
873 if (!mv64xxx_find_baud_factors(drv_data, bus_freq, tclk)) { in mv64xxx_of_config()
878 drv_data->rstc = devm_reset_control_get_optional_exclusive(dev, NULL); in mv64xxx_of_config()
879 if (IS_ERR(drv_data->rstc)) { in mv64xxx_of_config()
880 rc = PTR_ERR(drv_data->rstc); in mv64xxx_of_config()
887 drv_data->adapter.timeout = HZ; in mv64xxx_of_config()
893 memcpy(&drv_data->reg_offsets, device->data, sizeof(drv_data->reg_offsets)); in mv64xxx_of_config()
900 drv_data->offload_enabled = true; in mv64xxx_of_config()
903 drv_data->errata_delay = true; in mv64xxx_of_config()
907 drv_data->offload_enabled = false; in mv64xxx_of_config()
910 drv_data->errata_delay = true; in mv64xxx_of_config()
914 drv_data->irq_clear_inverted = true; in mv64xxx_of_config()
921 mv64xxx_of_config(struct mv64xxx_i2c_data *drv_data, in mv64xxx_of_config() argument
928 static int mv64xxx_i2c_init_recovery_info(struct mv64xxx_i2c_data *drv_data, in mv64xxx_i2c_init_recovery_info() argument
931 struct i2c_bus_recovery_info *rinfo = &drv_data->rinfo; in mv64xxx_i2c_init_recovery_info()
943 drv_data->adapter.bus_recovery_info = rinfo; in mv64xxx_i2c_init_recovery_info()
950 struct mv64xxx_i2c_data *drv_data = dev_get_drvdata(dev); in mv64xxx_i2c_runtime_suspend() local
952 reset_control_assert(drv_data->rstc); in mv64xxx_i2c_runtime_suspend()
953 clk_disable_unprepare(drv_data->reg_clk); in mv64xxx_i2c_runtime_suspend()
954 clk_disable_unprepare(drv_data->clk); in mv64xxx_i2c_runtime_suspend()
962 struct mv64xxx_i2c_data *drv_data = dev_get_drvdata(dev); in mv64xxx_i2c_runtime_resume() local
964 clk_prepare_enable(drv_data->clk); in mv64xxx_i2c_runtime_resume()
965 clk_prepare_enable(drv_data->reg_clk); in mv64xxx_i2c_runtime_resume()
966 reset_control_reset(drv_data->rstc); in mv64xxx_i2c_runtime_resume()
968 mv64xxx_i2c_hw_init(drv_data); in mv64xxx_i2c_runtime_resume()
976 struct mv64xxx_i2c_data *drv_data; in mv64xxx_i2c_probe() local
983 drv_data = devm_kzalloc(&pd->dev, sizeof(struct mv64xxx_i2c_data), in mv64xxx_i2c_probe()
985 if (!drv_data) in mv64xxx_i2c_probe()
988 drv_data->reg_base = devm_platform_ioremap_resource(pd, 0); in mv64xxx_i2c_probe()
989 if (IS_ERR(drv_data->reg_base)) in mv64xxx_i2c_probe()
990 return PTR_ERR(drv_data->reg_base); in mv64xxx_i2c_probe()
992 strscpy(drv_data->adapter.name, MV64XXX_I2C_CTLR_NAME " adapter", in mv64xxx_i2c_probe()
993 sizeof(drv_data->adapter.name)); in mv64xxx_i2c_probe()
995 init_waitqueue_head(&drv_data->waitq); in mv64xxx_i2c_probe()
996 spin_lock_init(&drv_data->lock); in mv64xxx_i2c_probe()
999 drv_data->clk = devm_clk_get(&pd->dev, NULL); in mv64xxx_i2c_probe()
1000 if (IS_ERR(drv_data->clk)) { in mv64xxx_i2c_probe()
1001 if (PTR_ERR(drv_data->clk) == -EPROBE_DEFER) in mv64xxx_i2c_probe()
1003 drv_data->clk = NULL; in mv64xxx_i2c_probe()
1006 drv_data->reg_clk = devm_clk_get(&pd->dev, "reg"); in mv64xxx_i2c_probe()
1007 if (IS_ERR(drv_data->reg_clk)) { in mv64xxx_i2c_probe()
1008 if (PTR_ERR(drv_data->reg_clk) == -EPROBE_DEFER) in mv64xxx_i2c_probe()
1010 drv_data->reg_clk = NULL; in mv64xxx_i2c_probe()
1013 drv_data->irq = platform_get_irq(pd, 0); in mv64xxx_i2c_probe()
1014 if (drv_data->irq < 0) in mv64xxx_i2c_probe()
1015 return drv_data->irq; in mv64xxx_i2c_probe()
1018 drv_data->freq_m = pdata->freq_m; in mv64xxx_i2c_probe()
1019 drv_data->freq_n = pdata->freq_n; in mv64xxx_i2c_probe()
1020 drv_data->adapter.timeout = msecs_to_jiffies(pdata->timeout); in mv64xxx_i2c_probe()
1021 drv_data->offload_enabled = false; in mv64xxx_i2c_probe()
1022 memcpy(&drv_data->reg_offsets, &mv64xxx_i2c_regs_mv64xxx, sizeof(drv_data->reg_offsets)); in mv64xxx_i2c_probe()
1024 rc = mv64xxx_of_config(drv_data, &pd->dev); in mv64xxx_i2c_probe()
1029 rc = mv64xxx_i2c_init_recovery_info(drv_data, &pd->dev); in mv64xxx_i2c_probe()
1033 drv_data->adapter.dev.parent = &pd->dev; in mv64xxx_i2c_probe()
1034 drv_data->adapter.algo = &mv64xxx_i2c_algo; in mv64xxx_i2c_probe()
1035 drv_data->adapter.owner = THIS_MODULE; in mv64xxx_i2c_probe()
1036 drv_data->adapter.class = I2C_CLASS_DEPRECATED; in mv64xxx_i2c_probe()
1037 drv_data->adapter.nr = pd->id; in mv64xxx_i2c_probe()
1038 drv_data->adapter.dev.of_node = pd->dev.of_node; in mv64xxx_i2c_probe()
1039 platform_set_drvdata(pd, drv_data); in mv64xxx_i2c_probe()
1040 i2c_set_adapdata(&drv_data->adapter, drv_data); in mv64xxx_i2c_probe()
1051 rc = request_irq(drv_data->irq, mv64xxx_i2c_intr, 0, in mv64xxx_i2c_probe()
1052 MV64XXX_I2C_CTLR_NAME, drv_data); in mv64xxx_i2c_probe()
1054 dev_err(&drv_data->adapter.dev, in mv64xxx_i2c_probe()
1056 drv_data->irq, rc); in mv64xxx_i2c_probe()
1058 } else if ((rc = i2c_add_numbered_adapter(&drv_data->adapter)) != 0) { in mv64xxx_i2c_probe()
1059 dev_err(&drv_data->adapter.dev, in mv64xxx_i2c_probe()
1067 free_irq(drv_data->irq, drv_data); in mv64xxx_i2c_probe()
1079 struct mv64xxx_i2c_data *drv_data = platform_get_drvdata(pd); in mv64xxx_i2c_remove() local
1081 i2c_del_adapter(&drv_data->adapter); in mv64xxx_i2c_remove()
1082 free_irq(drv_data->irq, drv_data); in mv64xxx_i2c_remove()