diff options
-rw-r--r-- | drivers/mfd/Kconfig | 5 | ||||
-rw-r--r-- | drivers/mfd/Makefile | 1 | ||||
-rw-r--r-- | drivers/mfd/ucb1x00-core.c | 665 | ||||
-rw-r--r-- | drivers/mfd/ucb1x00.h | 256 |
4 files changed, 927 insertions, 0 deletions
diff --git a/drivers/mfd/Kconfig b/drivers/mfd/Kconfig index 1588a59e3767..1f8563bde4a9 100644 --- a/drivers/mfd/Kconfig +++ b/drivers/mfd/Kconfig | |||
@@ -13,4 +13,9 @@ config MCP_SA11X0 | |||
13 | depends on ARCH_SA1100 | 13 | depends on ARCH_SA1100 |
14 | select MCP | 14 | select MCP |
15 | 15 | ||
16 | # Chip drivers | ||
17 | config MCP_UCB1200 | ||
18 | tristate "Support for UCB1200 / UCB1300" | ||
19 | depends on MCP | ||
20 | |||
16 | endmenu | 21 | endmenu |
diff --git a/drivers/mfd/Makefile b/drivers/mfd/Makefile index 98bdd6a42188..90815b284021 100644 --- a/drivers/mfd/Makefile +++ b/drivers/mfd/Makefile | |||
@@ -4,3 +4,4 @@ | |||
4 | 4 | ||
5 | obj-$(CONFIG_MCP) += mcp-core.o | 5 | obj-$(CONFIG_MCP) += mcp-core.o |
6 | obj-$(CONFIG_MCP_SA11X0) += mcp-sa11x0.o | 6 | obj-$(CONFIG_MCP_SA11X0) += mcp-sa11x0.o |
7 | obj-$(CONFIG_MCP_UCB1200) += ucb1x00-core.o | ||
diff --git a/drivers/mfd/ucb1x00-core.c b/drivers/mfd/ucb1x00-core.c new file mode 100644 index 000000000000..10f6ce1bc0ab --- /dev/null +++ b/drivers/mfd/ucb1x00-core.c | |||
@@ -0,0 +1,665 @@ | |||
1 | /* | ||
2 | * linux/drivers/mfd/ucb1x00-core.c | ||
3 | * | ||
4 | * Copyright (C) 2001 Russell King, All Rights Reserved. | ||
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 as published by | ||
8 | * the Free Software Foundation; either version 2 of the License. | ||
9 | * | ||
10 | * The UCB1x00 core driver provides basic services for handling IO, | ||
11 | * the ADC, interrupts, and accessing registers. It is designed | ||
12 | * such that everything goes through this layer, thereby providing | ||
13 | * a consistent locking methodology, as well as allowing the drivers | ||
14 | * to be used on other non-MCP-enabled hardware platforms. | ||
15 | * | ||
16 | * Note that all locks are private to this file. Nothing else may | ||
17 | * touch them. | ||
18 | */ | ||
19 | #include <linux/config.h> | ||
20 | #include <linux/module.h> | ||
21 | #include <linux/kernel.h> | ||
22 | #include <linux/slab.h> | ||
23 | #include <linux/init.h> | ||
24 | #include <linux/errno.h> | ||
25 | #include <linux/interrupt.h> | ||
26 | #include <linux/device.h> | ||
27 | |||
28 | #include <asm/dma.h> | ||
29 | #include <asm/hardware.h> | ||
30 | #include <asm/irq.h> | ||
31 | |||
32 | #include "ucb1x00.h" | ||
33 | |||
34 | static DECLARE_MUTEX(ucb1x00_sem); | ||
35 | static LIST_HEAD(ucb1x00_drivers); | ||
36 | static LIST_HEAD(ucb1x00_devices); | ||
37 | |||
38 | /** | ||
39 | * ucb1x00_io_set_dir - set IO direction | ||
40 | * @ucb: UCB1x00 structure describing chip | ||
41 | * @in: bitfield of IO pins to be set as inputs | ||
42 | * @out: bitfield of IO pins to be set as outputs | ||
43 | * | ||
44 | * Set the IO direction of the ten general purpose IO pins on | ||
45 | * the UCB1x00 chip. The @in bitfield has priority over the | ||
46 | * @out bitfield, in that if you specify a pin as both input | ||
47 | * and output, it will end up as an input. | ||
48 | * | ||
49 | * ucb1x00_enable must have been called to enable the comms | ||
50 | * before using this function. | ||
51 | * | ||
52 | * This function takes a spinlock, disabling interrupts. | ||
53 | */ | ||
54 | void ucb1x00_io_set_dir(struct ucb1x00 *ucb, unsigned int in, unsigned int out) | ||
55 | { | ||
56 | unsigned long flags; | ||
57 | |||
58 | spin_lock_irqsave(&ucb->io_lock, flags); | ||
59 | ucb->io_dir |= out; | ||
60 | ucb->io_dir &= ~in; | ||
61 | |||
62 | ucb1x00_reg_write(ucb, UCB_IO_DIR, ucb->io_dir); | ||
63 | spin_unlock_irqrestore(&ucb->io_lock, flags); | ||
64 | } | ||
65 | |||
66 | /** | ||
67 | * ucb1x00_io_write - set or clear IO outputs | ||
68 | * @ucb: UCB1x00 structure describing chip | ||
69 | * @set: bitfield of IO pins to set to logic '1' | ||
70 | * @clear: bitfield of IO pins to set to logic '0' | ||
71 | * | ||
72 | * Set the IO output state of the specified IO pins. The value | ||
73 | * is retained if the pins are subsequently configured as inputs. | ||
74 | * The @clear bitfield has priority over the @set bitfield - | ||
75 | * outputs will be cleared. | ||
76 | * | ||
77 | * ucb1x00_enable must have been called to enable the comms | ||
78 | * before using this function. | ||
79 | * | ||
80 | * This function takes a spinlock, disabling interrupts. | ||
81 | */ | ||
82 | void ucb1x00_io_write(struct ucb1x00 *ucb, unsigned int set, unsigned int clear) | ||
83 | { | ||
84 | unsigned long flags; | ||
85 | |||
86 | spin_lock_irqsave(&ucb->io_lock, flags); | ||
87 | ucb->io_out |= set; | ||
88 | ucb->io_out &= ~clear; | ||
89 | |||
90 | ucb1x00_reg_write(ucb, UCB_IO_DATA, ucb->io_out); | ||
91 | spin_unlock_irqrestore(&ucb->io_lock, flags); | ||
92 | } | ||
93 | |||
94 | /** | ||
95 | * ucb1x00_io_read - read the current state of the IO pins | ||
96 | * @ucb: UCB1x00 structure describing chip | ||
97 | * | ||
98 | * Return a bitfield describing the logic state of the ten | ||
99 | * general purpose IO pins. | ||
100 | * | ||
101 | * ucb1x00_enable must have been called to enable the comms | ||
102 | * before using this function. | ||
103 | * | ||
104 | * This function does not take any semaphores or spinlocks. | ||
105 | */ | ||
106 | unsigned int ucb1x00_io_read(struct ucb1x00 *ucb) | ||
107 | { | ||
108 | return ucb1x00_reg_read(ucb, UCB_IO_DATA); | ||
109 | } | ||
110 | |||
111 | /* | ||
112 | * UCB1300 data sheet says we must: | ||
113 | * 1. enable ADC => 5us (including reference startup time) | ||
114 | * 2. select input => 51*tsibclk => 4.3us | ||
115 | * 3. start conversion => 102*tsibclk => 8.5us | ||
116 | * (tsibclk = 1/11981000) | ||
117 | * Period between SIB 128-bit frames = 10.7us | ||
118 | */ | ||
119 | |||
120 | /** | ||
121 | * ucb1x00_adc_enable - enable the ADC converter | ||
122 | * @ucb: UCB1x00 structure describing chip | ||
123 | * | ||
124 | * Enable the ucb1x00 and ADC converter on the UCB1x00 for use. | ||
125 | * Any code wishing to use the ADC converter must call this | ||
126 | * function prior to using it. | ||
127 | * | ||
128 | * This function takes the ADC semaphore to prevent two or more | ||
129 | * concurrent uses, and therefore may sleep. As a result, it | ||
130 | * can only be called from process context, not interrupt | ||
131 | * context. | ||
132 | * | ||
133 | * You should release the ADC as soon as possible using | ||
134 | * ucb1x00_adc_disable. | ||
135 | */ | ||
136 | void ucb1x00_adc_enable(struct ucb1x00 *ucb) | ||
137 | { | ||
138 | down(&ucb->adc_sem); | ||
139 | |||
140 | ucb->adc_cr |= UCB_ADC_ENA; | ||
141 | |||
142 | ucb1x00_enable(ucb); | ||
143 | ucb1x00_reg_write(ucb, UCB_ADC_CR, ucb->adc_cr); | ||
144 | } | ||
145 | |||
146 | /** | ||
147 | * ucb1x00_adc_read - read the specified ADC channel | ||
148 | * @ucb: UCB1x00 structure describing chip | ||
149 | * @adc_channel: ADC channel mask | ||
150 | * @sync: wait for syncronisation pulse. | ||
151 | * | ||
152 | * Start an ADC conversion and wait for the result. Note that | ||
153 | * synchronised ADC conversions (via the ADCSYNC pin) must wait | ||
154 | * until the trigger is asserted and the conversion is finished. | ||
155 | * | ||
156 | * This function currently spins waiting for the conversion to | ||
157 | * complete (2 frames max without sync). | ||
158 | * | ||
159 | * If called for a synchronised ADC conversion, it may sleep | ||
160 | * with the ADC semaphore held. | ||
161 | */ | ||
162 | unsigned int ucb1x00_adc_read(struct ucb1x00 *ucb, int adc_channel, int sync) | ||
163 | { | ||
164 | unsigned int val; | ||
165 | |||
166 | if (sync) | ||
167 | adc_channel |= UCB_ADC_SYNC_ENA; | ||
168 | |||
169 | ucb1x00_reg_write(ucb, UCB_ADC_CR, ucb->adc_cr | adc_channel); | ||
170 | ucb1x00_reg_write(ucb, UCB_ADC_CR, ucb->adc_cr | adc_channel | UCB_ADC_START); | ||
171 | |||
172 | for (;;) { | ||
173 | val = ucb1x00_reg_read(ucb, UCB_ADC_DATA); | ||
174 | if (val & UCB_ADC_DAT_VAL) | ||
175 | break; | ||
176 | /* yield to other processes */ | ||
177 | set_current_state(TASK_INTERRUPTIBLE); | ||
178 | schedule_timeout(1); | ||
179 | } | ||
180 | |||
181 | return UCB_ADC_DAT(val); | ||
182 | } | ||
183 | |||
184 | /** | ||
185 | * ucb1x00_adc_disable - disable the ADC converter | ||
186 | * @ucb: UCB1x00 structure describing chip | ||
187 | * | ||
188 | * Disable the ADC converter and release the ADC semaphore. | ||
189 | */ | ||
190 | void ucb1x00_adc_disable(struct ucb1x00 *ucb) | ||
191 | { | ||
192 | ucb->adc_cr &= ~UCB_ADC_ENA; | ||
193 | ucb1x00_reg_write(ucb, UCB_ADC_CR, ucb->adc_cr); | ||
194 | ucb1x00_disable(ucb); | ||
195 | |||
196 | up(&ucb->adc_sem); | ||
197 | } | ||
198 | |||
199 | /* | ||
200 | * UCB1x00 Interrupt handling. | ||
201 | * | ||
202 | * The UCB1x00 can generate interrupts when the SIBCLK is stopped. | ||
203 | * Since we need to read an internal register, we must re-enable | ||
204 | * SIBCLK to talk to the chip. We leave the clock running until | ||
205 | * we have finished processing all interrupts from the chip. | ||
206 | */ | ||
207 | static irqreturn_t ucb1x00_irq(int irqnr, void *devid, struct pt_regs *regs) | ||
208 | { | ||
209 | struct ucb1x00 *ucb = devid; | ||
210 | struct ucb1x00_irq *irq; | ||
211 | unsigned int isr, i; | ||
212 | |||
213 | ucb1x00_enable(ucb); | ||
214 | isr = ucb1x00_reg_read(ucb, UCB_IE_STATUS); | ||
215 | ucb1x00_reg_write(ucb, UCB_IE_CLEAR, isr); | ||
216 | ucb1x00_reg_write(ucb, UCB_IE_CLEAR, 0); | ||
217 | |||
218 | for (i = 0, irq = ucb->irq_handler; i < 16 && isr; i++, isr >>= 1, irq++) | ||
219 | if (isr & 1 && irq->fn) | ||
220 | irq->fn(i, irq->devid); | ||
221 | ucb1x00_disable(ucb); | ||
222 | |||
223 | return IRQ_HANDLED; | ||
224 | } | ||
225 | |||
226 | /** | ||
227 | * ucb1x00_hook_irq - hook a UCB1x00 interrupt | ||
228 | * @ucb: UCB1x00 structure describing chip | ||
229 | * @idx: interrupt index | ||
230 | * @fn: function to call when interrupt is triggered | ||
231 | * @devid: device id to pass to interrupt handler | ||
232 | * | ||
233 | * Hook the specified interrupt. You can only register one handler | ||
234 | * for each interrupt source. The interrupt source is not enabled | ||
235 | * by this function; use ucb1x00_enable_irq instead. | ||
236 | * | ||
237 | * Interrupt handlers will be called with other interrupts enabled. | ||
238 | * | ||
239 | * Returns zero on success, or one of the following errors: | ||
240 | * -EINVAL if the interrupt index is invalid | ||
241 | * -EBUSY if the interrupt has already been hooked | ||
242 | */ | ||
243 | int ucb1x00_hook_irq(struct ucb1x00 *ucb, unsigned int idx, void (*fn)(int, void *), void *devid) | ||
244 | { | ||
245 | struct ucb1x00_irq *irq; | ||
246 | int ret = -EINVAL; | ||
247 | |||
248 | if (idx < 16) { | ||
249 | irq = ucb->irq_handler + idx; | ||
250 | ret = -EBUSY; | ||
251 | |||
252 | spin_lock_irq(&ucb->lock); | ||
253 | if (irq->fn == NULL) { | ||
254 | irq->devid = devid; | ||
255 | irq->fn = fn; | ||
256 | ret = 0; | ||
257 | } | ||
258 | spin_unlock_irq(&ucb->lock); | ||
259 | } | ||
260 | return ret; | ||
261 | } | ||
262 | |||
263 | /** | ||
264 | * ucb1x00_enable_irq - enable an UCB1x00 interrupt source | ||
265 | * @ucb: UCB1x00 structure describing chip | ||
266 | * @idx: interrupt index | ||
267 | * @edges: interrupt edges to enable | ||
268 | * | ||
269 | * Enable the specified interrupt to trigger on %UCB_RISING, | ||
270 | * %UCB_FALLING or both edges. The interrupt should have been | ||
271 | * hooked by ucb1x00_hook_irq. | ||
272 | */ | ||
273 | void ucb1x00_enable_irq(struct ucb1x00 *ucb, unsigned int idx, int edges) | ||
274 | { | ||
275 | unsigned long flags; | ||
276 | |||
277 | if (idx < 16) { | ||
278 | spin_lock_irqsave(&ucb->lock, flags); | ||
279 | |||
280 | ucb1x00_enable(ucb); | ||
281 | if (edges & UCB_RISING) { | ||
282 | ucb->irq_ris_enbl |= 1 << idx; | ||
283 | ucb1x00_reg_write(ucb, UCB_IE_RIS, ucb->irq_ris_enbl); | ||
284 | } | ||
285 | if (edges & UCB_FALLING) { | ||
286 | ucb->irq_fal_enbl |= 1 << idx; | ||
287 | ucb1x00_reg_write(ucb, UCB_IE_FAL, ucb->irq_fal_enbl); | ||
288 | } | ||
289 | ucb1x00_disable(ucb); | ||
290 | spin_unlock_irqrestore(&ucb->lock, flags); | ||
291 | } | ||
292 | } | ||
293 | |||
294 | /** | ||
295 | * ucb1x00_disable_irq - disable an UCB1x00 interrupt source | ||
296 | * @ucb: UCB1x00 structure describing chip | ||
297 | * @edges: interrupt edges to disable | ||
298 | * | ||
299 | * Disable the specified interrupt triggering on the specified | ||
300 | * (%UCB_RISING, %UCB_FALLING or both) edges. | ||
301 | */ | ||
302 | void ucb1x00_disable_irq(struct ucb1x00 *ucb, unsigned int idx, int edges) | ||
303 | { | ||
304 | unsigned long flags; | ||
305 | |||
306 | if (idx < 16) { | ||
307 | spin_lock_irqsave(&ucb->lock, flags); | ||
308 | |||
309 | ucb1x00_enable(ucb); | ||
310 | if (edges & UCB_RISING) { | ||
311 | ucb->irq_ris_enbl &= ~(1 << idx); | ||
312 | ucb1x00_reg_write(ucb, UCB_IE_RIS, ucb->irq_ris_enbl); | ||
313 | } | ||
314 | if (edges & UCB_FALLING) { | ||
315 | ucb->irq_fal_enbl &= ~(1 << idx); | ||
316 | ucb1x00_reg_write(ucb, UCB_IE_FAL, ucb->irq_fal_enbl); | ||
317 | } | ||
318 | ucb1x00_disable(ucb); | ||
319 | spin_unlock_irqrestore(&ucb->lock, flags); | ||
320 | } | ||
321 | } | ||
322 | |||
323 | /** | ||
324 | * ucb1x00_free_irq - disable and free the specified UCB1x00 interrupt | ||
325 | * @ucb: UCB1x00 structure describing chip | ||
326 | * @idx: interrupt index | ||
327 | * @devid: device id. | ||
328 | * | ||
329 | * Disable the interrupt source and remove the handler. devid must | ||
330 | * match the devid passed when hooking the interrupt. | ||
331 | * | ||
332 | * Returns zero on success, or one of the following errors: | ||
333 | * -EINVAL if the interrupt index is invalid | ||
334 | * -ENOENT if devid does not match | ||
335 | */ | ||
336 | int ucb1x00_free_irq(struct ucb1x00 *ucb, unsigned int idx, void *devid) | ||
337 | { | ||
338 | struct ucb1x00_irq *irq; | ||
339 | int ret; | ||
340 | |||
341 | if (idx >= 16) | ||
342 | goto bad; | ||
343 | |||
344 | irq = ucb->irq_handler + idx; | ||
345 | ret = -ENOENT; | ||
346 | |||
347 | spin_lock_irq(&ucb->lock); | ||
348 | if (irq->devid == devid) { | ||
349 | ucb->irq_ris_enbl &= ~(1 << idx); | ||
350 | ucb->irq_fal_enbl &= ~(1 << idx); | ||
351 | |||
352 | ucb1x00_enable(ucb); | ||
353 | ucb1x00_reg_write(ucb, UCB_IE_RIS, ucb->irq_ris_enbl); | ||
354 | ucb1x00_reg_write(ucb, UCB_IE_FAL, ucb->irq_fal_enbl); | ||
355 | ucb1x00_disable(ucb); | ||
356 | |||
357 | irq->fn = NULL; | ||
358 | irq->devid = NULL; | ||
359 | ret = 0; | ||
360 | } | ||
361 | spin_unlock_irq(&ucb->lock); | ||
362 | return ret; | ||
363 | |||
364 | bad: | ||
365 | printk(KERN_ERR "Freeing bad UCB1x00 irq %d\n", idx); | ||
366 | return -EINVAL; | ||
367 | } | ||
368 | |||
369 | static int ucb1x00_add_dev(struct ucb1x00 *ucb, struct ucb1x00_driver *drv) | ||
370 | { | ||
371 | struct ucb1x00_dev *dev; | ||
372 | int ret = -ENOMEM; | ||
373 | |||
374 | dev = kmalloc(sizeof(struct ucb1x00_dev), GFP_KERNEL); | ||
375 | if (dev) { | ||
376 | dev->ucb = ucb; | ||
377 | dev->drv = drv; | ||
378 | |||
379 | ret = drv->add(dev); | ||
380 | |||
381 | if (ret == 0) { | ||
382 | list_add(&dev->dev_node, &ucb->devs); | ||
383 | list_add(&dev->drv_node, &drv->devs); | ||
384 | } else { | ||
385 | kfree(dev); | ||
386 | } | ||
387 | } | ||
388 | return ret; | ||
389 | } | ||
390 | |||
391 | static void ucb1x00_remove_dev(struct ucb1x00_dev *dev) | ||
392 | { | ||
393 | dev->drv->remove(dev); | ||
394 | list_del(&dev->dev_node); | ||
395 | list_del(&dev->drv_node); | ||
396 | kfree(dev); | ||
397 | } | ||
398 | |||
399 | /* | ||
400 | * Try to probe our interrupt, rather than relying on lots of | ||
401 | * hard-coded machine dependencies. For reference, the expected | ||
402 | * IRQ mappings are: | ||
403 | * | ||
404 | * Machine Default IRQ | ||
405 | * adsbitsy IRQ_GPCIN4 | ||
406 | * cerf IRQ_GPIO_UCB1200_IRQ | ||
407 | * flexanet IRQ_GPIO_GUI | ||
408 | * freebird IRQ_GPIO_FREEBIRD_UCB1300_IRQ | ||
409 | * graphicsclient ADS_EXT_IRQ(8) | ||
410 | * graphicsmaster ADS_EXT_IRQ(8) | ||
411 | * lart LART_IRQ_UCB1200 | ||
412 | * omnimeter IRQ_GPIO23 | ||
413 | * pfs168 IRQ_GPIO_UCB1300_IRQ | ||
414 | * simpad IRQ_GPIO_UCB1300_IRQ | ||
415 | * shannon SHANNON_IRQ_GPIO_IRQ_CODEC | ||
416 | * yopy IRQ_GPIO_UCB1200_IRQ | ||
417 | */ | ||
418 | static int ucb1x00_detect_irq(struct ucb1x00 *ucb) | ||
419 | { | ||
420 | unsigned long mask; | ||
421 | |||
422 | mask = probe_irq_on(); | ||
423 | if (!mask) | ||
424 | return NO_IRQ; | ||
425 | |||
426 | /* | ||
427 | * Enable the ADC interrupt. | ||
428 | */ | ||
429 | ucb1x00_reg_write(ucb, UCB_IE_RIS, UCB_IE_ADC); | ||
430 | ucb1x00_reg_write(ucb, UCB_IE_FAL, UCB_IE_ADC); | ||
431 | ucb1x00_reg_write(ucb, UCB_IE_CLEAR, 0xffff); | ||
432 | ucb1x00_reg_write(ucb, UCB_IE_CLEAR, 0); | ||
433 | |||
434 | /* | ||
435 | * Cause an ADC interrupt. | ||
436 | */ | ||
437 | ucb1x00_reg_write(ucb, UCB_ADC_CR, UCB_ADC_ENA); | ||
438 | ucb1x00_reg_write(ucb, UCB_ADC_CR, UCB_ADC_ENA | UCB_ADC_START); | ||
439 | |||
440 | /* | ||
441 | * Wait for the conversion to complete. | ||
442 | */ | ||
443 | while ((ucb1x00_reg_read(ucb, UCB_ADC_DATA) & UCB_ADC_DAT_VAL) == 0); | ||
444 | ucb1x00_reg_write(ucb, UCB_ADC_CR, 0); | ||
445 | |||
446 | /* | ||
447 | * Disable and clear interrupt. | ||
448 | */ | ||
449 | ucb1x00_reg_write(ucb, UCB_IE_RIS, 0); | ||
450 | ucb1x00_reg_write(ucb, UCB_IE_FAL, 0); | ||
451 | ucb1x00_reg_write(ucb, UCB_IE_CLEAR, 0xffff); | ||
452 | ucb1x00_reg_write(ucb, UCB_IE_CLEAR, 0); | ||
453 | |||
454 | /* | ||
455 | * Read triggered interrupt. | ||
456 | */ | ||
457 | return probe_irq_off(mask); | ||
458 | } | ||
459 | |||
460 | static int ucb1x00_probe(struct mcp *mcp) | ||
461 | { | ||
462 | struct ucb1x00 *ucb; | ||
463 | struct ucb1x00_driver *drv; | ||
464 | unsigned int id; | ||
465 | int ret = -ENODEV; | ||
466 | |||
467 | mcp_enable(mcp); | ||
468 | id = mcp_reg_read(mcp, UCB_ID); | ||
469 | |||
470 | if (id != UCB_ID_1200 && id != UCB_ID_1300) { | ||
471 | printk(KERN_WARNING "UCB1x00 ID not found: %04x\n", id); | ||
472 | goto err_disable; | ||
473 | } | ||
474 | |||
475 | ucb = kmalloc(sizeof(struct ucb1x00), GFP_KERNEL); | ||
476 | ret = -ENOMEM; | ||
477 | if (!ucb) | ||
478 | goto err_disable; | ||
479 | |||
480 | memset(ucb, 0, sizeof(struct ucb1x00)); | ||
481 | |||
482 | ucb->cdev.class = &ucb1x00_class; | ||
483 | ucb->cdev.dev = &mcp->attached_device; | ||
484 | strlcpy(ucb->cdev.class_id, "ucb1x00", sizeof(ucb->cdev.class_id)); | ||
485 | |||
486 | spin_lock_init(&ucb->lock); | ||
487 | spin_lock_init(&ucb->io_lock); | ||
488 | sema_init(&ucb->adc_sem, 1); | ||
489 | |||
490 | ucb->id = id; | ||
491 | ucb->mcp = mcp; | ||
492 | ucb->irq = ucb1x00_detect_irq(ucb); | ||
493 | if (ucb->irq == NO_IRQ) { | ||
494 | printk(KERN_ERR "UCB1x00: IRQ probe failed\n"); | ||
495 | ret = -ENODEV; | ||
496 | goto err_free; | ||
497 | } | ||
498 | |||
499 | ret = request_irq(ucb->irq, ucb1x00_irq, 0, "UCB1x00", ucb); | ||
500 | if (ret) { | ||
501 | printk(KERN_ERR "ucb1x00: unable to grab irq%d: %d\n", | ||
502 | ucb->irq, ret); | ||
503 | goto err_free; | ||
504 | } | ||
505 | |||
506 | set_irq_type(ucb->irq, IRQT_RISING); | ||
507 | mcp_set_drvdata(mcp, ucb); | ||
508 | |||
509 | ret = class_device_register(&ucb->cdev); | ||
510 | if (ret) | ||
511 | goto err_irq; | ||
512 | |||
513 | INIT_LIST_HEAD(&ucb->devs); | ||
514 | down(&ucb1x00_sem); | ||
515 | list_add(&ucb->node, &ucb1x00_devices); | ||
516 | list_for_each_entry(drv, &ucb1x00_drivers, node) { | ||
517 | ucb1x00_add_dev(ucb, drv); | ||
518 | } | ||
519 | up(&ucb1x00_sem); | ||
520 | goto out; | ||
521 | |||
522 | err_irq: | ||
523 | free_irq(ucb->irq, ucb); | ||
524 | err_free: | ||
525 | kfree(ucb); | ||
526 | err_disable: | ||
527 | mcp_disable(mcp); | ||
528 | out: | ||
529 | return ret; | ||
530 | } | ||
531 | |||
532 | static void ucb1x00_remove(struct mcp *mcp) | ||
533 | { | ||
534 | struct ucb1x00 *ucb = mcp_get_drvdata(mcp); | ||
535 | struct list_head *l, *n; | ||
536 | |||
537 | down(&ucb1x00_sem); | ||
538 | list_del(&ucb->node); | ||
539 | list_for_each_safe(l, n, &ucb->devs) { | ||
540 | struct ucb1x00_dev *dev = list_entry(l, struct ucb1x00_dev, dev_node); | ||
541 | ucb1x00_remove_dev(dev); | ||
542 | } | ||
543 | up(&ucb1x00_sem); | ||
544 | |||
545 | free_irq(ucb->irq, ucb); | ||
546 | class_device_unregister(&ucb->cdev); | ||
547 | } | ||
548 | |||
549 | static void ucb1x00_release(struct class_device *dev) | ||
550 | { | ||
551 | struct ucb1x00 *ucb = classdev_to_ucb1x00(dev); | ||
552 | kfree(ucb); | ||
553 | } | ||
554 | |||
555 | static struct class ucb1x00_class = { | ||
556 | .name = "ucb1x00", | ||
557 | .release = ucb1x00_release, | ||
558 | }; | ||
559 | |||
560 | int ucb1x00_register_driver(struct ucb1x00_driver *drv) | ||
561 | { | ||
562 | struct ucb1x00 *ucb; | ||
563 | |||
564 | INIT_LIST_HEAD(&drv->devs); | ||
565 | down(&ucb1x00_sem); | ||
566 | list_add(&drv->node, &ucb1x00_drivers); | ||
567 | list_for_each_entry(ucb, &ucb1x00_devices, node) { | ||
568 | ucb1x00_add_dev(ucb, drv); | ||
569 | } | ||
570 | up(&ucb1x00_sem); | ||
571 | return 0; | ||
572 | } | ||
573 | |||
574 | void ucb1x00_unregister_driver(struct ucb1x00_driver *drv) | ||
575 | { | ||
576 | struct list_head *n, *l; | ||
577 | |||
578 | down(&ucb1x00_sem); | ||
579 | list_del(&drv->node); | ||
580 | list_for_each_safe(l, n, &drv->devs) { | ||
581 | struct ucb1x00_dev *dev = list_entry(l, struct ucb1x00_dev, drv_node); | ||
582 | ucb1x00_remove_dev(dev); | ||
583 | } | ||
584 | up(&ucb1x00_sem); | ||
585 | } | ||
586 | |||
587 | static int ucb1x00_suspend(struct mcp *mcp, pm_message_t state) | ||
588 | { | ||
589 | struct ucb1x00 *ucb = mcp_get_drvdata(mcp); | ||
590 | struct ucb1x00_dev *dev; | ||
591 | |||
592 | down(&ucb1x00_sem); | ||
593 | list_for_each_entry(dev, &ucb->devs, dev_node) { | ||
594 | if (dev->drv->suspend) | ||
595 | dev->drv->suspend(dev, state); | ||
596 | } | ||
597 | up(&ucb1x00_sem); | ||
598 | return 0; | ||
599 | } | ||
600 | |||
601 | static int ucb1x00_resume(struct mcp *mcp) | ||
602 | { | ||
603 | struct ucb1x00 *ucb = mcp_get_drvdata(mcp); | ||
604 | struct ucb1x00_dev *dev; | ||
605 | |||
606 | down(&ucb1x00_sem); | ||
607 | list_for_each_entry(dev, &ucb->devs, dev_node) { | ||
608 | if (dev->drv->resume) | ||
609 | dev->drv->resume(dev); | ||
610 | } | ||
611 | up(&ucb1x00_sem); | ||
612 | return 0; | ||
613 | } | ||
614 | |||
615 | static struct mcp_driver ucb1x00_driver = { | ||
616 | .drv = { | ||
617 | .name = "ucb1x00", | ||
618 | }, | ||
619 | .probe = ucb1x00_probe, | ||
620 | .remove = ucb1x00_remove, | ||
621 | .suspend = ucb1x00_suspend, | ||
622 | .resume = ucb1x00_resume, | ||
623 | }; | ||
624 | |||
625 | static int __init ucb1x00_init(void) | ||
626 | { | ||
627 | int ret = class_register(&ucb1x00_class); | ||
628 | if (ret == 0) { | ||
629 | ret = mcp_driver_register(&ucb1x00_driver); | ||
630 | if (ret) | ||
631 | class_unregister(&ucb1x00_class); | ||
632 | } | ||
633 | return ret; | ||
634 | } | ||
635 | |||
636 | static void __exit ucb1x00_exit(void) | ||
637 | { | ||
638 | mcp_driver_unregister(&ucb1x00_driver); | ||
639 | class_unregister(&ucb1x00_class); | ||
640 | } | ||
641 | |||
642 | module_init(ucb1x00_init); | ||
643 | module_exit(ucb1x00_exit); | ||
644 | |||
645 | EXPORT_SYMBOL(ucb1x00_class); | ||
646 | |||
647 | EXPORT_SYMBOL(ucb1x00_io_set_dir); | ||
648 | EXPORT_SYMBOL(ucb1x00_io_write); | ||
649 | EXPORT_SYMBOL(ucb1x00_io_read); | ||
650 | |||
651 | EXPORT_SYMBOL(ucb1x00_adc_enable); | ||
652 | EXPORT_SYMBOL(ucb1x00_adc_read); | ||
653 | EXPORT_SYMBOL(ucb1x00_adc_disable); | ||
654 | |||
655 | EXPORT_SYMBOL(ucb1x00_hook_irq); | ||
656 | EXPORT_SYMBOL(ucb1x00_free_irq); | ||
657 | EXPORT_SYMBOL(ucb1x00_enable_irq); | ||
658 | EXPORT_SYMBOL(ucb1x00_disable_irq); | ||
659 | |||
660 | EXPORT_SYMBOL(ucb1x00_register_driver); | ||
661 | EXPORT_SYMBOL(ucb1x00_unregister_driver); | ||
662 | |||
663 | MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>"); | ||
664 | MODULE_DESCRIPTION("UCB1x00 core driver"); | ||
665 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/mfd/ucb1x00.h b/drivers/mfd/ucb1x00.h new file mode 100644 index 000000000000..6b632644f59a --- /dev/null +++ b/drivers/mfd/ucb1x00.h | |||
@@ -0,0 +1,256 @@ | |||
1 | /* | ||
2 | * linux/drivers/mfd/ucb1x00.h | ||
3 | * | ||
4 | * Copyright (C) 2001 Russell King, All Rights Reserved. | ||
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 as published by | ||
8 | * the Free Software Foundation; either version 2 of the License. | ||
9 | */ | ||
10 | #ifndef UCB1200_H | ||
11 | #define UCB1200_H | ||
12 | |||
13 | #define UCB_IO_DATA 0x00 | ||
14 | #define UCB_IO_DIR 0x01 | ||
15 | |||
16 | #define UCB_IO_0 (1 << 0) | ||
17 | #define UCB_IO_1 (1 << 1) | ||
18 | #define UCB_IO_2 (1 << 2) | ||
19 | #define UCB_IO_3 (1 << 3) | ||
20 | #define UCB_IO_4 (1 << 4) | ||
21 | #define UCB_IO_5 (1 << 5) | ||
22 | #define UCB_IO_6 (1 << 6) | ||
23 | #define UCB_IO_7 (1 << 7) | ||
24 | #define UCB_IO_8 (1 << 8) | ||
25 | #define UCB_IO_9 (1 << 9) | ||
26 | |||
27 | #define UCB_IE_RIS 0x02 | ||
28 | #define UCB_IE_FAL 0x03 | ||
29 | #define UCB_IE_STATUS 0x04 | ||
30 | #define UCB_IE_CLEAR 0x04 | ||
31 | #define UCB_IE_ADC (1 << 11) | ||
32 | #define UCB_IE_TSPX (1 << 12) | ||
33 | #define UCB_IE_TSMX (1 << 13) | ||
34 | #define UCB_IE_TCLIP (1 << 14) | ||
35 | #define UCB_IE_ACLIP (1 << 15) | ||
36 | |||
37 | #define UCB_IRQ_TSPX 12 | ||
38 | |||
39 | #define UCB_TC_A 0x05 | ||
40 | #define UCB_TC_A_LOOP (1 << 7) /* UCB1200 */ | ||
41 | #define UCB_TC_A_AMPL (1 << 7) /* UCB1300 */ | ||
42 | |||
43 | #define UCB_TC_B 0x06 | ||
44 | #define UCB_TC_B_VOICE_ENA (1 << 3) | ||
45 | #define UCB_TC_B_CLIP (1 << 4) | ||
46 | #define UCB_TC_B_ATT (1 << 6) | ||
47 | #define UCB_TC_B_SIDE_ENA (1 << 11) | ||
48 | #define UCB_TC_B_MUTE (1 << 13) | ||
49 | #define UCB_TC_B_IN_ENA (1 << 14) | ||
50 | #define UCB_TC_B_OUT_ENA (1 << 15) | ||
51 | |||
52 | #define UCB_AC_A 0x07 | ||
53 | #define UCB_AC_B 0x08 | ||
54 | #define UCB_AC_B_LOOP (1 << 8) | ||
55 | #define UCB_AC_B_MUTE (1 << 13) | ||
56 | #define UCB_AC_B_IN_ENA (1 << 14) | ||
57 | #define UCB_AC_B_OUT_ENA (1 << 15) | ||
58 | |||
59 | #define UCB_TS_CR 0x09 | ||
60 | #define UCB_TS_CR_TSMX_POW (1 << 0) | ||
61 | #define UCB_TS_CR_TSPX_POW (1 << 1) | ||
62 | #define UCB_TS_CR_TSMY_POW (1 << 2) | ||
63 | #define UCB_TS_CR_TSPY_POW (1 << 3) | ||
64 | #define UCB_TS_CR_TSMX_GND (1 << 4) | ||
65 | #define UCB_TS_CR_TSPX_GND (1 << 5) | ||
66 | #define UCB_TS_CR_TSMY_GND (1 << 6) | ||
67 | #define UCB_TS_CR_TSPY_GND (1 << 7) | ||
68 | #define UCB_TS_CR_MODE_INT (0 << 8) | ||
69 | #define UCB_TS_CR_MODE_PRES (1 << 8) | ||
70 | #define UCB_TS_CR_MODE_POS (2 << 8) | ||
71 | #define UCB_TS_CR_BIAS_ENA (1 << 11) | ||
72 | #define UCB_TS_CR_TSPX_LOW (1 << 12) | ||
73 | #define UCB_TS_CR_TSMX_LOW (1 << 13) | ||
74 | |||
75 | #define UCB_ADC_CR 0x0a | ||
76 | #define UCB_ADC_SYNC_ENA (1 << 0) | ||
77 | #define UCB_ADC_VREFBYP_CON (1 << 1) | ||
78 | #define UCB_ADC_INP_TSPX (0 << 2) | ||
79 | #define UCB_ADC_INP_TSMX (1 << 2) | ||
80 | #define UCB_ADC_INP_TSPY (2 << 2) | ||
81 | #define UCB_ADC_INP_TSMY (3 << 2) | ||
82 | #define UCB_ADC_INP_AD0 (4 << 2) | ||
83 | #define UCB_ADC_INP_AD1 (5 << 2) | ||
84 | #define UCB_ADC_INP_AD2 (6 << 2) | ||
85 | #define UCB_ADC_INP_AD3 (7 << 2) | ||
86 | #define UCB_ADC_EXT_REF (1 << 5) | ||
87 | #define UCB_ADC_START (1 << 7) | ||
88 | #define UCB_ADC_ENA (1 << 15) | ||
89 | |||
90 | #define UCB_ADC_DATA 0x0b | ||
91 | #define UCB_ADC_DAT_VAL (1 << 15) | ||
92 | #define UCB_ADC_DAT(x) (((x) & 0x7fe0) >> 5) | ||
93 | |||
94 | #define UCB_ID 0x0c | ||
95 | #define UCB_ID_1200 0x1004 | ||
96 | #define UCB_ID_1300 0x1005 | ||
97 | |||
98 | #define UCB_MODE 0x0d | ||
99 | #define UCB_MODE_DYN_VFLAG_ENA (1 << 12) | ||
100 | #define UCB_MODE_AUD_OFF_CAN (1 << 13) | ||
101 | |||
102 | #include "mcp.h" | ||
103 | |||
104 | struct ucb1x00_irq { | ||
105 | void *devid; | ||
106 | void (*fn)(int, void *); | ||
107 | }; | ||
108 | |||
109 | extern struct class ucb1x00_class; | ||
110 | |||
111 | struct ucb1x00 { | ||
112 | spinlock_t lock; | ||
113 | struct mcp *mcp; | ||
114 | unsigned int irq; | ||
115 | struct semaphore adc_sem; | ||
116 | spinlock_t io_lock; | ||
117 | u16 id; | ||
118 | u16 io_dir; | ||
119 | u16 io_out; | ||
120 | u16 adc_cr; | ||
121 | u16 irq_fal_enbl; | ||
122 | u16 irq_ris_enbl; | ||
123 | struct ucb1x00_irq irq_handler[16]; | ||
124 | struct class_device cdev; | ||
125 | struct list_head node; | ||
126 | struct list_head devs; | ||
127 | }; | ||
128 | |||
129 | struct ucb1x00_driver; | ||
130 | |||
131 | struct ucb1x00_dev { | ||
132 | struct list_head dev_node; | ||
133 | struct list_head drv_node; | ||
134 | struct ucb1x00 *ucb; | ||
135 | struct ucb1x00_driver *drv; | ||
136 | void *priv; | ||
137 | }; | ||
138 | |||
139 | struct ucb1x00_driver { | ||
140 | struct list_head node; | ||
141 | struct list_head devs; | ||
142 | int (*add)(struct ucb1x00_dev *dev); | ||
143 | void (*remove)(struct ucb1x00_dev *dev); | ||
144 | int (*suspend)(struct ucb1x00_dev *dev, pm_message_t state); | ||
145 | int (*resume)(struct ucb1x00_dev *dev); | ||
146 | }; | ||
147 | |||
148 | #define classdev_to_ucb1x00(cd) container_of(cd, struct ucb1x00, cdev) | ||
149 | |||
150 | int ucb1x00_register_driver(struct ucb1x00_driver *); | ||
151 | void ucb1x00_unregister_driver(struct ucb1x00_driver *); | ||
152 | |||
153 | /** | ||
154 | * ucb1x00_clkrate - return the UCB1x00 SIB clock rate | ||
155 | * @ucb: UCB1x00 structure describing chip | ||
156 | * | ||
157 | * Return the SIB clock rate in Hz. | ||
158 | */ | ||
159 | static inline unsigned int ucb1x00_clkrate(struct ucb1x00 *ucb) | ||
160 | { | ||
161 | return mcp_get_sclk_rate(ucb->mcp); | ||
162 | } | ||
163 | |||
164 | /** | ||
165 | * ucb1x00_enable - enable the UCB1x00 SIB clock | ||
166 | * @ucb: UCB1x00 structure describing chip | ||
167 | * | ||
168 | * Enable the SIB clock. This can be called multiple times. | ||
169 | */ | ||
170 | static inline void ucb1x00_enable(struct ucb1x00 *ucb) | ||
171 | { | ||
172 | mcp_enable(ucb->mcp); | ||
173 | } | ||
174 | |||
175 | /** | ||
176 | * ucb1x00_disable - disable the UCB1x00 SIB clock | ||
177 | * @ucb: UCB1x00 structure describing chip | ||
178 | * | ||
179 | * Disable the SIB clock. The SIB clock will only be disabled | ||
180 | * when the number of ucb1x00_enable calls match the number of | ||
181 | * ucb1x00_disable calls. | ||
182 | */ | ||
183 | static inline void ucb1x00_disable(struct ucb1x00 *ucb) | ||
184 | { | ||
185 | mcp_disable(ucb->mcp); | ||
186 | } | ||
187 | |||
188 | /** | ||
189 | * ucb1x00_reg_write - write a UCB1x00 register | ||
190 | * @ucb: UCB1x00 structure describing chip | ||
191 | * @reg: UCB1x00 4-bit register index to write | ||
192 | * @val: UCB1x00 16-bit value to write | ||
193 | * | ||
194 | * Write the UCB1x00 register @reg with value @val. The SIB | ||
195 | * clock must be running for this function to return. | ||
196 | */ | ||
197 | static inline void ucb1x00_reg_write(struct ucb1x00 *ucb, unsigned int reg, unsigned int val) | ||
198 | { | ||
199 | mcp_reg_write(ucb->mcp, reg, val); | ||
200 | } | ||
201 | |||
202 | /** | ||
203 | * ucb1x00_reg_read - read a UCB1x00 register | ||
204 | * @ucb: UCB1x00 structure describing chip | ||
205 | * @reg: UCB1x00 4-bit register index to write | ||
206 | * | ||
207 | * Read the UCB1x00 register @reg and return its value. The SIB | ||
208 | * clock must be running for this function to return. | ||
209 | */ | ||
210 | static inline unsigned int ucb1x00_reg_read(struct ucb1x00 *ucb, unsigned int reg) | ||
211 | { | ||
212 | return mcp_reg_read(ucb->mcp, reg); | ||
213 | } | ||
214 | /** | ||
215 | * ucb1x00_set_audio_divisor - | ||
216 | * @ucb: UCB1x00 structure describing chip | ||
217 | * @div: SIB clock divisor | ||
218 | */ | ||
219 | static inline void ucb1x00_set_audio_divisor(struct ucb1x00 *ucb, unsigned int div) | ||
220 | { | ||
221 | mcp_set_audio_divisor(ucb->mcp, div); | ||
222 | } | ||
223 | |||
224 | /** | ||
225 | * ucb1x00_set_telecom_divisor - | ||
226 | * @ucb: UCB1x00 structure describing chip | ||
227 | * @div: SIB clock divisor | ||
228 | */ | ||
229 | static inline void ucb1x00_set_telecom_divisor(struct ucb1x00 *ucb, unsigned int div) | ||
230 | { | ||
231 | mcp_set_telecom_divisor(ucb->mcp, div); | ||
232 | } | ||
233 | |||
234 | void ucb1x00_io_set_dir(struct ucb1x00 *ucb, unsigned int, unsigned int); | ||
235 | void ucb1x00_io_write(struct ucb1x00 *ucb, unsigned int, unsigned int); | ||
236 | unsigned int ucb1x00_io_read(struct ucb1x00 *ucb); | ||
237 | |||
238 | #define UCB_NOSYNC (0) | ||
239 | #define UCB_SYNC (1) | ||
240 | |||
241 | unsigned int ucb1x00_adc_read(struct ucb1x00 *ucb, int adc_channel, int sync); | ||
242 | void ucb1x00_adc_enable(struct ucb1x00 *ucb); | ||
243 | void ucb1x00_adc_disable(struct ucb1x00 *ucb); | ||
244 | |||
245 | /* | ||
246 | * Which edges of the IRQ do you want to control today? | ||
247 | */ | ||
248 | #define UCB_RISING (1 << 0) | ||
249 | #define UCB_FALLING (1 << 1) | ||
250 | |||
251 | int ucb1x00_hook_irq(struct ucb1x00 *ucb, unsigned int idx, void (*fn)(int, void *), void *devid); | ||
252 | void ucb1x00_enable_irq(struct ucb1x00 *ucb, unsigned int idx, int edges); | ||
253 | void ucb1x00_disable_irq(struct ucb1x00 *ucb, unsigned int idx, int edges); | ||
254 | int ucb1x00_free_irq(struct ucb1x00 *ucb, unsigned int idx, void *devid); | ||
255 | |||
256 | #endif | ||