Lines Matching refs: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 void 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()
375 static int __vlynq_try_remote(struct vlynq_device *dev) in __vlynq_try_remote() argument
379 vlynq_reset(dev); in __vlynq_try_remote()
380 for (i = dev->dev_id ? vlynq_rdiv2 : vlynq_rdiv8; dev->dev_id ? in __vlynq_try_remote()
382 dev->dev_id ? i++ : i--) { in __vlynq_try_remote()
384 if (!vlynq_linked(dev)) in __vlynq_try_remote()
387 writel((readl(&dev->remote->control) & in __vlynq_try_remote()
391 &dev->remote->control); in __vlynq_try_remote()
392 writel((readl(&dev->local->control) in __vlynq_try_remote()
396 &dev->local->control); in __vlynq_try_remote()
398 if (vlynq_linked(dev)) { in __vlynq_try_remote()
401 dev_name(&dev->dev), i - vlynq_rdiv1 + 1); in __vlynq_try_remote()
402 dev->divisor = i; in __vlynq_try_remote()
405 vlynq_reset(dev); in __vlynq_try_remote()
419 static int __vlynq_try_local(struct vlynq_device *dev) in __vlynq_try_local() argument
423 vlynq_reset(dev); in __vlynq_try_local()
425 for (i = dev->dev_id ? vlynq_ldiv2 : vlynq_ldiv8; dev->dev_id ? in __vlynq_try_local()
427 dev->dev_id ? i++ : i--) { in __vlynq_try_local()
429 writel((readl(&dev->local->control) & in __vlynq_try_local()
433 &dev->local->control); in __vlynq_try_local()
435 if (vlynq_linked(dev)) { in __vlynq_try_local()
438 dev_name(&dev->dev), i - vlynq_ldiv1 + 1); in __vlynq_try_local()
439 dev->divisor = i; in __vlynq_try_local()
442 vlynq_reset(dev); in __vlynq_try_local()
455 static int __vlynq_try_external(struct vlynq_device *dev) in __vlynq_try_external() argument
457 vlynq_reset(dev); in __vlynq_try_external()
458 if (!vlynq_linked(dev)) in __vlynq_try_external()
461 writel((readl(&dev->remote->control) & in __vlynq_try_external()
463 &dev->remote->control); in __vlynq_try_external()
465 writel((readl(&dev->local->control) & in __vlynq_try_external()
467 &dev->local->control); in __vlynq_try_external()
469 if (vlynq_linked(dev)) { in __vlynq_try_external()
471 dev_name(&dev->dev)); in __vlynq_try_external()
472 dev->divisor = vlynq_div_external; in __vlynq_try_external()
479 static int __vlynq_enable_device(struct vlynq_device *dev) in __vlynq_enable_device() argument
482 struct plat_vlynq_ops *ops = dev->dev.platform_data; in __vlynq_enable_device()
484 result = ops->on(dev); in __vlynq_enable_device()
488 switch (dev->divisor) { in __vlynq_enable_device()
495 if (vlynq_linked(dev) && readl(&dev->remote->control) & in __vlynq_enable_device()
497 if (!__vlynq_try_remote(dev) || in __vlynq_enable_device()
498 !__vlynq_try_local(dev) || in __vlynq_enable_device()
499 !__vlynq_try_external(dev)) in __vlynq_enable_device()
502 if (!__vlynq_try_external(dev) || in __vlynq_enable_device()
503 !__vlynq_try_local(dev) || in __vlynq_enable_device()
504 !__vlynq_try_remote(dev)) in __vlynq_enable_device()
517 VLYNQ_CTRL_CLOCK_DIV(dev->divisor - in __vlynq_enable_device()
518 vlynq_ldiv1), &dev->local->control); in __vlynq_enable_device()
519 writel(0, &dev->remote->control); in __vlynq_enable_device()
520 if (vlynq_linked(dev)) { in __vlynq_enable_device()
523 dev_name(&dev->dev), in __vlynq_enable_device()
524 dev->divisor - vlynq_ldiv1 + 1); in __vlynq_enable_device()
536 writel(0, &dev->local->control); in __vlynq_enable_device()
538 VLYNQ_CTRL_CLOCK_DIV(dev->divisor - in __vlynq_enable_device()
539 vlynq_rdiv1), &dev->remote->control); in __vlynq_enable_device()
540 if (vlynq_linked(dev)) { in __vlynq_enable_device()
543 dev_name(&dev->dev), in __vlynq_enable_device()
544 dev->divisor - vlynq_rdiv1 + 1); in __vlynq_enable_device()
550 ops->off(dev); in __vlynq_enable_device()
554 int vlynq_enable_device(struct vlynq_device *dev) in vlynq_enable_device() argument
556 struct plat_vlynq_ops *ops = dev->dev.platform_data; in vlynq_enable_device()
559 result = __vlynq_enable_device(dev); in vlynq_enable_device()
563 result = vlynq_setup_irq(dev); in vlynq_enable_device()
565 ops->off(dev); in vlynq_enable_device()
567 dev->enabled = !result; in vlynq_enable_device()
573 void vlynq_disable_device(struct vlynq_device *dev) in vlynq_disable_device() argument
575 struct plat_vlynq_ops *ops = dev->dev.platform_data; in vlynq_disable_device()
577 dev->enabled = 0; in vlynq_disable_device()
578 free_irq(dev->irq, dev); in vlynq_disable_device()
579 ops->off(dev); in vlynq_disable_device()
583 int vlynq_set_local_mapping(struct vlynq_device *dev, u32 tx_offset, in vlynq_set_local_mapping() argument
588 if (!dev->enabled) in vlynq_set_local_mapping()
591 writel(tx_offset, &dev->local->tx_offset); in vlynq_set_local_mapping()
593 writel(mapping[i].offset, &dev->local->rx_mapping[i].offset); in vlynq_set_local_mapping()
594 writel(mapping[i].size, &dev->local->rx_mapping[i].size); in vlynq_set_local_mapping()
600 int vlynq_set_remote_mapping(struct vlynq_device *dev, u32 tx_offset, in vlynq_set_remote_mapping() argument
605 if (!dev->enabled) in vlynq_set_remote_mapping()
608 writel(tx_offset, &dev->remote->tx_offset); in vlynq_set_remote_mapping()
610 writel(mapping[i].offset, &dev->remote->rx_mapping[i].offset); in vlynq_set_remote_mapping()
611 writel(mapping[i].size, &dev->remote->rx_mapping[i].size); in vlynq_set_remote_mapping()
617 int vlynq_set_local_irq(struct vlynq_device *dev, int virq) in vlynq_set_local_irq() argument
619 int irq = dev->irq_start + virq; in vlynq_set_local_irq()
620 if (dev->enabled) in vlynq_set_local_irq()
623 if ((irq < dev->irq_start) || (irq > dev->irq_end)) in vlynq_set_local_irq()
626 if (virq == dev->remote_irq) in vlynq_set_local_irq()
629 dev->local_irq = virq; in vlynq_set_local_irq()
635 int vlynq_set_remote_irq(struct vlynq_device *dev, int virq) in vlynq_set_remote_irq() argument
637 int irq = dev->irq_start + virq; in vlynq_set_remote_irq()
638 if (dev->enabled) in vlynq_set_remote_irq()
641 if ((irq < dev->irq_start) || (irq > dev->irq_end)) in vlynq_set_remote_irq()
644 if (virq == dev->local_irq) in vlynq_set_remote_irq()
647 dev->remote_irq = virq; in vlynq_set_remote_irq()
655 struct vlynq_device *dev; in vlynq_probe() local
671 dev = kzalloc(sizeof(*dev), GFP_KERNEL); in vlynq_probe()
672 if (!dev) { in vlynq_probe()
678 dev->id = pdev->id; in vlynq_probe()
679 dev->dev.bus = &vlynq_bus_type; in vlynq_probe()
680 dev->dev.parent = &pdev->dev; in vlynq_probe()
681 dev_set_name(&dev->dev, "vlynq%d", dev->id); in vlynq_probe()
682 dev->dev.platform_data = pdev->dev.platform_data; in vlynq_probe()
683 dev->dev.release = vlynq_device_release; in vlynq_probe()
685 dev->regs_start = regs_res->start; in vlynq_probe()
686 dev->regs_end = regs_res->end; in vlynq_probe()
687 dev->mem_start = mem_res->start; in vlynq_probe()
688 dev->mem_end = mem_res->end; in vlynq_probe()
691 if (!request_mem_region(regs_res->start, len, dev_name(&dev->dev))) { in vlynq_probe()
693 dev_name(&dev->dev)); in vlynq_probe()
698 dev->local = ioremap(regs_res->start, len); in vlynq_probe()
699 if (!dev->local) { in vlynq_probe()
701 dev_name(&dev->dev)); in vlynq_probe()
706 dev->remote = (struct vlynq_regs *)((void *)dev->local + in vlynq_probe()
709 dev->irq = platform_get_irq_byname(pdev, "irq"); in vlynq_probe()
710 dev->irq_start = irq_res->start; in vlynq_probe()
711 dev->irq_end = irq_res->end; in vlynq_probe()
712 dev->local_irq = dev->irq_end - dev->irq_start; in vlynq_probe()
713 dev->remote_irq = dev->local_irq - 1; in vlynq_probe()
715 if (device_register(&dev->dev)) in vlynq_probe()
717 platform_set_drvdata(pdev, dev); in vlynq_probe()
720 dev_name(&dev->dev), (void *)dev->regs_start, dev->irq, in vlynq_probe()
721 (void *)dev->mem_start); in vlynq_probe()
723 dev->dev_id = 0; in vlynq_probe()
724 dev->divisor = vlynq_div_auto; in vlynq_probe()
725 result = __vlynq_enable_device(dev); in vlynq_probe()
727 dev->dev_id = readl(&dev->remote->chip); in vlynq_probe()
728 ((struct plat_vlynq_ops *)(dev->dev.platform_data))->off(dev); in vlynq_probe()
730 if (dev->dev_id) in vlynq_probe()
731 printk(KERN_INFO "Found a VLYNQ device: %08x\n", dev->dev_id); in vlynq_probe()
736 iounmap(dev->local); in vlynq_probe()
740 kfree(dev); in vlynq_probe()
746 struct vlynq_device *dev = platform_get_drvdata(pdev); in vlynq_remove() local
748 device_unregister(&dev->dev); in vlynq_remove()
749 iounmap(dev->local); in vlynq_remove()
750 release_mem_region(dev->regs_start, in vlynq_remove()
751 dev->regs_end - dev->regs_start + 1); in vlynq_remove()
753 kfree(dev); in vlynq_remove()