xref: /linux/arch/arm/common/sa1111.c (revision db10cb9b) 
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * linux/arch/arm/common/sa1111.c
4  *
5  * SA1111 support
6  *
7  * Original code by John Dorsey
8  *
9  * This file contains all generic SA1111 support.
10  *
11  * All initialization functions provided here are intended to be called
12  * from machine specific code with proper arguments when required.
13  */
14 #include <linux/module.h>
15 #include <linux/gpio/driver.h>
16 #include <linux/init.h>
17 #include <linux/irq.h>
18 #include <linux/kernel.h>
19 #include <linux/delay.h>
20 #include <linux/errno.h>
21 #include <linux/ioport.h>
22 #include <linux/platform_device.h>
23 #include <linux/slab.h>
24 #include <linux/spinlock.h>
25 #include <linux/dma-map-ops.h>
26 #include <linux/clk.h>
27 #include <linux/io.h>
28 
29 #include <asm/mach/irq.h>
30 #include <asm/mach-types.h>
31 #include <linux/sizes.h>
32 
33 #include <asm/hardware/sa1111.h>
34 
35 #ifdef CONFIG_ARCH_SA1100
36 #include <mach/hardware.h>
37 #endif
38 
39 /* SA1111 IRQs */
40 #define IRQ_GPAIN0		(0)
41 #define IRQ_GPAIN1		(1)
42 #define IRQ_GPAIN2		(2)
43 #define IRQ_GPAIN3		(3)
44 #define IRQ_GPBIN0		(4)
45 #define IRQ_GPBIN1		(5)
46 #define IRQ_GPBIN2		(6)
47 #define IRQ_GPBIN3		(7)
48 #define IRQ_GPBIN4		(8)
49 #define IRQ_GPBIN5		(9)
50 #define IRQ_GPCIN0		(10)
51 #define IRQ_GPCIN1		(11)
52 #define IRQ_GPCIN2		(12)
53 #define IRQ_GPCIN3		(13)
54 #define IRQ_GPCIN4		(14)
55 #define IRQ_GPCIN5		(15)
56 #define IRQ_GPCIN6		(16)
57 #define IRQ_GPCIN7		(17)
58 #define IRQ_MSTXINT		(18)
59 #define IRQ_MSRXINT		(19)
60 #define IRQ_MSSTOPERRINT	(20)
61 #define IRQ_TPTXINT		(21)
62 #define IRQ_TPRXINT		(22)
63 #define IRQ_TPSTOPERRINT	(23)
64 #define SSPXMTINT		(24)
65 #define SSPRCVINT		(25)
66 #define SSPROR			(26)
67 #define AUDXMTDMADONEA		(32)
68 #define AUDRCVDMADONEA		(33)
69 #define AUDXMTDMADONEB		(34)
70 #define AUDRCVDMADONEB		(35)
71 #define AUDTFSR			(36)
72 #define AUDRFSR			(37)
73 #define AUDTUR			(38)
74 #define AUDROR			(39)
75 #define AUDDTS			(40)
76 #define AUDRDD			(41)
77 #define AUDSTO			(42)
78 #define IRQ_USBPWR		(43)
79 #define IRQ_HCIM		(44)
80 #define IRQ_HCIBUFFACC		(45)
81 #define IRQ_HCIRMTWKP		(46)
82 #define IRQ_NHCIMFCIR		(47)
83 #define IRQ_USB_PORT_RESUME	(48)
84 #define IRQ_S0_READY_NINT	(49)
85 #define IRQ_S1_READY_NINT	(50)
86 #define IRQ_S0_CD_VALID		(51)
87 #define IRQ_S1_CD_VALID		(52)
88 #define IRQ_S0_BVD1_STSCHG	(53)
89 #define IRQ_S1_BVD1_STSCHG	(54)
90 #define SA1111_IRQ_NR		(55)
91 
92 extern void sa1110_mb_enable(void);
93 extern void sa1110_mb_disable(void);
94 
95 /*
96  * We keep the following data for the overall SA1111.  Note that the
97  * struct device and struct resource are "fake"; they should be supplied
98  * by the bus above us.  However, in the interests of getting all SA1111
99  * drivers converted over to the device model, we provide this as an
100  * anchor point for all the other drivers.
101  */
102 struct sa1111 {
103 	struct device	*dev;
104 	struct clk	*clk;
105 	unsigned long	phys;
106 	int		irq;
107 	int		irq_base;	/* base for cascaded on-chip IRQs */
108 	spinlock_t	lock;
109 	void __iomem	*base;
110 	struct sa1111_platform_data *pdata;
111 	struct irq_domain *irqdomain;
112 	struct gpio_chip gc;
113 #ifdef CONFIG_PM
114 	void		*saved_state;
115 #endif
116 };
117 
118 /*
119  * We _really_ need to eliminate this.  Its only users
120  * are the PWM and DMA checking code.
121  */
122 static struct sa1111 *g_sa1111;
123 
124 struct sa1111_dev_info {
125 	unsigned long	offset;
126 	unsigned long	skpcr_mask;
127 	bool		dma;
128 	unsigned int	devid;
129 	unsigned int	hwirq[6];
130 };
131 
132 static struct sa1111_dev_info sa1111_devices[] = {
133 	{
134 		.offset		= SA1111_USB,
135 		.skpcr_mask	= SKPCR_UCLKEN,
136 		.dma		= true,
137 		.devid		= SA1111_DEVID_USB,
138 		.hwirq = {
139 			IRQ_USBPWR,
140 			IRQ_HCIM,
141 			IRQ_HCIBUFFACC,
142 			IRQ_HCIRMTWKP,
143 			IRQ_NHCIMFCIR,
144 			IRQ_USB_PORT_RESUME
145 		},
146 	},
147 	{
148 		.offset		= 0x0600,
149 		.skpcr_mask	= SKPCR_I2SCLKEN | SKPCR_L3CLKEN,
150 		.dma		= true,
151 		.devid		= SA1111_DEVID_SAC,
152 		.hwirq = {
153 			AUDXMTDMADONEA,
154 			AUDXMTDMADONEB,
155 			AUDRCVDMADONEA,
156 			AUDRCVDMADONEB
157 		},
158 	},
159 	{
160 		.offset		= 0x0800,
161 		.skpcr_mask	= SKPCR_SCLKEN,
162 		.devid		= SA1111_DEVID_SSP,
163 	},
164 	{
165 		.offset		= SA1111_KBD,
166 		.skpcr_mask	= SKPCR_PTCLKEN,
167 		.devid		= SA1111_DEVID_PS2_KBD,
168 		.hwirq = {
169 			IRQ_TPRXINT,
170 			IRQ_TPTXINT
171 		},
172 	},
173 	{
174 		.offset		= SA1111_MSE,
175 		.skpcr_mask	= SKPCR_PMCLKEN,
176 		.devid		= SA1111_DEVID_PS2_MSE,
177 		.hwirq = {
178 			IRQ_MSRXINT,
179 			IRQ_MSTXINT
180 		},
181 	},
182 	{
183 		.offset		= 0x1800,
184 		.skpcr_mask	= 0,
185 		.devid		= SA1111_DEVID_PCMCIA,
186 		.hwirq = {
187 			IRQ_S0_READY_NINT,
188 			IRQ_S0_CD_VALID,
189 			IRQ_S0_BVD1_STSCHG,
190 			IRQ_S1_READY_NINT,
191 			IRQ_S1_CD_VALID,
192 			IRQ_S1_BVD1_STSCHG,
193 		},
194 	},
195 };
196 
197 static int sa1111_map_irq(struct sa1111 *sachip, irq_hw_number_t hwirq)
198 {
199 	return irq_create_mapping(sachip->irqdomain, hwirq);
200 }
201 
202 /*
203  * SA1111 interrupt support.  Since clearing an IRQ while there are
204  * active IRQs causes the interrupt output to pulse, the upper levels
205  * will call us again if there are more interrupts to process.
206  */
207 static void sa1111_irq_handler(struct irq_desc *desc)
208 {
209 	unsigned int stat0, stat1, i;
210 	struct sa1111 *sachip = irq_desc_get_handler_data(desc);
211 	struct irq_domain *irqdomain;
212 	void __iomem *mapbase = sachip->base + SA1111_INTC;
213 
214 	stat0 = readl_relaxed(mapbase + SA1111_INTSTATCLR0);
215 	stat1 = readl_relaxed(mapbase + SA1111_INTSTATCLR1);
216 
217 	writel_relaxed(stat0, mapbase + SA1111_INTSTATCLR0);
218 
219 	desc->irq_data.chip->irq_ack(&desc->irq_data);
220 
221 	writel_relaxed(stat1, mapbase + SA1111_INTSTATCLR1);
222 
223 	if (stat0 == 0 && stat1 == 0) {
224 		do_bad_IRQ(desc);
225 		return;
226 	}
227 
228 	irqdomain = sachip->irqdomain;
229 
230 	for (i = 0; stat0; i++, stat0 >>= 1)
231 		if (stat0 & 1)
232 			generic_handle_domain_irq(irqdomain, i);
233 
234 	for (i = 32; stat1; i++, stat1 >>= 1)
235 		if (stat1 & 1)
236 			generic_handle_domain_irq(irqdomain, i);
237 
238 	/* For level-based interrupts */
239 	desc->irq_data.chip->irq_unmask(&desc->irq_data);
240 }
241 
242 static u32 sa1111_irqmask(struct irq_data *d)
243 {
244 	return BIT(irqd_to_hwirq(d) & 31);
245 }
246 
247 static int sa1111_irqbank(struct irq_data *d)
248 {
249 	return (irqd_to_hwirq(d) / 32) * 4;
250 }
251 
252 static void sa1111_ack_irq(struct irq_data *d)
253 {
254 }
255 
256 static void sa1111_mask_irq(struct irq_data *d)
257 {
258 	struct sa1111 *sachip = irq_data_get_irq_chip_data(d);
259 	void __iomem *mapbase = sachip->base + SA1111_INTC + sa1111_irqbank(d);
260 	u32 ie;
261 
262 	ie = readl_relaxed(mapbase + SA1111_INTEN0);
263 	ie &= ~sa1111_irqmask(d);
264 	writel(ie, mapbase + SA1111_INTEN0);
265 }
266 
267 static void sa1111_unmask_irq(struct irq_data *d)
268 {
269 	struct sa1111 *sachip = irq_data_get_irq_chip_data(d);
270 	void __iomem *mapbase = sachip->base + SA1111_INTC + sa1111_irqbank(d);
271 	u32 ie;
272 
273 	ie = readl_relaxed(mapbase + SA1111_INTEN0);
274 	ie |= sa1111_irqmask(d);
275 	writel_relaxed(ie, mapbase + SA1111_INTEN0);
276 }
277 
278 /*
279  * Attempt to re-trigger the interrupt.  The SA1111 contains a register
280  * (INTSET) which claims to do this.  However, in practice no amount of
281  * manipulation of INTEN and INTSET guarantees that the interrupt will
282  * be triggered.  In fact, its very difficult, if not impossible to get
283  * INTSET to re-trigger the interrupt.
284  */
285 static int sa1111_retrigger_irq(struct irq_data *d)
286 {
287 	struct sa1111 *sachip = irq_data_get_irq_chip_data(d);
288 	void __iomem *mapbase = sachip->base + SA1111_INTC + sa1111_irqbank(d);
289 	u32 ip, mask = sa1111_irqmask(d);
290 	int i;
291 
292 	ip = readl_relaxed(mapbase + SA1111_INTPOL0);
293 	for (i = 0; i < 8; i++) {
294 		writel_relaxed(ip ^ mask, mapbase + SA1111_INTPOL0);
295 		writel_relaxed(ip, mapbase + SA1111_INTPOL0);
296 		if (readl_relaxed(mapbase + SA1111_INTSTATCLR0) & mask)
297 			break;
298 	}
299 
300 	if (i == 8) {
301 		pr_err("Danger Will Robinson: failed to re-trigger IRQ%d\n",
302 		       d->irq);
303 		return 0;
304 	}
305 
306 	return 1;
307 }
308 
309 static int sa1111_type_irq(struct irq_data *d, unsigned int flags)
310 {
311 	struct sa1111 *sachip = irq_data_get_irq_chip_data(d);
312 	void __iomem *mapbase = sachip->base + SA1111_INTC + sa1111_irqbank(d);
313 	u32 ip, mask = sa1111_irqmask(d);
314 
315 	if (flags == IRQ_TYPE_PROBE)
316 		return 0;
317 
318 	if ((!(flags & IRQ_TYPE_EDGE_RISING) ^ !(flags & IRQ_TYPE_EDGE_FALLING)) == 0)
319 		return -EINVAL;
320 
321 	ip = readl_relaxed(mapbase + SA1111_INTPOL0);
322 	if (flags & IRQ_TYPE_EDGE_RISING)
323 		ip &= ~mask;
324 	else
325 		ip |= mask;
326 	writel_relaxed(ip, mapbase + SA1111_INTPOL0);
327 	writel_relaxed(ip, mapbase + SA1111_WAKEPOL0);
328 
329 	return 0;
330 }
331 
332 static int sa1111_wake_irq(struct irq_data *d, unsigned int on)
333 {
334 	struct sa1111 *sachip = irq_data_get_irq_chip_data(d);
335 	void __iomem *mapbase = sachip->base + SA1111_INTC + sa1111_irqbank(d);
336 	u32 we, mask = sa1111_irqmask(d);
337 
338 	we = readl_relaxed(mapbase + SA1111_WAKEEN0);
339 	if (on)
340 		we |= mask;
341 	else
342 		we &= ~mask;
343 	writel_relaxed(we, mapbase + SA1111_WAKEEN0);
344 
345 	return 0;
346 }
347 
348 static struct irq_chip sa1111_irq_chip = {
349 	.name		= "SA1111",
350 	.irq_ack	= sa1111_ack_irq,
351 	.irq_mask	= sa1111_mask_irq,
352 	.irq_unmask	= sa1111_unmask_irq,
353 	.irq_retrigger	= sa1111_retrigger_irq,
354 	.irq_set_type	= sa1111_type_irq,
355 	.irq_set_wake	= sa1111_wake_irq,
356 };
357 
358 static int sa1111_irqdomain_map(struct irq_domain *d, unsigned int irq,
359 	irq_hw_number_t hwirq)
360 {
361 	struct sa1111 *sachip = d->host_data;
362 
363 	/* Disallow unavailable interrupts */
364 	if (hwirq > SSPROR && hwirq < AUDXMTDMADONEA)
365 		return -EINVAL;
366 
367 	irq_set_chip_data(irq, sachip);
368 	irq_set_chip_and_handler(irq, &sa1111_irq_chip, handle_edge_irq);
369 	irq_clear_status_flags(irq, IRQ_NOREQUEST | IRQ_NOPROBE);
370 
371 	return 0;
372 }
373 
374 static const struct irq_domain_ops sa1111_irqdomain_ops = {
375 	.map = sa1111_irqdomain_map,
376 	.xlate = irq_domain_xlate_twocell,
377 };
378 
379 static int sa1111_setup_irq(struct sa1111 *sachip, unsigned irq_base)
380 {
381 	void __iomem *irqbase = sachip->base + SA1111_INTC;
382 	int ret;
383 
384 	/*
385 	 * We're guaranteed that this region hasn't been taken.
386 	 */
387 	request_mem_region(sachip->phys + SA1111_INTC, 512, "irq");
388 
389 	ret = irq_alloc_descs(-1, irq_base, SA1111_IRQ_NR, -1);
390 	if (ret <= 0) {
391 		dev_err(sachip->dev, "unable to allocate %u irqs: %d\n",
392 			SA1111_IRQ_NR, ret);
393 		if (ret == 0)
394 			ret = -EINVAL;
395 		return ret;
396 	}
397 
398 	sachip->irq_base = ret;
399 
400 	/* disable all IRQs */
401 	writel_relaxed(0, irqbase + SA1111_INTEN0);
402 	writel_relaxed(0, irqbase + SA1111_INTEN1);
403 	writel_relaxed(0, irqbase + SA1111_WAKEEN0);
404 	writel_relaxed(0, irqbase + SA1111_WAKEEN1);
405 
406 	/*
407 	 * detect on rising edge.  Note: Feb 2001 Errata for SA1111
408 	 * specifies that S0ReadyInt and S1ReadyInt should be '1'.
409 	 */
410 	writel_relaxed(0, irqbase + SA1111_INTPOL0);
411 	writel_relaxed(BIT(IRQ_S0_READY_NINT & 31) |
412 		       BIT(IRQ_S1_READY_NINT & 31),
413 		       irqbase + SA1111_INTPOL1);
414 
415 	/* clear all IRQs */
416 	writel_relaxed(~0, irqbase + SA1111_INTSTATCLR0);
417 	writel_relaxed(~0, irqbase + SA1111_INTSTATCLR1);
418 
419 	sachip->irqdomain = irq_domain_add_linear(NULL, SA1111_IRQ_NR,
420 						  &sa1111_irqdomain_ops,
421 						  sachip);
422 	if (!sachip->irqdomain) {
423 		irq_free_descs(sachip->irq_base, SA1111_IRQ_NR);
424 		return -ENOMEM;
425 	}
426 
427 	irq_domain_associate_many(sachip->irqdomain,
428 				  sachip->irq_base + IRQ_GPAIN0,
429 				  IRQ_GPAIN0, SSPROR + 1 - IRQ_GPAIN0);
430 	irq_domain_associate_many(sachip->irqdomain,
431 				  sachip->irq_base + AUDXMTDMADONEA,
432 				  AUDXMTDMADONEA,
433 				  IRQ_S1_BVD1_STSCHG + 1 - AUDXMTDMADONEA);
434 
435 	/*
436 	 * Register SA1111 interrupt
437 	 */
438 	irq_set_irq_type(sachip->irq, IRQ_TYPE_EDGE_RISING);
439 	irq_set_chained_handler_and_data(sachip->irq, sa1111_irq_handler,
440 					 sachip);
441 
442 	dev_info(sachip->dev, "Providing IRQ%u-%u\n",
443 		sachip->irq_base, sachip->irq_base + SA1111_IRQ_NR - 1);
444 
445 	return 0;
446 }
447 
448 static void sa1111_remove_irq(struct sa1111 *sachip)
449 {
450 	struct irq_domain *domain = sachip->irqdomain;
451 	void __iomem *irqbase = sachip->base + SA1111_INTC;
452 	int i;
453 
454 	/* disable all IRQs */
455 	writel_relaxed(0, irqbase + SA1111_INTEN0);
456 	writel_relaxed(0, irqbase + SA1111_INTEN1);
457 	writel_relaxed(0, irqbase + SA1111_WAKEEN0);
458 	writel_relaxed(0, irqbase + SA1111_WAKEEN1);
459 
460 	irq_set_chained_handler_and_data(sachip->irq, NULL, NULL);
461 	for (i = 0; i < SA1111_IRQ_NR; i++)
462 		irq_dispose_mapping(irq_find_mapping(domain, i));
463 	irq_domain_remove(domain);
464 
465 	release_mem_region(sachip->phys + SA1111_INTC, 512);
466 }
467 
468 enum {
469 	SA1111_GPIO_PXDDR = (SA1111_GPIO_PADDR - SA1111_GPIO_PADDR),
470 	SA1111_GPIO_PXDRR = (SA1111_GPIO_PADRR - SA1111_GPIO_PADDR),
471 	SA1111_GPIO_PXDWR = (SA1111_GPIO_PADWR - SA1111_GPIO_PADDR),
472 	SA1111_GPIO_PXSDR = (SA1111_GPIO_PASDR - SA1111_GPIO_PADDR),
473 	SA1111_GPIO_PXSSR = (SA1111_GPIO_PASSR - SA1111_GPIO_PADDR),
474 };
475 
476 static struct sa1111 *gc_to_sa1111(struct gpio_chip *gc)
477 {
478 	return container_of(gc, struct sa1111, gc);
479 }
480 
481 static void __iomem *sa1111_gpio_map_reg(struct sa1111 *sachip, unsigned offset)
482 {
483 	void __iomem *reg = sachip->base + SA1111_GPIO;
484 
485 	if (offset < 4)
486 		return reg + SA1111_GPIO_PADDR;
487 	if (offset < 10)
488 		return reg + SA1111_GPIO_PBDDR;
489 	if (offset < 18)
490 		return reg + SA1111_GPIO_PCDDR;
491 	return NULL;
492 }
493 
494 static u32 sa1111_gpio_map_bit(unsigned offset)
495 {
496 	if (offset < 4)
497 		return BIT(offset);
498 	if (offset < 10)
499 		return BIT(offset - 4);
500 	if (offset < 18)
501 		return BIT(offset - 10);
502 	return 0;
503 }
504 
505 static void sa1111_gpio_modify(void __iomem *reg, u32 mask, u32 set)
506 {
507 	u32 val;
508 
509 	val = readl_relaxed(reg);
510 	val &= ~mask;
511 	val |= mask & set;
512 	writel_relaxed(val, reg);
513 }
514 
515 static int sa1111_gpio_get_direction(struct gpio_chip *gc, unsigned offset)
516 {
517 	struct sa1111 *sachip = gc_to_sa1111(gc);
518 	void __iomem *reg = sa1111_gpio_map_reg(sachip, offset);
519 	u32 mask = sa1111_gpio_map_bit(offset);
520 
521 	return !!(readl_relaxed(reg + SA1111_GPIO_PXDDR) & mask);
522 }
523 
524 static int sa1111_gpio_direction_input(struct gpio_chip *gc, unsigned offset)
525 {
526 	struct sa1111 *sachip = gc_to_sa1111(gc);
527 	unsigned long flags;
528 	void __iomem *reg = sa1111_gpio_map_reg(sachip, offset);
529 	u32 mask = sa1111_gpio_map_bit(offset);
530 
531 	spin_lock_irqsave(&sachip->lock, flags);
532 	sa1111_gpio_modify(reg + SA1111_GPIO_PXDDR, mask, mask);
533 	sa1111_gpio_modify(reg + SA1111_GPIO_PXSDR, mask, mask);
534 	spin_unlock_irqrestore(&sachip->lock, flags);
535 
536 	return 0;
537 }
538 
539 static int sa1111_gpio_direction_output(struct gpio_chip *gc, unsigned offset,
540 	int value)
541 {
542 	struct sa1111 *sachip = gc_to_sa1111(gc);
543 	unsigned long flags;
544 	void __iomem *reg = sa1111_gpio_map_reg(sachip, offset);
545 	u32 mask = sa1111_gpio_map_bit(offset);
546 
547 	spin_lock_irqsave(&sachip->lock, flags);
548 	sa1111_gpio_modify(reg + SA1111_GPIO_PXDWR, mask, value ? mask : 0);
549 	sa1111_gpio_modify(reg + SA1111_GPIO_PXSSR, mask, value ? mask : 0);
550 	sa1111_gpio_modify(reg + SA1111_GPIO_PXDDR, mask, 0);
551 	sa1111_gpio_modify(reg + SA1111_GPIO_PXSDR, mask, 0);
552 	spin_unlock_irqrestore(&sachip->lock, flags);
553 
554 	return 0;
555 }
556 
557 static int sa1111_gpio_get(struct gpio_chip *gc, unsigned offset)
558 {
559 	struct sa1111 *sachip = gc_to_sa1111(gc);
560 	void __iomem *reg = sa1111_gpio_map_reg(sachip, offset);
561 	u32 mask = sa1111_gpio_map_bit(offset);
562 
563 	return !!(readl_relaxed(reg + SA1111_GPIO_PXDRR) & mask);
564 }
565 
566 static void sa1111_gpio_set(struct gpio_chip *gc, unsigned offset, int value)
567 {
568 	struct sa1111 *sachip = gc_to_sa1111(gc);
569 	unsigned long flags;
570 	void __iomem *reg = sa1111_gpio_map_reg(sachip, offset);
571 	u32 mask = sa1111_gpio_map_bit(offset);
572 
573 	spin_lock_irqsave(&sachip->lock, flags);
574 	sa1111_gpio_modify(reg + SA1111_GPIO_PXDWR, mask, value ? mask : 0);
575 	sa1111_gpio_modify(reg + SA1111_GPIO_PXSSR, mask, value ? mask : 0);
576 	spin_unlock_irqrestore(&sachip->lock, flags);
577 }
578 
579 static void sa1111_gpio_set_multiple(struct gpio_chip *gc, unsigned long *mask,
580 	unsigned long *bits)
581 {
582 	struct sa1111 *sachip = gc_to_sa1111(gc);
583 	unsigned long flags;
584 	void __iomem *reg = sachip->base + SA1111_GPIO;
585 	u32 msk, val;
586 
587 	msk = *mask;
588 	val = *bits;
589 
590 	spin_lock_irqsave(&sachip->lock, flags);
591 	sa1111_gpio_modify(reg + SA1111_GPIO_PADWR, msk & 15, val);
592 	sa1111_gpio_modify(reg + SA1111_GPIO_PASSR, msk & 15, val);
593 	sa1111_gpio_modify(reg + SA1111_GPIO_PBDWR, (msk >> 4) & 255, val >> 4);
594 	sa1111_gpio_modify(reg + SA1111_GPIO_PBSSR, (msk >> 4) & 255, val >> 4);
595 	sa1111_gpio_modify(reg + SA1111_GPIO_PCDWR, (msk >> 12) & 255, val >> 12);
596 	sa1111_gpio_modify(reg + SA1111_GPIO_PCSSR, (msk >> 12) & 255, val >> 12);
597 	spin_unlock_irqrestore(&sachip->lock, flags);
598 }
599 
600 static int sa1111_gpio_to_irq(struct gpio_chip *gc, unsigned offset)
601 {
602 	struct sa1111 *sachip = gc_to_sa1111(gc);
603 
604 	return sa1111_map_irq(sachip, offset);
605 }
606 
607 static int sa1111_setup_gpios(struct sa1111 *sachip)
608 {
609 	sachip->gc.label = "sa1111";
610 	sachip->gc.parent = sachip->dev;
611 	sachip->gc.owner = THIS_MODULE;
612 	sachip->gc.get_direction = sa1111_gpio_get_direction;
613 	sachip->gc.direction_input = sa1111_gpio_direction_input;
614 	sachip->gc.direction_output = sa1111_gpio_direction_output;
615 	sachip->gc.get = sa1111_gpio_get;
616 	sachip->gc.set = sa1111_gpio_set;
617 	sachip->gc.set_multiple = sa1111_gpio_set_multiple;
618 	sachip->gc.to_irq = sa1111_gpio_to_irq;
619 	sachip->gc.base = -1;
620 	sachip->gc.ngpio = 18;
621 
622 	return devm_gpiochip_add_data(sachip->dev, &sachip->gc, sachip);
623 }
624 
625 /*
626  * Bring the SA1111 out of reset.  This requires a set procedure:
627  *  1. nRESET asserted (by hardware)
628  *  2. CLK turned on from SA1110
629  *  3. nRESET deasserted
630  *  4. VCO turned on, PLL_BYPASS turned off
631  *  5. Wait lock time, then assert RCLKEn
632  *  7. PCR set to allow clocking of individual functions
633  *
634  * Until we've done this, the only registers we can access are:
635  *   SBI_SKCR
636  *   SBI_SMCR
637  *   SBI_SKID
638  */
639 static void sa1111_wake(struct sa1111 *sachip)
640 {
641 	unsigned long flags, r;
642 
643 	spin_lock_irqsave(&sachip->lock, flags);
644 
645 	clk_enable(sachip->clk);
646 
647 	/*
648 	 * Turn VCO on, and disable PLL Bypass.
649 	 */
650 	r = readl_relaxed(sachip->base + SA1111_SKCR);
651 	r &= ~SKCR_VCO_OFF;
652 	writel_relaxed(r, sachip->base + SA1111_SKCR);
653 	r |= SKCR_PLL_BYPASS | SKCR_OE_EN;
654 	writel_relaxed(r, sachip->base + SA1111_SKCR);
655 
656 	/*
657 	 * Wait lock time.  SA1111 manual _doesn't_
658 	 * specify a figure for this!  We choose 100us.
659 	 */
660 	udelay(100);
661 
662 	/*
663 	 * Enable RCLK.  We also ensure that RDYEN is set.
664 	 */
665 	r |= SKCR_RCLKEN | SKCR_RDYEN;
666 	writel_relaxed(r, sachip->base + SA1111_SKCR);
667 
668 	/*
669 	 * Wait 14 RCLK cycles for the chip to finish coming out
670 	 * of reset. (RCLK=24MHz).  This is 590ns.
671 	 */
672 	udelay(1);
673 
674 	/*
675 	 * Ensure all clocks are initially off.
676 	 */
677 	writel_relaxed(0, sachip->base + SA1111_SKPCR);
678 
679 	spin_unlock_irqrestore(&sachip->lock, flags);
680 }
681 
682 #ifdef CONFIG_ARCH_SA1100
683 
684 static u32 sa1111_dma_mask[] = {
685 	~0,
686 	~(1 << 20),
687 	~(1 << 23),
688 	~(1 << 24),
689 	~(1 << 25),
690 	~(1 << 20),
691 	~(1 << 20),
692 	0,
693 };
694 
695 /*
696  * Configure the SA1111 shared memory controller.
697  */
698 static void
699 sa1111_configure_smc(struct sa1111 *sachip, int sdram, unsigned int drac,
700 		     unsigned int cas_latency)
701 {
702 	unsigned int smcr = SMCR_DTIM | SMCR_MBGE | FInsrt(drac, SMCR_DRAC);
703 
704 	if (cas_latency == 3)
705 		smcr |= SMCR_CLAT;
706 
707 	writel_relaxed(smcr, sachip->base + SA1111_SMCR);
708 
709 	/*
710 	 * Now clear the bits in the DMA mask to work around the SA1111
711 	 * DMA erratum (Intel StrongARM SA-1111 Microprocessor Companion
712 	 * Chip Specification Update, June 2000, Erratum #7).
713 	 */
714 	if (sachip->dev->dma_mask)
715 		*sachip->dev->dma_mask &= sa1111_dma_mask[drac >> 2];
716 
717 	sachip->dev->coherent_dma_mask &= sa1111_dma_mask[drac >> 2];
718 }
719 #endif
720 
721 static void sa1111_dev_release(struct device *_dev)
722 {
723 	struct sa1111_dev *dev = to_sa1111_device(_dev);
724 
725 	kfree(dev);
726 }
727 
728 static int
729 sa1111_init_one_child(struct sa1111 *sachip, struct resource *parent,
730 		      struct sa1111_dev_info *info)
731 {
732 	struct sa1111_dev *dev;
733 	unsigned i;
734 	int ret;
735 
736 	dev = kzalloc(sizeof(struct sa1111_dev), GFP_KERNEL);
737 	if (!dev) {
738 		ret = -ENOMEM;
739 		goto err_alloc;
740 	}
741 
742 	device_initialize(&dev->dev);
743 	dev_set_name(&dev->dev, "%4.4lx", info->offset);
744 	dev->devid	 = info->devid;
745 	dev->dev.parent  = sachip->dev;
746 	dev->dev.bus     = &sa1111_bus_type;
747 	dev->dev.release = sa1111_dev_release;
748 	dev->res.start   = sachip->phys + info->offset;
749 	dev->res.end     = dev->res.start + 511;
750 	dev->res.name    = dev_name(&dev->dev);
751 	dev->res.flags   = IORESOURCE_MEM;
752 	dev->mapbase     = sachip->base + info->offset;
753 	dev->skpcr_mask  = info->skpcr_mask;
754 
755 	for (i = 0; i < ARRAY_SIZE(info->hwirq); i++)
756 		dev->hwirq[i] = info->hwirq[i];
757 
758 	/*
759 	 * If the parent device has a DMA mask associated with it, and
760 	 * this child supports DMA, propagate it down to the children.
761 	 */
762 	if (info->dma && sachip->dev->dma_mask) {
763 		dev->dma_mask = *sachip->dev->dma_mask;
764 		dev->dev.dma_mask = &dev->dma_mask;
765 		dev->dev.coherent_dma_mask = sachip->dev->coherent_dma_mask;
766 	}
767 
768 	ret = request_resource(parent, &dev->res);
769 	if (ret) {
770 		dev_err(sachip->dev, "failed to allocate resource for %s\n",
771 			dev->res.name);
772 		goto err_resource;
773 	}
774 
775 	ret = device_add(&dev->dev);
776 	if (ret)
777 		goto err_add;
778 	return 0;
779 
780  err_add:
781 	release_resource(&dev->res);
782  err_resource:
783 	put_device(&dev->dev);
784  err_alloc:
785 	return ret;
786 }
787 
788 /**
789  *	sa1111_probe - probe for a single SA1111 chip.
790  *	@phys_addr: physical address of device.
791  *
792  *	Probe for a SA1111 chip.  This must be called
793  *	before any other SA1111-specific code.
794  *
795  *	Returns:
796  *	%-ENODEV	device not found.
797  *	%-EBUSY		physical address already marked in-use.
798  *	%-EINVAL	no platform data passed
799  *	%0		successful.
800  */
801 static int __sa1111_probe(struct device *me, struct resource *mem, int irq)
802 {
803 	struct sa1111_platform_data *pd = me->platform_data;
804 	struct sa1111 *sachip;
805 	unsigned long id;
806 	unsigned int has_devs;
807 	int i, ret = -ENODEV;
808 
809 	if (!pd)
810 		return -EINVAL;
811 
812 	sachip = devm_kzalloc(me, sizeof(struct sa1111), GFP_KERNEL);
813 	if (!sachip)
814 		return -ENOMEM;
815 
816 	sachip->clk = devm_clk_get(me, "SA1111_CLK");
817 	if (IS_ERR(sachip->clk))
818 		return PTR_ERR(sachip->clk);
819 
820 	ret = clk_prepare(sachip->clk);
821 	if (ret)
822 		return ret;
823 
824 	spin_lock_init(&sachip->lock);
825 
826 	sachip->dev = me;
827 	dev_set_drvdata(sachip->dev, sachip);
828 
829 	sachip->pdata = pd;
830 	sachip->phys = mem->start;
831 	sachip->irq = irq;
832 
833 	/*
834 	 * Map the whole region.  This also maps the
835 	 * registers for our children.
836 	 */
837 	sachip->base = ioremap(mem->start, PAGE_SIZE * 2);
838 	if (!sachip->base) {
839 		ret = -ENOMEM;
840 		goto err_clk_unprep;
841 	}
842 
843 	/*
844 	 * Probe for the chip.  Only touch the SBI registers.
845 	 */
846 	id = readl_relaxed(sachip->base + SA1111_SKID);
847 	if ((id & SKID_ID_MASK) != SKID_SA1111_ID) {
848 		printk(KERN_DEBUG "SA1111 not detected: ID = %08lx\n", id);
849 		ret = -ENODEV;
850 		goto err_unmap;
851 	}
852 
853 	pr_info("SA1111 Microprocessor Companion Chip: silicon revision %lx, metal revision %lx\n",
854 		(id & SKID_SIREV_MASK) >> 4, id & SKID_MTREV_MASK);
855 
856 	/*
857 	 * We found it.  Wake the chip up, and initialise.
858 	 */
859 	sa1111_wake(sachip);
860 
861 	/*
862 	 * The interrupt controller must be initialised before any
863 	 * other device to ensure that the interrupts are available.
864 	 */
865 	ret = sa1111_setup_irq(sachip, pd->irq_base);
866 	if (ret)
867 		goto err_clk;
868 
869 	/* Setup the GPIOs - should really be done after the IRQ setup */
870 	ret = sa1111_setup_gpios(sachip);
871 	if (ret)
872 		goto err_irq;
873 
874 #ifdef CONFIG_ARCH_SA1100
875 	{
876 	unsigned int val;
877 
878 	/*
879 	 * The SDRAM configuration of the SA1110 and the SA1111 must
880 	 * match.  This is very important to ensure that SA1111 accesses
881 	 * don't corrupt the SDRAM.  Note that this ungates the SA1111's
882 	 * MBGNT signal, so we must have called sa1110_mb_disable()
883 	 * beforehand.
884 	 */
885 	sa1111_configure_smc(sachip, 1,
886 			     FExtr(MDCNFG, MDCNFG_SA1110_DRAC0),
887 			     FExtr(MDCNFG, MDCNFG_SA1110_TDL0));
888 
889 	/*
890 	 * We only need to turn on DCLK whenever we want to use the
891 	 * DMA.  It can otherwise be held firmly in the off position.
892 	 * (currently, we always enable it.)
893 	 */
894 	val = readl_relaxed(sachip->base + SA1111_SKPCR);
895 	writel_relaxed(val | SKPCR_DCLKEN, sachip->base + SA1111_SKPCR);
896 
897 	/*
898 	 * Enable the SA1110 memory bus request and grant signals.
899 	 */
900 	sa1110_mb_enable();
901 	}
902 #endif
903 
904 	g_sa1111 = sachip;
905 
906 	has_devs = ~0;
907 	if (pd)
908 		has_devs &= ~pd->disable_devs;
909 
910 	for (i = 0; i < ARRAY_SIZE(sa1111_devices); i++)
911 		if (sa1111_devices[i].devid & has_devs)
912 			sa1111_init_one_child(sachip, mem, &sa1111_devices[i]);
913 
914 	return 0;
915 
916  err_irq:
917 	sa1111_remove_irq(sachip);
918  err_clk:
919 	clk_disable(sachip->clk);
920  err_unmap:
921 	iounmap(sachip->base);
922  err_clk_unprep:
923 	clk_unprepare(sachip->clk);
924 	return ret;
925 }
926 
927 static int sa1111_remove_one(struct device *dev, void *data)
928 {
929 	struct sa1111_dev *sadev = to_sa1111_device(dev);
930 	if (dev->bus != &sa1111_bus_type)
931 		return 0;
932 	device_del(&sadev->dev);
933 	release_resource(&sadev->res);
934 	put_device(&sadev->dev);
935 	return 0;
936 }
937 
938 static void __sa1111_remove(struct sa1111 *sachip)
939 {
940 	device_for_each_child(sachip->dev, NULL, sa1111_remove_one);
941 
942 	sa1111_remove_irq(sachip);
943 
944 	clk_disable(sachip->clk);
945 	clk_unprepare(sachip->clk);
946 
947 	iounmap(sachip->base);
948 }
949 
950 struct sa1111_save_data {
951 	unsigned int	skcr;
952 	unsigned int	skpcr;
953 	unsigned int	skcdr;
954 	unsigned char	skaud;
955 	unsigned char	skpwm0;
956 	unsigned char	skpwm1;
957 
958 	/*
959 	 * Interrupt controller
960 	 */
961 	unsigned int	intpol0;
962 	unsigned int	intpol1;
963 	unsigned int	inten0;
964 	unsigned int	inten1;
965 	unsigned int	wakepol0;
966 	unsigned int	wakepol1;
967 	unsigned int	wakeen0;
968 	unsigned int	wakeen1;
969 };
970 
971 #ifdef CONFIG_PM
972 
973 static int sa1111_suspend_noirq(struct device *dev)
974 {
975 	struct sa1111 *sachip = dev_get_drvdata(dev);
976 	struct sa1111_save_data *save;
977 	unsigned long flags;
978 	unsigned int val;
979 	void __iomem *base;
980 
981 	save = kmalloc(sizeof(struct sa1111_save_data), GFP_KERNEL);
982 	if (!save)
983 		return -ENOMEM;
984 	sachip->saved_state = save;
985 
986 	spin_lock_irqsave(&sachip->lock, flags);
987 
988 	/*
989 	 * Save state.
990 	 */
991 	base = sachip->base;
992 	save->skcr     = readl_relaxed(base + SA1111_SKCR);
993 	save->skpcr    = readl_relaxed(base + SA1111_SKPCR);
994 	save->skcdr    = readl_relaxed(base + SA1111_SKCDR);
995 	save->skaud    = readl_relaxed(base + SA1111_SKAUD);
996 	save->skpwm0   = readl_relaxed(base + SA1111_SKPWM0);
997 	save->skpwm1   = readl_relaxed(base + SA1111_SKPWM1);
998 
999 	writel_relaxed(0, sachip->base + SA1111_SKPWM0);
1000 	writel_relaxed(0, sachip->base + SA1111_SKPWM1);
1001 
1002 	base = sachip->base + SA1111_INTC;
1003 	save->intpol0  = readl_relaxed(base + SA1111_INTPOL0);
1004 	save->intpol1  = readl_relaxed(base + SA1111_INTPOL1);
1005 	save->inten0   = readl_relaxed(base + SA1111_INTEN0);
1006 	save->inten1   = readl_relaxed(base + SA1111_INTEN1);
1007 	save->wakepol0 = readl_relaxed(base + SA1111_WAKEPOL0);
1008 	save->wakepol1 = readl_relaxed(base + SA1111_WAKEPOL1);
1009 	save->wakeen0  = readl_relaxed(base + SA1111_WAKEEN0);
1010 	save->wakeen1  = readl_relaxed(base + SA1111_WAKEEN1);
1011 
1012 	/*
1013 	 * Disable.
1014 	 */
1015 	val = readl_relaxed(sachip->base + SA1111_SKCR);
1016 	writel_relaxed(val | SKCR_SLEEP, sachip->base + SA1111_SKCR);
1017 
1018 	clk_disable(sachip->clk);
1019 
1020 	spin_unlock_irqrestore(&sachip->lock, flags);
1021 
1022 #ifdef CONFIG_ARCH_SA1100
1023 	sa1110_mb_disable();
1024 #endif
1025 
1026 	return 0;
1027 }
1028 
1029 /*
1030  *	sa1111_resume - Restore the SA1111 device state.
1031  *	@dev: device to restore
1032  *
1033  *	Restore the general state of the SA1111; clock control and
1034  *	interrupt controller.  Other parts of the SA1111 must be
1035  *	restored by their respective drivers, and must be called
1036  *	via LDM after this function.
1037  */
1038 static int sa1111_resume_noirq(struct device *dev)
1039 {
1040 	struct sa1111 *sachip = dev_get_drvdata(dev);
1041 	struct sa1111_save_data *save;
1042 	unsigned long flags, id;
1043 	void __iomem *base;
1044 
1045 	save = sachip->saved_state;
1046 	if (!save)
1047 		return 0;
1048 
1049 	/*
1050 	 * Ensure that the SA1111 is still here.
1051 	 * FIXME: shouldn't do this here.
1052 	 */
1053 	id = readl_relaxed(sachip->base + SA1111_SKID);
1054 	if ((id & SKID_ID_MASK) != SKID_SA1111_ID) {
1055 		__sa1111_remove(sachip);
1056 		dev_set_drvdata(dev, NULL);
1057 		kfree(save);
1058 		return 0;
1059 	}
1060 
1061 	/*
1062 	 * First of all, wake up the chip.
1063 	 */
1064 	sa1111_wake(sachip);
1065 
1066 #ifdef CONFIG_ARCH_SA1100
1067 	/* Enable the memory bus request/grant signals */
1068 	sa1110_mb_enable();
1069 #endif
1070 
1071 	/*
1072 	 * Only lock for write ops. Also, sa1111_wake must be called with
1073 	 * released spinlock!
1074 	 */
1075 	spin_lock_irqsave(&sachip->lock, flags);
1076 
1077 	writel_relaxed(0, sachip->base + SA1111_INTC + SA1111_INTEN0);
1078 	writel_relaxed(0, sachip->base + SA1111_INTC + SA1111_INTEN1);
1079 
1080 	base = sachip->base;
1081 	writel_relaxed(save->skcr,     base + SA1111_SKCR);
1082 	writel_relaxed(save->skpcr,    base + SA1111_SKPCR);
1083 	writel_relaxed(save->skcdr,    base + SA1111_SKCDR);
1084 	writel_relaxed(save->skaud,    base + SA1111_SKAUD);
1085 	writel_relaxed(save->skpwm0,   base + SA1111_SKPWM0);
1086 	writel_relaxed(save->skpwm1,   base + SA1111_SKPWM1);
1087 
1088 	base = sachip->base + SA1111_INTC;
1089 	writel_relaxed(save->intpol0,  base + SA1111_INTPOL0);
1090 	writel_relaxed(save->intpol1,  base + SA1111_INTPOL1);
1091 	writel_relaxed(save->inten0,   base + SA1111_INTEN0);
1092 	writel_relaxed(save->inten1,   base + SA1111_INTEN1);
1093 	writel_relaxed(save->wakepol0, base + SA1111_WAKEPOL0);
1094 	writel_relaxed(save->wakepol1, base + SA1111_WAKEPOL1);
1095 	writel_relaxed(save->wakeen0,  base + SA1111_WAKEEN0);
1096 	writel_relaxed(save->wakeen1,  base + SA1111_WAKEEN1);
1097 
1098 	spin_unlock_irqrestore(&sachip->lock, flags);
1099 
1100 	sachip->saved_state = NULL;
1101 	kfree(save);
1102 
1103 	return 0;
1104 }
1105 
1106 #else
1107 #define sa1111_suspend_noirq NULL
1108 #define sa1111_resume_noirq  NULL
1109 #endif
1110 
1111 static int sa1111_probe(struct platform_device *pdev)
1112 {
1113 	struct resource *mem;
1114 	int irq;
1115 
1116 	mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1117 	if (!mem)
1118 		return -EINVAL;
1119 	irq = platform_get_irq(pdev, 0);
1120 	if (irq < 0)
1121 		return irq;
1122 
1123 	return __sa1111_probe(&pdev->dev, mem, irq);
1124 }
1125 
1126 static void sa1111_remove(struct platform_device *pdev)
1127 {
1128 	struct sa1111 *sachip = platform_get_drvdata(pdev);
1129 
1130 	if (sachip) {
1131 #ifdef CONFIG_PM
1132 		kfree(sachip->saved_state);
1133 		sachip->saved_state = NULL;
1134 #endif
1135 		__sa1111_remove(sachip);
1136 		platform_set_drvdata(pdev, NULL);
1137 	}
1138 }
1139 
1140 static struct dev_pm_ops sa1111_pm_ops = {
1141 	.suspend_noirq = sa1111_suspend_noirq,
1142 	.resume_noirq = sa1111_resume_noirq,
1143 };
1144 
1145 /*
1146  *	Not sure if this should be on the system bus or not yet.
1147  *	We really want some way to register a system device at
1148  *	the per-machine level, and then have this driver pick
1149  *	up the registered devices.
1150  *
1151  *	We also need to handle the SDRAM configuration for
1152  *	PXA250/SA1110 machine classes.
1153  */
1154 static struct platform_driver sa1111_device_driver = {
1155 	.probe		= sa1111_probe,
1156 	.remove_new	= sa1111_remove,
1157 	.driver		= {
1158 		.name	= "sa1111",
1159 		.pm	= &sa1111_pm_ops,
1160 	},
1161 };
1162 
1163 /*
1164  *	Get the parent device driver (us) structure
1165  *	from a child function device
1166  */
1167 static inline struct sa1111 *sa1111_chip_driver(struct sa1111_dev *sadev)
1168 {
1169 	return (struct sa1111 *)dev_get_drvdata(sadev->dev.parent);
1170 }
1171 
1172 /*
1173  * The bits in the opdiv field are non-linear.
1174  */
1175 static unsigned char opdiv_table[] = { 1, 4, 2, 8 };
1176 
1177 static unsigned int __sa1111_pll_clock(struct sa1111 *sachip)
1178 {
1179 	unsigned int skcdr, fbdiv, ipdiv, opdiv;
1180 
1181 	skcdr = readl_relaxed(sachip->base + SA1111_SKCDR);
1182 
1183 	fbdiv = (skcdr & 0x007f) + 2;
1184 	ipdiv = ((skcdr & 0x0f80) >> 7) + 2;
1185 	opdiv = opdiv_table[(skcdr & 0x3000) >> 12];
1186 
1187 	return 3686400 * fbdiv / (ipdiv * opdiv);
1188 }
1189 
1190 /**
1191  *	sa1111_pll_clock - return the current PLL clock frequency.
1192  *	@sadev: SA1111 function block
1193  *
1194  *	BUG: we should look at SKCR.  We also blindly believe that
1195  *	the chip is being fed with the 3.6864MHz clock.
1196  *
1197  *	Returns the PLL clock in Hz.
1198  */
1199 unsigned int sa1111_pll_clock(struct sa1111_dev *sadev)
1200 {
1201 	struct sa1111 *sachip = sa1111_chip_driver(sadev);
1202 
1203 	return __sa1111_pll_clock(sachip);
1204 }
1205 EXPORT_SYMBOL(sa1111_pll_clock);
1206 
1207 /**
1208  *	sa1111_select_audio_mode - select I2S or AC link mode
1209  *	@sadev: SA1111 function block
1210  *	@mode: One of %SA1111_AUDIO_ACLINK or %SA1111_AUDIO_I2S
1211  *
1212  *	Frob the SKCR to select AC Link mode or I2S mode for
1213  *	the audio block.
1214  */
1215 void sa1111_select_audio_mode(struct sa1111_dev *sadev, int mode)
1216 {
1217 	struct sa1111 *sachip = sa1111_chip_driver(sadev);
1218 	unsigned long flags;
1219 	unsigned int val;
1220 
1221 	spin_lock_irqsave(&sachip->lock, flags);
1222 
1223 	val = readl_relaxed(sachip->base + SA1111_SKCR);
1224 	if (mode == SA1111_AUDIO_I2S) {
1225 		val &= ~SKCR_SELAC;
1226 	} else {
1227 		val |= SKCR_SELAC;
1228 	}
1229 	writel_relaxed(val, sachip->base + SA1111_SKCR);
1230 
1231 	spin_unlock_irqrestore(&sachip->lock, flags);
1232 }
1233 EXPORT_SYMBOL(sa1111_select_audio_mode);
1234 
1235 /**
1236  *	sa1111_set_audio_rate - set the audio sample rate
1237  *	@sadev: SA1111 SAC function block
1238  *	@rate: sample rate to select
1239  */
1240 int sa1111_set_audio_rate(struct sa1111_dev *sadev, int rate)
1241 {
1242 	struct sa1111 *sachip = sa1111_chip_driver(sadev);
1243 	unsigned int div;
1244 
1245 	if (sadev->devid != SA1111_DEVID_SAC)
1246 		return -EINVAL;
1247 
1248 	div = (__sa1111_pll_clock(sachip) / 256 + rate / 2) / rate;
1249 	if (div == 0)
1250 		div = 1;
1251 	if (div > 128)
1252 		div = 128;
1253 
1254 	writel_relaxed(div - 1, sachip->base + SA1111_SKAUD);
1255 
1256 	return 0;
1257 }
1258 EXPORT_SYMBOL(sa1111_set_audio_rate);
1259 
1260 /**
1261  *	sa1111_get_audio_rate - get the audio sample rate
1262  *	@sadev: SA1111 SAC function block device
1263  */
1264 int sa1111_get_audio_rate(struct sa1111_dev *sadev)
1265 {
1266 	struct sa1111 *sachip = sa1111_chip_driver(sadev);
1267 	unsigned long div;
1268 
1269 	if (sadev->devid != SA1111_DEVID_SAC)
1270 		return -EINVAL;
1271 
1272 	div = readl_relaxed(sachip->base + SA1111_SKAUD) + 1;
1273 
1274 	return __sa1111_pll_clock(sachip) / (256 * div);
1275 }
1276 EXPORT_SYMBOL(sa1111_get_audio_rate);
1277 
1278 /*
1279  * Individual device operations.
1280  */
1281 
1282 /**
1283  *	sa1111_enable_device - enable an on-chip SA1111 function block
1284  *	@sadev: SA1111 function block device to enable
1285  */
1286 int sa1111_enable_device(struct sa1111_dev *sadev)
1287 {
1288 	struct sa1111 *sachip = sa1111_chip_driver(sadev);
1289 	unsigned long flags;
1290 	unsigned int val;
1291 	int ret = 0;
1292 
1293 	if (sachip->pdata && sachip->pdata->enable)
1294 		ret = sachip->pdata->enable(sachip->pdata->data, sadev->devid);
1295 
1296 	if (ret == 0) {
1297 		spin_lock_irqsave(&sachip->lock, flags);
1298 		val = readl_relaxed(sachip->base + SA1111_SKPCR);
1299 		writel_relaxed(val | sadev->skpcr_mask, sachip->base + SA1111_SKPCR);
1300 		spin_unlock_irqrestore(&sachip->lock, flags);
1301 	}
1302 	return ret;
1303 }
1304 EXPORT_SYMBOL(sa1111_enable_device);
1305 
1306 /**
1307  *	sa1111_disable_device - disable an on-chip SA1111 function block
1308  *	@sadev: SA1111 function block device to disable
1309  */
1310 void sa1111_disable_device(struct sa1111_dev *sadev)
1311 {
1312 	struct sa1111 *sachip = sa1111_chip_driver(sadev);
1313 	unsigned long flags;
1314 	unsigned int val;
1315 
1316 	spin_lock_irqsave(&sachip->lock, flags);
1317 	val = readl_relaxed(sachip->base + SA1111_SKPCR);
1318 	writel_relaxed(val & ~sadev->skpcr_mask, sachip->base + SA1111_SKPCR);
1319 	spin_unlock_irqrestore(&sachip->lock, flags);
1320 
1321 	if (sachip->pdata && sachip->pdata->disable)
1322 		sachip->pdata->disable(sachip->pdata->data, sadev->devid);
1323 }
1324 EXPORT_SYMBOL(sa1111_disable_device);
1325 
1326 int sa1111_get_irq(struct sa1111_dev *sadev, unsigned num)
1327 {
1328 	struct sa1111 *sachip = sa1111_chip_driver(sadev);
1329 	if (num >= ARRAY_SIZE(sadev->hwirq))
1330 		return -EINVAL;
1331 	return sa1111_map_irq(sachip, sadev->hwirq[num]);
1332 }
1333 EXPORT_SYMBOL_GPL(sa1111_get_irq);
1334 
1335 /*
1336  *	SA1111 "Register Access Bus."
1337  *
1338  *	We model this as a regular bus type, and hang devices directly
1339  *	off this.
1340  */
1341 static int sa1111_match(struct device *_dev, struct device_driver *_drv)
1342 {
1343 	struct sa1111_dev *dev = to_sa1111_device(_dev);
1344 	struct sa1111_driver *drv = SA1111_DRV(_drv);
1345 
1346 	return !!(dev->devid & drv->devid);
1347 }
1348 
1349 static int sa1111_bus_probe(struct device *dev)
1350 {
1351 	struct sa1111_dev *sadev = to_sa1111_device(dev);
1352 	struct sa1111_driver *drv = SA1111_DRV(dev->driver);
1353 	int ret = -ENODEV;
1354 
1355 	if (drv->probe)
1356 		ret = drv->probe(sadev);
1357 	return ret;
1358 }
1359 
1360 static void sa1111_bus_remove(struct device *dev)
1361 {
1362 	struct sa1111_dev *sadev = to_sa1111_device(dev);
1363 	struct sa1111_driver *drv = SA1111_DRV(dev->driver);
1364 
1365 	if (drv->remove)
1366 		drv->remove(sadev);
1367 }
1368 
1369 struct bus_type sa1111_bus_type = {
1370 	.name		= "sa1111-rab",
1371 	.match		= sa1111_match,
1372 	.probe		= sa1111_bus_probe,
1373 	.remove		= sa1111_bus_remove,
1374 };
1375 EXPORT_SYMBOL(sa1111_bus_type);
1376 
1377 int sa1111_driver_register(struct sa1111_driver *driver)
1378 {
1379 	driver->drv.bus = &sa1111_bus_type;
1380 	return driver_register(&driver->drv);
1381 }
1382 EXPORT_SYMBOL(sa1111_driver_register);
1383 
1384 void sa1111_driver_unregister(struct sa1111_driver *driver)
1385 {
1386 	driver_unregister(&driver->drv);
1387 }
1388 EXPORT_SYMBOL(sa1111_driver_unregister);
1389 
1390 static int __init sa1111_init(void)
1391 {
1392 	int ret = bus_register(&sa1111_bus_type);
1393 	if (ret == 0)
1394 		platform_driver_register(&sa1111_device_driver);
1395 	return ret;
1396 }
1397 
1398 static void __exit sa1111_exit(void)
1399 {
1400 	platform_driver_unregister(&sa1111_device_driver);
1401 	bus_unregister(&sa1111_bus_type);
1402 }
1403 
1404 subsys_initcall(sa1111_init);
1405 module_exit(sa1111_exit);
1406 
1407 MODULE_DESCRIPTION("Intel Corporation SA1111 core driver");
1408 MODULE_LICENSE("GPL");
1409