Commit | Line | Data |
---|---|---|
48329582 MH |
1 | /* |
2 | * Rotary counter driver for Analog Devices Blackfin Processors | |
3 | * | |
4 | * Copyright 2008-2009 Analog Devices Inc. | |
5 | * Licensed under the GPL-2 or later. | |
6 | */ | |
7 | ||
8 | #include <linux/module.h> | |
48329582 | 9 | #include <linux/interrupt.h> |
71adf22f | 10 | #include <linux/io.h> |
48329582 MH |
11 | #include <linux/irq.h> |
12 | #include <linux/pm.h> | |
13 | #include <linux/platform_device.h> | |
14 | #include <linux/input.h> | |
5a0e3ad6 | 15 | #include <linux/slab.h> |
1ea74014 | 16 | #include <linux/platform_data/bfin_rotary.h> |
48329582 MH |
17 | |
18 | #include <asm/portmux.h> | |
48329582 | 19 | |
71adf22f SZ |
20 | #define CNT_CONFIG_OFF 0 /* CNT Config Offset */ |
21 | #define CNT_IMASK_OFF 4 /* CNT Interrupt Mask Offset */ | |
22 | #define CNT_STATUS_OFF 8 /* CNT Status Offset */ | |
23 | #define CNT_COMMAND_OFF 12 /* CNT Command Offset */ | |
24 | #define CNT_DEBOUNCE_OFF 16 /* CNT Debounce Offset */ | |
25 | #define CNT_COUNTER_OFF 20 /* CNT Counter Offset */ | |
26 | #define CNT_MAX_OFF 24 /* CNT Maximum Count Offset */ | |
27 | #define CNT_MIN_OFF 28 /* CNT Minimum Count Offset */ | |
28 | ||
48329582 MH |
29 | struct bfin_rot { |
30 | struct input_dev *input; | |
71adf22f | 31 | void __iomem *base; |
48329582 MH |
32 | int irq; |
33 | unsigned int up_key; | |
34 | unsigned int down_key; | |
35 | unsigned int button_key; | |
36 | unsigned int rel_code; | |
37 | unsigned short cnt_config; | |
38 | unsigned short cnt_imask; | |
39 | unsigned short cnt_debounce; | |
40 | }; | |
41 | ||
42 | static void report_key_event(struct input_dev *input, int keycode) | |
43 | { | |
44 | /* simulate a press-n-release */ | |
45 | input_report_key(input, keycode, 1); | |
46 | input_sync(input); | |
47 | input_report_key(input, keycode, 0); | |
48 | input_sync(input); | |
49 | } | |
50 | ||
51 | static void report_rotary_event(struct bfin_rot *rotary, int delta) | |
52 | { | |
53 | struct input_dev *input = rotary->input; | |
54 | ||
55 | if (rotary->up_key) { | |
56 | report_key_event(input, | |
57 | delta > 0 ? rotary->up_key : rotary->down_key); | |
58 | } else { | |
59 | input_report_rel(input, rotary->rel_code, delta); | |
60 | input_sync(input); | |
61 | } | |
62 | } | |
63 | ||
64 | static irqreturn_t bfin_rotary_isr(int irq, void *dev_id) | |
65 | { | |
7694f44d | 66 | struct bfin_rot *rotary = dev_id; |
48329582 MH |
67 | int delta; |
68 | ||
71adf22f | 69 | switch (readw(rotary->base + CNT_STATUS_OFF)) { |
48329582 MH |
70 | |
71 | case ICII: | |
72 | break; | |
73 | ||
74 | case UCII: | |
75 | case DCII: | |
71adf22f | 76 | delta = readl(rotary->base + CNT_COUNTER_OFF); |
48329582 MH |
77 | if (delta) |
78 | report_rotary_event(rotary, delta); | |
79 | break; | |
80 | ||
81 | case CZMII: | |
82 | report_key_event(rotary->input, rotary->button_key); | |
83 | break; | |
84 | ||
85 | default: | |
86 | break; | |
87 | } | |
88 | ||
71adf22f SZ |
89 | writew(W1LCNT_ZERO, rotary->base + CNT_COMMAND_OFF); /* Clear COUNTER */ |
90 | writew(-1, rotary->base + CNT_STATUS_OFF); /* Clear STATUS */ | |
48329582 MH |
91 | |
92 | return IRQ_HANDLED; | |
93 | } | |
94 | ||
f14d4df9 SZ |
95 | static void bfin_rotary_free_action(void *data) |
96 | { | |
97 | peripheral_free_list(data); | |
98 | } | |
99 | ||
5298cc4c | 100 | static int bfin_rotary_probe(struct platform_device *pdev) |
48329582 | 101 | { |
71adf22f | 102 | struct device *dev = &pdev->dev; |
f14d4df9 | 103 | const struct bfin_rotary_platform_data *pdata = dev_get_platdata(dev); |
48329582 | 104 | struct bfin_rot *rotary; |
71adf22f | 105 | struct resource *res; |
48329582 MH |
106 | struct input_dev *input; |
107 | int error; | |
108 | ||
109 | /* Basic validation */ | |
110 | if ((pdata->rotary_up_key && !pdata->rotary_down_key) || | |
111 | (!pdata->rotary_up_key && pdata->rotary_down_key)) { | |
112 | return -EINVAL; | |
113 | } | |
114 | ||
5ea0699a SZ |
115 | if (pdata->pin_list) { |
116 | error = peripheral_request_list(pdata->pin_list, | |
117 | dev_name(&pdev->dev)); | |
118 | if (error) { | |
f14d4df9 SZ |
119 | dev_err(dev, "requesting peripherals failed: %d\n", |
120 | error); | |
5ea0699a SZ |
121 | return error; |
122 | } | |
48329582 | 123 | |
f14d4df9 SZ |
124 | error = devm_add_action(dev, bfin_rotary_free_action, |
125 | pdata->pin_list); | |
126 | if (error) { | |
127 | dev_err(dev, "setting cleanup action failed: %d\n", | |
128 | error); | |
129 | peripheral_free_list(pdata->pin_list); | |
130 | return error; | |
131 | } | |
48329582 MH |
132 | } |
133 | ||
f14d4df9 SZ |
134 | rotary = devm_kzalloc(dev, sizeof(struct bfin_rot), GFP_KERNEL); |
135 | if (!rotary) | |
136 | return -ENOMEM; | |
137 | ||
71adf22f SZ |
138 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
139 | rotary->base = devm_ioremap_resource(dev, res); | |
f14d4df9 SZ |
140 | if (IS_ERR(rotary->base)) |
141 | return PTR_ERR(rotary->base); | |
142 | ||
143 | input = devm_input_allocate_device(dev); | |
144 | if (!input) | |
145 | return -ENOMEM; | |
71adf22f | 146 | |
48329582 MH |
147 | rotary->input = input; |
148 | ||
149 | rotary->up_key = pdata->rotary_up_key; | |
150 | rotary->down_key = pdata->rotary_down_key; | |
151 | rotary->button_key = pdata->rotary_button_key; | |
152 | rotary->rel_code = pdata->rotary_rel_code; | |
153 | ||
48329582 MH |
154 | input->name = pdev->name; |
155 | input->phys = "bfin-rotary/input0"; | |
156 | input->dev.parent = &pdev->dev; | |
157 | ||
158 | input_set_drvdata(input, rotary); | |
159 | ||
160 | input->id.bustype = BUS_HOST; | |
161 | input->id.vendor = 0x0001; | |
162 | input->id.product = 0x0001; | |
163 | input->id.version = 0x0100; | |
164 | ||
165 | if (rotary->up_key) { | |
166 | __set_bit(EV_KEY, input->evbit); | |
167 | __set_bit(rotary->up_key, input->keybit); | |
168 | __set_bit(rotary->down_key, input->keybit); | |
169 | } else { | |
170 | __set_bit(EV_REL, input->evbit); | |
171 | __set_bit(rotary->rel_code, input->relbit); | |
172 | } | |
173 | ||
174 | if (rotary->button_key) { | |
175 | __set_bit(EV_KEY, input->evbit); | |
176 | __set_bit(rotary->button_key, input->keybit); | |
177 | } | |
178 | ||
f14d4df9 SZ |
179 | rotary->irq = platform_get_irq(pdev, 0); |
180 | if (rotary->irq < 0) { | |
181 | dev_err(dev, "No rotary IRQ specified\n"); | |
182 | return -ENOENT; | |
183 | } | |
184 | ||
185 | error = devm_request_irq(dev, rotary->irq, bfin_rotary_isr, | |
186 | 0, dev_name(dev), rotary); | |
48329582 | 187 | if (error) { |
f14d4df9 | 188 | dev_err(dev, "unable to claim irq %d; error %d\n", |
48329582 | 189 | rotary->irq, error); |
f14d4df9 | 190 | return error; |
48329582 MH |
191 | } |
192 | ||
193 | error = input_register_device(input); | |
194 | if (error) { | |
f14d4df9 SZ |
195 | dev_err(dev, "unable to register input device (%d)\n", error); |
196 | return error; | |
48329582 MH |
197 | } |
198 | ||
199 | if (pdata->rotary_button_key) | |
71adf22f | 200 | writew(CZMIE, rotary->base + CNT_IMASK_OFF); |
48329582 MH |
201 | |
202 | if (pdata->mode & ROT_DEBE) | |
71adf22f SZ |
203 | writew(pdata->debounce & DPRESCALE, |
204 | rotary->base + CNT_DEBOUNCE_OFF); | |
48329582 MH |
205 | |
206 | if (pdata->mode) | |
71adf22f SZ |
207 | writew(readw(rotary->base + CNT_CONFIG_OFF) | |
208 | (pdata->mode & ~CNTE), | |
209 | rotary->base + CNT_CONFIG_OFF); | |
48329582 | 210 | |
71adf22f SZ |
211 | writew(readw(rotary->base + CNT_IMASK_OFF) | UCIE | DCIE, |
212 | rotary->base + CNT_IMASK_OFF); | |
213 | writew(readw(rotary->base + CNT_CONFIG_OFF) | CNTE, | |
214 | rotary->base + CNT_CONFIG_OFF); | |
48329582 MH |
215 | |
216 | platform_set_drvdata(pdev, rotary); | |
217 | device_init_wakeup(&pdev->dev, 1); | |
218 | ||
219 | return 0; | |
48329582 MH |
220 | } |
221 | ||
e2619cf7 | 222 | static int bfin_rotary_remove(struct platform_device *pdev) |
48329582 MH |
223 | { |
224 | struct bfin_rot *rotary = platform_get_drvdata(pdev); | |
225 | ||
71adf22f SZ |
226 | writew(0, rotary->base + CNT_CONFIG_OFF); |
227 | writew(0, rotary->base + CNT_IMASK_OFF); | |
48329582 | 228 | |
48329582 MH |
229 | return 0; |
230 | } | |
231 | ||
5ec662e7 | 232 | static int __maybe_unused bfin_rotary_suspend(struct device *dev) |
48329582 MH |
233 | { |
234 | struct platform_device *pdev = to_platform_device(dev); | |
235 | struct bfin_rot *rotary = platform_get_drvdata(pdev); | |
236 | ||
71adf22f SZ |
237 | rotary->cnt_config = readw(rotary->base + CNT_CONFIG_OFF); |
238 | rotary->cnt_imask = readw(rotary->base + CNT_IMASK_OFF); | |
239 | rotary->cnt_debounce = readw(rotary->base + CNT_DEBOUNCE_OFF); | |
48329582 MH |
240 | |
241 | if (device_may_wakeup(&pdev->dev)) | |
242 | enable_irq_wake(rotary->irq); | |
243 | ||
244 | return 0; | |
245 | } | |
246 | ||
5ec662e7 | 247 | static int __maybe_unused bfin_rotary_resume(struct device *dev) |
48329582 MH |
248 | { |
249 | struct platform_device *pdev = to_platform_device(dev); | |
250 | struct bfin_rot *rotary = platform_get_drvdata(pdev); | |
251 | ||
71adf22f SZ |
252 | writew(rotary->cnt_debounce, rotary->base + CNT_DEBOUNCE_OFF); |
253 | writew(rotary->cnt_imask, rotary->base + CNT_IMASK_OFF); | |
254 | writew(rotary->cnt_config & ~CNTE, rotary->base + CNT_CONFIG_OFF); | |
48329582 MH |
255 | |
256 | if (device_may_wakeup(&pdev->dev)) | |
257 | disable_irq_wake(rotary->irq); | |
258 | ||
259 | if (rotary->cnt_config & CNTE) | |
71adf22f | 260 | writew(rotary->cnt_config, rotary->base + CNT_CONFIG_OFF); |
48329582 MH |
261 | |
262 | return 0; | |
263 | } | |
264 | ||
5ec662e7 DT |
265 | static SIMPLE_DEV_PM_OPS(bfin_rotary_pm_ops, |
266 | bfin_rotary_suspend, bfin_rotary_resume); | |
48329582 MH |
267 | |
268 | static struct platform_driver bfin_rotary_device_driver = { | |
269 | .probe = bfin_rotary_probe, | |
1cb0aa88 | 270 | .remove = bfin_rotary_remove, |
48329582 MH |
271 | .driver = { |
272 | .name = "bfin-rotary", | |
48329582 | 273 | .pm = &bfin_rotary_pm_ops, |
48329582 MH |
274 | }, |
275 | }; | |
840a746b | 276 | module_platform_driver(bfin_rotary_device_driver); |
48329582 MH |
277 | |
278 | MODULE_LICENSE("GPL"); | |
279 | MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>"); | |
280 | MODULE_DESCRIPTION("Rotary Counter driver for Blackfin Processors"); | |
281 | MODULE_ALIAS("platform:bfin-rotary"); |