Commit | Line | Data |
---|---|---|
fb5bbee0 TC |
1 | /* |
2 | * Altera University Program PS2 controller driver | |
3 | * | |
4 | * Copyright (C) 2008 Thomas Chou <thomas@wytron.com.tw> | |
5 | * | |
6 | * Based on sa1111ps2.c, which is: | |
7 | * Copyright (C) 2002 Russell King | |
8 | * | |
9 | * This program is free software; you can redistribute it and/or modify | |
10 | * it under the terms of the GNU General Public License version 2 as | |
11 | * published by the Free Software Foundation. | |
12 | */ | |
13 | ||
14 | #include <linux/module.h> | |
15 | #include <linux/init.h> | |
16 | #include <linux/input.h> | |
17 | #include <linux/serio.h> | |
18 | #include <linux/interrupt.h> | |
19 | #include <linux/platform_device.h> | |
20 | #include <linux/io.h> | |
5a0e3ad6 | 21 | #include <linux/slab.h> |
fb5bbee0 TC |
22 | |
23 | #define DRV_NAME "altera_ps2" | |
24 | ||
25 | struct ps2if { | |
26 | struct serio *io; | |
27 | struct resource *iomem_res; | |
28 | void __iomem *base; | |
29 | unsigned irq; | |
30 | }; | |
31 | ||
32 | /* | |
33 | * Read all bytes waiting in the PS2 port. There should be | |
34 | * at the most one, but we loop for safety. | |
35 | */ | |
36 | static irqreturn_t altera_ps2_rxint(int irq, void *dev_id) | |
37 | { | |
38 | struct ps2if *ps2if = dev_id; | |
39 | unsigned int status; | |
40 | int handled = IRQ_NONE; | |
41 | ||
42 | while ((status = readl(ps2if->base)) & 0xffff0000) { | |
43 | serio_interrupt(ps2if->io, status & 0xff, 0); | |
44 | handled = IRQ_HANDLED; | |
45 | } | |
46 | ||
47 | return handled; | |
48 | } | |
49 | ||
50 | /* | |
51 | * Write a byte to the PS2 port. | |
52 | */ | |
53 | static int altera_ps2_write(struct serio *io, unsigned char val) | |
54 | { | |
55 | struct ps2if *ps2if = io->port_data; | |
56 | ||
57 | writel(val, ps2if->base); | |
58 | return 0; | |
59 | } | |
60 | ||
61 | static int altera_ps2_open(struct serio *io) | |
62 | { | |
63 | struct ps2if *ps2if = io->port_data; | |
64 | ||
65 | /* clear fifo */ | |
66 | while (readl(ps2if->base) & 0xffff0000) | |
67 | /* empty */; | |
68 | ||
69 | writel(1, ps2if->base + 4); /* enable rx irq */ | |
70 | return 0; | |
71 | } | |
72 | ||
73 | static void altera_ps2_close(struct serio *io) | |
74 | { | |
75 | struct ps2if *ps2if = io->port_data; | |
76 | ||
77 | writel(0, ps2if->base); /* disable rx irq */ | |
78 | } | |
79 | ||
80 | /* | |
81 | * Add one device to this driver. | |
82 | */ | |
1def7afa | 83 | static int __devinit altera_ps2_probe(struct platform_device *pdev) |
fb5bbee0 TC |
84 | { |
85 | struct ps2if *ps2if; | |
86 | struct serio *serio; | |
909275bc | 87 | int error, irq; |
fb5bbee0 TC |
88 | |
89 | ps2if = kzalloc(sizeof(struct ps2if), GFP_KERNEL); | |
90 | serio = kzalloc(sizeof(struct serio), GFP_KERNEL); | |
91 | if (!ps2if || !serio) { | |
92 | error = -ENOMEM; | |
93 | goto err_free_mem; | |
94 | } | |
95 | ||
96 | serio->id.type = SERIO_8042; | |
97 | serio->write = altera_ps2_write; | |
98 | serio->open = altera_ps2_open; | |
99 | serio->close = altera_ps2_close; | |
100 | strlcpy(serio->name, dev_name(&pdev->dev), sizeof(serio->name)); | |
101 | strlcpy(serio->phys, dev_name(&pdev->dev), sizeof(serio->phys)); | |
102 | serio->port_data = ps2if; | |
103 | serio->dev.parent = &pdev->dev; | |
104 | ps2if->io = serio; | |
105 | ||
106 | ps2if->iomem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
107 | if (ps2if->iomem_res == NULL) { | |
108 | error = -ENOENT; | |
109 | goto err_free_mem; | |
110 | } | |
111 | ||
909275bc RK |
112 | |
113 | irq = platform_get_irq(pdev, 0); | |
114 | if (irq < 0) { | |
fb5bbee0 TC |
115 | error = -ENXIO; |
116 | goto err_free_mem; | |
117 | } | |
909275bc | 118 | ps2if->irq = irq; |
fb5bbee0 TC |
119 | |
120 | if (!request_mem_region(ps2if->iomem_res->start, | |
121 | resource_size(ps2if->iomem_res), pdev->name)) { | |
122 | error = -EBUSY; | |
123 | goto err_free_mem; | |
124 | } | |
125 | ||
126 | ps2if->base = ioremap(ps2if->iomem_res->start, | |
127 | resource_size(ps2if->iomem_res)); | |
128 | if (!ps2if->base) { | |
129 | error = -ENOMEM; | |
130 | goto err_free_res; | |
131 | } | |
132 | ||
133 | error = request_irq(ps2if->irq, altera_ps2_rxint, 0, pdev->name, ps2if); | |
134 | if (error) { | |
135 | dev_err(&pdev->dev, "could not allocate IRQ %d: %d\n", | |
136 | ps2if->irq, error); | |
137 | goto err_unmap; | |
138 | } | |
139 | ||
140 | dev_info(&pdev->dev, "base %p, irq %d\n", ps2if->base, ps2if->irq); | |
141 | ||
142 | serio_register_port(ps2if->io); | |
143 | platform_set_drvdata(pdev, ps2if); | |
144 | ||
145 | return 0; | |
146 | ||
147 | err_unmap: | |
148 | iounmap(ps2if->base); | |
149 | err_free_res: | |
150 | release_mem_region(ps2if->iomem_res->start, | |
151 | resource_size(ps2if->iomem_res)); | |
152 | err_free_mem: | |
153 | kfree(ps2if); | |
154 | kfree(serio); | |
155 | return error; | |
156 | } | |
157 | ||
158 | /* | |
159 | * Remove one device from this driver. | |
160 | */ | |
1def7afa | 161 | static int __devexit altera_ps2_remove(struct platform_device *pdev) |
fb5bbee0 TC |
162 | { |
163 | struct ps2if *ps2if = platform_get_drvdata(pdev); | |
164 | ||
165 | platform_set_drvdata(pdev, NULL); | |
166 | serio_unregister_port(ps2if->io); | |
167 | free_irq(ps2if->irq, ps2if); | |
168 | iounmap(ps2if->base); | |
169 | release_mem_region(ps2if->iomem_res->start, | |
170 | resource_size(ps2if->iomem_res)); | |
171 | kfree(ps2if); | |
172 | ||
173 | return 0; | |
174 | } | |
175 | ||
176 | /* | |
177 | * Our device driver structure | |
178 | */ | |
179 | static struct platform_driver altera_ps2_driver = { | |
180 | .probe = altera_ps2_probe, | |
1def7afa | 181 | .remove = __devexit_p(altera_ps2_remove), |
fb5bbee0 TC |
182 | .driver = { |
183 | .name = DRV_NAME, | |
898d1053 | 184 | .owner = THIS_MODULE, |
fb5bbee0 TC |
185 | }, |
186 | }; | |
187 | ||
188 | static int __init altera_ps2_init(void) | |
189 | { | |
190 | return platform_driver_register(&altera_ps2_driver); | |
191 | } | |
192 | ||
193 | static void __exit altera_ps2_exit(void) | |
194 | { | |
195 | platform_driver_unregister(&altera_ps2_driver); | |
196 | } | |
197 | ||
198 | module_init(altera_ps2_init); | |
199 | module_exit(altera_ps2_exit); | |
200 | ||
201 | MODULE_DESCRIPTION("Altera University Program PS2 controller driver"); | |
202 | MODULE_AUTHOR("Thomas Chou <thomas@wytron.com.tw>"); | |
203 | MODULE_LICENSE("GPL"); | |
204 | MODULE_ALIAS("platform:" DRV_NAME); |