SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/uio/uio_smx.c

   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
  27 static 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
  41 static 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
  96 out_unmap:
  97         iounmap(info->mem[0].internal_addr);
  98 out_free:
  99         kfree(info);
 100
 101         return ret;
 102 }
 103
 104 static 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
 117 static 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
 126 static int __init smx_ce_init_module(void)
 127 {
 128         return platform_driver_register(&smx_ce_driver);
 129 }
 130 module_init(smx_ce_init_module);
 131
 132 static void __exit smx_ce_exit_module(void)
 133 {
 134         platform_driver_unregister(&smx_ce_driver);
 135 }
 136 module_exit(smx_ce_exit_module);
 137
 138 MODULE_LICENSE("GPL v2");
 139 MODULE_VERSION(DRV_VERSION);
 140 MODULE_AUTHOR("Ben Nizette <bn@niasdigital.com>");