Lines Matching refs:drv_data
172 mv64xxx_i2c_prepare_for_io(struct mv64xxx_i2c_data *drv_data, in mv64xxx_i2c_prepare_for_io() argument
177 drv_data->cntl_bits = MV64XXX_I2C_REG_CONTROL_ACK | in mv64xxx_i2c_prepare_for_io()
184 drv_data->addr1 = 0xf0 | (((u32)msg->addr & 0x300) >> 7) | dir; in mv64xxx_i2c_prepare_for_io()
185 drv_data->addr2 = (u32)msg->addr & 0xff; in mv64xxx_i2c_prepare_for_io()
187 drv_data->addr1 = MV64XXX_I2C_ADDR_ADDR((u32)msg->addr) | dir; in mv64xxx_i2c_prepare_for_io()
188 drv_data->addr2 = 0; in mv64xxx_i2c_prepare_for_io()
202 mv64xxx_i2c_hw_init(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_hw_init() argument
204 if (drv_data->offload_enabled) { in mv64xxx_i2c_hw_init()
205 writel(0, drv_data->reg_base + MV64XXX_I2C_REG_BRIDGE_CONTROL); in mv64xxx_i2c_hw_init()
206 writel(0, drv_data->reg_base + MV64XXX_I2C_REG_BRIDGE_TIMING); in mv64xxx_i2c_hw_init()
207 writel(0, drv_data->reg_base + in mv64xxx_i2c_hw_init()
209 writel(0, drv_data->reg_base + in mv64xxx_i2c_hw_init()
213 writel(0, drv_data->reg_base + drv_data->reg_offsets.soft_reset); in mv64xxx_i2c_hw_init()
214 writel(MV64XXX_I2C_BAUD_DIV_M(drv_data->freq_m) | MV64XXX_I2C_BAUD_DIV_N(drv_data->freq_n), in mv64xxx_i2c_hw_init()
215 drv_data->reg_base + drv_data->reg_offsets.clock); in mv64xxx_i2c_hw_init()
216 writel(0, drv_data->reg_base + drv_data->reg_offsets.addr); in mv64xxx_i2c_hw_init()
217 writel(0, drv_data->reg_base + drv_data->reg_offsets.ext_addr); in mv64xxx_i2c_hw_init()
219 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_hw_init()
220 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_hw_init()
224 mv64xxx_i2c_fsm(struct mv64xxx_i2c_data *drv_data, u32 status) in mv64xxx_i2c_fsm() argument
231 if (drv_data->state == MV64XXX_I2C_STATE_IDLE) { in mv64xxx_i2c_fsm()
232 drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP; in mv64xxx_i2c_fsm()
241 drv_data->action = MV64XXX_I2C_ACTION_SEND_ADDR_1; in mv64xxx_i2c_fsm()
242 drv_data->state = MV64XXX_I2C_STATE_WAITING_FOR_ADDR_1_ACK; in mv64xxx_i2c_fsm()
247 if (drv_data->msg->flags & I2C_M_TEN) { in mv64xxx_i2c_fsm()
248 drv_data->action = MV64XXX_I2C_ACTION_SEND_ADDR_2; in mv64xxx_i2c_fsm()
249 drv_data->state = in mv64xxx_i2c_fsm()
256 if ((drv_data->bytes_left == 0) in mv64xxx_i2c_fsm()
257 || (drv_data->aborting in mv64xxx_i2c_fsm()
258 && (drv_data->byte_posn != 0))) { in mv64xxx_i2c_fsm()
259 if (drv_data->send_stop || drv_data->aborting) { in mv64xxx_i2c_fsm()
260 drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP; in mv64xxx_i2c_fsm()
261 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_fsm()
263 drv_data->action = in mv64xxx_i2c_fsm()
265 drv_data->state = in mv64xxx_i2c_fsm()
269 drv_data->action = MV64XXX_I2C_ACTION_SEND_DATA; in mv64xxx_i2c_fsm()
270 drv_data->state = in mv64xxx_i2c_fsm()
272 drv_data->bytes_left--; in mv64xxx_i2c_fsm()
278 if (drv_data->msg->flags & I2C_M_TEN) { in mv64xxx_i2c_fsm()
279 drv_data->action = MV64XXX_I2C_ACTION_SEND_ADDR_2; in mv64xxx_i2c_fsm()
280 drv_data->state = in mv64xxx_i2c_fsm()
286 if (drv_data->bytes_left == 0) { in mv64xxx_i2c_fsm()
287 drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP; in mv64xxx_i2c_fsm()
288 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_fsm()
294 drv_data->action = MV64XXX_I2C_ACTION_CONTINUE; in mv64xxx_i2c_fsm()
296 drv_data->action = MV64XXX_I2C_ACTION_RCV_DATA; in mv64xxx_i2c_fsm()
297 drv_data->bytes_left--; in mv64xxx_i2c_fsm()
299 drv_data->state = MV64XXX_I2C_STATE_WAITING_FOR_SLAVE_DATA; in mv64xxx_i2c_fsm()
301 if ((drv_data->bytes_left == 1) || drv_data->aborting) in mv64xxx_i2c_fsm()
302 drv_data->cntl_bits &= ~MV64XXX_I2C_REG_CONTROL_ACK; in mv64xxx_i2c_fsm()
306 drv_data->action = MV64XXX_I2C_ACTION_RCV_DATA_STOP; in mv64xxx_i2c_fsm()
307 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_fsm()
314 drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP; in mv64xxx_i2c_fsm()
315 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_fsm()
316 drv_data->rc = -ENXIO; in mv64xxx_i2c_fsm()
320 dev_err(&drv_data->adapter.dev, in mv64xxx_i2c_fsm()
323 drv_data->state, status, drv_data->msg->addr, in mv64xxx_i2c_fsm()
324 drv_data->msg->flags); in mv64xxx_i2c_fsm()
325 drv_data->action = MV64XXX_I2C_ACTION_SEND_STOP; in mv64xxx_i2c_fsm()
326 mv64xxx_i2c_hw_init(drv_data); in mv64xxx_i2c_fsm()
327 drv_data->rc = -EIO; in mv64xxx_i2c_fsm()
331 static void mv64xxx_i2c_send_start(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_send_start() argument
333 drv_data->msg = drv_data->msgs; in mv64xxx_i2c_send_start()
334 drv_data->byte_posn = 0; in mv64xxx_i2c_send_start()
335 drv_data->bytes_left = drv_data->msg->len; in mv64xxx_i2c_send_start()
336 drv_data->aborting = 0; in mv64xxx_i2c_send_start()
337 drv_data->rc = 0; in mv64xxx_i2c_send_start()
339 mv64xxx_i2c_prepare_for_io(drv_data, drv_data->msgs); in mv64xxx_i2c_send_start()
340 writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_START, in mv64xxx_i2c_send_start()
341 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_send_start()
345 mv64xxx_i2c_do_action(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_do_action() argument
347 switch(drv_data->action) { in mv64xxx_i2c_do_action()
350 BUG_ON(drv_data->num_msgs == 0); in mv64xxx_i2c_do_action()
352 drv_data->msgs++; in mv64xxx_i2c_do_action()
353 drv_data->num_msgs--; in mv64xxx_i2c_do_action()
354 mv64xxx_i2c_send_start(drv_data); in mv64xxx_i2c_do_action()
356 if (drv_data->errata_delay) in mv64xxx_i2c_do_action()
364 drv_data->send_stop = drv_data->num_msgs == 1; in mv64xxx_i2c_do_action()
368 writel(drv_data->cntl_bits, in mv64xxx_i2c_do_action()
369 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
373 writel(drv_data->addr1, in mv64xxx_i2c_do_action()
374 drv_data->reg_base + drv_data->reg_offsets.data); in mv64xxx_i2c_do_action()
375 writel(drv_data->cntl_bits, in mv64xxx_i2c_do_action()
376 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
380 writel(drv_data->addr2, in mv64xxx_i2c_do_action()
381 drv_data->reg_base + drv_data->reg_offsets.data); in mv64xxx_i2c_do_action()
382 writel(drv_data->cntl_bits, in mv64xxx_i2c_do_action()
383 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
387 writel(drv_data->msg->buf[drv_data->byte_posn++], in mv64xxx_i2c_do_action()
388 drv_data->reg_base + drv_data->reg_offsets.data); in mv64xxx_i2c_do_action()
389 writel(drv_data->cntl_bits, in mv64xxx_i2c_do_action()
390 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
394 drv_data->msg->buf[drv_data->byte_posn++] = in mv64xxx_i2c_do_action()
395 readl(drv_data->reg_base + drv_data->reg_offsets.data); in mv64xxx_i2c_do_action()
396 writel(drv_data->cntl_bits, in mv64xxx_i2c_do_action()
397 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
401 drv_data->msg->buf[drv_data->byte_posn++] = in mv64xxx_i2c_do_action()
402 readl(drv_data->reg_base + drv_data->reg_offsets.data); in mv64xxx_i2c_do_action()
403 drv_data->cntl_bits &= ~MV64XXX_I2C_REG_CONTROL_INTEN; in mv64xxx_i2c_do_action()
404 writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_STOP, in mv64xxx_i2c_do_action()
405 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
406 drv_data->block = 0; in mv64xxx_i2c_do_action()
407 if (drv_data->errata_delay) in mv64xxx_i2c_do_action()
410 wake_up(&drv_data->waitq); in mv64xxx_i2c_do_action()
415 dev_err(&drv_data->adapter.dev, in mv64xxx_i2c_do_action()
417 drv_data->action); in mv64xxx_i2c_do_action()
418 drv_data->rc = -EIO; in mv64xxx_i2c_do_action()
422 drv_data->cntl_bits &= ~MV64XXX_I2C_REG_CONTROL_INTEN; in mv64xxx_i2c_do_action()
423 writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_STOP, in mv64xxx_i2c_do_action()
424 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_do_action()
425 drv_data->block = 0; in mv64xxx_i2c_do_action()
426 wake_up(&drv_data->waitq); in mv64xxx_i2c_do_action()
432 mv64xxx_i2c_read_offload_rx_data(struct mv64xxx_i2c_data *drv_data, in mv64xxx_i2c_read_offload_rx_data() argument
437 buf[0] = readl(drv_data->reg_base + MV64XXX_I2C_REG_RX_DATA_LO); in mv64xxx_i2c_read_offload_rx_data()
438 buf[1] = readl(drv_data->reg_base + MV64XXX_I2C_REG_RX_DATA_HI); in mv64xxx_i2c_read_offload_rx_data()
444 mv64xxx_i2c_intr_offload(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_intr_offload() argument
448 cause = readl(drv_data->reg_base + in mv64xxx_i2c_intr_offload()
453 status = readl(drv_data->reg_base + in mv64xxx_i2c_intr_offload()
457 drv_data->rc = -EIO; in mv64xxx_i2c_intr_offload()
461 drv_data->rc = 0; in mv64xxx_i2c_intr_offload()
467 if (drv_data->num_msgs == 1 && drv_data->msgs[0].flags & I2C_M_RD) { in mv64xxx_i2c_intr_offload()
468 mv64xxx_i2c_read_offload_rx_data(drv_data, drv_data->msgs); in mv64xxx_i2c_intr_offload()
469 drv_data->msgs++; in mv64xxx_i2c_intr_offload()
470 drv_data->num_msgs--; in mv64xxx_i2c_intr_offload()
476 else if (drv_data->num_msgs == 2 && in mv64xxx_i2c_intr_offload()
477 !(drv_data->msgs[0].flags & I2C_M_RD) && in mv64xxx_i2c_intr_offload()
478 drv_data->msgs[1].flags & I2C_M_RD) { in mv64xxx_i2c_intr_offload()
479 mv64xxx_i2c_read_offload_rx_data(drv_data, drv_data->msgs + 1); in mv64xxx_i2c_intr_offload()
480 drv_data->msgs += 2; in mv64xxx_i2c_intr_offload()
481 drv_data->num_msgs -= 2; in mv64xxx_i2c_intr_offload()
485 writel(0, drv_data->reg_base + MV64XXX_I2C_REG_BRIDGE_CONTROL); in mv64xxx_i2c_intr_offload()
486 writel(0, drv_data->reg_base + in mv64xxx_i2c_intr_offload()
488 drv_data->block = 0; in mv64xxx_i2c_intr_offload()
490 wake_up(&drv_data->waitq); in mv64xxx_i2c_intr_offload()
498 struct mv64xxx_i2c_data *drv_data = dev_id; in mv64xxx_i2c_intr() local
503 spin_lock_irqsave(&drv_data->lock, flags); in mv64xxx_i2c_intr()
505 if (drv_data->offload_enabled) in mv64xxx_i2c_intr()
506 rc = mv64xxx_i2c_intr_offload(drv_data); in mv64xxx_i2c_intr()
508 while (readl(drv_data->reg_base + drv_data->reg_offsets.control) & in mv64xxx_i2c_intr()
510 status = readl(drv_data->reg_base + drv_data->reg_offsets.status); in mv64xxx_i2c_intr()
511 mv64xxx_i2c_fsm(drv_data, status); in mv64xxx_i2c_intr()
512 mv64xxx_i2c_do_action(drv_data); in mv64xxx_i2c_intr()
514 if (drv_data->irq_clear_inverted) in mv64xxx_i2c_intr()
515 writel(drv_data->cntl_bits | MV64XXX_I2C_REG_CONTROL_IFLG, in mv64xxx_i2c_intr()
516 drv_data->reg_base + drv_data->reg_offsets.control); in mv64xxx_i2c_intr()
520 spin_unlock_irqrestore(&drv_data->lock, flags); in mv64xxx_i2c_intr()
533 mv64xxx_i2c_wait_for_completion(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_wait_for_completion() argument
539 time_left = wait_event_timeout(drv_data->waitq, in mv64xxx_i2c_wait_for_completion()
540 !drv_data->block, drv_data->adapter.timeout); in mv64xxx_i2c_wait_for_completion()
542 spin_lock_irqsave(&drv_data->lock, flags); in mv64xxx_i2c_wait_for_completion()
544 drv_data->rc = -ETIMEDOUT; in mv64xxx_i2c_wait_for_completion()
547 drv_data->rc = time_left; /* errno value */ in mv64xxx_i2c_wait_for_completion()
551 if (abort && drv_data->block) { in mv64xxx_i2c_wait_for_completion()
552 drv_data->aborting = 1; in mv64xxx_i2c_wait_for_completion()
553 spin_unlock_irqrestore(&drv_data->lock, flags); in mv64xxx_i2c_wait_for_completion()
555 time_left = wait_event_timeout(drv_data->waitq, in mv64xxx_i2c_wait_for_completion()
556 !drv_data->block, drv_data->adapter.timeout); in mv64xxx_i2c_wait_for_completion()
558 if ((time_left <= 0) && drv_data->block) { in mv64xxx_i2c_wait_for_completion()
559 drv_data->state = MV64XXX_I2C_STATE_IDLE; in mv64xxx_i2c_wait_for_completion()
560 dev_err(&drv_data->adapter.dev, in mv64xxx_i2c_wait_for_completion()
562 "time_left: %d\n", drv_data->block, in mv64xxx_i2c_wait_for_completion()
564 mv64xxx_i2c_hw_init(drv_data); in mv64xxx_i2c_wait_for_completion()
567 spin_unlock_irqrestore(&drv_data->lock, flags); in mv64xxx_i2c_wait_for_completion()
571 mv64xxx_i2c_execute_msg(struct mv64xxx_i2c_data *drv_data, struct i2c_msg *msg, in mv64xxx_i2c_execute_msg() argument
576 spin_lock_irqsave(&drv_data->lock, flags); in mv64xxx_i2c_execute_msg()
578 drv_data->state = MV64XXX_I2C_STATE_WAITING_FOR_START_COND; in mv64xxx_i2c_execute_msg()
580 drv_data->send_stop = is_last; in mv64xxx_i2c_execute_msg()
581 drv_data->block = 1; in mv64xxx_i2c_execute_msg()
582 mv64xxx_i2c_send_start(drv_data); in mv64xxx_i2c_execute_msg()
583 spin_unlock_irqrestore(&drv_data->lock, flags); in mv64xxx_i2c_execute_msg()
585 mv64xxx_i2c_wait_for_completion(drv_data); in mv64xxx_i2c_execute_msg()
586 return drv_data->rc; in mv64xxx_i2c_execute_msg()
590 mv64xxx_i2c_prepare_tx(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_prepare_tx() argument
592 struct i2c_msg *msg = drv_data->msgs; in mv64xxx_i2c_prepare_tx()
597 writel(buf[0], drv_data->reg_base + MV64XXX_I2C_REG_TX_DATA_LO); in mv64xxx_i2c_prepare_tx()
598 writel(buf[1], drv_data->reg_base + MV64XXX_I2C_REG_TX_DATA_HI); in mv64xxx_i2c_prepare_tx()
602 mv64xxx_i2c_offload_xfer(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_offload_xfer() argument
604 struct i2c_msg *msgs = drv_data->msgs; in mv64xxx_i2c_offload_xfer()
605 int num = drv_data->num_msgs; in mv64xxx_i2c_offload_xfer()
609 spin_lock_irqsave(&drv_data->lock, flags); in mv64xxx_i2c_offload_xfer()
624 mv64xxx_i2c_prepare_tx(drv_data); in mv64xxx_i2c_offload_xfer()
647 mv64xxx_i2c_prepare_tx(drv_data); in mv64xxx_i2c_offload_xfer()
651 drv_data->block = 1; in mv64xxx_i2c_offload_xfer()
652 writel(ctrl_reg, drv_data->reg_base + MV64XXX_I2C_REG_BRIDGE_CONTROL); in mv64xxx_i2c_offload_xfer()
653 spin_unlock_irqrestore(&drv_data->lock, flags); in mv64xxx_i2c_offload_xfer()
655 mv64xxx_i2c_wait_for_completion(drv_data); in mv64xxx_i2c_offload_xfer()
657 return drv_data->rc; in mv64xxx_i2c_offload_xfer()
667 mv64xxx_i2c_can_offload(struct mv64xxx_i2c_data *drv_data) in mv64xxx_i2c_can_offload() argument
669 struct i2c_msg *msgs = drv_data->msgs; in mv64xxx_i2c_can_offload()
670 int num = drv_data->num_msgs; in mv64xxx_i2c_can_offload()
672 if (!drv_data->offload_enabled) in mv64xxx_i2c_can_offload()
714 struct mv64xxx_i2c_data *drv_data = i2c_get_adapdata(adap); in mv64xxx_i2c_xfer() local
717 BUG_ON(drv_data->msgs != NULL); in mv64xxx_i2c_xfer()
718 drv_data->msgs = msgs; in mv64xxx_i2c_xfer()
719 drv_data->num_msgs = num; in mv64xxx_i2c_xfer()
721 if (mv64xxx_i2c_can_offload(drv_data)) in mv64xxx_i2c_xfer()
722 rc = mv64xxx_i2c_offload_xfer(drv_data); in mv64xxx_i2c_xfer()
724 rc = mv64xxx_i2c_execute_msg(drv_data, &msgs[0], num == 1); in mv64xxx_i2c_xfer()
729 drv_data->num_msgs = 0; in mv64xxx_i2c_xfer()
730 drv_data->msgs = NULL; in mv64xxx_i2c_xfer()
791 mv64xxx_of_config(struct mv64xxx_i2c_data *drv_data, in mv64xxx_of_config() argument
807 if (IS_ERR(drv_data->clk)) { in mv64xxx_of_config()
811 tclk = clk_get_rate(drv_data->clk); in mv64xxx_of_config()
817 &drv_data->freq_n, &drv_data->freq_m)) { in mv64xxx_of_config()
821 drv_data->irq = irq_of_parse_and_map(np, 0); in mv64xxx_of_config()
823 drv_data->rstc = devm_reset_control_get_optional(dev, NULL); in mv64xxx_of_config()
824 if (IS_ERR(drv_data->rstc)) { in mv64xxx_of_config()
825 if (PTR_ERR(drv_data->rstc) == -EPROBE_DEFER) { in mv64xxx_of_config()
830 reset_control_deassert(drv_data->rstc); in mv64xxx_of_config()
836 drv_data->adapter.timeout = HZ; in mv64xxx_of_config()
842 memcpy(&drv_data->reg_offsets, device->data, sizeof(drv_data->reg_offsets)); in mv64xxx_of_config()
849 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()
855 drv_data->errata_delay = true; in mv64xxx_of_config()
859 drv_data->irq_clear_inverted = true; in mv64xxx_of_config()
867 mv64xxx_of_config(struct mv64xxx_i2c_data *drv_data, in mv64xxx_of_config() argument
877 struct mv64xxx_i2c_data *drv_data; in mv64xxx_i2c_probe() local
885 drv_data = devm_kzalloc(&pd->dev, sizeof(struct mv64xxx_i2c_data), in mv64xxx_i2c_probe()
887 if (!drv_data) in mv64xxx_i2c_probe()
891 drv_data->reg_base = devm_ioremap_resource(&pd->dev, r); in mv64xxx_i2c_probe()
892 if (IS_ERR(drv_data->reg_base)) in mv64xxx_i2c_probe()
893 return PTR_ERR(drv_data->reg_base); in mv64xxx_i2c_probe()
895 strlcpy(drv_data->adapter.name, MV64XXX_I2C_CTLR_NAME " adapter", in mv64xxx_i2c_probe()
896 sizeof(drv_data->adapter.name)); in mv64xxx_i2c_probe()
898 init_waitqueue_head(&drv_data->waitq); in mv64xxx_i2c_probe()
899 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)) { in mv64xxx_i2c_probe()
905 clk_prepare(drv_data->clk); in mv64xxx_i2c_probe()
906 clk_enable(drv_data->clk); in mv64xxx_i2c_probe()
910 drv_data->freq_m = pdata->freq_m; in mv64xxx_i2c_probe()
911 drv_data->freq_n = pdata->freq_n; in mv64xxx_i2c_probe()
912 drv_data->irq = platform_get_irq(pd, 0); in mv64xxx_i2c_probe()
913 drv_data->adapter.timeout = msecs_to_jiffies(pdata->timeout); in mv64xxx_i2c_probe()
914 drv_data->offload_enabled = false; in mv64xxx_i2c_probe()
915 memcpy(&drv_data->reg_offsets, &mv64xxx_i2c_regs_mv64xxx, sizeof(drv_data->reg_offsets)); in mv64xxx_i2c_probe()
917 rc = mv64xxx_of_config(drv_data, &pd->dev); in mv64xxx_i2c_probe()
921 if (drv_data->irq < 0) { in mv64xxx_i2c_probe()
926 drv_data->adapter.dev.parent = &pd->dev; in mv64xxx_i2c_probe()
927 drv_data->adapter.algo = &mv64xxx_i2c_algo; in mv64xxx_i2c_probe()
928 drv_data->adapter.owner = THIS_MODULE; in mv64xxx_i2c_probe()
929 drv_data->adapter.class = I2C_CLASS_DEPRECATED; in mv64xxx_i2c_probe()
930 drv_data->adapter.nr = pd->id; in mv64xxx_i2c_probe()
931 drv_data->adapter.dev.of_node = pd->dev.of_node; in mv64xxx_i2c_probe()
932 platform_set_drvdata(pd, drv_data); in mv64xxx_i2c_probe()
933 i2c_set_adapdata(&drv_data->adapter, drv_data); in mv64xxx_i2c_probe()
935 mv64xxx_i2c_hw_init(drv_data); in mv64xxx_i2c_probe()
937 rc = request_irq(drv_data->irq, mv64xxx_i2c_intr, 0, in mv64xxx_i2c_probe()
938 MV64XXX_I2C_CTLR_NAME, drv_data); in mv64xxx_i2c_probe()
940 dev_err(&drv_data->adapter.dev, in mv64xxx_i2c_probe()
942 drv_data->irq, rc); in mv64xxx_i2c_probe()
944 } else if ((rc = i2c_add_numbered_adapter(&drv_data->adapter)) != 0) { in mv64xxx_i2c_probe()
945 dev_err(&drv_data->adapter.dev, in mv64xxx_i2c_probe()
953 free_irq(drv_data->irq, drv_data); in mv64xxx_i2c_probe()
955 if (!IS_ERR_OR_NULL(drv_data->rstc)) in mv64xxx_i2c_probe()
956 reset_control_assert(drv_data->rstc); in mv64xxx_i2c_probe()
960 if (!IS_ERR(drv_data->clk)) { in mv64xxx_i2c_probe()
961 clk_disable(drv_data->clk); in mv64xxx_i2c_probe()
962 clk_unprepare(drv_data->clk); in mv64xxx_i2c_probe()
971 struct mv64xxx_i2c_data *drv_data = platform_get_drvdata(dev); in mv64xxx_i2c_remove() local
973 i2c_del_adapter(&drv_data->adapter); in mv64xxx_i2c_remove()
974 free_irq(drv_data->irq, drv_data); in mv64xxx_i2c_remove()
975 if (!IS_ERR_OR_NULL(drv_data->rstc)) in mv64xxx_i2c_remove()
976 reset_control_assert(drv_data->rstc); in mv64xxx_i2c_remove()
979 if (!IS_ERR(drv_data->clk)) { in mv64xxx_i2c_remove()
980 clk_disable(drv_data->clk); in mv64xxx_i2c_remove()
981 clk_unprepare(drv_data->clk); in mv64xxx_i2c_remove()