1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/module.h>
20#include <linux/kernel.h>
21#include <linux/sched.h>
22#include <linux/slab.h>
23#include <linux/errno.h>
24#include <linux/interrupt.h>
25#include <linux/ioport.h>
26#include <linux/init.h>
27#include <linux/mutex.h>
28#include <linux/clk.h>
29#include <linux/err.h>
30#include <linux/platform_device.h>
31#include <linux/io.h>
32
33#include <asm/irq.h>
34#include <mach/hardware.h>
35#include <mach/ssp.h>
36#include <mach/regs-ssp.h>
37
38#define TIMEOUT 100000
39
40static irqreturn_t ssp_interrupt(int irq, void *dev_id)
41{
42 struct ssp_dev *dev = dev_id;
43 struct ssp_device *ssp = dev->ssp;
44 unsigned int status;
45
46 status = __raw_readl(ssp->mmio_base + SSSR);
47 __raw_writel(status, ssp->mmio_base + SSSR);
48
49 if (status & SSSR_ROR)
50 printk(KERN_WARNING "SSP(%d): receiver overrun\n", dev->port);
51
52 if (status & SSSR_TUR)
53 printk(KERN_WARNING "SSP(%d): transmitter underrun\n", dev->port);
54
55 if (status & SSSR_BCE)
56 printk(KERN_WARNING "SSP(%d): bit count error\n", dev->port);
57
58 return IRQ_HANDLED;
59}
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74int ssp_write_word(struct ssp_dev *dev, u32 data)
75{
76 struct ssp_device *ssp = dev->ssp;
77 int timeout = TIMEOUT;
78
79 while (!(__raw_readl(ssp->mmio_base + SSSR) & SSSR_TNF)) {
80 if (!--timeout)
81 return -ETIMEDOUT;
82 cpu_relax();
83 }
84
85 __raw_writel(data, ssp->mmio_base + SSDR);
86
87 return 0;
88}
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105int ssp_read_word(struct ssp_dev *dev, u32 *data)
106{
107 struct ssp_device *ssp = dev->ssp;
108 int timeout = TIMEOUT;
109
110 while (!(__raw_readl(ssp->mmio_base + SSSR) & SSSR_RNE)) {
111 if (!--timeout)
112 return -ETIMEDOUT;
113 cpu_relax();
114 }
115
116 *data = __raw_readl(ssp->mmio_base + SSDR);
117 return 0;
118}
119
120
121
122
123
124
125
126
127
128int ssp_flush(struct ssp_dev *dev)
129{
130 struct ssp_device *ssp = dev->ssp;
131 int timeout = TIMEOUT * 2;
132
133
134 if (cpu_is_pxa3xx()) {
135 while (__raw_readl(ssp->mmio_base + SSSR) & 0xf00) {
136 if (!--timeout)
137 return -ETIMEDOUT;
138 cpu_relax();
139 }
140 timeout = TIMEOUT * 2;
141 }
142
143 do {
144 while (__raw_readl(ssp->mmio_base + SSSR) & SSSR_RNE) {
145 if (!--timeout)
146 return -ETIMEDOUT;
147 (void)__raw_readl(ssp->mmio_base + SSDR);
148 }
149 if (!--timeout)
150 return -ETIMEDOUT;
151 } while (__raw_readl(ssp->mmio_base + SSSR) & SSSR_BSY);
152
153 return 0;
154}
155
156
157
158
159
160
161void ssp_enable(struct ssp_dev *dev)
162{
163 struct ssp_device *ssp = dev->ssp;
164 uint32_t sscr0;
165
166 sscr0 = __raw_readl(ssp->mmio_base + SSCR0);
167 sscr0 |= SSCR0_SSE;
168 __raw_writel(sscr0, ssp->mmio_base + SSCR0);
169}
170
171
172
173
174
175
176void ssp_disable(struct ssp_dev *dev)
177{
178 struct ssp_device *ssp = dev->ssp;
179 uint32_t sscr0;
180
181 sscr0 = __raw_readl(ssp->mmio_base + SSCR0);
182 sscr0 &= ~SSCR0_SSE;
183 __raw_writel(sscr0, ssp->mmio_base + SSCR0);
184}
185
186
187
188
189
190
191
192void ssp_save_state(struct ssp_dev *dev, struct ssp_state *state)
193{
194 struct ssp_device *ssp = dev->ssp;
195
196 state->cr0 = __raw_readl(ssp->mmio_base + SSCR0);
197 state->cr1 = __raw_readl(ssp->mmio_base + SSCR1);
198 state->to = __raw_readl(ssp->mmio_base + SSTO);
199 state->psp = __raw_readl(ssp->mmio_base + SSPSP);
200
201 ssp_disable(dev);
202}
203
204
205
206
207
208
209
210void ssp_restore_state(struct ssp_dev *dev, struct ssp_state *state)
211{
212 struct ssp_device *ssp = dev->ssp;
213 uint32_t sssr = SSSR_ROR | SSSR_TUR | SSSR_BCE;
214
215 __raw_writel(sssr, ssp->mmio_base + SSSR);
216
217 __raw_writel(state->cr0 & ~SSCR0_SSE, ssp->mmio_base + SSCR0);
218 __raw_writel(state->cr1, ssp->mmio_base + SSCR1);
219 __raw_writel(state->to, ssp->mmio_base + SSTO);
220 __raw_writel(state->psp, ssp->mmio_base + SSPSP);
221 __raw_writel(state->cr0, ssp->mmio_base + SSCR0);
222}
223
224
225
226
227
228
229
230
231
232
233int ssp_config(struct ssp_dev *dev, u32 mode, u32 flags, u32 psp_flags, u32 speed)
234{
235 struct ssp_device *ssp = dev->ssp;
236
237 dev->mode = mode;
238 dev->flags = flags;
239 dev->psp_flags = psp_flags;
240 dev->speed = speed;
241
242
243 __raw_writel((dev->speed | dev->mode), ssp->mmio_base + SSCR0);
244 __raw_writel(dev->flags, ssp->mmio_base + SSCR1);
245 __raw_writel(dev->psp_flags, ssp->mmio_base + SSPSP);
246
247 return 0;
248}
249
250
251
252
253
254
255
256
257
258
259
260int ssp_init(struct ssp_dev *dev, u32 port, u32 init_flags)
261{
262 struct ssp_device *ssp;
263 int ret;
264
265 ssp = ssp_request(port, "SSP");
266 if (ssp == NULL)
267 return -ENODEV;
268
269 dev->ssp = ssp;
270 dev->port = port;
271
272
273 if (!(init_flags & SSP_NO_IRQ)) {
274 ret = request_irq(ssp->irq, ssp_interrupt,
275 0, "SSP", dev);
276 if (ret)
277 goto out_region;
278 dev->irq = ssp->irq;
279 } else
280 dev->irq = NO_IRQ;
281
282
283 clk_enable(ssp->clk);
284 return 0;
285
286out_region:
287 ssp_free(ssp);
288 return ret;
289}
290
291
292
293
294
295
296void ssp_exit(struct ssp_dev *dev)
297{
298 struct ssp_device *ssp = dev->ssp;
299
300 ssp_disable(dev);
301 if (dev->irq != NO_IRQ)
302 free_irq(dev->irq, dev);
303 clk_disable(ssp->clk);
304 ssp_free(ssp);
305}
306
307static DEFINE_MUTEX(ssp_lock);
308static LIST_HEAD(ssp_list);
309
310struct ssp_device *ssp_request(int port, const char *label)
311{
312 struct ssp_device *ssp = NULL;
313
314 mutex_lock(&ssp_lock);
315
316 list_for_each_entry(ssp, &ssp_list, node) {
317 if (ssp->port_id == port && ssp->use_count == 0) {
318 ssp->use_count++;
319 ssp->label = label;
320 break;
321 }
322 }
323
324 mutex_unlock(&ssp_lock);
325
326 if (&ssp->node == &ssp_list)
327 return NULL;
328
329 return ssp;
330}
331EXPORT_SYMBOL(ssp_request);
332
333void ssp_free(struct ssp_device *ssp)
334{
335 mutex_lock(&ssp_lock);
336 if (ssp->use_count) {
337 ssp->use_count--;
338 ssp->label = NULL;
339 } else
340 dev_err(&ssp->pdev->dev, "device already free\n");
341 mutex_unlock(&ssp_lock);
342}
343EXPORT_SYMBOL(ssp_free);
344
345static int __devinit ssp_probe(struct platform_device *pdev, int type)
346{
347 struct resource *res;
348 struct ssp_device *ssp;
349 int ret = 0;
350
351 ssp = kzalloc(sizeof(struct ssp_device), GFP_KERNEL);
352 if (ssp == NULL) {
353 dev_err(&pdev->dev, "failed to allocate memory");
354 return -ENOMEM;
355 }
356 ssp->pdev = pdev;
357
358 ssp->clk = clk_get(&pdev->dev, NULL);
359 if (IS_ERR(ssp->clk)) {
360 ret = PTR_ERR(ssp->clk);
361 goto err_free;
362 }
363
364 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
365 if (res == NULL) {
366 dev_err(&pdev->dev, "no memory resource defined\n");
367 ret = -ENODEV;
368 goto err_free_clk;
369 }
370
371 res = request_mem_region(res->start, res->end - res->start + 1,
372 pdev->name);
373 if (res == NULL) {
374 dev_err(&pdev->dev, "failed to request memory resource\n");
375 ret = -EBUSY;
376 goto err_free_clk;
377 }
378
379 ssp->phys_base = res->start;
380
381 ssp->mmio_base = ioremap(res->start, res->end - res->start + 1);
382 if (ssp->mmio_base == NULL) {
383 dev_err(&pdev->dev, "failed to ioremap() registers\n");
384 ret = -ENODEV;
385 goto err_free_mem;
386 }
387
388 ssp->irq = platform_get_irq(pdev, 0);
389 if (ssp->irq < 0) {
390 dev_err(&pdev->dev, "no IRQ resource defined\n");
391 ret = -ENODEV;
392 goto err_free_io;
393 }
394
395 res = platform_get_resource(pdev, IORESOURCE_DMA, 0);
396 if (res == NULL) {
397 dev_err(&pdev->dev, "no SSP RX DRCMR defined\n");
398 ret = -ENODEV;
399 goto err_free_io;
400 }
401 ssp->drcmr_rx = res->start;
402
403 res = platform_get_resource(pdev, IORESOURCE_DMA, 1);
404 if (res == NULL) {
405 dev_err(&pdev->dev, "no SSP TX DRCMR defined\n");
406 ret = -ENODEV;
407 goto err_free_io;
408 }
409 ssp->drcmr_tx = res->start;
410
411
412
413
414 ssp->port_id = pdev->id + 1;
415 ssp->use_count = 0;
416 ssp->type = type;
417
418 mutex_lock(&ssp_lock);
419 list_add(&ssp->node, &ssp_list);
420 mutex_unlock(&ssp_lock);
421
422 platform_set_drvdata(pdev, ssp);
423 return 0;
424
425err_free_io:
426 iounmap(ssp->mmio_base);
427err_free_mem:
428 release_mem_region(res->start, res->end - res->start + 1);
429err_free_clk:
430 clk_put(ssp->clk);
431err_free:
432 kfree(ssp);
433 return ret;
434}
435
436static int __devexit ssp_remove(struct platform_device *pdev)
437{
438 struct resource *res;
439 struct ssp_device *ssp;
440
441 ssp = platform_get_drvdata(pdev);
442 if (ssp == NULL)
443 return -ENODEV;
444
445 iounmap(ssp->mmio_base);
446
447 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
448 release_mem_region(res->start, res->end - res->start + 1);
449
450 clk_put(ssp->clk);
451
452 mutex_lock(&ssp_lock);
453 list_del(&ssp->node);
454 mutex_unlock(&ssp_lock);
455
456 kfree(ssp);
457 return 0;
458}
459
460static int __devinit pxa25x_ssp_probe(struct platform_device *pdev)
461{
462 return ssp_probe(pdev, PXA25x_SSP);
463}
464
465static int __devinit pxa25x_nssp_probe(struct platform_device *pdev)
466{
467 return ssp_probe(pdev, PXA25x_NSSP);
468}
469
470static int __devinit pxa27x_ssp_probe(struct platform_device *pdev)
471{
472 return ssp_probe(pdev, PXA27x_SSP);
473}
474
475static struct platform_driver pxa25x_ssp_driver = {
476 .driver = {
477 .name = "pxa25x-ssp",
478 },
479 .probe = pxa25x_ssp_probe,
480 .remove = __devexit_p(ssp_remove),
481};
482
483static struct platform_driver pxa25x_nssp_driver = {
484 .driver = {
485 .name = "pxa25x-nssp",
486 },
487 .probe = pxa25x_nssp_probe,
488 .remove = __devexit_p(ssp_remove),
489};
490
491static struct platform_driver pxa27x_ssp_driver = {
492 .driver = {
493 .name = "pxa27x-ssp",
494 },
495 .probe = pxa27x_ssp_probe,
496 .remove = __devexit_p(ssp_remove),
497};
498
499static int __init pxa_ssp_init(void)
500{
501 int ret = 0;
502
503 ret = platform_driver_register(&pxa25x_ssp_driver);
504 if (ret) {
505 printk(KERN_ERR "failed to register pxa25x_ssp_driver");
506 return ret;
507 }
508
509 ret = platform_driver_register(&pxa25x_nssp_driver);
510 if (ret) {
511 printk(KERN_ERR "failed to register pxa25x_nssp_driver");
512 return ret;
513 }
514
515 ret = platform_driver_register(&pxa27x_ssp_driver);
516 if (ret) {
517 printk(KERN_ERR "failed to register pxa27x_ssp_driver");
518 return ret;
519 }
520
521 return ret;
522}
523
524static void __exit pxa_ssp_exit(void)
525{
526 platform_driver_unregister(&pxa25x_ssp_driver);
527 platform_driver_unregister(&pxa25x_nssp_driver);
528 platform_driver_unregister(&pxa27x_ssp_driver);
529}
530
531arch_initcall(pxa_ssp_init);
532module_exit(pxa_ssp_exit);
533
534EXPORT_SYMBOL(ssp_write_word);
535EXPORT_SYMBOL(ssp_read_word);
536EXPORT_SYMBOL(ssp_flush);
537EXPORT_SYMBOL(ssp_enable);
538EXPORT_SYMBOL(ssp_disable);
539EXPORT_SYMBOL(ssp_save_state);
540EXPORT_SYMBOL(ssp_restore_state);
541EXPORT_SYMBOL(ssp_init);
542EXPORT_SYMBOL(ssp_exit);
543EXPORT_SYMBOL(ssp_config);
544
545MODULE_DESCRIPTION("PXA SSP driver");
546MODULE_AUTHOR("Liam Girdwood");
547MODULE_LICENSE("GPL");
548
549