123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279 |
- #include <linux/platform_device.h>
- #include <linux/uio_driver.h>
- #include <linux/spinlock.h>
- #include <linux/bitops.h>
- #include <linux/module.h>
- #include <linux/interrupt.h>
- #include <linux/stringify.h>
- #include <linux/pm_runtime.h>
- #include <linux/slab.h>
- #include <linux/of.h>
- #include <linux/of_platform.h>
- #include <linux/of_address.h>
- #define DRIVER_NAME "uio_pdrv_genirq"
- struct uio_pdrv_genirq_platdata {
- struct uio_info *uioinfo;
- spinlock_t lock;
- unsigned long flags;
- struct platform_device *pdev;
- };
- enum {
- UIO_IRQ_DISABLED = 0,
- };
- static int uio_pdrv_genirq_open(struct uio_info *info, struct inode *inode)
- {
- struct uio_pdrv_genirq_platdata *priv = info->priv;
-
- pm_runtime_get_sync(&priv->pdev->dev);
- return 0;
- }
- static int uio_pdrv_genirq_release(struct uio_info *info, struct inode *inode)
- {
- struct uio_pdrv_genirq_platdata *priv = info->priv;
-
- pm_runtime_put_sync(&priv->pdev->dev);
- return 0;
- }
- static irqreturn_t uio_pdrv_genirq_handler(int irq, struct uio_info *dev_info)
- {
- struct uio_pdrv_genirq_platdata *priv = dev_info->priv;
-
- spin_lock(&priv->lock);
- if (!__test_and_set_bit(UIO_IRQ_DISABLED, &priv->flags))
- disable_irq_nosync(irq);
- spin_unlock(&priv->lock);
- return IRQ_HANDLED;
- }
- static int uio_pdrv_genirq_irqcontrol(struct uio_info *dev_info, s32 irq_on)
- {
- struct uio_pdrv_genirq_platdata *priv = dev_info->priv;
- unsigned long flags;
-
- spin_lock_irqsave(&priv->lock, flags);
- if (irq_on) {
- if (__test_and_clear_bit(UIO_IRQ_DISABLED, &priv->flags))
- enable_irq(dev_info->irq);
- } else {
- if (!__test_and_set_bit(UIO_IRQ_DISABLED, &priv->flags))
- disable_irq_nosync(dev_info->irq);
- }
- spin_unlock_irqrestore(&priv->lock, flags);
- return 0;
- }
- static int uio_pdrv_genirq_probe(struct platform_device *pdev)
- {
- struct uio_info *uioinfo = dev_get_platdata(&pdev->dev);
- struct uio_pdrv_genirq_platdata *priv;
- struct uio_mem *uiomem;
- int ret = -EINVAL;
- int i;
- if (pdev->dev.of_node) {
-
- uioinfo = devm_kzalloc(&pdev->dev, sizeof(*uioinfo),
- GFP_KERNEL);
- if (!uioinfo) {
- dev_err(&pdev->dev, "unable to kmalloc\n");
- return -ENOMEM;
- }
- uioinfo->name = pdev->dev.of_node->name;
- uioinfo->version = "devicetree";
-
- }
- if (!uioinfo || !uioinfo->name || !uioinfo->version) {
- dev_err(&pdev->dev, "missing platform_data\n");
- return ret;
- }
- if (uioinfo->handler || uioinfo->irqcontrol ||
- uioinfo->irq_flags & IRQF_SHARED) {
- dev_err(&pdev->dev, "interrupt configuration error\n");
- return ret;
- }
- priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
- if (!priv) {
- dev_err(&pdev->dev, "unable to kmalloc\n");
- return -ENOMEM;
- }
- priv->uioinfo = uioinfo;
- spin_lock_init(&priv->lock);
- priv->flags = 0;
- priv->pdev = pdev;
- if (!uioinfo->irq) {
- ret = platform_get_irq(pdev, 0);
- uioinfo->irq = ret;
- if (ret == -ENXIO && pdev->dev.of_node)
- uioinfo->irq = UIO_IRQ_NONE;
- else if (ret < 0) {
- dev_err(&pdev->dev, "failed to get IRQ\n");
- return ret;
- }
- }
- uiomem = &uioinfo->mem[0];
- for (i = 0; i < pdev->num_resources; ++i) {
- struct resource *r = &pdev->resource[i];
- if (r->flags != IORESOURCE_MEM)
- continue;
- if (uiomem >= &uioinfo->mem[MAX_UIO_MAPS]) {
- dev_warn(&pdev->dev, "device has more than "
- __stringify(MAX_UIO_MAPS)
- " I/O memory resources.\n");
- break;
- }
- uiomem->memtype = UIO_MEM_PHYS;
- uiomem->addr = r->start;
- uiomem->size = resource_size(r);
- uiomem->name = r->name;
- ++uiomem;
- }
- while (uiomem < &uioinfo->mem[MAX_UIO_MAPS]) {
- uiomem->size = 0;
- ++uiomem;
- }
-
- uioinfo->handler = uio_pdrv_genirq_handler;
- uioinfo->irqcontrol = uio_pdrv_genirq_irqcontrol;
- uioinfo->open = uio_pdrv_genirq_open;
- uioinfo->release = uio_pdrv_genirq_release;
- uioinfo->priv = priv;
-
- pm_runtime_enable(&pdev->dev);
- ret = uio_register_device(&pdev->dev, priv->uioinfo);
- if (ret) {
- dev_err(&pdev->dev, "unable to register uio device\n");
- pm_runtime_disable(&pdev->dev);
- return ret;
- }
- platform_set_drvdata(pdev, priv);
- return 0;
- }
- static int uio_pdrv_genirq_remove(struct platform_device *pdev)
- {
- struct uio_pdrv_genirq_platdata *priv = platform_get_drvdata(pdev);
- uio_unregister_device(priv->uioinfo);
- pm_runtime_disable(&pdev->dev);
- priv->uioinfo->handler = NULL;
- priv->uioinfo->irqcontrol = NULL;
- return 0;
- }
- static int uio_pdrv_genirq_runtime_nop(struct device *dev)
- {
-
- return 0;
- }
- static const struct dev_pm_ops uio_pdrv_genirq_dev_pm_ops = {
- .runtime_suspend = uio_pdrv_genirq_runtime_nop,
- .runtime_resume = uio_pdrv_genirq_runtime_nop,
- };
- #ifdef CONFIG_OF
- static struct of_device_id uio_of_genirq_match[] = {
- { },
- { },
- };
- MODULE_DEVICE_TABLE(of, uio_of_genirq_match);
- module_param_string(of_id, uio_of_genirq_match[0].compatible, 128, 0);
- MODULE_PARM_DESC(of_id, "Openfirmware id of the device to be handled by uio");
- #endif
- static struct platform_driver uio_pdrv_genirq = {
- .probe = uio_pdrv_genirq_probe,
- .remove = uio_pdrv_genirq_remove,
- .driver = {
- .name = DRIVER_NAME,
- .pm = &uio_pdrv_genirq_dev_pm_ops,
- .of_match_table = of_match_ptr(uio_of_genirq_match),
- },
- };
- module_platform_driver(uio_pdrv_genirq);
- MODULE_AUTHOR("Magnus Damm");
- MODULE_DESCRIPTION("Userspace I/O platform driver with generic IRQ handling");
- MODULE_LICENSE("GPL v2");
- MODULE_ALIAS("platform:" DRIVER_NAME);
|