Lines Matching full:dev
68 static void vlynq_dump_regs(struct vlynq_device *dev) in vlynq_dump_regs() argument
73 dev->local, dev->remote); in vlynq_dump_regs()
76 i + 1, ((u32 *)dev->local)[i]); in vlynq_dump_regs()
78 i + 1, ((u32 *)dev->remote)[i]); in vlynq_dump_regs()
96 static int vlynq_linked(struct vlynq_device *dev) in vlynq_linked() argument
101 if (readl(&dev->local->status) & VLYNQ_STATUS_LINK) in vlynq_linked()
109 static void vlynq_reset(struct vlynq_device *dev) in vlynq_reset() argument
111 writel(readl(&dev->local->control) | VLYNQ_CTRL_RESET, in vlynq_reset()
112 &dev->local->control); in vlynq_reset()
118 writel(readl(&dev->local->control) & ~VLYNQ_CTRL_RESET, in vlynq_reset()
119 &dev->local->control); in vlynq_reset()
127 struct vlynq_device *dev = irq_data_get_irq_chip_data(d); in vlynq_irq_unmask() local
131 BUG_ON(!dev); in vlynq_irq_unmask()
132 virq = d->irq - dev->irq_start; in vlynq_irq_unmask()
133 val = readl(&dev->remote->int_device[virq >> 2]); in vlynq_irq_unmask()
135 writel(val, &dev->remote->int_device[virq >> 2]); in vlynq_irq_unmask()
140 struct vlynq_device *dev = irq_data_get_irq_chip_data(d); in vlynq_irq_mask() local
144 BUG_ON(!dev); in vlynq_irq_mask()
145 virq = d->irq - dev->irq_start; in vlynq_irq_mask()
146 val = readl(&dev->remote->int_device[virq >> 2]); in vlynq_irq_mask()
148 writel(val, &dev->remote->int_device[virq >> 2]); in vlynq_irq_mask()
153 struct vlynq_device *dev = irq_data_get_irq_chip_data(d); in vlynq_irq_type() local
157 BUG_ON(!dev); in vlynq_irq_type()
158 virq = d->irq - dev->irq_start; in vlynq_irq_type()
159 val = readl(&dev->remote->int_device[virq >> 2]); in vlynq_irq_type()
178 writel(val, &dev->remote->int_device[virq >> 2]); in vlynq_irq_type()
184 struct vlynq_device *dev = irq_data_get_irq_chip_data(d); in vlynq_local_ack() local
185 u32 status = readl(&dev->local->status); in vlynq_local_ack()
188 dev_name(&dev->dev), status); in vlynq_local_ack()
189 writel(status, &dev->local->status); in vlynq_local_ack()
194 struct vlynq_device *dev = irq_data_get_irq_chip_data(d); in vlynq_remote_ack() local
195 u32 status = readl(&dev->remote->status); in vlynq_remote_ack()
198 dev_name(&dev->dev), status); in vlynq_remote_ack()
199 writel(status, &dev->remote->status); in vlynq_remote_ack()
204 struct vlynq_device *dev = dev_id; in vlynq_irq() local
208 status = readl(&dev->local->int_status); in vlynq_irq()
209 writel(status, &dev->local->int_status); in vlynq_irq()
216 do_IRQ(dev->irq_start + virq); in vlynq_irq()
245 static int vlynq_setup_irq(struct vlynq_device *dev) in vlynq_setup_irq() argument
250 if (dev->local_irq == dev->remote_irq) { in vlynq_setup_irq()
253 dev_name(&dev->dev)); in vlynq_setup_irq()
258 writel(readl(&dev->local->status), &dev->local->status); in vlynq_setup_irq()
259 writel(readl(&dev->remote->status), &dev->remote->status); in vlynq_setup_irq()
262 val = VLYNQ_CTRL_INT_VECTOR(dev->local_irq); in vlynq_setup_irq()
265 val |= readl(&dev->local->control); in vlynq_setup_irq()
266 writel(VLYNQ_INT_OFFSET, &dev->local->int_ptr); in vlynq_setup_irq()
267 writel(val, &dev->local->control); in vlynq_setup_irq()
269 val = VLYNQ_CTRL_INT_VECTOR(dev->remote_irq); in vlynq_setup_irq()
271 val |= readl(&dev->remote->control); in vlynq_setup_irq()
272 writel(VLYNQ_INT_OFFSET, &dev->remote->int_ptr); in vlynq_setup_irq()
273 writel(val, &dev->remote->int_ptr); in vlynq_setup_irq()
274 writel(val, &dev->remote->control); in vlynq_setup_irq()
276 for (i = dev->irq_start; i <= dev->irq_end; i++) { in vlynq_setup_irq()
277 virq = i - dev->irq_start; in vlynq_setup_irq()
278 if (virq == dev->local_irq) { in vlynq_setup_irq()
281 irq_set_chip_data(i, dev); in vlynq_setup_irq()
282 } else if (virq == dev->remote_irq) { in vlynq_setup_irq()
285 irq_set_chip_data(i, dev); in vlynq_setup_irq()
289 irq_set_chip_data(i, dev); in vlynq_setup_irq()
290 writel(0, &dev->remote->int_device[virq >> 2]); in vlynq_setup_irq()
294 if (request_irq(dev->irq, vlynq_irq, IRQF_SHARED, "vlynq", dev)) { in vlynq_setup_irq()
296 dev_name(&dev->dev)); in vlynq_setup_irq()
303 static void vlynq_device_release(struct device *dev) in vlynq_device_release() argument
305 struct vlynq_device *vdev = to_vlynq_device(dev); in vlynq_device_release()
309 static int vlynq_device_match(struct device *dev, in vlynq_device_match() argument
312 struct vlynq_device *vdev = to_vlynq_device(dev); in vlynq_device_match()
331 static int vlynq_device_probe(struct device *dev) in vlynq_device_probe() argument
333 struct vlynq_device *vdev = to_vlynq_device(dev); in vlynq_device_probe()
334 struct vlynq_driver *drv = to_vlynq_driver(dev->driver); in vlynq_device_probe()
341 put_device(dev); in vlynq_device_probe()
345 static int vlynq_device_remove(struct device *dev) in vlynq_device_remove() argument
347 struct vlynq_driver *drv = to_vlynq_driver(dev->driver); in vlynq_device_remove()
350 drv->remove(to_vlynq_device(dev)); in vlynq_device_remove()
377 static int __vlynq_try_remote(struct vlynq_device *dev) in __vlynq_try_remote() argument
381 vlynq_reset(dev); in __vlynq_try_remote()
382 for (i = dev->dev_id ? vlynq_rdiv2 : vlynq_rdiv8; dev->dev_id ? in __vlynq_try_remote()
384 dev->dev_id ? i++ : i--) { in __vlynq_try_remote()
386 if (!vlynq_linked(dev)) in __vlynq_try_remote()
389 writel((readl(&dev->remote->control) & in __vlynq_try_remote()
393 &dev->remote->control); in __vlynq_try_remote()
394 writel((readl(&dev->local->control) in __vlynq_try_remote()
398 &dev->local->control); in __vlynq_try_remote()
400 if (vlynq_linked(dev)) { in __vlynq_try_remote()
403 dev_name(&dev->dev), i - vlynq_rdiv1 + 1); in __vlynq_try_remote()
404 dev->divisor = i; in __vlynq_try_remote()
407 vlynq_reset(dev); in __vlynq_try_remote()
421 static int __vlynq_try_local(struct vlynq_device *dev) in __vlynq_try_local() argument
425 vlynq_reset(dev); in __vlynq_try_local()
427 for (i = dev->dev_id ? vlynq_ldiv2 : vlynq_ldiv8; dev->dev_id ? in __vlynq_try_local()
429 dev->dev_id ? i++ : i--) { in __vlynq_try_local()
431 writel((readl(&dev->local->control) & in __vlynq_try_local()
435 &dev->local->control); in __vlynq_try_local()
437 if (vlynq_linked(dev)) { in __vlynq_try_local()
440 dev_name(&dev->dev), i - vlynq_ldiv1 + 1); in __vlynq_try_local()
441 dev->divisor = i; in __vlynq_try_local()
444 vlynq_reset(dev); in __vlynq_try_local()
457 static int __vlynq_try_external(struct vlynq_device *dev) in __vlynq_try_external() argument
459 vlynq_reset(dev); in __vlynq_try_external()
460 if (!vlynq_linked(dev)) in __vlynq_try_external()
463 writel((readl(&dev->remote->control) & in __vlynq_try_external()
465 &dev->remote->control); in __vlynq_try_external()
467 writel((readl(&dev->local->control) & in __vlynq_try_external()
469 &dev->local->control); in __vlynq_try_external()
471 if (vlynq_linked(dev)) { in __vlynq_try_external()
473 dev_name(&dev->dev)); in __vlynq_try_external()
474 dev->divisor = vlynq_div_external; in __vlynq_try_external()
481 static int __vlynq_enable_device(struct vlynq_device *dev) in __vlynq_enable_device() argument
484 struct plat_vlynq_ops *ops = dev->dev.platform_data; in __vlynq_enable_device()
486 result = ops->on(dev); in __vlynq_enable_device()
490 switch (dev->divisor) { in __vlynq_enable_device()
497 if (vlynq_linked(dev) && readl(&dev->remote->control) & in __vlynq_enable_device()
499 if (!__vlynq_try_remote(dev) || in __vlynq_enable_device()
500 !__vlynq_try_local(dev) || in __vlynq_enable_device()
501 !__vlynq_try_external(dev)) in __vlynq_enable_device()
504 if (!__vlynq_try_external(dev) || in __vlynq_enable_device()
505 !__vlynq_try_local(dev) || in __vlynq_enable_device()
506 !__vlynq_try_remote(dev)) in __vlynq_enable_device()
519 VLYNQ_CTRL_CLOCK_DIV(dev->divisor - in __vlynq_enable_device()
520 vlynq_ldiv1), &dev->local->control); in __vlynq_enable_device()
521 writel(0, &dev->remote->control); in __vlynq_enable_device()
522 if (vlynq_linked(dev)) { in __vlynq_enable_device()
525 dev_name(&dev->dev), in __vlynq_enable_device()
526 dev->divisor - vlynq_ldiv1 + 1); in __vlynq_enable_device()
538 writel(0, &dev->local->control); in __vlynq_enable_device()
540 VLYNQ_CTRL_CLOCK_DIV(dev->divisor - in __vlynq_enable_device()
541 vlynq_rdiv1), &dev->remote->control); in __vlynq_enable_device()
542 if (vlynq_linked(dev)) { in __vlynq_enable_device()
545 dev_name(&dev->dev), in __vlynq_enable_device()
546 dev->divisor - vlynq_rdiv1 + 1); in __vlynq_enable_device()
552 ops->off(dev); in __vlynq_enable_device()
556 int vlynq_enable_device(struct vlynq_device *dev) in vlynq_enable_device() argument
558 struct plat_vlynq_ops *ops = dev->dev.platform_data; in vlynq_enable_device()
561 result = __vlynq_enable_device(dev); in vlynq_enable_device()
565 result = vlynq_setup_irq(dev); in vlynq_enable_device()
567 ops->off(dev); in vlynq_enable_device()
569 dev->enabled = !result; in vlynq_enable_device()
575 void vlynq_disable_device(struct vlynq_device *dev) in vlynq_disable_device() argument
577 struct plat_vlynq_ops *ops = dev->dev.platform_data; in vlynq_disable_device()
579 dev->enabled = 0; in vlynq_disable_device()
580 free_irq(dev->irq, dev); in vlynq_disable_device()
581 ops->off(dev); in vlynq_disable_device()
585 int vlynq_set_local_mapping(struct vlynq_device *dev, u32 tx_offset, in vlynq_set_local_mapping() argument
590 if (!dev->enabled) in vlynq_set_local_mapping()
593 writel(tx_offset, &dev->local->tx_offset); in vlynq_set_local_mapping()
595 writel(mapping[i].offset, &dev->local->rx_mapping[i].offset); in vlynq_set_local_mapping()
596 writel(mapping[i].size, &dev->local->rx_mapping[i].size); in vlynq_set_local_mapping()
602 int vlynq_set_remote_mapping(struct vlynq_device *dev, u32 tx_offset, in vlynq_set_remote_mapping() argument
607 if (!dev->enabled) in vlynq_set_remote_mapping()
610 writel(tx_offset, &dev->remote->tx_offset); in vlynq_set_remote_mapping()
612 writel(mapping[i].offset, &dev->remote->rx_mapping[i].offset); in vlynq_set_remote_mapping()
613 writel(mapping[i].size, &dev->remote->rx_mapping[i].size); in vlynq_set_remote_mapping()
619 int vlynq_set_local_irq(struct vlynq_device *dev, int virq) in vlynq_set_local_irq() argument
621 int irq = dev->irq_start + virq; in vlynq_set_local_irq()
622 if (dev->enabled) in vlynq_set_local_irq()
625 if ((irq < dev->irq_start) || (irq > dev->irq_end)) in vlynq_set_local_irq()
628 if (virq == dev->remote_irq) in vlynq_set_local_irq()
631 dev->local_irq = virq; in vlynq_set_local_irq()
637 int vlynq_set_remote_irq(struct vlynq_device *dev, int virq) in vlynq_set_remote_irq() argument
639 int irq = dev->irq_start + virq; in vlynq_set_remote_irq()
640 if (dev->enabled) in vlynq_set_remote_irq()
643 if ((irq < dev->irq_start) || (irq > dev->irq_end)) in vlynq_set_remote_irq()
646 if (virq == dev->local_irq) in vlynq_set_remote_irq()
649 dev->remote_irq = virq; in vlynq_set_remote_irq()
657 struct vlynq_device *dev; in vlynq_probe() local
673 dev = kzalloc(sizeof(*dev), GFP_KERNEL); in vlynq_probe()
674 if (!dev) { in vlynq_probe()
680 dev->id = pdev->id; in vlynq_probe()
681 dev->dev.bus = &vlynq_bus_type; in vlynq_probe()
682 dev->dev.parent = &pdev->dev; in vlynq_probe()
683 dev_set_name(&dev->dev, "vlynq%d", dev->id); in vlynq_probe()
684 dev->dev.platform_data = pdev->dev.platform_data; in vlynq_probe()
685 dev->dev.release = vlynq_device_release; in vlynq_probe()
687 dev->regs_start = regs_res->start; in vlynq_probe()
688 dev->regs_end = regs_res->end; in vlynq_probe()
689 dev->mem_start = mem_res->start; in vlynq_probe()
690 dev->mem_end = mem_res->end; in vlynq_probe()
693 if (!request_mem_region(regs_res->start, len, dev_name(&dev->dev))) { in vlynq_probe()
695 dev_name(&dev->dev)); in vlynq_probe()
700 dev->local = ioremap(regs_res->start, len); in vlynq_probe()
701 if (!dev->local) { in vlynq_probe()
703 dev_name(&dev->dev)); in vlynq_probe()
708 dev->remote = (struct vlynq_regs *)((void *)dev->local + in vlynq_probe()
711 dev->irq = platform_get_irq_byname(pdev, "irq"); in vlynq_probe()
712 dev->irq_start = irq_res->start; in vlynq_probe()
713 dev->irq_end = irq_res->end; in vlynq_probe()
714 dev->local_irq = dev->irq_end - dev->irq_start; in vlynq_probe()
715 dev->remote_irq = dev->local_irq - 1; in vlynq_probe()
717 if (device_register(&dev->dev)) in vlynq_probe()
719 platform_set_drvdata(pdev, dev); in vlynq_probe()
722 dev_name(&dev->dev), (void *)dev->regs_start, dev->irq, in vlynq_probe()
723 (void *)dev->mem_start); in vlynq_probe()
725 dev->dev_id = 0; in vlynq_probe()
726 dev->divisor = vlynq_div_auto; in vlynq_probe()
727 result = __vlynq_enable_device(dev); in vlynq_probe()
729 dev->dev_id = readl(&dev->remote->chip); in vlynq_probe()
730 ((struct plat_vlynq_ops *)(dev->dev.platform_data))->off(dev); in vlynq_probe()
732 if (dev->dev_id) in vlynq_probe()
733 printk(KERN_INFO "Found a VLYNQ device: %08x\n", dev->dev_id); in vlynq_probe()
738 iounmap(dev->local); in vlynq_probe()
742 kfree(dev); in vlynq_probe()
748 struct vlynq_device *dev = platform_get_drvdata(pdev); in vlynq_remove() local
750 device_unregister(&dev->dev); in vlynq_remove()
751 iounmap(dev->local); in vlynq_remove()
752 release_mem_region(dev->regs_start, in vlynq_remove()
753 dev->regs_end - dev->regs_start + 1); in vlynq_remove()
755 kfree(dev); in vlynq_remove()