Lines Matching refs:drv_data
173 mv64xxx_i2c_prepare_for_io(struct mv64xxx_i2c_data *drv_data, in mv64xxx_i2c_prepare_for_io() argument
178 drv_data->cntl_bits = MV64XXX_I2C_REG_CONTROL_ACK | in mv64xxx_i2c_prepare_for_io()
185 drv_data->addr1 = 0xf0 | (((u32)msg->addr & 0x300) >> 7) | dir; in mv64xxx_i2c_prepare_for_io()
186 drv_data->addr2 = (u32)msg->addr & 0xff; in mv64xxx_i2c_prepare_for_io()
188 drv_data->addr1 = MV64XXX_I2C_ADDR_ADDR((u32)msg->addr) | dir; in mv64xxx_i2c_prepare_for_io()
189 drv_data->addr2 = 0; in mv64xxx_i2c_prepare_for_io()
203 mv64xxx_i2c_hw_init(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_hw_init() argument
205 if (drv_data->offload_enabled) { in mv64xxx_i2c_hw_init()
206 writel(0, drv_data->reg_base + MV64XXX_I2C_REG_BRIDGE_CONTROL); in mv64xxx_i2c_hw_init()
207 writel(0, drv_data->reg_base + MV64XXX_I2C_REG_BRIDGE_TIMING); in mv64xxx_i2c_hw_init()
208 writel(0, drv_data->reg_base + in mv64xxx_i2c_hw_init()
210 writel(0, drv_data->reg_base + in mv64xxx_i2c_hw_init()
214 writel(0, drv_data->reg_base + drv_data->reg_offsets.soft_reset); in mv64xxx_i2c_hw_init()
215 writel(MV64XXX_I2C_BAUD_DIV_M(drv_data->freq_m) | MV64XXX_I2C_BAUD_DIV_N(drv_data->freq_n), in mv64xxx_i2c_hw_init()
216 drv_data->reg_base + drv_data->reg_offsets.clock); in mv64xxx_i2c_hw_init()
217 writel(0, drv_data->reg_base + drv_data->reg_offsets.addr); in mv64xxx_i2c_hw_init()
218 writel(0, drv_data->reg_base + drv_data->reg_offsets.ext_addr); in mv64xxx_i2c_hw_init()
220 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_hw_init()
221 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_hw_init()
225 mv64xxx_i2c_fsm(struct mv64xxx_i2c_data *drv_data, u32 status) in mv64xxx_i2c_fsm() argument
232 if (drv_data->state == MV64XXX_I2C_STATE_IDLE) { in mv64xxx_i2c_fsm()
233 drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP; in mv64xxx_i2c_fsm()
242 drv_data->action = MV64XXX_I2C_ACTION_SEND_ADDR_1; in mv64xxx_i2c_fsm()
243 drv_data->state = MV64XXX_I2C_STATE_WAITING_FOR_ADDR_1_ACK; in mv64xxx_i2c_fsm()
248 if (drv_data->msg->flags & I2C_M_TEN) { in mv64xxx_i2c_fsm()
249 drv_data->action = MV64XXX_I2C_ACTION_SEND_ADDR_2; in mv64xxx_i2c_fsm()
250 drv_data->state = in mv64xxx_i2c_fsm()
257 if ((drv_data->bytes_left == 0) in mv64xxx_i2c_fsm()
258 || (drv_data->aborting in mv64xxx_i2c_fsm()
259 && (drv_data->byte_posn != 0))) { in mv64xxx_i2c_fsm()
260 if (drv_data->send_stop || drv_data->aborting) { in mv64xxx_i2c_fsm()
261 drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP; in mv64xxx_i2c_fsm()
262 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_fsm()
264 drv_data->action = in mv64xxx_i2c_fsm()
266 drv_data->state = in mv64xxx_i2c_fsm()
270 drv_data->action = MV64XXX_I2C_ACTION_SEND_DATA; in mv64xxx_i2c_fsm()
271 drv_data->state = in mv64xxx_i2c_fsm()
273 drv_data->bytes_left--; in mv64xxx_i2c_fsm()
279 if (drv_data->msg->flags & I2C_M_TEN) { in mv64xxx_i2c_fsm()
280 drv_data->action = MV64XXX_I2C_ACTION_SEND_ADDR_2; in mv64xxx_i2c_fsm()
281 drv_data->state = in mv64xxx_i2c_fsm()
287 if (drv_data->bytes_left == 0) { in mv64xxx_i2c_fsm()
288 drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP; in mv64xxx_i2c_fsm()
289 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_fsm()
295 drv_data->action = MV64XXX_I2C_ACTION_CONTINUE; in mv64xxx_i2c_fsm()
297 drv_data->action = MV64XXX_I2C_ACTION_RCV_DATA; in mv64xxx_i2c_fsm()
298 drv_data->bytes_left--; in mv64xxx_i2c_fsm()
300 drv_data->state = MV64XXX_I2C_STATE_WAITING_FOR_SLAVE_DATA; in mv64xxx_i2c_fsm()
302 if ((drv_data->bytes_left == 1) || drv_data->aborting) in mv64xxx_i2c_fsm()
303 drv_data->cntl_bits &= ~MV64XXX_I2C_REG_CONTROL_ACK; in mv64xxx_i2c_fsm()
307 drv_data->action = MV64XXX_I2C_ACTION_RCV_DATA_STOP; in mv64xxx_i2c_fsm()
308 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_fsm()
315 drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP; in mv64xxx_i2c_fsm()
316 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_fsm()
317 drv_data->rc = -ENXIO; in mv64xxx_i2c_fsm()
321 dev_err(&drv_data->adapter.dev, in mv64xxx_i2c_fsm()
324 drv_data->state, status, drv_data->msg->addr, in mv64xxx_i2c_fsm()
325 drv_data->msg->flags); in mv64xxx_i2c_fsm()
326 drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP; in mv64xxx_i2c_fsm()
327 mv64xxx_i2c_hw_init(drv_data); in mv64xxx_i2c_fsm()
328 drv_data->rc = -EIO; in mv64xxx_i2c_fsm()
332 static void mv64xxx_i2c_send_start(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_send_start() argument
334 drv_data->msg = drv_data->msgs; in mv64xxx_i2c_send_start()
335 drv_data->byte_posn = 0; in mv64xxx_i2c_send_start()
336 drv_data->bytes_left = drv_data->msg->len; in mv64xxx_i2c_send_start()
337 drv_data->aborting = 0; in mv64xxx_i2c_send_start()
338 drv_data->rc = 0; in mv64xxx_i2c_send_start()
340 mv64xxx_i2c_prepare_for_io(drv_data, drv_data->msgs); in mv64xxx_i2c_send_start()
341 writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_START, in mv64xxx_i2c_send_start()
342 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_send_start()
346 mv64xxx_i2c_do_action(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_do_action() argument
348 switch(drv_data->action) { in mv64xxx_i2c_do_action()
351 BUG_ON(drv_data->num_msgs == 0); in mv64xxx_i2c_do_action()
353 drv_data->msgs++; in mv64xxx_i2c_do_action()
354 drv_data->num_msgs--; in mv64xxx_i2c_do_action()
355 mv64xxx_i2c_send_start(drv_data); in mv64xxx_i2c_do_action()
357 if (drv_data->errata_delay) in mv64xxx_i2c_do_action()
365 drv_data->send_stop = drv_data->num_msgs == 1; in mv64xxx_i2c_do_action()
369 writel(drv_data->cntl_bits, in mv64xxx_i2c_do_action()
370 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
374 writel(drv_data->addr1, in mv64xxx_i2c_do_action()
375 drv_data->reg_base + drv_data->reg_offsets.data); in mv64xxx_i2c_do_action()
376 writel(drv_data->cntl_bits, in mv64xxx_i2c_do_action()
377 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
381 writel(drv_data->addr2, in mv64xxx_i2c_do_action()
382 drv_data->reg_base + drv_data->reg_offsets.data); in mv64xxx_i2c_do_action()
383 writel(drv_data->cntl_bits, in mv64xxx_i2c_do_action()
384 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
388 writel(drv_data->msg->buf[drv_data->byte_posn++], in mv64xxx_i2c_do_action()
389 drv_data->reg_base + drv_data->reg_offsets.data); in mv64xxx_i2c_do_action()
390 writel(drv_data->cntl_bits, in mv64xxx_i2c_do_action()
391 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
395 drv_data->msg->buf[drv_data->byte_posn++] = in mv64xxx_i2c_do_action()
396 readl(drv_data->reg_base + drv_data->reg_offsets.data); in mv64xxx_i2c_do_action()
397 writel(drv_data->cntl_bits, in mv64xxx_i2c_do_action()
398 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
402 drv_data->msg->buf[drv_data->byte_posn++] = in mv64xxx_i2c_do_action()
403 readl(drv_data->reg_base + drv_data->reg_offsets.data); in mv64xxx_i2c_do_action()
404 drv_data->cntl_bits &= ~MV64XXX_I2C_REG_CONTROL_INTEN; in mv64xxx_i2c_do_action()
405 writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_STOP, in mv64xxx_i2c_do_action()
406 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
407 drv_data->block = 0; in mv64xxx_i2c_do_action()
408 if (drv_data->errata_delay) in mv64xxx_i2c_do_action()
411 wake_up(&drv_data->waitq); in mv64xxx_i2c_do_action()
416 dev_err(&drv_data->adapter.dev, in mv64xxx_i2c_do_action()
418 drv_data->action); in mv64xxx_i2c_do_action()
419 drv_data->rc = -EIO; in mv64xxx_i2c_do_action()
423 drv_data->cntl_bits &= ~MV64XXX_I2C_REG_CONTROL_INTEN; in mv64xxx_i2c_do_action()
424 writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_STOP, in mv64xxx_i2c_do_action()
425 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
426 drv_data->block = 0; in mv64xxx_i2c_do_action()
427 wake_up(&drv_data->waitq); in mv64xxx_i2c_do_action()
433 mv64xxx_i2c_read_offload_rx_data(struct mv64xxx_i2c_data *drv_data, in mv64xxx_i2c_read_offload_rx_data() argument
438 buf[0] = readl(drv_data->reg_base + MV64XXX_I2C_REG_RX_DATA_LO); in mv64xxx_i2c_read_offload_rx_data()
439 buf[1] = readl(drv_data->reg_base + MV64XXX_I2C_REG_RX_DATA_HI); in mv64xxx_i2c_read_offload_rx_data()
445 mv64xxx_i2c_intr_offload(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_intr_offload() argument
449 cause = readl(drv_data->reg_base + in mv64xxx_i2c_intr_offload()
454 status = readl(drv_data->reg_base + in mv64xxx_i2c_intr_offload()
458 drv_data->rc = -EIO; in mv64xxx_i2c_intr_offload()
462 drv_data->rc = 0; in mv64xxx_i2c_intr_offload()
468 if (drv_data->num_msgs == 1 && drv_data->msgs[0].flags & I2C_M_RD) { in mv64xxx_i2c_intr_offload()
469 mv64xxx_i2c_read_offload_rx_data(drv_data, drv_data->msgs); in mv64xxx_i2c_intr_offload()
470 drv_data->msgs++; in mv64xxx_i2c_intr_offload()
471 drv_data->num_msgs--; in mv64xxx_i2c_intr_offload()
477 else if (drv_data->num_msgs == 2 && in mv64xxx_i2c_intr_offload()
478 !(drv_data->msgs[0].flags & I2C_M_RD) && in mv64xxx_i2c_intr_offload()
479 drv_data->msgs[1].flags & I2C_M_RD) { in mv64xxx_i2c_intr_offload()
480 mv64xxx_i2c_read_offload_rx_data(drv_data, drv_data->msgs + 1); in mv64xxx_i2c_intr_offload()
481 drv_data->msgs += 2; in mv64xxx_i2c_intr_offload()
482 drv_data->num_msgs -= 2; in mv64xxx_i2c_intr_offload()
486 writel(0, drv_data->reg_base + MV64XXX_I2C_REG_BRIDGE_CONTROL); in mv64xxx_i2c_intr_offload()
487 writel(0, drv_data->reg_base + in mv64xxx_i2c_intr_offload()
489 drv_data->block = 0; in mv64xxx_i2c_intr_offload()
491 wake_up(&drv_data->waitq); in mv64xxx_i2c_intr_offload()
499 struct mv64xxx_i2c_data *drv_data = dev_id; in mv64xxx_i2c_intr() local
504 spin_lock_irqsave(&drv_data->lock, flags); in mv64xxx_i2c_intr()
506 if (drv_data->offload_enabled) in mv64xxx_i2c_intr()
507 rc = mv64xxx_i2c_intr_offload(drv_data); in mv64xxx_i2c_intr()
509 while (readl(drv_data->reg_base + drv_data->reg_offsets.control) & in mv64xxx_i2c_intr()
511 status = readl(drv_data->reg_base + drv_data->reg_offsets.status); in mv64xxx_i2c_intr()
512 mv64xxx_i2c_fsm(drv_data, status); in mv64xxx_i2c_intr()
513 mv64xxx_i2c_do_action(drv_data); in mv64xxx_i2c_intr()
515 if (drv_data->irq_clear_inverted) in mv64xxx_i2c_intr()
516 writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_IFLG, in mv64xxx_i2c_intr()
517 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_intr()
521 spin_unlock_irqrestore(&drv_data->lock, flags); in mv64xxx_i2c_intr()
534 mv64xxx_i2c_wait_for_completion(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_wait_for_completion() argument
540 time_left = wait_event_timeout(drv_data->waitq, in mv64xxx_i2c_wait_for_completion()
541 !drv_data->block, drv_data->adapter.timeout); in mv64xxx_i2c_wait_for_completion()
543 spin_lock_irqsave(&drv_data->lock, flags); in mv64xxx_i2c_wait_for_completion()
545 drv_data->rc = -ETIMEDOUT; in mv64xxx_i2c_wait_for_completion()
548 drv_data->rc = time_left; /* errno value */ in mv64xxx_i2c_wait_for_completion()
552 if (abort && drv_data->block) { in mv64xxx_i2c_wait_for_completion()
553 drv_data->aborting = 1; in mv64xxx_i2c_wait_for_completion()
554 spin_unlock_irqrestore(&drv_data->lock, flags); in mv64xxx_i2c_wait_for_completion()
556 time_left = wait_event_timeout(drv_data->waitq, in mv64xxx_i2c_wait_for_completion()
557 !drv_data->block, drv_data->adapter.timeout); in mv64xxx_i2c_wait_for_completion()
559 if ((time_left <= 0) && drv_data->block) { in mv64xxx_i2c_wait_for_completion()
560 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_wait_for_completion()
561 dev_err(&drv_data->adapter.dev, in mv64xxx_i2c_wait_for_completion()
563 "time_left: %d\n", drv_data->block, in mv64xxx_i2c_wait_for_completion()
565 mv64xxx_i2c_hw_init(drv_data); in mv64xxx_i2c_wait_for_completion()
568 spin_unlock_irqrestore(&drv_data->lock, flags); in mv64xxx_i2c_wait_for_completion()
572 mv64xxx_i2c_execute_msg(struct mv64xxx_i2c_data *drv_data, struct i2c_msg *msg, in mv64xxx_i2c_execute_msg() argument
577 spin_lock_irqsave(&drv_data->lock, flags); in mv64xxx_i2c_execute_msg()
579 drv_data->state = MV64XXX_I2C_STATE_WAITING_FOR_START_COND; in mv64xxx_i2c_execute_msg()
581 drv_data->send_stop = is_last; in mv64xxx_i2c_execute_msg()
582 drv_data->block = 1; in mv64xxx_i2c_execute_msg()
583 mv64xxx_i2c_send_start(drv_data); in mv64xxx_i2c_execute_msg()
584 spin_unlock_irqrestore(&drv_data->lock, flags); in mv64xxx_i2c_execute_msg()
586 mv64xxx_i2c_wait_for_completion(drv_data); in mv64xxx_i2c_execute_msg()
587 return drv_data->rc; in mv64xxx_i2c_execute_msg()
591 mv64xxx_i2c_prepare_tx(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_prepare_tx() argument
593 struct i2c_msg *msg = drv_data->msgs; in mv64xxx_i2c_prepare_tx()
598 writel(buf[0], drv_data->reg_base + MV64XXX_I2C_REG_TX_DATA_LO); in mv64xxx_i2c_prepare_tx()
599 writel(buf[1], drv_data->reg_base + MV64XXX_I2C_REG_TX_DATA_HI); in mv64xxx_i2c_prepare_tx()
603 mv64xxx_i2c_offload_xfer(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_offload_xfer() argument
605 struct i2c_msg *msgs = drv_data->msgs; in mv64xxx_i2c_offload_xfer()
606 int num = drv_data->num_msgs; in mv64xxx_i2c_offload_xfer()
610 spin_lock_irqsave(&drv_data->lock, flags); in mv64xxx_i2c_offload_xfer()
625 mv64xxx_i2c_prepare_tx(drv_data); in mv64xxx_i2c_offload_xfer()
648 mv64xxx_i2c_prepare_tx(drv_data); in mv64xxx_i2c_offload_xfer()
652 drv_data->block = 1; in mv64xxx_i2c_offload_xfer()
653 writel(ctrl_reg, drv_data->reg_base + MV64XXX_I2C_REG_BRIDGE_CONTROL); in mv64xxx_i2c_offload_xfer()
654 spin_unlock_irqrestore(&drv_data->lock, flags); in mv64xxx_i2c_offload_xfer()
656 mv64xxx_i2c_wait_for_completion(drv_data); in mv64xxx_i2c_offload_xfer()
658 return drv_data->rc; in mv64xxx_i2c_offload_xfer()
668 mv64xxx_i2c_can_offload(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_can_offload() argument
670 struct i2c_msg *msgs = drv_data->msgs; in mv64xxx_i2c_can_offload()
671 int num = drv_data->num_msgs; in mv64xxx_i2c_can_offload()
673 if (!drv_data->offload_enabled) in mv64xxx_i2c_can_offload()
715 struct mv64xxx_i2c_data *drv_data = i2c_get_adapdata(adap); in mv64xxx_i2c_xfer() local
718 BUG_ON(drv_data->msgs != NULL); in mv64xxx_i2c_xfer()
719 drv_data->msgs = msgs; in mv64xxx_i2c_xfer()
720 drv_data->num_msgs = num; in mv64xxx_i2c_xfer()
722 if (mv64xxx_i2c_can_offload(drv_data)) in mv64xxx_i2c_xfer()
723 rc = mv64xxx_i2c_offload_xfer(drv_data); in mv64xxx_i2c_xfer()
725 rc = mv64xxx_i2c_execute_msg(drv_data, &msgs[0], num == 1); in mv64xxx_i2c_xfer()
730 drv_data->num_msgs = 0; in mv64xxx_i2c_xfer()
731 drv_data->msgs = NULL; in mv64xxx_i2c_xfer()
760 mv64xxx_calc_freq(struct mv64xxx_i2c_data *drv_data, in mv64xxx_calc_freq() argument
763 if (drv_data->clk_n_base_0) in mv64xxx_calc_freq()
770 mv64xxx_find_baud_factors(struct mv64xxx_i2c_data *drv_data, in mv64xxx_find_baud_factors() argument
778 freq = mv64xxx_calc_freq(drv_data, tclk, n, m); in mv64xxx_find_baud_factors()
781 drv_data->freq_m = m; in mv64xxx_find_baud_factors()
782 drv_data->freq_n = n; in mv64xxx_find_baud_factors()
794 mv64xxx_of_config(struct mv64xxx_i2c_data *drv_data, in mv64xxx_of_config() argument
806 if (IS_ERR(drv_data->clk)) { in mv64xxx_of_config()
810 tclk = clk_get_rate(drv_data->clk); in mv64xxx_of_config()
817 drv_data->clk_n_base_0 = true; in mv64xxx_of_config()
819 if (!mv64xxx_find_baud_factors(drv_data, bus_freq, tclk)) { in mv64xxx_of_config()
824 drv_data->rstc = devm_reset_control_get_optional_exclusive(dev, NULL); in mv64xxx_of_config()
825 if (IS_ERR(drv_data->rstc)) { in mv64xxx_of_config()
826 rc = PTR_ERR(drv_data->rstc); in mv64xxx_of_config()
829 reset_control_deassert(drv_data->rstc); in mv64xxx_of_config()
834 drv_data->adapter.timeout = HZ; in mv64xxx_of_config()
840 memcpy(&drv_data->reg_offsets, device->data, sizeof(drv_data->reg_offsets)); in mv64xxx_of_config()
847 drv_data->offload_enabled = true; in mv64xxx_of_config()
850 drv_data->errata_delay = true; in mv64xxx_of_config()
854 drv_data->offload_enabled = false; in mv64xxx_of_config()
857 drv_data->errata_delay = true; in mv64xxx_of_config()
861 drv_data->irq_clear_inverted = true; in mv64xxx_of_config()
868 mv64xxx_of_config(struct mv64xxx_i2c_data *drv_data, in mv64xxx_of_config() argument
878 struct mv64xxx_i2c_data *drv_data; in mv64xxx_i2c_probe() local
886 drv_data = devm_kzalloc(&pd->dev, sizeof(struct mv64xxx_i2c_data), in mv64xxx_i2c_probe()
888 if (!drv_data) in mv64xxx_i2c_probe()
892 drv_data->reg_base = devm_ioremap_resource(&pd->dev, r); in mv64xxx_i2c_probe()
893 if (IS_ERR(drv_data->reg_base)) in mv64xxx_i2c_probe()
894 return PTR_ERR(drv_data->reg_base); in mv64xxx_i2c_probe()
896 strlcpy(drv_data->adapter.name, MV64XXX_I2C_CTLR_NAME " adapter", in mv64xxx_i2c_probe()
897 sizeof(drv_data->adapter.name)); in mv64xxx_i2c_probe()
899 init_waitqueue_head(&drv_data->waitq); in mv64xxx_i2c_probe()
900 spin_lock_init(&drv_data->lock); in mv64xxx_i2c_probe()
903 drv_data->clk = devm_clk_get(&pd->dev, NULL); in mv64xxx_i2c_probe()
904 if (IS_ERR(drv_data->clk) && PTR_ERR(drv_data->clk) == -EPROBE_DEFER) in mv64xxx_i2c_probe()
906 if (!IS_ERR(drv_data->clk)) in mv64xxx_i2c_probe()
907 clk_prepare_enable(drv_data->clk); in mv64xxx_i2c_probe()
909 drv_data->reg_clk = devm_clk_get(&pd->dev, "reg"); in mv64xxx_i2c_probe()
910 if (IS_ERR(drv_data->reg_clk) && in mv64xxx_i2c_probe()
911 PTR_ERR(drv_data->reg_clk) == -EPROBE_DEFER) in mv64xxx_i2c_probe()
913 if (!IS_ERR(drv_data->reg_clk)) in mv64xxx_i2c_probe()
914 clk_prepare_enable(drv_data->reg_clk); in mv64xxx_i2c_probe()
916 drv_data->irq = platform_get_irq(pd, 0); in mv64xxx_i2c_probe()
919 drv_data->freq_m = pdata->freq_m; in mv64xxx_i2c_probe()
920 drv_data->freq_n = pdata->freq_n; in mv64xxx_i2c_probe()
921 drv_data->adapter.timeout = msecs_to_jiffies(pdata->timeout); in mv64xxx_i2c_probe()
922 drv_data->offload_enabled = false; in mv64xxx_i2c_probe()
923 memcpy(&drv_data->reg_offsets, &mv64xxx_i2c_regs_mv64xxx, sizeof(drv_data->reg_offsets)); in mv64xxx_i2c_probe()
925 rc = mv64xxx_of_config(drv_data, &pd->dev); in mv64xxx_i2c_probe()
929 if (drv_data->irq < 0) { in mv64xxx_i2c_probe()
930 rc = drv_data->irq; in mv64xxx_i2c_probe()
934 drv_data->adapter.dev.parent = &pd->dev; in mv64xxx_i2c_probe()
935 drv_data->adapter.algo = &mv64xxx_i2c_algo; in mv64xxx_i2c_probe()
936 drv_data->adapter.owner = THIS_MODULE; in mv64xxx_i2c_probe()
937 drv_data->adapter.class = I2C_CLASS_DEPRECATED; in mv64xxx_i2c_probe()
938 drv_data->adapter.nr = pd->id; in mv64xxx_i2c_probe()
939 drv_data->adapter.dev.of_node = pd->dev.of_node; in mv64xxx_i2c_probe()
940 platform_set_drvdata(pd, drv_data); in mv64xxx_i2c_probe()
941 i2c_set_adapdata(&drv_data->adapter, drv_data); in mv64xxx_i2c_probe()
943 mv64xxx_i2c_hw_init(drv_data); in mv64xxx_i2c_probe()
945 rc = request_irq(drv_data->irq, mv64xxx_i2c_intr, 0, in mv64xxx_i2c_probe()
946 MV64XXX_I2C_CTLR_NAME, drv_data); in mv64xxx_i2c_probe()
948 dev_err(&drv_data->adapter.dev, in mv64xxx_i2c_probe()
950 drv_data->irq, rc); in mv64xxx_i2c_probe()
952 } else if ((rc = i2c_add_numbered_adapter(&drv_data->adapter)) != 0) { in mv64xxx_i2c_probe()
953 dev_err(&drv_data->adapter.dev, in mv64xxx_i2c_probe()
961 free_irq(drv_data->irq, drv_data); in mv64xxx_i2c_probe()
963 reset_control_assert(drv_data->rstc); in mv64xxx_i2c_probe()
965 clk_disable_unprepare(drv_data->reg_clk); in mv64xxx_i2c_probe()
966 clk_disable_unprepare(drv_data->clk); in mv64xxx_i2c_probe()
974 struct mv64xxx_i2c_data *drv_data = platform_get_drvdata(dev); in mv64xxx_i2c_remove() local
976 i2c_del_adapter(&drv_data->adapter); in mv64xxx_i2c_remove()
977 free_irq(drv_data->irq, drv_data); in mv64xxx_i2c_remove()
978 reset_control_assert(drv_data->rstc); in mv64xxx_i2c_remove()
979 clk_disable_unprepare(drv_data->reg_clk); in mv64xxx_i2c_remove()
980 clk_disable_unprepare(drv_data->clk); in mv64xxx_i2c_remove()
988 struct mv64xxx_i2c_data *drv_data = dev_get_drvdata(dev); in mv64xxx_i2c_resume() local
990 mv64xxx_i2c_hw_init(drv_data); in mv64xxx_i2c_resume()