1 /*
2 * linux/arch/arm/plat-omap/mcbsp.c
3 *
4 * Copyright (C) 2004 Nokia Corporation
5 * Author: Samuel Ortiz <samuel.ortiz@nokia.com>
6 *
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
11 *
12 * Multichannel mode not supported.
13 */
14
15 #include <linux/module.h>
16 #include <linux/init.h>
17 #include <linux/device.h>
18 #include <linux/platform_device.h>
19 #include <linux/wait.h>
20 #include <linux/completion.h>
21 #include <linux/interrupt.h>
22 #include <linux/err.h>
23 #include <linux/clk.h>
24 #include <linux/delay.h>
25 #include <linux/io.h>
26 #include <linux/slab.h>
27
28 #include <plat/dma.h>
29 #include <plat/mcbsp.h>
30 #include <plat/omap_device.h>
31 #include <linux/pm_runtime.h>
32
33 /* XXX These "sideways" includes are a sign that something is wrong */
34 #include "../mach-omap2/cm2xxx_3xxx.h"
35 #include "../mach-omap2/cm-regbits-34xx.h"
36
37 struct omap_mcbsp **mcbsp_ptr;
38 int omap_mcbsp_count, omap_mcbsp_cache_size;
39
omap_mcbsp_write(struct omap_mcbsp * mcbsp,u16 reg,u32 val)40 static void omap_mcbsp_write(struct omap_mcbsp *mcbsp, u16 reg, u32 val)
41 {
42 if (cpu_class_is_omap1()) {
43 ((u16 *)mcbsp->reg_cache)[reg / sizeof(u16)] = (u16)val;
44 __raw_writew((u16)val, mcbsp->io_base + reg);
45 } else if (cpu_is_omap2420()) {
46 ((u16 *)mcbsp->reg_cache)[reg / sizeof(u32)] = (u16)val;
47 __raw_writew((u16)val, mcbsp->io_base + reg);
48 } else {
49 ((u32 *)mcbsp->reg_cache)[reg / sizeof(u32)] = val;
50 __raw_writel(val, mcbsp->io_base + reg);
51 }
52 }
53
omap_mcbsp_read(struct omap_mcbsp * mcbsp,u16 reg,bool from_cache)54 static int omap_mcbsp_read(struct omap_mcbsp *mcbsp, u16 reg, bool from_cache)
55 {
56 if (cpu_class_is_omap1()) {
57 return !from_cache ? __raw_readw(mcbsp->io_base + reg) :
58 ((u16 *)mcbsp->reg_cache)[reg / sizeof(u16)];
59 } else if (cpu_is_omap2420()) {
60 return !from_cache ? __raw_readw(mcbsp->io_base + reg) :
61 ((u16 *)mcbsp->reg_cache)[reg / sizeof(u32)];
62 } else {
63 return !from_cache ? __raw_readl(mcbsp->io_base + reg) :
64 ((u32 *)mcbsp->reg_cache)[reg / sizeof(u32)];
65 }
66 }
67
68 #ifdef CONFIG_ARCH_OMAP3
omap_mcbsp_st_write(struct omap_mcbsp * mcbsp,u16 reg,u32 val)69 static void omap_mcbsp_st_write(struct omap_mcbsp *mcbsp, u16 reg, u32 val)
70 {
71 __raw_writel(val, mcbsp->st_data->io_base_st + reg);
72 }
73
omap_mcbsp_st_read(struct omap_mcbsp * mcbsp,u16 reg)74 static int omap_mcbsp_st_read(struct omap_mcbsp *mcbsp, u16 reg)
75 {
76 return __raw_readl(mcbsp->st_data->io_base_st + reg);
77 }
78 #endif
79
80 #define MCBSP_READ(mcbsp, reg) \
81 omap_mcbsp_read(mcbsp, OMAP_MCBSP_REG_##reg, 0)
82 #define MCBSP_WRITE(mcbsp, reg, val) \
83 omap_mcbsp_write(mcbsp, OMAP_MCBSP_REG_##reg, val)
84 #define MCBSP_READ_CACHE(mcbsp, reg) \
85 omap_mcbsp_read(mcbsp, OMAP_MCBSP_REG_##reg, 1)
86
87 #define MCBSP_ST_READ(mcbsp, reg) \
88 omap_mcbsp_st_read(mcbsp, OMAP_ST_REG_##reg)
89 #define MCBSP_ST_WRITE(mcbsp, reg, val) \
90 omap_mcbsp_st_write(mcbsp, OMAP_ST_REG_##reg, val)
91
omap_mcbsp_dump_reg(u8 id)92 static void omap_mcbsp_dump_reg(u8 id)
93 {
94 struct omap_mcbsp *mcbsp = id_to_mcbsp_ptr(id);
95
96 dev_dbg(mcbsp->dev, "**** McBSP%d regs ****\n", mcbsp->id);
97 dev_dbg(mcbsp->dev, "DRR2: 0x%04x\n",
98 MCBSP_READ(mcbsp, DRR2));
99 dev_dbg(mcbsp->dev, "DRR1: 0x%04x\n",
100 MCBSP_READ(mcbsp, DRR1));
101 dev_dbg(mcbsp->dev, "DXR2: 0x%04x\n",
102 MCBSP_READ(mcbsp, DXR2));
103 dev_dbg(mcbsp->dev, "DXR1: 0x%04x\n",
104 MCBSP_READ(mcbsp, DXR1));
105 dev_dbg(mcbsp->dev, "SPCR2: 0x%04x\n",
106 MCBSP_READ(mcbsp, SPCR2));
107 dev_dbg(mcbsp->dev, "SPCR1: 0x%04x\n",
108 MCBSP_READ(mcbsp, SPCR1));
109 dev_dbg(mcbsp->dev, "RCR2: 0x%04x\n",
110 MCBSP_READ(mcbsp, RCR2));
111 dev_dbg(mcbsp->dev, "RCR1: 0x%04x\n",
112 MCBSP_READ(mcbsp, RCR1));
113 dev_dbg(mcbsp->dev, "XCR2: 0x%04x\n",
114 MCBSP_READ(mcbsp, XCR2));
115 dev_dbg(mcbsp->dev, "XCR1: 0x%04x\n",
116 MCBSP_READ(mcbsp, XCR1));
117 dev_dbg(mcbsp->dev, "SRGR2: 0x%04x\n",
118 MCBSP_READ(mcbsp, SRGR2));
119 dev_dbg(mcbsp->dev, "SRGR1: 0x%04x\n",
120 MCBSP_READ(mcbsp, SRGR1));
121 dev_dbg(mcbsp->dev, "PCR0: 0x%04x\n",
122 MCBSP_READ(mcbsp, PCR0));
123 dev_dbg(mcbsp->dev, "***********************\n");
124 }
125
omap_mcbsp_tx_irq_handler(int irq,void * dev_id)126 static irqreturn_t omap_mcbsp_tx_irq_handler(int irq, void *dev_id)
127 {
128 struct omap_mcbsp *mcbsp_tx = dev_id;
129 u16 irqst_spcr2;
130
131 irqst_spcr2 = MCBSP_READ(mcbsp_tx, SPCR2);
132 dev_dbg(mcbsp_tx->dev, "TX IRQ callback : 0x%x\n", irqst_spcr2);
133
134 if (irqst_spcr2 & XSYNC_ERR) {
135 dev_err(mcbsp_tx->dev, "TX Frame Sync Error! : 0x%x\n",
136 irqst_spcr2);
137 /* Writing zero to XSYNC_ERR clears the IRQ */
138 MCBSP_WRITE(mcbsp_tx, SPCR2, MCBSP_READ_CACHE(mcbsp_tx, SPCR2));
139 } else {
140 complete(&mcbsp_tx->tx_irq_completion);
141 }
142
143 return IRQ_HANDLED;
144 }
145
omap_mcbsp_rx_irq_handler(int irq,void * dev_id)146 static irqreturn_t omap_mcbsp_rx_irq_handler(int irq, void *dev_id)
147 {
148 struct omap_mcbsp *mcbsp_rx = dev_id;
149 u16 irqst_spcr1;
150
151 irqst_spcr1 = MCBSP_READ(mcbsp_rx, SPCR1);
152 dev_dbg(mcbsp_rx->dev, "RX IRQ callback : 0x%x\n", irqst_spcr1);
153
154 if (irqst_spcr1 & RSYNC_ERR) {
155 dev_err(mcbsp_rx->dev, "RX Frame Sync Error! : 0x%x\n",
156 irqst_spcr1);
157 /* Writing zero to RSYNC_ERR clears the IRQ */
158 MCBSP_WRITE(mcbsp_rx, SPCR1, MCBSP_READ_CACHE(mcbsp_rx, SPCR1));
159 } else {
160 complete(&mcbsp_rx->rx_irq_completion);
161 }
162
163 return IRQ_HANDLED;
164 }
165
omap_mcbsp_tx_dma_callback(int lch,u16 ch_status,void * data)166 static void omap_mcbsp_tx_dma_callback(int lch, u16 ch_status, void *data)
167 {
168 struct omap_mcbsp *mcbsp_dma_tx = data;
169
170 dev_dbg(mcbsp_dma_tx->dev, "TX DMA callback : 0x%x\n",
171 MCBSP_READ(mcbsp_dma_tx, SPCR2));
172
173 /* We can free the channels */
174 omap_free_dma(mcbsp_dma_tx->dma_tx_lch);
175 mcbsp_dma_tx->dma_tx_lch = -1;
176
177 complete(&mcbsp_dma_tx->tx_dma_completion);
178 }
179
omap_mcbsp_rx_dma_callback(int lch,u16 ch_status,void * data)180 static void omap_mcbsp_rx_dma_callback(int lch, u16 ch_status, void *data)
181 {
182 struct omap_mcbsp *mcbsp_dma_rx = data;
183
184 dev_dbg(mcbsp_dma_rx->dev, "RX DMA callback : 0x%x\n",
185 MCBSP_READ(mcbsp_dma_rx, SPCR2));
186
187 /* We can free the channels */
188 omap_free_dma(mcbsp_dma_rx->dma_rx_lch);
189 mcbsp_dma_rx->dma_rx_lch = -1;
190
191 complete(&mcbsp_dma_rx->rx_dma_completion);
192 }
193
194 /*
195 * omap_mcbsp_config simply write a config to the
196 * appropriate McBSP.
197 * You either call this function or set the McBSP registers
198 * by yourself before calling omap_mcbsp_start().
199 */
omap_mcbsp_config(unsigned int id,const struct omap_mcbsp_reg_cfg * config)200 void omap_mcbsp_config(unsigned int id, const struct omap_mcbsp_reg_cfg *config)
201 {
202 struct omap_mcbsp *mcbsp;
203
204 if (!omap_mcbsp_check_valid_id(id)) {
205 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
206 return;
207 }
208 mcbsp = id_to_mcbsp_ptr(id);
209
210 dev_dbg(mcbsp->dev, "Configuring McBSP%d phys_base: 0x%08lx\n",
211 mcbsp->id, mcbsp->phys_base);
212
213 /* We write the given config */
214 MCBSP_WRITE(mcbsp, SPCR2, config->spcr2);
215 MCBSP_WRITE(mcbsp, SPCR1, config->spcr1);
216 MCBSP_WRITE(mcbsp, RCR2, config->rcr2);
217 MCBSP_WRITE(mcbsp, RCR1, config->rcr1);
218 MCBSP_WRITE(mcbsp, XCR2, config->xcr2);
219 MCBSP_WRITE(mcbsp, XCR1, config->xcr1);
220 MCBSP_WRITE(mcbsp, SRGR2, config->srgr2);
221 MCBSP_WRITE(mcbsp, SRGR1, config->srgr1);
222 MCBSP_WRITE(mcbsp, MCR2, config->mcr2);
223 MCBSP_WRITE(mcbsp, MCR1, config->mcr1);
224 MCBSP_WRITE(mcbsp, PCR0, config->pcr0);
225 if (cpu_is_omap2430() || cpu_is_omap34xx() || cpu_is_omap44xx()) {
226 MCBSP_WRITE(mcbsp, XCCR, config->xccr);
227 MCBSP_WRITE(mcbsp, RCCR, config->rccr);
228 }
229 }
230 EXPORT_SYMBOL(omap_mcbsp_config);
231
232 /**
233 * omap_mcbsp_dma_params - returns the dma channel number
234 * @id - mcbsp id
235 * @stream - indicates the direction of data flow (rx or tx)
236 *
237 * Returns the dma channel number for the rx channel or tx channel
238 * based on the value of @stream for the requested mcbsp given by @id
239 */
omap_mcbsp_dma_ch_params(unsigned int id,unsigned int stream)240 int omap_mcbsp_dma_ch_params(unsigned int id, unsigned int stream)
241 {
242 struct omap_mcbsp *mcbsp;
243
244 if (!omap_mcbsp_check_valid_id(id)) {
245 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
246 return -ENODEV;
247 }
248 mcbsp = id_to_mcbsp_ptr(id);
249
250 if (stream)
251 return mcbsp->dma_rx_sync;
252 else
253 return mcbsp->dma_tx_sync;
254 }
255 EXPORT_SYMBOL(omap_mcbsp_dma_ch_params);
256
257 /**
258 * omap_mcbsp_dma_reg_params - returns the address of mcbsp data register
259 * @id - mcbsp id
260 * @stream - indicates the direction of data flow (rx or tx)
261 *
262 * Returns the address of mcbsp data transmit register or data receive register
263 * to be used by DMA for transferring/receiving data based on the value of
264 * @stream for the requested mcbsp given by @id
265 */
omap_mcbsp_dma_reg_params(unsigned int id,unsigned int stream)266 int omap_mcbsp_dma_reg_params(unsigned int id, unsigned int stream)
267 {
268 struct omap_mcbsp *mcbsp;
269 int data_reg;
270
271 if (!omap_mcbsp_check_valid_id(id)) {
272 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
273 return -ENODEV;
274 }
275 mcbsp = id_to_mcbsp_ptr(id);
276
277 data_reg = mcbsp->phys_dma_base;
278
279 if (mcbsp->mcbsp_config_type < MCBSP_CONFIG_TYPE2) {
280 if (stream)
281 data_reg += OMAP_MCBSP_REG_DRR1;
282 else
283 data_reg += OMAP_MCBSP_REG_DXR1;
284 } else {
285 if (stream)
286 data_reg += OMAP_MCBSP_REG_DRR;
287 else
288 data_reg += OMAP_MCBSP_REG_DXR;
289 }
290
291 return data_reg;
292 }
293 EXPORT_SYMBOL(omap_mcbsp_dma_reg_params);
294
295 #ifdef CONFIG_ARCH_OMAP3
find_omap_device_by_dev(struct device * dev)296 static struct omap_device *find_omap_device_by_dev(struct device *dev)
297 {
298 struct platform_device *pdev = container_of(dev,
299 struct platform_device, dev);
300 return container_of(pdev, struct omap_device, pdev);
301 }
302
omap_st_on(struct omap_mcbsp * mcbsp)303 static void omap_st_on(struct omap_mcbsp *mcbsp)
304 {
305 unsigned int w;
306 struct omap_device *od;
307
308 od = find_omap_device_by_dev(mcbsp->dev);
309
310 /*
311 * Sidetone uses McBSP ICLK - which must not idle when sidetones
312 * are enabled or sidetones start sounding ugly.
313 */
314 w = omap2_cm_read_mod_reg(OMAP3430_PER_MOD, CM_AUTOIDLE);
315 w &= ~(1 << (mcbsp->id - 2));
316 omap2_cm_write_mod_reg(w, OMAP3430_PER_MOD, CM_AUTOIDLE);
317
318 /* Enable McBSP Sidetone */
319 w = MCBSP_READ(mcbsp, SSELCR);
320 MCBSP_WRITE(mcbsp, SSELCR, w | SIDETONEEN);
321
322 /* Enable Sidetone from Sidetone Core */
323 w = MCBSP_ST_READ(mcbsp, SSELCR);
324 MCBSP_ST_WRITE(mcbsp, SSELCR, w | ST_SIDETONEEN);
325 }
326
omap_st_off(struct omap_mcbsp * mcbsp)327 static void omap_st_off(struct omap_mcbsp *mcbsp)
328 {
329 unsigned int w;
330 struct omap_device *od;
331
332 od = find_omap_device_by_dev(mcbsp->dev);
333
334 w = MCBSP_ST_READ(mcbsp, SSELCR);
335 MCBSP_ST_WRITE(mcbsp, SSELCR, w & ~(ST_SIDETONEEN));
336
337 w = MCBSP_READ(mcbsp, SSELCR);
338 MCBSP_WRITE(mcbsp, SSELCR, w & ~(SIDETONEEN));
339
340 w = omap2_cm_read_mod_reg(OMAP3430_PER_MOD, CM_AUTOIDLE);
341 w |= 1 << (mcbsp->id - 2);
342 omap2_cm_write_mod_reg(w, OMAP3430_PER_MOD, CM_AUTOIDLE);
343 }
344
omap_st_fir_write(struct omap_mcbsp * mcbsp,s16 * fir)345 static void omap_st_fir_write(struct omap_mcbsp *mcbsp, s16 *fir)
346 {
347 u16 val, i;
348 struct omap_device *od;
349
350 od = find_omap_device_by_dev(mcbsp->dev);
351
352 val = MCBSP_ST_READ(mcbsp, SSELCR);
353
354 if (val & ST_COEFFWREN)
355 MCBSP_ST_WRITE(mcbsp, SSELCR, val & ~(ST_COEFFWREN));
356
357 MCBSP_ST_WRITE(mcbsp, SSELCR, val | ST_COEFFWREN);
358
359 for (i = 0; i < 128; i++)
360 MCBSP_ST_WRITE(mcbsp, SFIRCR, fir[i]);
361
362 i = 0;
363
364 val = MCBSP_ST_READ(mcbsp, SSELCR);
365 while (!(val & ST_COEFFWRDONE) && (++i < 1000))
366 val = MCBSP_ST_READ(mcbsp, SSELCR);
367
368 MCBSP_ST_WRITE(mcbsp, SSELCR, val & ~(ST_COEFFWREN));
369
370 if (i == 1000)
371 dev_err(mcbsp->dev, "McBSP FIR load error!\n");
372 }
373
omap_st_chgain(struct omap_mcbsp * mcbsp)374 static void omap_st_chgain(struct omap_mcbsp *mcbsp)
375 {
376 u16 w;
377 struct omap_mcbsp_st_data *st_data = mcbsp->st_data;
378 struct omap_device *od;
379
380 od = find_omap_device_by_dev(mcbsp->dev);
381
382 w = MCBSP_ST_READ(mcbsp, SSELCR);
383
384 MCBSP_ST_WRITE(mcbsp, SGAINCR, ST_CH0GAIN(st_data->ch0gain) | \
385 ST_CH1GAIN(st_data->ch1gain));
386 }
387
omap_st_set_chgain(unsigned int id,int channel,s16 chgain)388 int omap_st_set_chgain(unsigned int id, int channel, s16 chgain)
389 {
390 struct omap_mcbsp *mcbsp;
391 struct omap_mcbsp_st_data *st_data;
392 int ret = 0;
393
394 if (!omap_mcbsp_check_valid_id(id)) {
395 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
396 return -ENODEV;
397 }
398
399 mcbsp = id_to_mcbsp_ptr(id);
400 st_data = mcbsp->st_data;
401
402 if (!st_data)
403 return -ENOENT;
404
405 spin_lock_irq(&mcbsp->lock);
406 if (channel == 0)
407 st_data->ch0gain = chgain;
408 else if (channel == 1)
409 st_data->ch1gain = chgain;
410 else
411 ret = -EINVAL;
412
413 if (st_data->enabled)
414 omap_st_chgain(mcbsp);
415 spin_unlock_irq(&mcbsp->lock);
416
417 return ret;
418 }
419 EXPORT_SYMBOL(omap_st_set_chgain);
420
omap_st_get_chgain(unsigned int id,int channel,s16 * chgain)421 int omap_st_get_chgain(unsigned int id, int channel, s16 *chgain)
422 {
423 struct omap_mcbsp *mcbsp;
424 struct omap_mcbsp_st_data *st_data;
425 int ret = 0;
426
427 if (!omap_mcbsp_check_valid_id(id)) {
428 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
429 return -ENODEV;
430 }
431
432 mcbsp = id_to_mcbsp_ptr(id);
433 st_data = mcbsp->st_data;
434
435 if (!st_data)
436 return -ENOENT;
437
438 spin_lock_irq(&mcbsp->lock);
439 if (channel == 0)
440 *chgain = st_data->ch0gain;
441 else if (channel == 1)
442 *chgain = st_data->ch1gain;
443 else
444 ret = -EINVAL;
445 spin_unlock_irq(&mcbsp->lock);
446
447 return ret;
448 }
449 EXPORT_SYMBOL(omap_st_get_chgain);
450
omap_st_start(struct omap_mcbsp * mcbsp)451 static int omap_st_start(struct omap_mcbsp *mcbsp)
452 {
453 struct omap_mcbsp_st_data *st_data = mcbsp->st_data;
454
455 if (st_data && st_data->enabled && !st_data->running) {
456 omap_st_fir_write(mcbsp, st_data->taps);
457 omap_st_chgain(mcbsp);
458
459 if (!mcbsp->free) {
460 omap_st_on(mcbsp);
461 st_data->running = 1;
462 }
463 }
464
465 return 0;
466 }
467
omap_st_enable(unsigned int id)468 int omap_st_enable(unsigned int id)
469 {
470 struct omap_mcbsp *mcbsp;
471 struct omap_mcbsp_st_data *st_data;
472
473 if (!omap_mcbsp_check_valid_id(id)) {
474 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
475 return -ENODEV;
476 }
477
478 mcbsp = id_to_mcbsp_ptr(id);
479 st_data = mcbsp->st_data;
480
481 if (!st_data)
482 return -ENODEV;
483
484 spin_lock_irq(&mcbsp->lock);
485 st_data->enabled = 1;
486 omap_st_start(mcbsp);
487 spin_unlock_irq(&mcbsp->lock);
488
489 return 0;
490 }
491 EXPORT_SYMBOL(omap_st_enable);
492
omap_st_stop(struct omap_mcbsp * mcbsp)493 static int omap_st_stop(struct omap_mcbsp *mcbsp)
494 {
495 struct omap_mcbsp_st_data *st_data = mcbsp->st_data;
496
497 if (st_data && st_data->running) {
498 if (!mcbsp->free) {
499 omap_st_off(mcbsp);
500 st_data->running = 0;
501 }
502 }
503
504 return 0;
505 }
506
omap_st_disable(unsigned int id)507 int omap_st_disable(unsigned int id)
508 {
509 struct omap_mcbsp *mcbsp;
510 struct omap_mcbsp_st_data *st_data;
511 int ret = 0;
512
513 if (!omap_mcbsp_check_valid_id(id)) {
514 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
515 return -ENODEV;
516 }
517
518 mcbsp = id_to_mcbsp_ptr(id);
519 st_data = mcbsp->st_data;
520
521 if (!st_data)
522 return -ENODEV;
523
524 spin_lock_irq(&mcbsp->lock);
525 omap_st_stop(mcbsp);
526 st_data->enabled = 0;
527 spin_unlock_irq(&mcbsp->lock);
528
529 return ret;
530 }
531 EXPORT_SYMBOL(omap_st_disable);
532
omap_st_is_enabled(unsigned int id)533 int omap_st_is_enabled(unsigned int id)
534 {
535 struct omap_mcbsp *mcbsp;
536 struct omap_mcbsp_st_data *st_data;
537
538 if (!omap_mcbsp_check_valid_id(id)) {
539 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
540 return -ENODEV;
541 }
542
543 mcbsp = id_to_mcbsp_ptr(id);
544 st_data = mcbsp->st_data;
545
546 if (!st_data)
547 return -ENODEV;
548
549
550 return st_data->enabled;
551 }
552 EXPORT_SYMBOL(omap_st_is_enabled);
553
554 /*
555 * omap_mcbsp_set_rx_threshold configures the transmit threshold in words.
556 * The threshold parameter is 1 based, and it is converted (threshold - 1)
557 * for the THRSH2 register.
558 */
omap_mcbsp_set_tx_threshold(unsigned int id,u16 threshold)559 void omap_mcbsp_set_tx_threshold(unsigned int id, u16 threshold)
560 {
561 struct omap_mcbsp *mcbsp;
562
563 if (!cpu_is_omap34xx() && !cpu_is_omap44xx())
564 return;
565
566 if (!omap_mcbsp_check_valid_id(id)) {
567 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
568 return;
569 }
570 mcbsp = id_to_mcbsp_ptr(id);
571
572 if (threshold && threshold <= mcbsp->max_tx_thres)
573 MCBSP_WRITE(mcbsp, THRSH2, threshold - 1);
574 }
575 EXPORT_SYMBOL(omap_mcbsp_set_tx_threshold);
576
577 /*
578 * omap_mcbsp_set_rx_threshold configures the receive threshold in words.
579 * The threshold parameter is 1 based, and it is converted (threshold - 1)
580 * for the THRSH1 register.
581 */
omap_mcbsp_set_rx_threshold(unsigned int id,u16 threshold)582 void omap_mcbsp_set_rx_threshold(unsigned int id, u16 threshold)
583 {
584 struct omap_mcbsp *mcbsp;
585
586 if (!cpu_is_omap34xx() && !cpu_is_omap44xx())
587 return;
588
589 if (!omap_mcbsp_check_valid_id(id)) {
590 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
591 return;
592 }
593 mcbsp = id_to_mcbsp_ptr(id);
594
595 if (threshold && threshold <= mcbsp->max_rx_thres)
596 MCBSP_WRITE(mcbsp, THRSH1, threshold - 1);
597 }
598 EXPORT_SYMBOL(omap_mcbsp_set_rx_threshold);
599
600 /*
601 * omap_mcbsp_get_max_tx_thres just return the current configured
602 * maximum threshold for transmission
603 */
omap_mcbsp_get_max_tx_threshold(unsigned int id)604 u16 omap_mcbsp_get_max_tx_threshold(unsigned int id)
605 {
606 struct omap_mcbsp *mcbsp;
607
608 if (!omap_mcbsp_check_valid_id(id)) {
609 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
610 return -ENODEV;
611 }
612 mcbsp = id_to_mcbsp_ptr(id);
613
614 return mcbsp->max_tx_thres;
615 }
616 EXPORT_SYMBOL(omap_mcbsp_get_max_tx_threshold);
617
618 /*
619 * omap_mcbsp_get_max_rx_thres just return the current configured
620 * maximum threshold for reception
621 */
omap_mcbsp_get_max_rx_threshold(unsigned int id)622 u16 omap_mcbsp_get_max_rx_threshold(unsigned int id)
623 {
624 struct omap_mcbsp *mcbsp;
625
626 if (!omap_mcbsp_check_valid_id(id)) {
627 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
628 return -ENODEV;
629 }
630 mcbsp = id_to_mcbsp_ptr(id);
631
632 return mcbsp->max_rx_thres;
633 }
634 EXPORT_SYMBOL(omap_mcbsp_get_max_rx_threshold);
635
omap_mcbsp_get_fifo_size(unsigned int id)636 u16 omap_mcbsp_get_fifo_size(unsigned int id)
637 {
638 struct omap_mcbsp *mcbsp;
639
640 if (!omap_mcbsp_check_valid_id(id)) {
641 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
642 return -ENODEV;
643 }
644 mcbsp = id_to_mcbsp_ptr(id);
645
646 return mcbsp->pdata->buffer_size;
647 }
648 EXPORT_SYMBOL(omap_mcbsp_get_fifo_size);
649
650 /*
651 * omap_mcbsp_get_tx_delay returns the number of used slots in the McBSP FIFO
652 */
omap_mcbsp_get_tx_delay(unsigned int id)653 u16 omap_mcbsp_get_tx_delay(unsigned int id)
654 {
655 struct omap_mcbsp *mcbsp;
656 u16 buffstat;
657
658 if (!omap_mcbsp_check_valid_id(id)) {
659 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
660 return -ENODEV;
661 }
662 mcbsp = id_to_mcbsp_ptr(id);
663
664 /* Returns the number of free locations in the buffer */
665 buffstat = MCBSP_READ(mcbsp, XBUFFSTAT);
666
667 /* Number of slots are different in McBSP ports */
668 return mcbsp->pdata->buffer_size - buffstat;
669 }
670 EXPORT_SYMBOL(omap_mcbsp_get_tx_delay);
671
672 /*
673 * omap_mcbsp_get_rx_delay returns the number of free slots in the McBSP FIFO
674 * to reach the threshold value (when the DMA will be triggered to read it)
675 */
omap_mcbsp_get_rx_delay(unsigned int id)676 u16 omap_mcbsp_get_rx_delay(unsigned int id)
677 {
678 struct omap_mcbsp *mcbsp;
679 u16 buffstat, threshold;
680
681 if (!omap_mcbsp_check_valid_id(id)) {
682 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
683 return -ENODEV;
684 }
685 mcbsp = id_to_mcbsp_ptr(id);
686
687 /* Returns the number of used locations in the buffer */
688 buffstat = MCBSP_READ(mcbsp, RBUFFSTAT);
689 /* RX threshold */
690 threshold = MCBSP_READ(mcbsp, THRSH1);
691
692 /* Return the number of location till we reach the threshold limit */
693 if (threshold <= buffstat)
694 return 0;
695 else
696 return threshold - buffstat;
697 }
698 EXPORT_SYMBOL(omap_mcbsp_get_rx_delay);
699
700 /*
701 * omap_mcbsp_get_dma_op_mode just return the current configured
702 * operating mode for the mcbsp channel
703 */
omap_mcbsp_get_dma_op_mode(unsigned int id)704 int omap_mcbsp_get_dma_op_mode(unsigned int id)
705 {
706 struct omap_mcbsp *mcbsp;
707 int dma_op_mode;
708
709 if (!omap_mcbsp_check_valid_id(id)) {
710 printk(KERN_ERR "%s: Invalid id (%u)\n", __func__, id + 1);
711 return -ENODEV;
712 }
713 mcbsp = id_to_mcbsp_ptr(id);
714
715 dma_op_mode = mcbsp->dma_op_mode;
716
717 return dma_op_mode;
718 }
719 EXPORT_SYMBOL(omap_mcbsp_get_dma_op_mode);
720
omap34xx_mcbsp_request(struct omap_mcbsp * mcbsp)721 static inline void omap34xx_mcbsp_request(struct omap_mcbsp *mcbsp)
722 {
723 struct omap_device *od;
724
725 od = find_omap_device_by_dev(mcbsp->dev);
726 /*
727 * Enable wakup behavior, smart idle and all wakeups
728 * REVISIT: some wakeups may be unnecessary
729 */
730 if (cpu_is_omap34xx() || cpu_is_omap44xx()) {
731 MCBSP_WRITE(mcbsp, WAKEUPEN, XRDYEN | RRDYEN);
732 }
733 }
734
omap34xx_mcbsp_free(struct omap_mcbsp * mcbsp)735 static inline void omap34xx_mcbsp_free(struct omap_mcbsp *mcbsp)
736 {
737 struct omap_device *od;
738
739 od = find_omap_device_by_dev(mcbsp->dev);
740
741 /*
742 * Disable wakup behavior, smart idle and all wakeups
743 */
744 if (cpu_is_omap34xx() || cpu_is_omap44xx()) {
745 /*
746 * HW bug workaround - If no_idle mode is taken, we need to
747 * go to smart_idle before going to always_idle, or the
748 * device will not hit retention anymore.
749 */
750
751 MCBSP_WRITE(mcbsp, WAKEUPEN, 0);
752 }
753 }
754 #else
omap34xx_mcbsp_request(struct omap_mcbsp * mcbsp)755 static inline void omap34xx_mcbsp_request(struct omap_mcbsp *mcbsp) {}
omap34xx_mcbsp_free(struct omap_mcbsp * mcbsp)756 static inline void omap34xx_mcbsp_free(struct omap_mcbsp *mcbsp) {}
omap_st_start(struct omap_mcbsp * mcbsp)757 static inline void omap_st_start(struct omap_mcbsp *mcbsp) {}
omap_st_stop(struct omap_mcbsp * mcbsp)758 static inline void omap_st_stop(struct omap_mcbsp *mcbsp) {}
759 #endif
760
761 /*
762 * We can choose between IRQ based or polled IO.
763 * This needs to be called before omap_mcbsp_request().
764 */
omap_mcbsp_set_io_type(unsigned int id,omap_mcbsp_io_type_t io_type)765 int omap_mcbsp_set_io_type(unsigned int id, omap_mcbsp_io_type_t io_type)
766 {
767 struct omap_mcbsp *mcbsp;
768
769 if (!omap_mcbsp_check_valid_id(id)) {
770 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
771 return -ENODEV;
772 }
773 mcbsp = id_to_mcbsp_ptr(id);
774
775 spin_lock(&mcbsp->lock);
776
777 if (!mcbsp->free) {
778 dev_err(mcbsp->dev, "McBSP%d is currently in use\n",
779 mcbsp->id);
780 spin_unlock(&mcbsp->lock);
781 return -EINVAL;
782 }
783
784 mcbsp->io_type = io_type;
785
786 spin_unlock(&mcbsp->lock);
787
788 return 0;
789 }
790 EXPORT_SYMBOL(omap_mcbsp_set_io_type);
791
omap_mcbsp_request(unsigned int id)792 int omap_mcbsp_request(unsigned int id)
793 {
794 struct omap_mcbsp *mcbsp;
795 void *reg_cache;
796 int err;
797
798 if (!omap_mcbsp_check_valid_id(id)) {
799 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
800 return -ENODEV;
801 }
802 mcbsp = id_to_mcbsp_ptr(id);
803
804 reg_cache = kzalloc(omap_mcbsp_cache_size, GFP_KERNEL);
805 if (!reg_cache) {
806 return -ENOMEM;
807 }
808
809 spin_lock(&mcbsp->lock);
810 if (!mcbsp->free) {
811 dev_err(mcbsp->dev, "McBSP%d is currently in use\n",
812 mcbsp->id);
813 err = -EBUSY;
814 goto err_kfree;
815 }
816
817 mcbsp->free = false;
818 mcbsp->reg_cache = reg_cache;
819 spin_unlock(&mcbsp->lock);
820
821 if (mcbsp->pdata && mcbsp->pdata->ops && mcbsp->pdata->ops->request)
822 mcbsp->pdata->ops->request(id);
823
824 pm_runtime_get_sync(mcbsp->dev);
825
826 /* Do procedure specific to omap34xx arch, if applicable */
827 omap34xx_mcbsp_request(mcbsp);
828
829 /*
830 * Make sure that transmitter, receiver and sample-rate generator are
831 * not running before activating IRQs.
832 */
833 MCBSP_WRITE(mcbsp, SPCR1, 0);
834 MCBSP_WRITE(mcbsp, SPCR2, 0);
835
836 if (mcbsp->io_type == OMAP_MCBSP_IRQ_IO) {
837 /* We need to get IRQs here */
838 init_completion(&mcbsp->tx_irq_completion);
839 err = request_irq(mcbsp->tx_irq, omap_mcbsp_tx_irq_handler,
840 0, "McBSP", (void *)mcbsp);
841 if (err != 0) {
842 dev_err(mcbsp->dev, "Unable to request TX IRQ %d "
843 "for McBSP%d\n", mcbsp->tx_irq,
844 mcbsp->id);
845 goto err_clk_disable;
846 }
847
848 if (mcbsp->rx_irq) {
849 init_completion(&mcbsp->rx_irq_completion);
850 err = request_irq(mcbsp->rx_irq,
851 omap_mcbsp_rx_irq_handler,
852 0, "McBSP", (void *)mcbsp);
853 if (err != 0) {
854 dev_err(mcbsp->dev, "Unable to request RX IRQ %d "
855 "for McBSP%d\n", mcbsp->rx_irq,
856 mcbsp->id);
857 goto err_free_irq;
858 }
859 }
860 }
861
862 return 0;
863 err_free_irq:
864 free_irq(mcbsp->tx_irq, (void *)mcbsp);
865 err_clk_disable:
866 if (mcbsp->pdata && mcbsp->pdata->ops && mcbsp->pdata->ops->free)
867 mcbsp->pdata->ops->free(id);
868
869 /* Do procedure specific to omap34xx arch, if applicable */
870 omap34xx_mcbsp_free(mcbsp);
871
872 pm_runtime_put_sync(mcbsp->dev);
873
874 spin_lock(&mcbsp->lock);
875 mcbsp->free = true;
876 mcbsp->reg_cache = NULL;
877 err_kfree:
878 spin_unlock(&mcbsp->lock);
879 kfree(reg_cache);
880
881 return err;
882 }
883 EXPORT_SYMBOL(omap_mcbsp_request);
884
omap_mcbsp_free(unsigned int id)885 void omap_mcbsp_free(unsigned int id)
886 {
887 struct omap_mcbsp *mcbsp;
888 void *reg_cache;
889
890 if (!omap_mcbsp_check_valid_id(id)) {
891 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
892 return;
893 }
894 mcbsp = id_to_mcbsp_ptr(id);
895
896 if (mcbsp->pdata && mcbsp->pdata->ops && mcbsp->pdata->ops->free)
897 mcbsp->pdata->ops->free(id);
898
899 /* Do procedure specific to omap34xx arch, if applicable */
900 omap34xx_mcbsp_free(mcbsp);
901
902 pm_runtime_put_sync(mcbsp->dev);
903
904 if (mcbsp->io_type == OMAP_MCBSP_IRQ_IO) {
905 /* Free IRQs */
906 if (mcbsp->rx_irq)
907 free_irq(mcbsp->rx_irq, (void *)mcbsp);
908 free_irq(mcbsp->tx_irq, (void *)mcbsp);
909 }
910
911 reg_cache = mcbsp->reg_cache;
912
913 spin_lock(&mcbsp->lock);
914 if (mcbsp->free)
915 dev_err(mcbsp->dev, "McBSP%d was not reserved\n", mcbsp->id);
916 else
917 mcbsp->free = true;
918 mcbsp->reg_cache = NULL;
919 spin_unlock(&mcbsp->lock);
920
921 if (reg_cache)
922 kfree(reg_cache);
923 }
924 EXPORT_SYMBOL(omap_mcbsp_free);
925
926 /*
927 * Here we start the McBSP, by enabling transmitter, receiver or both.
928 * If no transmitter or receiver is active prior calling, then sample-rate
929 * generator and frame sync are started.
930 */
omap_mcbsp_start(unsigned int id,int tx,int rx)931 void omap_mcbsp_start(unsigned int id, int tx, int rx)
932 {
933 struct omap_mcbsp *mcbsp;
934 int enable_srg = 0;
935 u16 w;
936
937 if (!omap_mcbsp_check_valid_id(id)) {
938 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
939 return;
940 }
941 mcbsp = id_to_mcbsp_ptr(id);
942
943 if (cpu_is_omap34xx())
944 omap_st_start(mcbsp);
945
946 mcbsp->rx_word_length = (MCBSP_READ_CACHE(mcbsp, RCR1) >> 5) & 0x7;
947 mcbsp->tx_word_length = (MCBSP_READ_CACHE(mcbsp, XCR1) >> 5) & 0x7;
948
949 /* Only enable SRG, if McBSP is master */
950 w = MCBSP_READ_CACHE(mcbsp, PCR0);
951 if (w & (FSXM | FSRM | CLKXM | CLKRM))
952 enable_srg = !((MCBSP_READ_CACHE(mcbsp, SPCR2) |
953 MCBSP_READ_CACHE(mcbsp, SPCR1)) & 1);
954
955 if (enable_srg) {
956 /* Start the sample generator */
957 w = MCBSP_READ_CACHE(mcbsp, SPCR2);
958 MCBSP_WRITE(mcbsp, SPCR2, w | (1 << 6));
959 }
960
961 /* Enable transmitter and receiver */
962 tx &= 1;
963 w = MCBSP_READ_CACHE(mcbsp, SPCR2);
964 MCBSP_WRITE(mcbsp, SPCR2, w | tx);
965
966 rx &= 1;
967 w = MCBSP_READ_CACHE(mcbsp, SPCR1);
968 MCBSP_WRITE(mcbsp, SPCR1, w | rx);
969
970 /*
971 * Worst case: CLKSRG*2 = 8000khz: (1/8000) * 2 * 2 usec
972 * REVISIT: 100us may give enough time for two CLKSRG, however
973 * due to some unknown PM related, clock gating etc. reason it
974 * is now at 500us.
975 */
976 udelay(500);
977
978 if (enable_srg) {
979 /* Start frame sync */
980 w = MCBSP_READ_CACHE(mcbsp, SPCR2);
981 MCBSP_WRITE(mcbsp, SPCR2, w | (1 << 7));
982 }
983
984 if (cpu_is_omap2430() || cpu_is_omap34xx() || cpu_is_omap44xx()) {
985 /* Release the transmitter and receiver */
986 w = MCBSP_READ_CACHE(mcbsp, XCCR);
987 w &= ~(tx ? XDISABLE : 0);
988 MCBSP_WRITE(mcbsp, XCCR, w);
989 w = MCBSP_READ_CACHE(mcbsp, RCCR);
990 w &= ~(rx ? RDISABLE : 0);
991 MCBSP_WRITE(mcbsp, RCCR, w);
992 }
993
994 /* Dump McBSP Regs */
995 omap_mcbsp_dump_reg(id);
996 }
997 EXPORT_SYMBOL(omap_mcbsp_start);
998
omap_mcbsp_stop(unsigned int id,int tx,int rx)999 void omap_mcbsp_stop(unsigned int id, int tx, int rx)
1000 {
1001 struct omap_mcbsp *mcbsp;
1002 int idle;
1003 u16 w;
1004
1005 if (!omap_mcbsp_check_valid_id(id)) {
1006 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
1007 return;
1008 }
1009
1010 mcbsp = id_to_mcbsp_ptr(id);
1011
1012 /* Reset transmitter */
1013 tx &= 1;
1014 if (cpu_is_omap2430() || cpu_is_omap34xx() || cpu_is_omap44xx()) {
1015 w = MCBSP_READ_CACHE(mcbsp, XCCR);
1016 w |= (tx ? XDISABLE : 0);
1017 MCBSP_WRITE(mcbsp, XCCR, w);
1018 }
1019 w = MCBSP_READ_CACHE(mcbsp, SPCR2);
1020 MCBSP_WRITE(mcbsp, SPCR2, w & ~tx);
1021
1022 /* Reset receiver */
1023 rx &= 1;
1024 if (cpu_is_omap2430() || cpu_is_omap34xx() || cpu_is_omap44xx()) {
1025 w = MCBSP_READ_CACHE(mcbsp, RCCR);
1026 w |= (rx ? RDISABLE : 0);
1027 MCBSP_WRITE(mcbsp, RCCR, w);
1028 }
1029 w = MCBSP_READ_CACHE(mcbsp, SPCR1);
1030 MCBSP_WRITE(mcbsp, SPCR1, w & ~rx);
1031
1032 idle = !((MCBSP_READ_CACHE(mcbsp, SPCR2) |
1033 MCBSP_READ_CACHE(mcbsp, SPCR1)) & 1);
1034
1035 if (idle) {
1036 /* Reset the sample rate generator */
1037 w = MCBSP_READ_CACHE(mcbsp, SPCR2);
1038 MCBSP_WRITE(mcbsp, SPCR2, w & ~(1 << 6));
1039 }
1040
1041 if (cpu_is_omap34xx())
1042 omap_st_stop(mcbsp);
1043 }
1044 EXPORT_SYMBOL(omap_mcbsp_stop);
1045
1046 /* polled mcbsp i/o operations */
omap_mcbsp_pollwrite(unsigned int id,u16 buf)1047 int omap_mcbsp_pollwrite(unsigned int id, u16 buf)
1048 {
1049 struct omap_mcbsp *mcbsp;
1050
1051 if (!omap_mcbsp_check_valid_id(id)) {
1052 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
1053 return -ENODEV;
1054 }
1055
1056 mcbsp = id_to_mcbsp_ptr(id);
1057
1058 MCBSP_WRITE(mcbsp, DXR1, buf);
1059 /* if frame sync error - clear the error */
1060 if (MCBSP_READ(mcbsp, SPCR2) & XSYNC_ERR) {
1061 /* clear error */
1062 MCBSP_WRITE(mcbsp, SPCR2, MCBSP_READ_CACHE(mcbsp, SPCR2));
1063 /* resend */
1064 return -1;
1065 } else {
1066 /* wait for transmit confirmation */
1067 int attemps = 0;
1068 while (!(MCBSP_READ(mcbsp, SPCR2) & XRDY)) {
1069 if (attemps++ > 1000) {
1070 MCBSP_WRITE(mcbsp, SPCR2,
1071 MCBSP_READ_CACHE(mcbsp, SPCR2) &
1072 (~XRST));
1073 udelay(10);
1074 MCBSP_WRITE(mcbsp, SPCR2,
1075 MCBSP_READ_CACHE(mcbsp, SPCR2) |
1076 (XRST));
1077 udelay(10);
1078 dev_err(mcbsp->dev, "Could not write to"
1079 " McBSP%d Register\n", mcbsp->id);
1080 return -2;
1081 }
1082 }
1083 }
1084
1085 return 0;
1086 }
1087 EXPORT_SYMBOL(omap_mcbsp_pollwrite);
1088
omap_mcbsp_pollread(unsigned int id,u16 * buf)1089 int omap_mcbsp_pollread(unsigned int id, u16 *buf)
1090 {
1091 struct omap_mcbsp *mcbsp;
1092
1093 if (!omap_mcbsp_check_valid_id(id)) {
1094 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
1095 return -ENODEV;
1096 }
1097 mcbsp = id_to_mcbsp_ptr(id);
1098
1099 /* if frame sync error - clear the error */
1100 if (MCBSP_READ(mcbsp, SPCR1) & RSYNC_ERR) {
1101 /* clear error */
1102 MCBSP_WRITE(mcbsp, SPCR1, MCBSP_READ_CACHE(mcbsp, SPCR1));
1103 /* resend */
1104 return -1;
1105 } else {
1106 /* wait for receive confirmation */
1107 int attemps = 0;
1108 while (!(MCBSP_READ(mcbsp, SPCR1) & RRDY)) {
1109 if (attemps++ > 1000) {
1110 MCBSP_WRITE(mcbsp, SPCR1,
1111 MCBSP_READ_CACHE(mcbsp, SPCR1) &
1112 (~RRST));
1113 udelay(10);
1114 MCBSP_WRITE(mcbsp, SPCR1,
1115 MCBSP_READ_CACHE(mcbsp, SPCR1) |
1116 (RRST));
1117 udelay(10);
1118 dev_err(mcbsp->dev, "Could not read from"
1119 " McBSP%d Register\n", mcbsp->id);
1120 return -2;
1121 }
1122 }
1123 }
1124 *buf = MCBSP_READ(mcbsp, DRR1);
1125
1126 return 0;
1127 }
1128 EXPORT_SYMBOL(omap_mcbsp_pollread);
1129
1130 /*
1131 * IRQ based word transmission.
1132 */
omap_mcbsp_xmit_word(unsigned int id,u32 word)1133 void omap_mcbsp_xmit_word(unsigned int id, u32 word)
1134 {
1135 struct omap_mcbsp *mcbsp;
1136 omap_mcbsp_word_length word_length;
1137
1138 if (!omap_mcbsp_check_valid_id(id)) {
1139 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
1140 return;
1141 }
1142
1143 mcbsp = id_to_mcbsp_ptr(id);
1144 word_length = mcbsp->tx_word_length;
1145
1146 wait_for_completion(&mcbsp->tx_irq_completion);
1147
1148 if (word_length > OMAP_MCBSP_WORD_16)
1149 MCBSP_WRITE(mcbsp, DXR2, word >> 16);
1150 MCBSP_WRITE(mcbsp, DXR1, word & 0xffff);
1151 }
1152 EXPORT_SYMBOL(omap_mcbsp_xmit_word);
1153
omap_mcbsp_recv_word(unsigned int id)1154 u32 omap_mcbsp_recv_word(unsigned int id)
1155 {
1156 struct omap_mcbsp *mcbsp;
1157 u16 word_lsb, word_msb = 0;
1158 omap_mcbsp_word_length word_length;
1159
1160 if (!omap_mcbsp_check_valid_id(id)) {
1161 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
1162 return -ENODEV;
1163 }
1164 mcbsp = id_to_mcbsp_ptr(id);
1165
1166 word_length = mcbsp->rx_word_length;
1167
1168 wait_for_completion(&mcbsp->rx_irq_completion);
1169
1170 if (word_length > OMAP_MCBSP_WORD_16)
1171 word_msb = MCBSP_READ(mcbsp, DRR2);
1172 word_lsb = MCBSP_READ(mcbsp, DRR1);
1173
1174 return (word_lsb | (word_msb << 16));
1175 }
1176 EXPORT_SYMBOL(omap_mcbsp_recv_word);
1177
omap_mcbsp_spi_master_xmit_word_poll(unsigned int id,u32 word)1178 int omap_mcbsp_spi_master_xmit_word_poll(unsigned int id, u32 word)
1179 {
1180 struct omap_mcbsp *mcbsp;
1181 omap_mcbsp_word_length tx_word_length;
1182 omap_mcbsp_word_length rx_word_length;
1183 u16 spcr2, spcr1, attempts = 0, word_lsb, word_msb = 0;
1184
1185 if (!omap_mcbsp_check_valid_id(id)) {
1186 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
1187 return -ENODEV;
1188 }
1189 mcbsp = id_to_mcbsp_ptr(id);
1190 tx_word_length = mcbsp->tx_word_length;
1191 rx_word_length = mcbsp->rx_word_length;
1192
1193 if (tx_word_length != rx_word_length)
1194 return -EINVAL;
1195
1196 /* First we wait for the transmitter to be ready */
1197 spcr2 = MCBSP_READ(mcbsp, SPCR2);
1198 while (!(spcr2 & XRDY)) {
1199 spcr2 = MCBSP_READ(mcbsp, SPCR2);
1200 if (attempts++ > 1000) {
1201 /* We must reset the transmitter */
1202 MCBSP_WRITE(mcbsp, SPCR2,
1203 MCBSP_READ_CACHE(mcbsp, SPCR2) & (~XRST));
1204 udelay(10);
1205 MCBSP_WRITE(mcbsp, SPCR2,
1206 MCBSP_READ_CACHE(mcbsp, SPCR2) | XRST);
1207 udelay(10);
1208 dev_err(mcbsp->dev, "McBSP%d transmitter not "
1209 "ready\n", mcbsp->id);
1210 return -EAGAIN;
1211 }
1212 }
1213
1214 /* Now we can push the data */
1215 if (tx_word_length > OMAP_MCBSP_WORD_16)
1216 MCBSP_WRITE(mcbsp, DXR2, word >> 16);
1217 MCBSP_WRITE(mcbsp, DXR1, word & 0xffff);
1218
1219 /* We wait for the receiver to be ready */
1220 spcr1 = MCBSP_READ(mcbsp, SPCR1);
1221 while (!(spcr1 & RRDY)) {
1222 spcr1 = MCBSP_READ(mcbsp, SPCR1);
1223 if (attempts++ > 1000) {
1224 /* We must reset the receiver */
1225 MCBSP_WRITE(mcbsp, SPCR1,
1226 MCBSP_READ_CACHE(mcbsp, SPCR1) & (~RRST));
1227 udelay(10);
1228 MCBSP_WRITE(mcbsp, SPCR1,
1229 MCBSP_READ_CACHE(mcbsp, SPCR1) | RRST);
1230 udelay(10);
1231 dev_err(mcbsp->dev, "McBSP%d receiver not "
1232 "ready\n", mcbsp->id);
1233 return -EAGAIN;
1234 }
1235 }
1236
1237 /* Receiver is ready, let's read the dummy data */
1238 if (rx_word_length > OMAP_MCBSP_WORD_16)
1239 word_msb = MCBSP_READ(mcbsp, DRR2);
1240 word_lsb = MCBSP_READ(mcbsp, DRR1);
1241
1242 return 0;
1243 }
1244 EXPORT_SYMBOL(omap_mcbsp_spi_master_xmit_word_poll);
1245
omap_mcbsp_spi_master_recv_word_poll(unsigned int id,u32 * word)1246 int omap_mcbsp_spi_master_recv_word_poll(unsigned int id, u32 *word)
1247 {
1248 struct omap_mcbsp *mcbsp;
1249 u32 clock_word = 0;
1250 omap_mcbsp_word_length tx_word_length;
1251 omap_mcbsp_word_length rx_word_length;
1252 u16 spcr2, spcr1, attempts = 0, word_lsb, word_msb = 0;
1253
1254 if (!omap_mcbsp_check_valid_id(id)) {
1255 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
1256 return -ENODEV;
1257 }
1258
1259 mcbsp = id_to_mcbsp_ptr(id);
1260
1261 tx_word_length = mcbsp->tx_word_length;
1262 rx_word_length = mcbsp->rx_word_length;
1263
1264 if (tx_word_length != rx_word_length)
1265 return -EINVAL;
1266
1267 /* First we wait for the transmitter to be ready */
1268 spcr2 = MCBSP_READ(mcbsp, SPCR2);
1269 while (!(spcr2 & XRDY)) {
1270 spcr2 = MCBSP_READ(mcbsp, SPCR2);
1271 if (attempts++ > 1000) {
1272 /* We must reset the transmitter */
1273 MCBSP_WRITE(mcbsp, SPCR2,
1274 MCBSP_READ_CACHE(mcbsp, SPCR2) & (~XRST));
1275 udelay(10);
1276 MCBSP_WRITE(mcbsp, SPCR2,
1277 MCBSP_READ_CACHE(mcbsp, SPCR2) | XRST);
1278 udelay(10);
1279 dev_err(mcbsp->dev, "McBSP%d transmitter not "
1280 "ready\n", mcbsp->id);
1281 return -EAGAIN;
1282 }
1283 }
1284
1285 /* We first need to enable the bus clock */
1286 if (tx_word_length > OMAP_MCBSP_WORD_16)
1287 MCBSP_WRITE(mcbsp, DXR2, clock_word >> 16);
1288 MCBSP_WRITE(mcbsp, DXR1, clock_word & 0xffff);
1289
1290 /* We wait for the receiver to be ready */
1291 spcr1 = MCBSP_READ(mcbsp, SPCR1);
1292 while (!(spcr1 & RRDY)) {
1293 spcr1 = MCBSP_READ(mcbsp, SPCR1);
1294 if (attempts++ > 1000) {
1295 /* We must reset the receiver */
1296 MCBSP_WRITE(mcbsp, SPCR1,
1297 MCBSP_READ_CACHE(mcbsp, SPCR1) & (~RRST));
1298 udelay(10);
1299 MCBSP_WRITE(mcbsp, SPCR1,
1300 MCBSP_READ_CACHE(mcbsp, SPCR1) | RRST);
1301 udelay(10);
1302 dev_err(mcbsp->dev, "McBSP%d receiver not "
1303 "ready\n", mcbsp->id);
1304 return -EAGAIN;
1305 }
1306 }
1307
1308 /* Receiver is ready, there is something for us */
1309 if (rx_word_length > OMAP_MCBSP_WORD_16)
1310 word_msb = MCBSP_READ(mcbsp, DRR2);
1311 word_lsb = MCBSP_READ(mcbsp, DRR1);
1312
1313 word[0] = (word_lsb | (word_msb << 16));
1314
1315 return 0;
1316 }
1317 EXPORT_SYMBOL(omap_mcbsp_spi_master_recv_word_poll);
1318
1319 /*
1320 * Simple DMA based buffer rx/tx routines.
1321 * Nothing fancy, just a single buffer tx/rx through DMA.
1322 * The DMA resources are released once the transfer is done.
1323 * For anything fancier, you should use your own customized DMA
1324 * routines and callbacks.
1325 */
omap_mcbsp_xmit_buffer(unsigned int id,dma_addr_t buffer,unsigned int length)1326 int omap_mcbsp_xmit_buffer(unsigned int id, dma_addr_t buffer,
1327 unsigned int length)
1328 {
1329 struct omap_mcbsp *mcbsp;
1330 int dma_tx_ch;
1331 int src_port = 0;
1332 int dest_port = 0;
1333 int sync_dev = 0;
1334
1335 if (!omap_mcbsp_check_valid_id(id)) {
1336 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
1337 return -ENODEV;
1338 }
1339 mcbsp = id_to_mcbsp_ptr(id);
1340
1341 if (omap_request_dma(mcbsp->dma_tx_sync, "McBSP TX",
1342 omap_mcbsp_tx_dma_callback,
1343 mcbsp,
1344 &dma_tx_ch)) {
1345 dev_err(mcbsp->dev, " Unable to request DMA channel for "
1346 "McBSP%d TX. Trying IRQ based TX\n",
1347 mcbsp->id);
1348 return -EAGAIN;
1349 }
1350 mcbsp->dma_tx_lch = dma_tx_ch;
1351
1352 dev_err(mcbsp->dev, "McBSP%d TX DMA on channel %d\n", mcbsp->id,
1353 dma_tx_ch);
1354
1355 init_completion(&mcbsp->tx_dma_completion);
1356
1357 if (cpu_class_is_omap1()) {
1358 src_port = OMAP_DMA_PORT_TIPB;
1359 dest_port = OMAP_DMA_PORT_EMIFF;
1360 }
1361 if (cpu_class_is_omap2())
1362 sync_dev = mcbsp->dma_tx_sync;
1363
1364 omap_set_dma_transfer_params(mcbsp->dma_tx_lch,
1365 OMAP_DMA_DATA_TYPE_S16,
1366 length >> 1, 1,
1367 OMAP_DMA_SYNC_ELEMENT,
1368 sync_dev, 0);
1369
1370 omap_set_dma_dest_params(mcbsp->dma_tx_lch,
1371 src_port,
1372 OMAP_DMA_AMODE_CONSTANT,
1373 mcbsp->phys_base + OMAP_MCBSP_REG_DXR1,
1374 0, 0);
1375
1376 omap_set_dma_src_params(mcbsp->dma_tx_lch,
1377 dest_port,
1378 OMAP_DMA_AMODE_POST_INC,
1379 buffer,
1380 0, 0);
1381
1382 omap_start_dma(mcbsp->dma_tx_lch);
1383 wait_for_completion(&mcbsp->tx_dma_completion);
1384
1385 return 0;
1386 }
1387 EXPORT_SYMBOL(omap_mcbsp_xmit_buffer);
1388
omap_mcbsp_recv_buffer(unsigned int id,dma_addr_t buffer,unsigned int length)1389 int omap_mcbsp_recv_buffer(unsigned int id, dma_addr_t buffer,
1390 unsigned int length)
1391 {
1392 struct omap_mcbsp *mcbsp;
1393 int dma_rx_ch;
1394 int src_port = 0;
1395 int dest_port = 0;
1396 int sync_dev = 0;
1397
1398 if (!omap_mcbsp_check_valid_id(id)) {
1399 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
1400 return -ENODEV;
1401 }
1402 mcbsp = id_to_mcbsp_ptr(id);
1403
1404 if (omap_request_dma(mcbsp->dma_rx_sync, "McBSP RX",
1405 omap_mcbsp_rx_dma_callback,
1406 mcbsp,
1407 &dma_rx_ch)) {
1408 dev_err(mcbsp->dev, "Unable to request DMA channel for "
1409 "McBSP%d RX. Trying IRQ based RX\n",
1410 mcbsp->id);
1411 return -EAGAIN;
1412 }
1413 mcbsp->dma_rx_lch = dma_rx_ch;
1414
1415 dev_err(mcbsp->dev, "McBSP%d RX DMA on channel %d\n", mcbsp->id,
1416 dma_rx_ch);
1417
1418 init_completion(&mcbsp->rx_dma_completion);
1419
1420 if (cpu_class_is_omap1()) {
1421 src_port = OMAP_DMA_PORT_TIPB;
1422 dest_port = OMAP_DMA_PORT_EMIFF;
1423 }
1424 if (cpu_class_is_omap2())
1425 sync_dev = mcbsp->dma_rx_sync;
1426
1427 omap_set_dma_transfer_params(mcbsp->dma_rx_lch,
1428 OMAP_DMA_DATA_TYPE_S16,
1429 length >> 1, 1,
1430 OMAP_DMA_SYNC_ELEMENT,
1431 sync_dev, 0);
1432
1433 omap_set_dma_src_params(mcbsp->dma_rx_lch,
1434 src_port,
1435 OMAP_DMA_AMODE_CONSTANT,
1436 mcbsp->phys_base + OMAP_MCBSP_REG_DRR1,
1437 0, 0);
1438
1439 omap_set_dma_dest_params(mcbsp->dma_rx_lch,
1440 dest_port,
1441 OMAP_DMA_AMODE_POST_INC,
1442 buffer,
1443 0, 0);
1444
1445 omap_start_dma(mcbsp->dma_rx_lch);
1446 wait_for_completion(&mcbsp->rx_dma_completion);
1447
1448 return 0;
1449 }
1450 EXPORT_SYMBOL(omap_mcbsp_recv_buffer);
1451
1452 /*
1453 * SPI wrapper.
1454 * Since SPI setup is much simpler than the generic McBSP one,
1455 * this wrapper just need an omap_mcbsp_spi_cfg structure as an input.
1456 * Once this is done, you can call omap_mcbsp_start().
1457 */
omap_mcbsp_set_spi_mode(unsigned int id,const struct omap_mcbsp_spi_cfg * spi_cfg)1458 void omap_mcbsp_set_spi_mode(unsigned int id,
1459 const struct omap_mcbsp_spi_cfg *spi_cfg)
1460 {
1461 struct omap_mcbsp *mcbsp;
1462 struct omap_mcbsp_reg_cfg mcbsp_cfg;
1463
1464 if (!omap_mcbsp_check_valid_id(id)) {
1465 printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
1466 return;
1467 }
1468 mcbsp = id_to_mcbsp_ptr(id);
1469
1470 memset(&mcbsp_cfg, 0, sizeof(struct omap_mcbsp_reg_cfg));
1471
1472 /* SPI has only one frame */
1473 mcbsp_cfg.rcr1 |= (RWDLEN1(spi_cfg->word_length) | RFRLEN1(0));
1474 mcbsp_cfg.xcr1 |= (XWDLEN1(spi_cfg->word_length) | XFRLEN1(0));
1475
1476 /* Clock stop mode */
1477 if (spi_cfg->clk_stp_mode == OMAP_MCBSP_CLK_STP_MODE_NO_DELAY)
1478 mcbsp_cfg.spcr1 |= (1 << 12);
1479 else
1480 mcbsp_cfg.spcr1 |= (3 << 11);
1481
1482 /* Set clock parities */
1483 if (spi_cfg->rx_clock_polarity == OMAP_MCBSP_CLK_RISING)
1484 mcbsp_cfg.pcr0 |= CLKRP;
1485 else
1486 mcbsp_cfg.pcr0 &= ~CLKRP;
1487
1488 if (spi_cfg->tx_clock_polarity == OMAP_MCBSP_CLK_RISING)
1489 mcbsp_cfg.pcr0 &= ~CLKXP;
1490 else
1491 mcbsp_cfg.pcr0 |= CLKXP;
1492
1493 /* Set SCLKME to 0 and CLKSM to 1 */
1494 mcbsp_cfg.pcr0 &= ~SCLKME;
1495 mcbsp_cfg.srgr2 |= CLKSM;
1496
1497 /* Set FSXP */
1498 if (spi_cfg->fsx_polarity == OMAP_MCBSP_FS_ACTIVE_HIGH)
1499 mcbsp_cfg.pcr0 &= ~FSXP;
1500 else
1501 mcbsp_cfg.pcr0 |= FSXP;
1502
1503 if (spi_cfg->spi_mode == OMAP_MCBSP_SPI_MASTER) {
1504 mcbsp_cfg.pcr0 |= CLKXM;
1505 mcbsp_cfg.srgr1 |= CLKGDV(spi_cfg->clk_div - 1);
1506 mcbsp_cfg.pcr0 |= FSXM;
1507 mcbsp_cfg.srgr2 &= ~FSGM;
1508 mcbsp_cfg.xcr2 |= XDATDLY(1);
1509 mcbsp_cfg.rcr2 |= RDATDLY(1);
1510 } else {
1511 mcbsp_cfg.pcr0 &= ~CLKXM;
1512 mcbsp_cfg.srgr1 |= CLKGDV(1);
1513 mcbsp_cfg.pcr0 &= ~FSXM;
1514 mcbsp_cfg.xcr2 &= ~XDATDLY(3);
1515 mcbsp_cfg.rcr2 &= ~RDATDLY(3);
1516 }
1517
1518 mcbsp_cfg.xcr2 &= ~XPHASE;
1519 mcbsp_cfg.rcr2 &= ~RPHASE;
1520
1521 omap_mcbsp_config(id, &mcbsp_cfg);
1522 }
1523 EXPORT_SYMBOL(omap_mcbsp_set_spi_mode);
1524
1525 #ifdef CONFIG_ARCH_OMAP3
1526 #define max_thres(m) (mcbsp->pdata->buffer_size)
1527 #define valid_threshold(m, val) ((val) <= max_thres(m))
1528 #define THRESHOLD_PROP_BUILDER(prop) \
1529 static ssize_t prop##_show(struct device *dev, \
1530 struct device_attribute *attr, char *buf) \
1531 { \
1532 struct omap_mcbsp *mcbsp = dev_get_drvdata(dev); \
1533 \
1534 return sprintf(buf, "%u\n", mcbsp->prop); \
1535 } \
1536 \
1537 static ssize_t prop##_store(struct device *dev, \
1538 struct device_attribute *attr, \
1539 const char *buf, size_t size) \
1540 { \
1541 struct omap_mcbsp *mcbsp = dev_get_drvdata(dev); \
1542 unsigned long val; \
1543 int status; \
1544 \
1545 status = strict_strtoul(buf, 0, &val); \
1546 if (status) \
1547 return status; \
1548 \
1549 if (!valid_threshold(mcbsp, val)) \
1550 return -EDOM; \
1551 \
1552 mcbsp->prop = val; \
1553 return size; \
1554 } \
1555 \
1556 static DEVICE_ATTR(prop, 0644, prop##_show, prop##_store);
1557
1558 THRESHOLD_PROP_BUILDER(max_tx_thres);
1559 THRESHOLD_PROP_BUILDER(max_rx_thres);
1560
1561 static const char *dma_op_modes[] = {
1562 "element", "threshold", "frame",
1563 };
1564
dma_op_mode_show(struct device * dev,struct device_attribute * attr,char * buf)1565 static ssize_t dma_op_mode_show(struct device *dev,
1566 struct device_attribute *attr, char *buf)
1567 {
1568 struct omap_mcbsp *mcbsp = dev_get_drvdata(dev);
1569 int dma_op_mode, i = 0;
1570 ssize_t len = 0;
1571 const char * const *s;
1572
1573 dma_op_mode = mcbsp->dma_op_mode;
1574
1575 for (s = &dma_op_modes[i]; i < ARRAY_SIZE(dma_op_modes); s++, i++) {
1576 if (dma_op_mode == i)
1577 len += sprintf(buf + len, "[%s] ", *s);
1578 else
1579 len += sprintf(buf + len, "%s ", *s);
1580 }
1581 len += sprintf(buf + len, "\n");
1582
1583 return len;
1584 }
1585
dma_op_mode_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t size)1586 static ssize_t dma_op_mode_store(struct device *dev,
1587 struct device_attribute *attr,
1588 const char *buf, size_t size)
1589 {
1590 struct omap_mcbsp *mcbsp = dev_get_drvdata(dev);
1591 const char * const *s;
1592 int i = 0;
1593
1594 for (s = &dma_op_modes[i]; i < ARRAY_SIZE(dma_op_modes); s++, i++)
1595 if (sysfs_streq(buf, *s))
1596 break;
1597
1598 if (i == ARRAY_SIZE(dma_op_modes))
1599 return -EINVAL;
1600
1601 spin_lock_irq(&mcbsp->lock);
1602 if (!mcbsp->free) {
1603 size = -EBUSY;
1604 goto unlock;
1605 }
1606 mcbsp->dma_op_mode = i;
1607
1608 unlock:
1609 spin_unlock_irq(&mcbsp->lock);
1610
1611 return size;
1612 }
1613
1614 static DEVICE_ATTR(dma_op_mode, 0644, dma_op_mode_show, dma_op_mode_store);
1615
st_taps_show(struct device * dev,struct device_attribute * attr,char * buf)1616 static ssize_t st_taps_show(struct device *dev,
1617 struct device_attribute *attr, char *buf)
1618 {
1619 struct omap_mcbsp *mcbsp = dev_get_drvdata(dev);
1620 struct omap_mcbsp_st_data *st_data = mcbsp->st_data;
1621 ssize_t status = 0;
1622 int i;
1623
1624 spin_lock_irq(&mcbsp->lock);
1625 for (i = 0; i < st_data->nr_taps; i++)
1626 status += sprintf(&buf[status], (i ? ", %d" : "%d"),
1627 st_data->taps[i]);
1628 if (i)
1629 status += sprintf(&buf[status], "\n");
1630 spin_unlock_irq(&mcbsp->lock);
1631
1632 return status;
1633 }
1634
st_taps_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t size)1635 static ssize_t st_taps_store(struct device *dev,
1636 struct device_attribute *attr,
1637 const char *buf, size_t size)
1638 {
1639 struct omap_mcbsp *mcbsp = dev_get_drvdata(dev);
1640 struct omap_mcbsp_st_data *st_data = mcbsp->st_data;
1641 int val, tmp, status, i = 0;
1642
1643 spin_lock_irq(&mcbsp->lock);
1644 memset(st_data->taps, 0, sizeof(st_data->taps));
1645 st_data->nr_taps = 0;
1646
1647 do {
1648 status = sscanf(buf, "%d%n", &val, &tmp);
1649 if (status < 0 || status == 0) {
1650 size = -EINVAL;
1651 goto out;
1652 }
1653 if (val < -32768 || val > 32767) {
1654 size = -EINVAL;
1655 goto out;
1656 }
1657 st_data->taps[i++] = val;
1658 buf += tmp;
1659 if (*buf != ',')
1660 break;
1661 buf++;
1662 } while (1);
1663
1664 st_data->nr_taps = i;
1665
1666 out:
1667 spin_unlock_irq(&mcbsp->lock);
1668
1669 return size;
1670 }
1671
1672 static DEVICE_ATTR(st_taps, 0644, st_taps_show, st_taps_store);
1673
1674 static const struct attribute *additional_attrs[] = {
1675 &dev_attr_max_tx_thres.attr,
1676 &dev_attr_max_rx_thres.attr,
1677 &dev_attr_dma_op_mode.attr,
1678 NULL,
1679 };
1680
1681 static const struct attribute_group additional_attr_group = {
1682 .attrs = (struct attribute **)additional_attrs,
1683 };
1684
omap_additional_add(struct device * dev)1685 static inline int __devinit omap_additional_add(struct device *dev)
1686 {
1687 return sysfs_create_group(&dev->kobj, &additional_attr_group);
1688 }
1689
omap_additional_remove(struct device * dev)1690 static inline void __devexit omap_additional_remove(struct device *dev)
1691 {
1692 sysfs_remove_group(&dev->kobj, &additional_attr_group);
1693 }
1694
1695 static const struct attribute *sidetone_attrs[] = {
1696 &dev_attr_st_taps.attr,
1697 NULL,
1698 };
1699
1700 static const struct attribute_group sidetone_attr_group = {
1701 .attrs = (struct attribute **)sidetone_attrs,
1702 };
1703
omap_st_add(struct omap_mcbsp * mcbsp)1704 static int __devinit omap_st_add(struct omap_mcbsp *mcbsp)
1705 {
1706 struct platform_device *pdev;
1707 struct resource *res;
1708 struct omap_mcbsp_st_data *st_data;
1709 int err;
1710
1711 st_data = kzalloc(sizeof(*mcbsp->st_data), GFP_KERNEL);
1712 if (!st_data) {
1713 err = -ENOMEM;
1714 goto err1;
1715 }
1716
1717 pdev = container_of(mcbsp->dev, struct platform_device, dev);
1718
1719 res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "sidetone");
1720 st_data->io_base_st = ioremap(res->start, resource_size(res));
1721 if (!st_data->io_base_st) {
1722 err = -ENOMEM;
1723 goto err2;
1724 }
1725
1726 err = sysfs_create_group(&mcbsp->dev->kobj, &sidetone_attr_group);
1727 if (err)
1728 goto err3;
1729
1730 mcbsp->st_data = st_data;
1731 return 0;
1732
1733 err3:
1734 iounmap(st_data->io_base_st);
1735 err2:
1736 kfree(st_data);
1737 err1:
1738 return err;
1739
1740 }
1741
omap_st_remove(struct omap_mcbsp * mcbsp)1742 static void __devexit omap_st_remove(struct omap_mcbsp *mcbsp)
1743 {
1744 struct omap_mcbsp_st_data *st_data = mcbsp->st_data;
1745
1746 if (st_data) {
1747 sysfs_remove_group(&mcbsp->dev->kobj, &sidetone_attr_group);
1748 iounmap(st_data->io_base_st);
1749 kfree(st_data);
1750 }
1751 }
1752
omap34xx_device_init(struct omap_mcbsp * mcbsp)1753 static inline void __devinit omap34xx_device_init(struct omap_mcbsp *mcbsp)
1754 {
1755 mcbsp->dma_op_mode = MCBSP_DMA_MODE_ELEMENT;
1756 if (cpu_is_omap34xx()) {
1757 /*
1758 * Initially configure the maximum thresholds to a safe value.
1759 * The McBSP FIFO usage with these values should not go under
1760 * 16 locations.
1761 * If the whole FIFO without safety buffer is used, than there
1762 * is a possibility that the DMA will be not able to push the
1763 * new data on time, causing channel shifts in runtime.
1764 */
1765 mcbsp->max_tx_thres = max_thres(mcbsp) - 0x10;
1766 mcbsp->max_rx_thres = max_thres(mcbsp) - 0x10;
1767 /*
1768 * REVISIT: Set dmap_op_mode to THRESHOLD as default
1769 * for mcbsp2 instances.
1770 */
1771 if (omap_additional_add(mcbsp->dev))
1772 dev_warn(mcbsp->dev,
1773 "Unable to create additional controls\n");
1774
1775 if (mcbsp->id == 2 || mcbsp->id == 3)
1776 if (omap_st_add(mcbsp))
1777 dev_warn(mcbsp->dev,
1778 "Unable to create sidetone controls\n");
1779
1780 } else {
1781 mcbsp->max_tx_thres = -EINVAL;
1782 mcbsp->max_rx_thres = -EINVAL;
1783 }
1784 }
1785
omap34xx_device_exit(struct omap_mcbsp * mcbsp)1786 static inline void __devexit omap34xx_device_exit(struct omap_mcbsp *mcbsp)
1787 {
1788 if (cpu_is_omap34xx()) {
1789 omap_additional_remove(mcbsp->dev);
1790
1791 if (mcbsp->id == 2 || mcbsp->id == 3)
1792 omap_st_remove(mcbsp);
1793 }
1794 }
1795 #else
omap34xx_device_init(struct omap_mcbsp * mcbsp)1796 static inline void __devinit omap34xx_device_init(struct omap_mcbsp *mcbsp) {}
omap34xx_device_exit(struct omap_mcbsp * mcbsp)1797 static inline void __devexit omap34xx_device_exit(struct omap_mcbsp *mcbsp) {}
1798 #endif /* CONFIG_ARCH_OMAP3 */
1799
1800 /*
1801 * McBSP1 and McBSP3 are directly mapped on 1610 and 1510.
1802 * 730 has only 2 McBSP, and both of them are MPU peripherals.
1803 */
omap_mcbsp_probe(struct platform_device * pdev)1804 static int __devinit omap_mcbsp_probe(struct platform_device *pdev)
1805 {
1806 struct omap_mcbsp_platform_data *pdata = pdev->dev.platform_data;
1807 struct omap_mcbsp *mcbsp;
1808 int id = pdev->id - 1;
1809 struct resource *res;
1810 int ret = 0;
1811
1812 if (!pdata) {
1813 dev_err(&pdev->dev, "McBSP device initialized without"
1814 "platform data\n");
1815 ret = -EINVAL;
1816 goto exit;
1817 }
1818
1819 dev_dbg(&pdev->dev, "Initializing OMAP McBSP (%d).\n", pdev->id);
1820
1821 if (id >= omap_mcbsp_count) {
1822 dev_err(&pdev->dev, "Invalid McBSP device id (%d)\n", id);
1823 ret = -EINVAL;
1824 goto exit;
1825 }
1826
1827 mcbsp = kzalloc(sizeof(struct omap_mcbsp), GFP_KERNEL);
1828 if (!mcbsp) {
1829 ret = -ENOMEM;
1830 goto exit;
1831 }
1832
1833 spin_lock_init(&mcbsp->lock);
1834 mcbsp->id = id + 1;
1835 mcbsp->free = true;
1836 mcbsp->dma_tx_lch = -1;
1837 mcbsp->dma_rx_lch = -1;
1838
1839 res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mpu");
1840 if (!res) {
1841 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1842 if (!res) {
1843 dev_err(&pdev->dev, "%s:mcbsp%d has invalid memory"
1844 "resource\n", __func__, pdev->id);
1845 ret = -ENOMEM;
1846 goto exit;
1847 }
1848 }
1849 mcbsp->phys_base = res->start;
1850 omap_mcbsp_cache_size = resource_size(res);
1851 mcbsp->io_base = ioremap(res->start, resource_size(res));
1852 if (!mcbsp->io_base) {
1853 ret = -ENOMEM;
1854 goto err_ioremap;
1855 }
1856
1857 res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dma");
1858 if (!res)
1859 mcbsp->phys_dma_base = mcbsp->phys_base;
1860 else
1861 mcbsp->phys_dma_base = res->start;
1862
1863 /* Default I/O is IRQ based */
1864 mcbsp->io_type = OMAP_MCBSP_IRQ_IO;
1865
1866 mcbsp->tx_irq = platform_get_irq_byname(pdev, "tx");
1867 mcbsp->rx_irq = platform_get_irq_byname(pdev, "rx");
1868
1869 /* From OMAP4 there will be a single irq line */
1870 if (mcbsp->tx_irq == -ENXIO)
1871 mcbsp->tx_irq = platform_get_irq(pdev, 0);
1872
1873 res = platform_get_resource_byname(pdev, IORESOURCE_DMA, "rx");
1874 if (!res) {
1875 dev_err(&pdev->dev, "%s:mcbsp%d has invalid rx DMA channel\n",
1876 __func__, pdev->id);
1877 ret = -ENODEV;
1878 goto err_res;
1879 }
1880 mcbsp->dma_rx_sync = res->start;
1881
1882 res = platform_get_resource_byname(pdev, IORESOURCE_DMA, "tx");
1883 if (!res) {
1884 dev_err(&pdev->dev, "%s:mcbsp%d has invalid tx DMA channel\n",
1885 __func__, pdev->id);
1886 ret = -ENODEV;
1887 goto err_res;
1888 }
1889 mcbsp->dma_tx_sync = res->start;
1890
1891 mcbsp->fclk = clk_get(&pdev->dev, "fck");
1892 if (IS_ERR(mcbsp->fclk)) {
1893 ret = PTR_ERR(mcbsp->fclk);
1894 dev_err(&pdev->dev, "unable to get fck: %d\n", ret);
1895 goto err_res;
1896 }
1897
1898 mcbsp->pdata = pdata;
1899 mcbsp->dev = &pdev->dev;
1900 mcbsp_ptr[id] = mcbsp;
1901 mcbsp->mcbsp_config_type = pdata->mcbsp_config_type;
1902 platform_set_drvdata(pdev, mcbsp);
1903 pm_runtime_enable(mcbsp->dev);
1904
1905 /* Initialize mcbsp properties for OMAP34XX if needed / applicable */
1906 omap34xx_device_init(mcbsp);
1907
1908 return 0;
1909
1910 err_res:
1911 iounmap(mcbsp->io_base);
1912 err_ioremap:
1913 kfree(mcbsp);
1914 exit:
1915 return ret;
1916 }
1917
omap_mcbsp_remove(struct platform_device * pdev)1918 static int __devexit omap_mcbsp_remove(struct platform_device *pdev)
1919 {
1920 struct omap_mcbsp *mcbsp = platform_get_drvdata(pdev);
1921
1922 platform_set_drvdata(pdev, NULL);
1923 if (mcbsp) {
1924
1925 if (mcbsp->pdata && mcbsp->pdata->ops &&
1926 mcbsp->pdata->ops->free)
1927 mcbsp->pdata->ops->free(mcbsp->id);
1928
1929 omap34xx_device_exit(mcbsp);
1930
1931 clk_put(mcbsp->fclk);
1932
1933 iounmap(mcbsp->io_base);
1934 kfree(mcbsp);
1935 }
1936
1937 return 0;
1938 }
1939
1940 static struct platform_driver omap_mcbsp_driver = {
1941 .probe = omap_mcbsp_probe,
1942 .remove = __devexit_p(omap_mcbsp_remove),
1943 .driver = {
1944 .name = "omap-mcbsp",
1945 },
1946 };
1947
omap_mcbsp_init(void)1948 int __init omap_mcbsp_init(void)
1949 {
1950 /* Register the McBSP driver */
1951 return platform_driver_register(&omap_mcbsp_driver);
1952 }
1953