LXR linux/drivers/uio/uio

   1/*
   2 * UIO SMX Cryptengine driver.
   3 *
   4 * (C) 2008 Nias Digital P/L <bn@niasdigital.com>
   5 *
   6 * This program is free software; you can redistribute it and/or modify
   7 * it under the terms of the GNU General Public License version 2 as
   8 * published by the Free Software Foundation.
   9 *
  10 */
  11
  12#include <linux/device.h>
  13#include <linux/module.h>
  14#include <linux/platform_device.h>
  15#include <linux/uio_driver.h>
  16#include <linux/io.h>
  17
  18#define DRV_NAME "smx-ce"
  19#define DRV_VERSION "0.03"
  20
  21#define SMX_CSR  0x00000000
  22#define SMX_EnD  0x00000001
  23#define SMX_RUN  0x00000002
  24#define SMX_DRDY 0x00000004
  25#define SMX_ERR  0x00000008
  26
  27static irqreturn_t smx_handler(int irq, struct uio_info *dev_info)
  28{
  29        void __iomem *csr = dev_info->mem[0].internal_addr + SMX_CSR;
  30
  31        u32 status = ioread32(csr);
  32
  33        if (!(status & SMX_DRDY))
  34                return IRQ_NONE;
  35
  36        /* Disable interrupt */
  37        iowrite32(status & ~SMX_DRDY, csr);
  38        return IRQ_HANDLED;
  39}
  40
  41static int __devinit smx_ce_probe(struct platform_device *dev)
  42{
  43
  44        int ret = -ENODEV;
  45        struct uio_info *info;
  46        struct resource *regs;
  47
  48        info = kzalloc(sizeof(struct uio_info), GFP_KERNEL);
  49        if (!info)
  50                return -ENOMEM;
  51
  52        regs = platform_get_resource(dev, IORESOURCE_MEM, 0);
  53        if (!regs) {
  54                dev_err(&dev->dev, "No memory resource specified\n");
  55                goto out_free;
  56        }
  57
  58        info->mem[0].addr = regs->start;
  59        if (!info->mem[0].addr) {
  60                dev_err(&dev->dev, "Invalid memory resource\n");
  61                goto out_free;
  62        }
  63
  64        info->mem[0].size = regs->end - regs->start + 1;
  65        info->mem[0].internal_addr = ioremap(regs->start, info->mem[0].size);
  66
  67        if (!info->mem[0].internal_addr) {
  68                dev_err(&dev->dev, "Can't remap memory address range\n");
  69                goto out_free;
  70        }
  71
  72        info->mem[0].memtype = UIO_MEM_PHYS;
  73
  74        info->name = "smx-ce";
  75        info->version = "0.03";
  76
  77        info->irq = platform_get_irq(dev, 0);
  78        if (info->irq < 0) {
  79                ret = info->irq;
  80                dev_err(&dev->dev, "No (or invalid) IRQ resource specified\n");
  81                goto out_unmap;
  82        }
  83
  84        info->irq_flags = IRQF_SHARED;
  85        info->handler = smx_handler;
  86
  87        platform_set_drvdata(dev, info);
  88
  89        ret = uio_register_device(&dev->dev, info);
  90
  91        if (ret)
  92                goto out_unmap;
  93
  94        return 0;
  95
  96out_unmap:
  97        iounmap(info->mem[0].internal_addr);
  98out_free:
  99        kfree(info);
 100
 101        return ret;
 102}
 103
 104static int __devexit smx_ce_remove(struct platform_device *dev)
 105{
 106        struct uio_info *info = platform_get_drvdata(dev);
 107
 108        uio_unregister_device(info);
 109        platform_set_drvdata(dev, NULL);
 110        iounmap(info->mem[0].internal_addr);
 111
 112        kfree(info);
 113
 114        return 0;
 115}
 116
 117static struct platform_driver smx_ce_driver = {
 118        .probe          = smx_ce_probe,
 119        .remove         = __devexit_p(smx_ce_remove),
 120        .driver         = {
 121                .name   = DRV_NAME,
 122                .owner  = THIS_MODULE,
 123        },
 124};
 125
 126static int __init smx_ce_init_module(void)
 127{
 128        return platform_driver_register(&smx_ce_driver);
 129}
 130module_init(smx_ce_init_module);
 131
 132static void __exit smx_ce_exit_module(void)
 133{
 134        platform_driver_unregister(&smx_ce_driver);
 135}
 136module_exit(smx_ce_exit_module);
 137
 138MODULE_LICENSE("GPL v2");
 139MODULE_VERSION(DRV_VERSION);
 140MODULE_AUTHOR("Ben Nizette <bn@niasdigital.com>");
 141