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
smx_handler(int irq,struct uio_info * dev_info)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
smx_ce_probe(struct platform_device * dev)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
smx_ce_remove(struct platform_device * dev)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
smx_ce_init_module(void)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
smx_ce_exit_module(void)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>");
141