xref: /openbmc/linux/drivers/mfd/ucb1x00-core.c (revision 7dd65feb)
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/module.h>
20 #include <linux/kernel.h>
21 #include <linux/sched.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 #include <linux/mutex.h>
28 #include <linux/mfd/ucb1x00.h>
29 #include <linux/gpio.h>
30 
31 #include <mach/dma.h>
32 #include <mach/hardware.h>
33 
34 static DEFINE_MUTEX(ucb1x00_mutex);
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 static void ucb1x00_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
112 {
113 	struct ucb1x00 *ucb = container_of(chip, struct ucb1x00, gpio);
114 	unsigned long flags;
115 
116 	spin_lock_irqsave(&ucb->io_lock, flags);
117 	if (value)
118 		ucb->io_out |= 1 << offset;
119 	else
120 		ucb->io_out &= ~(1 << offset);
121 
122 	ucb1x00_reg_write(ucb, UCB_IO_DATA, ucb->io_out);
123 	spin_unlock_irqrestore(&ucb->io_lock, flags);
124 }
125 
126 static int ucb1x00_gpio_get(struct gpio_chip *chip, unsigned offset)
127 {
128 	struct ucb1x00 *ucb = container_of(chip, struct ucb1x00, gpio);
129 	return ucb1x00_reg_read(ucb, UCB_IO_DATA) & (1 << offset);
130 }
131 
132 static int ucb1x00_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
133 {
134 	struct ucb1x00 *ucb = container_of(chip, struct ucb1x00, gpio);
135 	unsigned long flags;
136 
137 	spin_lock_irqsave(&ucb->io_lock, flags);
138 	ucb->io_dir &= ~(1 << offset);
139 	ucb1x00_reg_write(ucb, UCB_IO_DIR, ucb->io_dir);
140 	spin_unlock_irqrestore(&ucb->io_lock, flags);
141 
142 	return 0;
143 }
144 
145 static int ucb1x00_gpio_direction_output(struct gpio_chip *chip, unsigned offset
146 		, int value)
147 {
148 	struct ucb1x00 *ucb = container_of(chip, struct ucb1x00, gpio);
149 	unsigned long flags;
150 
151 	spin_lock_irqsave(&ucb->io_lock, flags);
152 	ucb->io_dir |= (1 << offset);
153 	ucb1x00_reg_write(ucb, UCB_IO_DIR, ucb->io_dir);
154 
155 	if (value)
156 		ucb->io_out |= 1 << offset;
157 	else
158 		ucb->io_out &= ~(1 << offset);
159 	ucb1x00_reg_write(ucb, UCB_IO_DATA, ucb->io_out);
160 	spin_unlock_irqrestore(&ucb->io_lock, flags);
161 
162 	return 0;
163 }
164 
165 /*
166  * UCB1300 data sheet says we must:
167  *  1. enable ADC	=> 5us (including reference startup time)
168  *  2. select input	=> 51*tsibclk  => 4.3us
169  *  3. start conversion	=> 102*tsibclk => 8.5us
170  * (tsibclk = 1/11981000)
171  * Period between SIB 128-bit frames = 10.7us
172  */
173 
174 /**
175  *	ucb1x00_adc_enable - enable the ADC converter
176  *	@ucb: UCB1x00 structure describing chip
177  *
178  *	Enable the ucb1x00 and ADC converter on the UCB1x00 for use.
179  *	Any code wishing to use the ADC converter must call this
180  *	function prior to using it.
181  *
182  *	This function takes the ADC semaphore to prevent two or more
183  *	concurrent uses, and therefore may sleep.  As a result, it
184  *	can only be called from process context, not interrupt
185  *	context.
186  *
187  *	You should release the ADC as soon as possible using
188  *	ucb1x00_adc_disable.
189  */
190 void ucb1x00_adc_enable(struct ucb1x00 *ucb)
191 {
192 	down(&ucb->adc_sem);
193 
194 	ucb->adc_cr |= UCB_ADC_ENA;
195 
196 	ucb1x00_enable(ucb);
197 	ucb1x00_reg_write(ucb, UCB_ADC_CR, ucb->adc_cr);
198 }
199 
200 /**
201  *	ucb1x00_adc_read - read the specified ADC channel
202  *	@ucb: UCB1x00 structure describing chip
203  *	@adc_channel: ADC channel mask
204  *	@sync: wait for syncronisation pulse.
205  *
206  *	Start an ADC conversion and wait for the result.  Note that
207  *	synchronised ADC conversions (via the ADCSYNC pin) must wait
208  *	until the trigger is asserted and the conversion is finished.
209  *
210  *	This function currently spins waiting for the conversion to
211  *	complete (2 frames max without sync).
212  *
213  *	If called for a synchronised ADC conversion, it may sleep
214  *	with the ADC semaphore held.
215  */
216 unsigned int ucb1x00_adc_read(struct ucb1x00 *ucb, int adc_channel, int sync)
217 {
218 	unsigned int val;
219 
220 	if (sync)
221 		adc_channel |= UCB_ADC_SYNC_ENA;
222 
223 	ucb1x00_reg_write(ucb, UCB_ADC_CR, ucb->adc_cr | adc_channel);
224 	ucb1x00_reg_write(ucb, UCB_ADC_CR, ucb->adc_cr | adc_channel | UCB_ADC_START);
225 
226 	for (;;) {
227 		val = ucb1x00_reg_read(ucb, UCB_ADC_DATA);
228 		if (val & UCB_ADC_DAT_VAL)
229 			break;
230 		/* yield to other processes */
231 		set_current_state(TASK_INTERRUPTIBLE);
232 		schedule_timeout(1);
233 	}
234 
235 	return UCB_ADC_DAT(val);
236 }
237 
238 /**
239  *	ucb1x00_adc_disable - disable the ADC converter
240  *	@ucb: UCB1x00 structure describing chip
241  *
242  *	Disable the ADC converter and release the ADC semaphore.
243  */
244 void ucb1x00_adc_disable(struct ucb1x00 *ucb)
245 {
246 	ucb->adc_cr &= ~UCB_ADC_ENA;
247 	ucb1x00_reg_write(ucb, UCB_ADC_CR, ucb->adc_cr);
248 	ucb1x00_disable(ucb);
249 
250 	up(&ucb->adc_sem);
251 }
252 
253 /*
254  * UCB1x00 Interrupt handling.
255  *
256  * The UCB1x00 can generate interrupts when the SIBCLK is stopped.
257  * Since we need to read an internal register, we must re-enable
258  * SIBCLK to talk to the chip.  We leave the clock running until
259  * we have finished processing all interrupts from the chip.
260  */
261 static irqreturn_t ucb1x00_irq(int irqnr, void *devid)
262 {
263 	struct ucb1x00 *ucb = devid;
264 	struct ucb1x00_irq *irq;
265 	unsigned int isr, i;
266 
267 	ucb1x00_enable(ucb);
268 	isr = ucb1x00_reg_read(ucb, UCB_IE_STATUS);
269 	ucb1x00_reg_write(ucb, UCB_IE_CLEAR, isr);
270 	ucb1x00_reg_write(ucb, UCB_IE_CLEAR, 0);
271 
272 	for (i = 0, irq = ucb->irq_handler; i < 16 && isr; i++, isr >>= 1, irq++)
273 		if (isr & 1 && irq->fn)
274 			irq->fn(i, irq->devid);
275 	ucb1x00_disable(ucb);
276 
277 	return IRQ_HANDLED;
278 }
279 
280 /**
281  *	ucb1x00_hook_irq - hook a UCB1x00 interrupt
282  *	@ucb:   UCB1x00 structure describing chip
283  *	@idx:   interrupt index
284  *	@fn:    function to call when interrupt is triggered
285  *	@devid: device id to pass to interrupt handler
286  *
287  *	Hook the specified interrupt.  You can only register one handler
288  *	for each interrupt source.  The interrupt source is not enabled
289  *	by this function; use ucb1x00_enable_irq instead.
290  *
291  *	Interrupt handlers will be called with other interrupts enabled.
292  *
293  *	Returns zero on success, or one of the following errors:
294  *	 -EINVAL if the interrupt index is invalid
295  *	 -EBUSY if the interrupt has already been hooked
296  */
297 int ucb1x00_hook_irq(struct ucb1x00 *ucb, unsigned int idx, void (*fn)(int, void *), void *devid)
298 {
299 	struct ucb1x00_irq *irq;
300 	int ret = -EINVAL;
301 
302 	if (idx < 16) {
303 		irq = ucb->irq_handler + idx;
304 		ret = -EBUSY;
305 
306 		spin_lock_irq(&ucb->lock);
307 		if (irq->fn == NULL) {
308 			irq->devid = devid;
309 			irq->fn = fn;
310 			ret = 0;
311 		}
312 		spin_unlock_irq(&ucb->lock);
313 	}
314 	return ret;
315 }
316 
317 /**
318  *	ucb1x00_enable_irq - enable an UCB1x00 interrupt source
319  *	@ucb: UCB1x00 structure describing chip
320  *	@idx: interrupt index
321  *	@edges: interrupt edges to enable
322  *
323  *	Enable the specified interrupt to trigger on %UCB_RISING,
324  *	%UCB_FALLING or both edges.  The interrupt should have been
325  *	hooked by ucb1x00_hook_irq.
326  */
327 void ucb1x00_enable_irq(struct ucb1x00 *ucb, unsigned int idx, int edges)
328 {
329 	unsigned long flags;
330 
331 	if (idx < 16) {
332 		spin_lock_irqsave(&ucb->lock, flags);
333 
334 		ucb1x00_enable(ucb);
335 		if (edges & UCB_RISING) {
336 			ucb->irq_ris_enbl |= 1 << idx;
337 			ucb1x00_reg_write(ucb, UCB_IE_RIS, ucb->irq_ris_enbl);
338 		}
339 		if (edges & UCB_FALLING) {
340 			ucb->irq_fal_enbl |= 1 << idx;
341 			ucb1x00_reg_write(ucb, UCB_IE_FAL, ucb->irq_fal_enbl);
342 		}
343 		ucb1x00_disable(ucb);
344 		spin_unlock_irqrestore(&ucb->lock, flags);
345 	}
346 }
347 
348 /**
349  *	ucb1x00_disable_irq - disable an UCB1x00 interrupt source
350  *	@ucb: UCB1x00 structure describing chip
351  *	@edges: interrupt edges to disable
352  *
353  *	Disable the specified interrupt triggering on the specified
354  *	(%UCB_RISING, %UCB_FALLING or both) edges.
355  */
356 void ucb1x00_disable_irq(struct ucb1x00 *ucb, unsigned int idx, int edges)
357 {
358 	unsigned long flags;
359 
360 	if (idx < 16) {
361 		spin_lock_irqsave(&ucb->lock, flags);
362 
363 		ucb1x00_enable(ucb);
364 		if (edges & UCB_RISING) {
365 			ucb->irq_ris_enbl &= ~(1 << idx);
366 			ucb1x00_reg_write(ucb, UCB_IE_RIS, ucb->irq_ris_enbl);
367 		}
368 		if (edges & UCB_FALLING) {
369 			ucb->irq_fal_enbl &= ~(1 << idx);
370 			ucb1x00_reg_write(ucb, UCB_IE_FAL, ucb->irq_fal_enbl);
371 		}
372 		ucb1x00_disable(ucb);
373 		spin_unlock_irqrestore(&ucb->lock, flags);
374 	}
375 }
376 
377 /**
378  *	ucb1x00_free_irq - disable and free the specified UCB1x00 interrupt
379  *	@ucb: UCB1x00 structure describing chip
380  *	@idx: interrupt index
381  *	@devid: device id.
382  *
383  *	Disable the interrupt source and remove the handler.  devid must
384  *	match the devid passed when hooking the interrupt.
385  *
386  *	Returns zero on success, or one of the following errors:
387  *	 -EINVAL if the interrupt index is invalid
388  *	 -ENOENT if devid does not match
389  */
390 int ucb1x00_free_irq(struct ucb1x00 *ucb, unsigned int idx, void *devid)
391 {
392 	struct ucb1x00_irq *irq;
393 	int ret;
394 
395 	if (idx >= 16)
396 		goto bad;
397 
398 	irq = ucb->irq_handler + idx;
399 	ret = -ENOENT;
400 
401 	spin_lock_irq(&ucb->lock);
402 	if (irq->devid == devid) {
403 		ucb->irq_ris_enbl &= ~(1 << idx);
404 		ucb->irq_fal_enbl &= ~(1 << idx);
405 
406 		ucb1x00_enable(ucb);
407 		ucb1x00_reg_write(ucb, UCB_IE_RIS, ucb->irq_ris_enbl);
408 		ucb1x00_reg_write(ucb, UCB_IE_FAL, ucb->irq_fal_enbl);
409 		ucb1x00_disable(ucb);
410 
411 		irq->fn = NULL;
412 		irq->devid = NULL;
413 		ret = 0;
414 	}
415 	spin_unlock_irq(&ucb->lock);
416 	return ret;
417 
418 bad:
419 	printk(KERN_ERR "Freeing bad UCB1x00 irq %d\n", idx);
420 	return -EINVAL;
421 }
422 
423 static int ucb1x00_add_dev(struct ucb1x00 *ucb, struct ucb1x00_driver *drv)
424 {
425 	struct ucb1x00_dev *dev;
426 	int ret = -ENOMEM;
427 
428 	dev = kmalloc(sizeof(struct ucb1x00_dev), GFP_KERNEL);
429 	if (dev) {
430 		dev->ucb = ucb;
431 		dev->drv = drv;
432 
433 		ret = drv->add(dev);
434 
435 		if (ret == 0) {
436 			list_add(&dev->dev_node, &ucb->devs);
437 			list_add(&dev->drv_node, &drv->devs);
438 		} else {
439 			kfree(dev);
440 		}
441 	}
442 	return ret;
443 }
444 
445 static void ucb1x00_remove_dev(struct ucb1x00_dev *dev)
446 {
447 	dev->drv->remove(dev);
448 	list_del(&dev->dev_node);
449 	list_del(&dev->drv_node);
450 	kfree(dev);
451 }
452 
453 /*
454  * Try to probe our interrupt, rather than relying on lots of
455  * hard-coded machine dependencies.  For reference, the expected
456  * IRQ mappings are:
457  *
458  *  	Machine		Default IRQ
459  *	adsbitsy	IRQ_GPCIN4
460  *	cerf		IRQ_GPIO_UCB1200_IRQ
461  *	flexanet	IRQ_GPIO_GUI
462  *	freebird	IRQ_GPIO_FREEBIRD_UCB1300_IRQ
463  *	graphicsclient	ADS_EXT_IRQ(8)
464  *	graphicsmaster	ADS_EXT_IRQ(8)
465  *	lart		LART_IRQ_UCB1200
466  *	omnimeter	IRQ_GPIO23
467  *	pfs168		IRQ_GPIO_UCB1300_IRQ
468  *	simpad		IRQ_GPIO_UCB1300_IRQ
469  *	shannon		SHANNON_IRQ_GPIO_IRQ_CODEC
470  *	yopy		IRQ_GPIO_UCB1200_IRQ
471  */
472 static int ucb1x00_detect_irq(struct ucb1x00 *ucb)
473 {
474 	unsigned long mask;
475 
476 	mask = probe_irq_on();
477 	if (!mask) {
478 		probe_irq_off(mask);
479 		return NO_IRQ;
480 	}
481 
482 	/*
483 	 * Enable the ADC interrupt.
484 	 */
485 	ucb1x00_reg_write(ucb, UCB_IE_RIS, UCB_IE_ADC);
486 	ucb1x00_reg_write(ucb, UCB_IE_FAL, UCB_IE_ADC);
487 	ucb1x00_reg_write(ucb, UCB_IE_CLEAR, 0xffff);
488 	ucb1x00_reg_write(ucb, UCB_IE_CLEAR, 0);
489 
490 	/*
491 	 * Cause an ADC interrupt.
492 	 */
493 	ucb1x00_reg_write(ucb, UCB_ADC_CR, UCB_ADC_ENA);
494 	ucb1x00_reg_write(ucb, UCB_ADC_CR, UCB_ADC_ENA | UCB_ADC_START);
495 
496 	/*
497 	 * Wait for the conversion to complete.
498 	 */
499 	while ((ucb1x00_reg_read(ucb, UCB_ADC_DATA) & UCB_ADC_DAT_VAL) == 0);
500 	ucb1x00_reg_write(ucb, UCB_ADC_CR, 0);
501 
502 	/*
503 	 * Disable and clear interrupt.
504 	 */
505 	ucb1x00_reg_write(ucb, UCB_IE_RIS, 0);
506 	ucb1x00_reg_write(ucb, UCB_IE_FAL, 0);
507 	ucb1x00_reg_write(ucb, UCB_IE_CLEAR, 0xffff);
508 	ucb1x00_reg_write(ucb, UCB_IE_CLEAR, 0);
509 
510 	/*
511 	 * Read triggered interrupt.
512 	 */
513 	return probe_irq_off(mask);
514 }
515 
516 static void ucb1x00_release(struct device *dev)
517 {
518 	struct ucb1x00 *ucb = classdev_to_ucb1x00(dev);
519 	kfree(ucb);
520 }
521 
522 static struct class ucb1x00_class = {
523 	.name		= "ucb1x00",
524 	.dev_release	= ucb1x00_release,
525 };
526 
527 static int ucb1x00_probe(struct mcp *mcp)
528 {
529 	struct ucb1x00 *ucb;
530 	struct ucb1x00_driver *drv;
531 	unsigned int id;
532 	int ret = -ENODEV;
533 	int temp;
534 
535 	mcp_enable(mcp);
536 	id = mcp_reg_read(mcp, UCB_ID);
537 
538 	if (id != UCB_ID_1200 && id != UCB_ID_1300 && id != UCB_ID_TC35143) {
539 		printk(KERN_WARNING "UCB1x00 ID not found: %04x\n", id);
540 		goto err_disable;
541 	}
542 
543 	ucb = kzalloc(sizeof(struct ucb1x00), GFP_KERNEL);
544 	ret = -ENOMEM;
545 	if (!ucb)
546 		goto err_disable;
547 
548 
549 	ucb->dev.class = &ucb1x00_class;
550 	ucb->dev.parent = &mcp->attached_device;
551 	dev_set_name(&ucb->dev, "ucb1x00");
552 
553 	spin_lock_init(&ucb->lock);
554 	spin_lock_init(&ucb->io_lock);
555 	sema_init(&ucb->adc_sem, 1);
556 
557 	ucb->id  = id;
558 	ucb->mcp = mcp;
559 	ucb->irq = ucb1x00_detect_irq(ucb);
560 	if (ucb->irq == NO_IRQ) {
561 		printk(KERN_ERR "UCB1x00: IRQ probe failed\n");
562 		ret = -ENODEV;
563 		goto err_free;
564 	}
565 
566 	ucb->gpio.base = -1;
567 	if (mcp->gpio_base != 0) {
568 		ucb->gpio.label = dev_name(&ucb->dev);
569 		ucb->gpio.base = mcp->gpio_base;
570 		ucb->gpio.ngpio = 10;
571 		ucb->gpio.set = ucb1x00_gpio_set;
572 		ucb->gpio.get = ucb1x00_gpio_get;
573 		ucb->gpio.direction_input = ucb1x00_gpio_direction_input;
574 		ucb->gpio.direction_output = ucb1x00_gpio_direction_output;
575 		ret = gpiochip_add(&ucb->gpio);
576 		if (ret)
577 			goto err_free;
578 	} else
579 		dev_info(&ucb->dev, "gpio_base not set so no gpiolib support");
580 
581 	ret = request_irq(ucb->irq, ucb1x00_irq, IRQF_TRIGGER_RISING,
582 			  "UCB1x00", ucb);
583 	if (ret) {
584 		printk(KERN_ERR "ucb1x00: unable to grab irq%d: %d\n",
585 			ucb->irq, ret);
586 		goto err_gpio;
587 	}
588 
589 	mcp_set_drvdata(mcp, ucb);
590 
591 	ret = device_register(&ucb->dev);
592 	if (ret)
593 		goto err_irq;
594 
595 
596 	INIT_LIST_HEAD(&ucb->devs);
597 	mutex_lock(&ucb1x00_mutex);
598 	list_add(&ucb->node, &ucb1x00_devices);
599 	list_for_each_entry(drv, &ucb1x00_drivers, node) {
600 		ucb1x00_add_dev(ucb, drv);
601 	}
602 	mutex_unlock(&ucb1x00_mutex);
603 
604 	goto out;
605 
606  err_irq:
607 	free_irq(ucb->irq, ucb);
608  err_gpio:
609 	if (ucb->gpio.base != -1)
610 		temp = gpiochip_remove(&ucb->gpio);
611  err_free:
612 	kfree(ucb);
613  err_disable:
614 	mcp_disable(mcp);
615  out:
616 	return ret;
617 }
618 
619 static void ucb1x00_remove(struct mcp *mcp)
620 {
621 	struct ucb1x00 *ucb = mcp_get_drvdata(mcp);
622 	struct list_head *l, *n;
623 	int ret;
624 
625 	mutex_lock(&ucb1x00_mutex);
626 	list_del(&ucb->node);
627 	list_for_each_safe(l, n, &ucb->devs) {
628 		struct ucb1x00_dev *dev = list_entry(l, struct ucb1x00_dev, dev_node);
629 		ucb1x00_remove_dev(dev);
630 	}
631 	mutex_unlock(&ucb1x00_mutex);
632 
633 	if (ucb->gpio.base != -1) {
634 		ret = gpiochip_remove(&ucb->gpio);
635 		if (ret)
636 			dev_err(&ucb->dev, "Can't remove gpio chip: %d\n", ret);
637 	}
638 
639 	free_irq(ucb->irq, ucb);
640 	device_unregister(&ucb->dev);
641 }
642 
643 int ucb1x00_register_driver(struct ucb1x00_driver *drv)
644 {
645 	struct ucb1x00 *ucb;
646 
647 	INIT_LIST_HEAD(&drv->devs);
648 	mutex_lock(&ucb1x00_mutex);
649 	list_add(&drv->node, &ucb1x00_drivers);
650 	list_for_each_entry(ucb, &ucb1x00_devices, node) {
651 		ucb1x00_add_dev(ucb, drv);
652 	}
653 	mutex_unlock(&ucb1x00_mutex);
654 	return 0;
655 }
656 
657 void ucb1x00_unregister_driver(struct ucb1x00_driver *drv)
658 {
659 	struct list_head *n, *l;
660 
661 	mutex_lock(&ucb1x00_mutex);
662 	list_del(&drv->node);
663 	list_for_each_safe(l, n, &drv->devs) {
664 		struct ucb1x00_dev *dev = list_entry(l, struct ucb1x00_dev, drv_node);
665 		ucb1x00_remove_dev(dev);
666 	}
667 	mutex_unlock(&ucb1x00_mutex);
668 }
669 
670 static int ucb1x00_suspend(struct mcp *mcp, pm_message_t state)
671 {
672 	struct ucb1x00 *ucb = mcp_get_drvdata(mcp);
673 	struct ucb1x00_dev *dev;
674 
675 	mutex_lock(&ucb1x00_mutex);
676 	list_for_each_entry(dev, &ucb->devs, dev_node) {
677 		if (dev->drv->suspend)
678 			dev->drv->suspend(dev, state);
679 	}
680 	mutex_unlock(&ucb1x00_mutex);
681 	return 0;
682 }
683 
684 static int ucb1x00_resume(struct mcp *mcp)
685 {
686 	struct ucb1x00 *ucb = mcp_get_drvdata(mcp);
687 	struct ucb1x00_dev *dev;
688 
689 	ucb1x00_reg_write(ucb, UCB_IO_DIR, ucb->io_dir);
690 	mutex_lock(&ucb1x00_mutex);
691 	list_for_each_entry(dev, &ucb->devs, dev_node) {
692 		if (dev->drv->resume)
693 			dev->drv->resume(dev);
694 	}
695 	mutex_unlock(&ucb1x00_mutex);
696 	return 0;
697 }
698 
699 static struct mcp_driver ucb1x00_driver = {
700 	.drv		= {
701 		.name	= "ucb1x00",
702 	},
703 	.probe		= ucb1x00_probe,
704 	.remove		= ucb1x00_remove,
705 	.suspend	= ucb1x00_suspend,
706 	.resume		= ucb1x00_resume,
707 };
708 
709 static int __init ucb1x00_init(void)
710 {
711 	int ret = class_register(&ucb1x00_class);
712 	if (ret == 0) {
713 		ret = mcp_driver_register(&ucb1x00_driver);
714 		if (ret)
715 			class_unregister(&ucb1x00_class);
716 	}
717 	return ret;
718 }
719 
720 static void __exit ucb1x00_exit(void)
721 {
722 	mcp_driver_unregister(&ucb1x00_driver);
723 	class_unregister(&ucb1x00_class);
724 }
725 
726 module_init(ucb1x00_init);
727 module_exit(ucb1x00_exit);
728 
729 EXPORT_SYMBOL(ucb1x00_io_set_dir);
730 EXPORT_SYMBOL(ucb1x00_io_write);
731 EXPORT_SYMBOL(ucb1x00_io_read);
732 
733 EXPORT_SYMBOL(ucb1x00_adc_enable);
734 EXPORT_SYMBOL(ucb1x00_adc_read);
735 EXPORT_SYMBOL(ucb1x00_adc_disable);
736 
737 EXPORT_SYMBOL(ucb1x00_hook_irq);
738 EXPORT_SYMBOL(ucb1x00_free_irq);
739 EXPORT_SYMBOL(ucb1x00_enable_irq);
740 EXPORT_SYMBOL(ucb1x00_disable_irq);
741 
742 EXPORT_SYMBOL(ucb1x00_register_driver);
743 EXPORT_SYMBOL(ucb1x00_unregister_driver);
744 
745 MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
746 MODULE_DESCRIPTION("UCB1x00 core driver");
747 MODULE_LICENSE("GPL");
748