Lines Matching refs:alg_data
120 static inline void i2c_pnx_arm_timer(struct i2c_pnx_algo_data *alg_data)
122 struct timer_list *timer = &alg_data->mif.timer;
123 unsigned long expires = msecs_to_jiffies(alg_data->timeout);
130 dev_dbg(&alg_data->adapter.dev, "Timer armed at %lu plus %lu jiffies.\n",
141 * @alg_data: pointer to local driver data structure
146 struct i2c_pnx_algo_data *alg_data)
148 dev_dbg(&alg_data->adapter.dev, "%s(): addr 0x%x mode %d\n", __func__,
149 slave_addr, alg_data->mif.mode);
153 dev_err(&alg_data->adapter.dev,
155 alg_data->adapter.name, slave_addr);
160 if (wait_timeout(alg_data)) {
162 dev_err(&alg_data->adapter.dev,
164 alg_data->adapter.name, slave_addr,
165 ioread32(I2C_REG_CTL(alg_data)),
166 ioread32(I2C_REG_STS(alg_data)));
168 } else if (ioread32(I2C_REG_STS(alg_data)) & mstatus_afi) {
170 dev_err(&alg_data->adapter.dev,
172 alg_data->adapter.name, slave_addr);
180 iowrite32(ioread32(I2C_REG_STS(alg_data)) | mstatus_tdi | mstatus_afi,
181 I2C_REG_STS(alg_data));
183 dev_dbg(&alg_data->adapter.dev, "%s(): sending %#x\n", __func__,
184 (slave_addr << 1) | start_bit | alg_data->mif.mode);
187 iowrite32((slave_addr << 1) | start_bit | alg_data->mif.mode,
188 I2C_REG_TX(alg_data));
190 dev_dbg(&alg_data->adapter.dev, "%s(): exit\n", __func__);
197 * @alg_data: pointer to local driver data structure
201 static void i2c_pnx_stop(struct i2c_pnx_algo_data *alg_data)
206 dev_dbg(&alg_data->adapter.dev, "%s(): entering: stat = %04x.\n",
207 __func__, ioread32(I2C_REG_STS(alg_data)));
210 iowrite32(0xff | stop_bit, I2C_REG_TX(alg_data));
214 (ioread32(I2C_REG_STS(alg_data)) & mstatus_active)) {
220 dev_dbg(&alg_data->adapter.dev, "%s(): exiting: stat = %04x.\n",
221 __func__, ioread32(I2C_REG_STS(alg_data)));
226 * @alg_data: pointer to local driver data structure
230 static int i2c_pnx_master_xmit(struct i2c_pnx_algo_data *alg_data)
234 dev_dbg(&alg_data->adapter.dev, "%s(): entering: stat = %04x.\n",
235 __func__, ioread32(I2C_REG_STS(alg_data)));
237 if (alg_data->mif.len > 0) {
239 val = *alg_data->mif.buf++;
241 if (alg_data->mif.len == 1)
244 alg_data->mif.len--;
245 iowrite32(val, I2C_REG_TX(alg_data));
247 dev_dbg(&alg_data->adapter.dev, "%s(): xmit %#x [%d]\n",
248 __func__, val, alg_data->mif.len + 1);
250 if (alg_data->mif.len == 0) {
251 if (alg_data->last) {
253 if (wait_timeout(alg_data))
254 dev_err(&alg_data->adapter.dev,
258 iowrite32(ioread32(I2C_REG_CTL(alg_data)) &
260 I2C_REG_CTL(alg_data));
262 del_timer_sync(&alg_data->mif.timer);
264 dev_dbg(&alg_data->adapter.dev,
268 complete(&alg_data->mif.complete);
270 } else if (alg_data->mif.len == 0) {
272 i2c_pnx_stop(alg_data);
275 iowrite32(ioread32(I2C_REG_CTL(alg_data)) &
277 I2C_REG_CTL(alg_data));
280 del_timer_sync(&alg_data->mif.timer);
281 dev_dbg(&alg_data->adapter.dev,
285 complete(&alg_data->mif.complete);
288 dev_dbg(&alg_data->adapter.dev, "%s(): exiting: stat = %04x.\n",
289 __func__, ioread32(I2C_REG_STS(alg_data)));
296 * @alg_data: pointer to local driver data structure
300 static int i2c_pnx_master_rcv(struct i2c_pnx_algo_data *alg_data)
305 dev_dbg(&alg_data->adapter.dev, "%s(): entering: stat = %04x.\n",
306 __func__, ioread32(I2C_REG_STS(alg_data)));
311 if (ioread32(I2C_REG_STS(alg_data)) & mstatus_rfe) {
316 if (alg_data->mif.order) {
317 dev_dbg(&alg_data->adapter.dev,
321 if (alg_data->mif.order == 1) {
329 ctl = ioread32(I2C_REG_CTL(alg_data));
332 iowrite32(ctl, I2C_REG_CTL(alg_data));
340 iowrite32(val, I2C_REG_TX(alg_data));
341 alg_data->mif.order--;
347 if (alg_data->mif.len > 0) {
348 val = ioread32(I2C_REG_RX(alg_data));
349 *alg_data->mif.buf++ = (u8) (val & 0xff);
350 dev_dbg(&alg_data->adapter.dev, "%s(): rcv 0x%x [%d]\n",
351 __func__, val, alg_data->mif.len);
353 alg_data->mif.len--;
354 if (alg_data->mif.len == 0) {
355 if (alg_data->last)
357 if (wait_timeout(alg_data))
358 dev_err(&alg_data->adapter.dev,
362 ctl = ioread32(I2C_REG_CTL(alg_data));
365 iowrite32(ctl, I2C_REG_CTL(alg_data));
368 del_timer_sync(&alg_data->mif.timer);
369 complete(&alg_data->mif.complete);
373 dev_dbg(&alg_data->adapter.dev, "%s(): exiting: stat = %04x.\n",
374 __func__, ioread32(I2C_REG_STS(alg_data)));
381 struct i2c_pnx_algo_data *alg_data = dev_id;
384 dev_dbg(&alg_data->adapter.dev,
387 ioread32(I2C_REG_STS(alg_data)),
388 ioread32(I2C_REG_CTL(alg_data)),
389 alg_data->mif.mode);
390 stat = ioread32(I2C_REG_STS(alg_data));
395 alg_data->mif.ret = -EIO;
398 ctl = ioread32(I2C_REG_CTL(alg_data));
401 iowrite32(ctl, I2C_REG_CTL(alg_data));
404 del_timer_sync(&alg_data->mif.timer);
405 complete(&alg_data->mif.complete);
408 dev_dbg(&alg_data->adapter.dev,
411 i2c_pnx_stop(alg_data);
414 ctl = ioread32(I2C_REG_CTL(alg_data));
417 iowrite32(ctl, I2C_REG_CTL(alg_data));
420 alg_data->mif.ret = -EIO;
423 del_timer_sync(&alg_data->mif.timer);
424 complete(&alg_data->mif.complete);
436 if (alg_data->mif.mode == I2C_SMBUS_WRITE) {
437 i2c_pnx_master_xmit(alg_data);
438 } else if (alg_data->mif.mode == I2C_SMBUS_READ) {
439 i2c_pnx_master_rcv(alg_data);
445 stat = ioread32(I2C_REG_STS(alg_data));
446 iowrite32(stat | mstatus_tdi | mstatus_afi, I2C_REG_STS(alg_data));
448 dev_dbg(&alg_data->adapter.dev,
450 __func__, ioread32(I2C_REG_STS(alg_data)),
451 ioread32(I2C_REG_CTL(alg_data)));
458 struct i2c_pnx_algo_data *alg_data = from_timer(alg_data, t, mif.timer);
461 dev_err(&alg_data->adapter.dev,
463 ioread32(I2C_REG_STS(alg_data)),
464 ioread32(I2C_REG_CTL(alg_data)));
467 ctl = ioread32(I2C_REG_CTL(alg_data));
469 iowrite32(ctl, I2C_REG_CTL(alg_data));
472 iowrite32(ctl, I2C_REG_CTL(alg_data));
473 wait_reset(alg_data);
474 alg_data->mif.ret = -EIO;
475 complete(&alg_data->mif.complete);
478 static inline void bus_reset_if_active(struct i2c_pnx_algo_data *alg_data)
482 if ((stat = ioread32(I2C_REG_STS(alg_data))) & mstatus_active) {
483 dev_err(&alg_data->adapter.dev,
485 alg_data->adapter.name);
486 iowrite32(ioread32(I2C_REG_CTL(alg_data)) | mcntrl_reset,
487 I2C_REG_CTL(alg_data));
488 wait_reset(alg_data);
493 iowrite32(ioread32(I2C_REG_CTL(alg_data)) | mcntrl_reset,
494 I2C_REG_CTL(alg_data));
495 wait_reset(alg_data);
497 iowrite32(ioread32(I2C_REG_CTL(alg_data)) | mcntrl_reset,
498 I2C_REG_CTL(alg_data));
499 wait_reset(alg_data);
516 struct i2c_pnx_algo_data *alg_data = adap->algo_data;
519 dev_dbg(&alg_data->adapter.dev,
521 __func__, num, ioread32(I2C_REG_STS(alg_data)));
523 bus_reset_if_active(alg_data);
533 dev_err(&alg_data->adapter.dev,
535 alg_data->adapter.name);
540 alg_data->mif.buf = pmsg->buf;
541 alg_data->mif.len = pmsg->len;
542 alg_data->mif.order = pmsg->len;
543 alg_data->mif.mode = (pmsg->flags & I2C_M_RD) ?
545 alg_data->mif.ret = 0;
546 alg_data->last = (i == num - 1);
548 dev_dbg(&alg_data->adapter.dev, "%s(): mode %d, %d bytes\n",
549 __func__, alg_data->mif.mode, alg_data->mif.len);
551 i2c_pnx_arm_timer(alg_data);
554 init_completion(&alg_data->mif.complete);
557 iowrite32(ioread32(I2C_REG_CTL(alg_data)) | mcntrl_afie |
559 I2C_REG_CTL(alg_data));
562 rc = i2c_pnx_start(addr, alg_data);
567 wait_for_completion(&alg_data->mif.complete);
569 if (!(rc = alg_data->mif.ret))
571 dev_dbg(&alg_data->adapter.dev,
576 if ((stat = ioread32(I2C_REG_STS(alg_data))) & mstatus_tdi) {
577 dev_dbg(&alg_data->adapter.dev,
579 alg_data->adapter.name);
580 iowrite32(stat, I2C_REG_STS(alg_data));
582 if ((stat = ioread32(I2C_REG_STS(alg_data))) & mstatus_afi) {
583 dev_dbg(&alg_data->adapter.dev,
585 alg_data->adapter.name);
586 iowrite32(stat, I2C_REG_STS(alg_data));
590 bus_reset_if_active(alg_data);
593 alg_data->mif.buf = NULL;
594 alg_data->mif.len = 0;
595 alg_data->mif.order = 0;
597 dev_dbg(&alg_data->adapter.dev, "%s(): exiting, stat = %x\n",
598 __func__, ioread32(I2C_REG_STS(alg_data)));
618 struct i2c_pnx_algo_data *alg_data = dev_get_drvdata(dev);
620 clk_disable_unprepare(alg_data->clk);
627 struct i2c_pnx_algo_data *alg_data = dev_get_drvdata(dev);
629 return clk_prepare_enable(alg_data->clk);
640 struct i2c_pnx_algo_data *alg_data;
645 alg_data = devm_kzalloc(&pdev->dev, sizeof(*alg_data), GFP_KERNEL);
646 if (!alg_data)
649 platform_set_drvdata(pdev, alg_data);
651 alg_data->adapter.dev.parent = &pdev->dev;
652 alg_data->adapter.algo = &pnx_algorithm;
653 alg_data->adapter.algo_data = alg_data;
654 alg_data->adapter.nr = pdev->id;
656 alg_data->timeout = I2C_PNX_TIMEOUT_DEFAULT;
658 alg_data->adapter.dev.of_node = of_node_get(pdev->dev.of_node);
668 * &alg_data->timeout);
672 alg_data->clk = devm_clk_get(&pdev->dev, NULL);
673 if (IS_ERR(alg_data->clk))
674 return PTR_ERR(alg_data->clk);
676 timer_setup(&alg_data->mif.timer, i2c_pnx_timeout, 0);
678 snprintf(alg_data->adapter.name, sizeof(alg_data->adapter.name),
682 alg_data->ioaddr = devm_platform_get_and_ioremap_resource(pdev, 0, &res);
683 if (IS_ERR(alg_data->ioaddr))
684 return PTR_ERR(alg_data->ioaddr);
686 ret = clk_prepare_enable(alg_data->clk);
690 freq = clk_get_rate(alg_data->clk);
706 iowrite32(tmp, I2C_REG_CKH(alg_data));
707 iowrite32(tmp, I2C_REG_CKL(alg_data));
709 iowrite32(mcntrl_reset, I2C_REG_CTL(alg_data));
710 if (wait_reset(alg_data)) {
714 init_completion(&alg_data->mif.complete);
716 alg_data->irq = platform_get_irq(pdev, 0);
717 if (alg_data->irq < 0) {
718 ret = alg_data->irq;
721 ret = devm_request_irq(&pdev->dev, alg_data->irq, i2c_pnx_interrupt,
722 0, pdev->name, alg_data);
727 ret = i2c_add_numbered_adapter(&alg_data->adapter);
732 alg_data->adapter.name, &res->start, alg_data->irq);
737 clk_disable_unprepare(alg_data->clk);
743 struct i2c_pnx_algo_data *alg_data = platform_get_drvdata(pdev);
745 i2c_del_adapter(&alg_data->adapter);
746 clk_disable_unprepare(alg_data->clk);