• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * sound/oss/dmabuf.c
3  *
4  * The DMA buffer manager for digitized voice applications
5  */
6 /*
7  * Copyright (C) by Hannu Savolainen 1993-1997
8  *
9  * OSS/Free for Linux is distributed under the GNU GENERAL PUBLIC LICENSE (GPL)
10  * Version 2 (June 1991). See the "COPYING" file distributed with this software
11  * for more info.
12  *
13  * Thomas Sailer   : moved several static variables into struct audio_operations
14  *                   (which is grossly misnamed btw.) because they have the same
15  *                   lifetime as the rest in there and dynamic allocation saves
16  *                   12k or so
17  * Thomas Sailer   : remove {in,out}_sleep_flag. It was used for the sleeper to
18  *                   determine if it was woken up by the expiring timeout or by
19  *                   an explicit wake_up. The return value from schedule_timeout
20  *		     can be used instead; if 0, the wakeup was due to the timeout.
21  *
22  * Rob Riggs		Added persistent DMA buffers (1998/10/17)
23  */
24 
25 #define BE_CONSERVATIVE
26 #define SAMPLE_ROUNDUP 0
27 
28 #include <linux/mm.h>
29 #include "sound_config.h"
30 
31 #define DMAP_FREE_ON_CLOSE      0
32 #define DMAP_KEEP_ON_CLOSE      1
33 extern int sound_dmap_flag;
34 
35 static void dma_reset_output(int dev);
36 static void dma_reset_input(int dev);
37 static int local_start_dma(struct audio_operations *adev, unsigned long physaddr, int count, int dma_mode);
38 
39 
40 
41 static int debugmem;    	/* switched off by default */
42 static int dma_buffsize = DSP_BUFFSIZE;
43 
dmabuf_timeout(struct dma_buffparms * dmap)44 static long dmabuf_timeout(struct dma_buffparms *dmap)
45 {
46 	long tmout;
47 
48 	tmout = (dmap->fragment_size * HZ) / dmap->data_rate;
49 	tmout += HZ / 5;	/* Some safety distance */
50 	if (tmout < (HZ / 2))
51 		tmout = HZ / 2;
52 	if (tmout > 20 * HZ)
53 		tmout = 20 * HZ;
54 	return tmout;
55 }
56 
sound_alloc_dmap(struct dma_buffparms * dmap)57 static int sound_alloc_dmap(struct dma_buffparms *dmap)
58 {
59 	char *start_addr, *end_addr;
60 	int dma_pagesize;
61 	int sz, size;
62 	struct page *page;
63 
64 	dmap->mapping_flags &= ~DMA_MAP_MAPPED;
65 
66 	if (dmap->raw_buf != NULL)
67 		return 0;	/* Already done */
68 	if (dma_buffsize < 4096)
69 		dma_buffsize = 4096;
70 	dma_pagesize = (dmap->dma < 4) ? (64 * 1024) : (128 * 1024);
71 
72 	/*
73 	 *	Now check for the Cyrix problem.
74 	 */
75 
76 	if(isa_dma_bridge_buggy==2)
77 		dma_pagesize=32768;
78 
79 	dmap->raw_buf = NULL;
80 	dmap->buffsize = dma_buffsize;
81 	if (dmap->buffsize > dma_pagesize)
82 		dmap->buffsize = dma_pagesize;
83 	start_addr = NULL;
84 	/*
85 	 * Now loop until we get a free buffer. Try to get smaller buffer if
86 	 * it fails. Don't accept smaller than 8k buffer for performance
87 	 * reasons.
88 	 */
89 	while (start_addr == NULL && dmap->buffsize > PAGE_SIZE) {
90 		for (sz = 0, size = PAGE_SIZE; size < dmap->buffsize; sz++, size <<= 1);
91 		dmap->buffsize = PAGE_SIZE * (1 << sz);
92 		start_addr = (char *) __get_free_pages(GFP_ATOMIC|GFP_DMA|__GFP_NOWARN, sz);
93 		if (start_addr == NULL)
94 			dmap->buffsize /= 2;
95 	}
96 
97 	if (start_addr == NULL) {
98 		printk(KERN_WARNING "Sound error: Couldn't allocate DMA buffer\n");
99 		return -ENOMEM;
100 	} else {
101 		/* make some checks */
102 		end_addr = start_addr + dmap->buffsize - 1;
103 
104 		if (debugmem)
105 			printk(KERN_DEBUG "sound: start 0x%lx, end 0x%lx\n", (long) start_addr, (long) end_addr);
106 
107 		/* now check if it fits into the same dma-pagesize */
108 
109 		if (((long) start_addr & ~(dma_pagesize - 1)) != ((long) end_addr & ~(dma_pagesize - 1))
110 		    || end_addr >= (char *) (MAX_DMA_ADDRESS)) {
111 			printk(KERN_ERR "sound: Got invalid address 0x%lx for %db DMA-buffer\n", (long) start_addr, dmap->buffsize);
112 			return -EFAULT;
113 		}
114 	}
115 	dmap->raw_buf = start_addr;
116 	dmap->raw_buf_phys = virt_to_bus(start_addr);
117 
118 	for (page = virt_to_page(start_addr); page <= virt_to_page(end_addr); page++)
119 		SetPageReserved(page);
120 	return 0;
121 }
122 
sound_free_dmap(struct dma_buffparms * dmap)123 static void sound_free_dmap(struct dma_buffparms *dmap)
124 {
125 	int sz, size;
126 	struct page *page;
127 	unsigned long start_addr, end_addr;
128 
129 	if (dmap->raw_buf == NULL)
130 		return;
131 	if (dmap->mapping_flags & DMA_MAP_MAPPED)
132 		return;		/* Don't free mmapped buffer. Will use it next time */
133 	for (sz = 0, size = PAGE_SIZE; size < dmap->buffsize; sz++, size <<= 1);
134 
135 	start_addr = (unsigned long) dmap->raw_buf;
136 	end_addr = start_addr + dmap->buffsize;
137 
138 	for (page = virt_to_page(start_addr); page <= virt_to_page(end_addr); page++)
139 		ClearPageReserved(page);
140 
141 	free_pages((unsigned long) dmap->raw_buf, sz);
142 	dmap->raw_buf = NULL;
143 }
144 
145 
146 /* Intel version !!!!!!!!! */
147 
sound_start_dma(struct dma_buffparms * dmap,unsigned long physaddr,int count,int dma_mode)148 static int sound_start_dma(struct dma_buffparms *dmap, unsigned long physaddr, int count, int dma_mode)
149 {
150 	unsigned long flags;
151 	int chan = dmap->dma;
152 
153 	/* printk( "Start DMA%d %d, %d\n",  chan,  (int)(physaddr-dmap->raw_buf_phys),  count); */
154 
155 	flags = claim_dma_lock();
156 	disable_dma(chan);
157 	clear_dma_ff(chan);
158 	set_dma_mode(chan, dma_mode);
159 	set_dma_addr(chan, physaddr);
160 	set_dma_count(chan, count);
161 	enable_dma(chan);
162 	release_dma_lock(flags);
163 
164 	return 0;
165 }
166 
dma_init_buffers(struct dma_buffparms * dmap)167 static void dma_init_buffers(struct dma_buffparms *dmap)
168 {
169 	dmap->qlen = dmap->qhead = dmap->qtail = dmap->user_counter = 0;
170 	dmap->byte_counter = 0;
171 	dmap->max_byte_counter = 8000 * 60 * 60;
172 	dmap->bytes_in_use = dmap->buffsize;
173 
174 	dmap->dma_mode = DMODE_NONE;
175 	dmap->mapping_flags = 0;
176 	dmap->neutral_byte = 0x80;
177 	dmap->data_rate = 8000;
178 	dmap->cfrag = -1;
179 	dmap->closing = 0;
180 	dmap->nbufs = 1;
181 	dmap->flags = DMA_BUSY;	/* Other flags off */
182 }
183 
open_dmap(struct audio_operations * adev,int mode,struct dma_buffparms * dmap)184 static int open_dmap(struct audio_operations *adev, int mode, struct dma_buffparms *dmap)
185 {
186 	int err;
187 
188 	if (dmap->flags & DMA_BUSY)
189 		return -EBUSY;
190 	if ((err = sound_alloc_dmap(dmap)) < 0)
191 		return err;
192 
193 	if (dmap->raw_buf == NULL) {
194 		printk(KERN_WARNING "Sound: DMA buffers not available\n");
195 		return -ENOSPC;	/* Memory allocation failed during boot */
196 	}
197 	if (dmap->dma >= 0 && sound_open_dma(dmap->dma, adev->name)) {
198 		printk(KERN_WARNING "Unable to grab(2) DMA%d for the audio driver\n", dmap->dma);
199 		return -EBUSY;
200 	}
201 	dma_init_buffers(dmap);
202 	spin_lock_init(&dmap->lock);
203 	dmap->open_mode = mode;
204 	dmap->subdivision = dmap->underrun_count = 0;
205 	dmap->fragment_size = 0;
206 	dmap->max_fragments = 65536;	/* Just a large value */
207 	dmap->byte_counter = 0;
208 	dmap->max_byte_counter = 8000 * 60 * 60;
209 	dmap->applic_profile = APF_NORMAL;
210 	dmap->needs_reorg = 1;
211 	dmap->audio_callback = NULL;
212 	dmap->callback_parm = 0;
213 	return 0;
214 }
215 
close_dmap(struct audio_operations * adev,struct dma_buffparms * dmap)216 static void close_dmap(struct audio_operations *adev, struct dma_buffparms *dmap)
217 {
218 	unsigned long flags;
219 
220 	if (dmap->dma >= 0) {
221 		sound_close_dma(dmap->dma);
222 		flags=claim_dma_lock();
223 		disable_dma(dmap->dma);
224 		release_dma_lock(flags);
225 	}
226 	if (dmap->flags & DMA_BUSY)
227 		dmap->dma_mode = DMODE_NONE;
228 	dmap->flags &= ~DMA_BUSY;
229 
230 	if (sound_dmap_flag == DMAP_FREE_ON_CLOSE)
231 		sound_free_dmap(dmap);
232 }
233 
234 
default_set_bits(int dev,unsigned int bits)235 static unsigned int default_set_bits(int dev, unsigned int bits)
236 {
237 	mm_segment_t fs = get_fs();
238 
239 	set_fs(get_ds());
240 	audio_devs[dev]->d->ioctl(dev, SNDCTL_DSP_SETFMT, (void __user *)&bits);
241 	set_fs(fs);
242 	return bits;
243 }
244 
default_set_speed(int dev,int speed)245 static int default_set_speed(int dev, int speed)
246 {
247 	mm_segment_t fs = get_fs();
248 
249 	set_fs(get_ds());
250 	audio_devs[dev]->d->ioctl(dev, SNDCTL_DSP_SPEED, (void __user *)&speed);
251 	set_fs(fs);
252 	return speed;
253 }
254 
default_set_channels(int dev,short channels)255 static short default_set_channels(int dev, short channels)
256 {
257 	int c = channels;
258 	mm_segment_t fs = get_fs();
259 
260 	set_fs(get_ds());
261 	audio_devs[dev]->d->ioctl(dev, SNDCTL_DSP_CHANNELS, (void __user *)&c);
262 	set_fs(fs);
263 	return c;
264 }
265 
check_driver(struct audio_driver * d)266 static void check_driver(struct audio_driver *d)
267 {
268 	if (d->set_speed == NULL)
269 		d->set_speed = default_set_speed;
270 	if (d->set_bits == NULL)
271 		d->set_bits = default_set_bits;
272 	if (d->set_channels == NULL)
273 		d->set_channels = default_set_channels;
274 }
275 
DMAbuf_open(int dev,int mode)276 int DMAbuf_open(int dev, int mode)
277 {
278 	struct audio_operations *adev = audio_devs[dev];
279 	int retval;
280 	struct dma_buffparms *dmap_in = NULL;
281 	struct dma_buffparms *dmap_out = NULL;
282 
283 	if (!adev)
284 		  return -ENXIO;
285 	if (!(adev->flags & DMA_DUPLEX))
286 		adev->dmap_in = adev->dmap_out;
287 	check_driver(adev->d);
288 
289 	if ((retval = adev->d->open(dev, mode)) < 0)
290 		return retval;
291 	dmap_out = adev->dmap_out;
292 	dmap_in = adev->dmap_in;
293 	if (dmap_in == dmap_out)
294 		adev->flags &= ~DMA_DUPLEX;
295 
296 	if (mode & OPEN_WRITE) {
297 		if ((retval = open_dmap(adev, mode, dmap_out)) < 0) {
298 			adev->d->close(dev);
299 			return retval;
300 		}
301 	}
302 	adev->enable_bits = mode;
303 
304 	if (mode == OPEN_READ || (mode != OPEN_WRITE && (adev->flags & DMA_DUPLEX))) {
305 		if ((retval = open_dmap(adev, mode, dmap_in)) < 0) {
306 			adev->d->close(dev);
307 			if (mode & OPEN_WRITE)
308 				close_dmap(adev, dmap_out);
309 			return retval;
310 		}
311 	}
312 	adev->open_mode = mode;
313 	adev->go = 1;
314 
315 	adev->d->set_bits(dev, 8);
316 	adev->d->set_channels(dev, 1);
317 	adev->d->set_speed(dev, DSP_DEFAULT_SPEED);
318 	if (adev->dmap_out->dma_mode == DMODE_OUTPUT)
319 		memset(adev->dmap_out->raw_buf, adev->dmap_out->neutral_byte,
320 		       adev->dmap_out->bytes_in_use);
321 	return 0;
322 }
323 /* MUST not hold the spinlock */
DMAbuf_reset(int dev)324 void DMAbuf_reset(int dev)
325 {
326 	if (audio_devs[dev]->open_mode & OPEN_WRITE)
327 		dma_reset_output(dev);
328 
329 	if (audio_devs[dev]->open_mode & OPEN_READ)
330 		dma_reset_input(dev);
331 }
332 
dma_reset_output(int dev)333 static void dma_reset_output(int dev)
334 {
335 	struct audio_operations *adev = audio_devs[dev];
336 	unsigned long flags,f ;
337 	struct dma_buffparms *dmap = adev->dmap_out;
338 
339 	if (!(dmap->flags & DMA_STARTED))	/* DMA is not active */
340 		return;
341 
342 	/*
343 	 *	First wait until the current fragment has been played completely
344 	 */
345 	spin_lock_irqsave(&dmap->lock,flags);
346 	adev->dmap_out->flags |= DMA_SYNCING;
347 
348 	adev->dmap_out->underrun_count = 0;
349 	if (!signal_pending(current) && adev->dmap_out->qlen &&
350 	    adev->dmap_out->underrun_count == 0){
351 		spin_unlock_irqrestore(&dmap->lock,flags);
352 		interruptible_sleep_on_timeout(&adev->out_sleeper,
353 					       dmabuf_timeout(dmap));
354 		spin_lock_irqsave(&dmap->lock,flags);
355 	}
356 	adev->dmap_out->flags &= ~(DMA_SYNCING | DMA_ACTIVE);
357 
358 	/*
359 	 *	Finally shut the device off
360 	 */
361 	if (!(adev->flags & DMA_DUPLEX) || !adev->d->halt_output)
362 		adev->d->halt_io(dev);
363 	else
364 		adev->d->halt_output(dev);
365 	adev->dmap_out->flags &= ~DMA_STARTED;
366 
367 	f=claim_dma_lock();
368 	clear_dma_ff(dmap->dma);
369 	disable_dma(dmap->dma);
370 	release_dma_lock(f);
371 
372 	dmap->byte_counter = 0;
373 	reorganize_buffers(dev, adev->dmap_out, 0);
374 	dmap->qlen = dmap->qhead = dmap->qtail = dmap->user_counter = 0;
375 	spin_unlock_irqrestore(&dmap->lock,flags);
376 }
377 
dma_reset_input(int dev)378 static void dma_reset_input(int dev)
379 {
380         struct audio_operations *adev = audio_devs[dev];
381 	unsigned long flags;
382 	struct dma_buffparms *dmap = adev->dmap_in;
383 
384 	spin_lock_irqsave(&dmap->lock,flags);
385 	if (!(adev->flags & DMA_DUPLEX) || !adev->d->halt_input)
386 		adev->d->halt_io(dev);
387 	else
388 		adev->d->halt_input(dev);
389 	adev->dmap_in->flags &= ~DMA_STARTED;
390 
391 	dmap->qlen = dmap->qhead = dmap->qtail = dmap->user_counter = 0;
392 	dmap->byte_counter = 0;
393 	reorganize_buffers(dev, adev->dmap_in, 1);
394 	spin_unlock_irqrestore(&dmap->lock,flags);
395 }
396 /* MUST be called with holding the dmap->lock */
DMAbuf_launch_output(int dev,struct dma_buffparms * dmap)397 void DMAbuf_launch_output(int dev, struct dma_buffparms *dmap)
398 {
399 	struct audio_operations *adev = audio_devs[dev];
400 
401 	if (!((adev->enable_bits * adev->go) & PCM_ENABLE_OUTPUT))
402 		return;		/* Don't start DMA yet */
403 	dmap->dma_mode = DMODE_OUTPUT;
404 
405 	if (!(dmap->flags & DMA_ACTIVE) || !(adev->flags & DMA_AUTOMODE) || (dmap->flags & DMA_NODMA)) {
406 		if (!(dmap->flags & DMA_STARTED)) {
407 			reorganize_buffers(dev, dmap, 0);
408 			if (adev->d->prepare_for_output(dev, dmap->fragment_size, dmap->nbufs))
409 				return;
410 			if (!(dmap->flags & DMA_NODMA))
411 				local_start_dma(adev, dmap->raw_buf_phys, dmap->bytes_in_use,DMA_MODE_WRITE);
412 			dmap->flags |= DMA_STARTED;
413 		}
414 		if (dmap->counts[dmap->qhead] == 0)
415 			dmap->counts[dmap->qhead] = dmap->fragment_size;
416 		dmap->dma_mode = DMODE_OUTPUT;
417 		adev->d->output_block(dev, dmap->raw_buf_phys + dmap->qhead * dmap->fragment_size,
418 				      dmap->counts[dmap->qhead], 1);
419 		if (adev->d->trigger)
420 			adev->d->trigger(dev,adev->enable_bits * adev->go);
421 	}
422 	dmap->flags |= DMA_ACTIVE;
423 }
424 
DMAbuf_sync(int dev)425 int DMAbuf_sync(int dev)
426 {
427 	struct audio_operations *adev = audio_devs[dev];
428 	unsigned long flags;
429 	int n = 0;
430 	struct dma_buffparms *dmap;
431 
432 	if (!adev->go && !(adev->enable_bits & PCM_ENABLE_OUTPUT))
433 		return 0;
434 
435 	if (adev->dmap_out->dma_mode == DMODE_OUTPUT) {
436 		dmap = adev->dmap_out;
437 		spin_lock_irqsave(&dmap->lock,flags);
438 		if (dmap->qlen > 0 && !(dmap->flags & DMA_ACTIVE))
439 			DMAbuf_launch_output(dev, dmap);
440 		adev->dmap_out->flags |= DMA_SYNCING;
441 		adev->dmap_out->underrun_count = 0;
442 		while (!signal_pending(current) && n++ <= adev->dmap_out->nbufs &&
443 		       adev->dmap_out->qlen && adev->dmap_out->underrun_count == 0) {
444 			long t = dmabuf_timeout(dmap);
445 			spin_unlock_irqrestore(&dmap->lock,flags);
446 			/* FIXME: not safe may miss events */
447 			t = interruptible_sleep_on_timeout(&adev->out_sleeper, t);
448 			spin_lock_irqsave(&dmap->lock,flags);
449 			if (!t) {
450 				adev->dmap_out->flags &= ~DMA_SYNCING;
451 				spin_unlock_irqrestore(&dmap->lock,flags);
452 				return adev->dmap_out->qlen;
453 			}
454 		}
455 		adev->dmap_out->flags &= ~(DMA_SYNCING | DMA_ACTIVE);
456 
457 		/*
458 		 * Some devices such as GUS have huge amount of on board RAM for the
459 		 * audio data. We have to wait until the device has finished playing.
460 		 */
461 
462 		/* still holding the lock */
463 		if (adev->d->local_qlen) {   /* Device has hidden buffers */
464 			while (!signal_pending(current) &&
465 			       adev->d->local_qlen(dev)){
466 				spin_unlock_irqrestore(&dmap->lock,flags);
467 				interruptible_sleep_on_timeout(&adev->out_sleeper,
468 							       dmabuf_timeout(dmap));
469 				spin_lock_irqsave(&dmap->lock,flags);
470 			}
471 		}
472 		spin_unlock_irqrestore(&dmap->lock,flags);
473 	}
474 	adev->dmap_out->dma_mode = DMODE_NONE;
475 	return adev->dmap_out->qlen;
476 }
477 
DMAbuf_release(int dev,int mode)478 int DMAbuf_release(int dev, int mode)
479 {
480 	struct audio_operations *adev = audio_devs[dev];
481 	struct dma_buffparms *dmap;
482 	unsigned long flags;
483 
484 	dmap = adev->dmap_out;
485 	if (adev->open_mode & OPEN_WRITE)
486 		adev->dmap_out->closing = 1;
487 
488 	if (adev->open_mode & OPEN_READ){
489 		adev->dmap_in->closing = 1;
490 		dmap = adev->dmap_in;
491 	}
492 	if (adev->open_mode & OPEN_WRITE)
493 		if (!(adev->dmap_out->mapping_flags & DMA_MAP_MAPPED))
494 			if (!signal_pending(current) && (adev->dmap_out->dma_mode == DMODE_OUTPUT))
495 				DMAbuf_sync(dev);
496 	if (adev->dmap_out->dma_mode == DMODE_OUTPUT)
497 		memset(adev->dmap_out->raw_buf, adev->dmap_out->neutral_byte, adev->dmap_out->bytes_in_use);
498 
499 	DMAbuf_reset(dev);
500 	spin_lock_irqsave(&dmap->lock,flags);
501 	adev->d->close(dev);
502 
503 	if (adev->open_mode & OPEN_WRITE)
504 		close_dmap(adev, adev->dmap_out);
505 
506 	if (adev->open_mode == OPEN_READ ||
507 	    (adev->open_mode != OPEN_WRITE &&
508 	     (adev->flags & DMA_DUPLEX)))
509 		close_dmap(adev, adev->dmap_in);
510 	adev->open_mode = 0;
511 	spin_unlock_irqrestore(&dmap->lock,flags);
512 	return 0;
513 }
514 /* called with dmap->lock dold */
DMAbuf_activate_recording(int dev,struct dma_buffparms * dmap)515 int DMAbuf_activate_recording(int dev, struct dma_buffparms *dmap)
516 {
517 	struct audio_operations *adev = audio_devs[dev];
518 	int  err;
519 
520 	if (!(adev->open_mode & OPEN_READ))
521 		return 0;
522 	if (!(adev->enable_bits & PCM_ENABLE_INPUT))
523 		return 0;
524 	if (dmap->dma_mode == DMODE_OUTPUT) {	/* Direction change */
525 		/* release lock - it's not recursive */
526 		spin_unlock_irq(&dmap->lock);
527 		DMAbuf_sync(dev);
528 		DMAbuf_reset(dev);
529 		spin_lock_irq(&dmap->lock);
530 		dmap->dma_mode = DMODE_NONE;
531 	}
532 	if (!dmap->dma_mode) {
533 		reorganize_buffers(dev, dmap, 1);
534 		if ((err = adev->d->prepare_for_input(dev,
535 				dmap->fragment_size, dmap->nbufs)) < 0)
536 			return err;
537 		dmap->dma_mode = DMODE_INPUT;
538 	}
539 	if (!(dmap->flags & DMA_ACTIVE)) {
540 		if (dmap->needs_reorg)
541 			reorganize_buffers(dev, dmap, 0);
542 		local_start_dma(adev, dmap->raw_buf_phys, dmap->bytes_in_use, DMA_MODE_READ);
543 		adev->d->start_input(dev, dmap->raw_buf_phys + dmap->qtail * dmap->fragment_size,
544 				     dmap->fragment_size, 0);
545 		dmap->flags |= DMA_ACTIVE;
546 		if (adev->d->trigger)
547 			adev->d->trigger(dev, adev->enable_bits * adev->go);
548 	}
549 	return 0;
550 }
551 /* acquires lock */
DMAbuf_getrdbuffer(int dev,char ** buf,int * len,int dontblock)552 int DMAbuf_getrdbuffer(int dev, char **buf, int *len, int dontblock)
553 {
554 	struct audio_operations *adev = audio_devs[dev];
555 	unsigned long flags;
556 	int err = 0, n = 0;
557 	struct dma_buffparms *dmap = adev->dmap_in;
558 	int go;
559 
560 	if (!(adev->open_mode & OPEN_READ))
561 		return -EIO;
562 	spin_lock_irqsave(&dmap->lock,flags);
563 	if (dmap->needs_reorg)
564 		reorganize_buffers(dev, dmap, 0);
565 	if (adev->dmap_in->mapping_flags & DMA_MAP_MAPPED) {
566 /*		  printk(KERN_WARNING "Sound: Can't read from mmapped device (1)\n");*/
567 		  spin_unlock_irqrestore(&dmap->lock,flags);
568 		  return -EINVAL;
569 	} else while (dmap->qlen <= 0 && n++ < 10) {
570 		long timeout = MAX_SCHEDULE_TIMEOUT;
571 		if (!(adev->enable_bits & PCM_ENABLE_INPUT) || !adev->go) {
572 			spin_unlock_irqrestore(&dmap->lock,flags);
573 			return -EAGAIN;
574 		}
575 		if ((err = DMAbuf_activate_recording(dev, dmap)) < 0) {
576 			spin_unlock_irqrestore(&dmap->lock,flags);
577 			return err;
578 		}
579 		/* Wait for the next block */
580 
581 		if (dontblock) {
582 			spin_unlock_irqrestore(&dmap->lock,flags);
583 			return -EAGAIN;
584 		}
585 		if ((go = adev->go))
586 			timeout = dmabuf_timeout(dmap);
587 
588 		spin_unlock_irqrestore(&dmap->lock,flags);
589 		timeout = interruptible_sleep_on_timeout(&adev->in_sleeper,
590 							 timeout);
591 		if (!timeout) {
592 			/* FIXME: include device name */
593 			err = -EIO;
594 			printk(KERN_WARNING "Sound: DMA (input) timed out - IRQ/DRQ config error?\n");
595 			dma_reset_input(dev);
596 		} else
597 			err = -EINTR;
598 		spin_lock_irqsave(&dmap->lock,flags);
599 	}
600 	spin_unlock_irqrestore(&dmap->lock,flags);
601 
602 	if (dmap->qlen <= 0)
603 		return err ? err : -EINTR;
604 	*buf = &dmap->raw_buf[dmap->qhead * dmap->fragment_size + dmap->counts[dmap->qhead]];
605 	*len = dmap->fragment_size - dmap->counts[dmap->qhead];
606 
607 	return dmap->qhead;
608 }
609 
DMAbuf_rmchars(int dev,int buff_no,int c)610 int DMAbuf_rmchars(int dev, int buff_no, int c)
611 {
612 	struct audio_operations *adev = audio_devs[dev];
613 	struct dma_buffparms *dmap = adev->dmap_in;
614 	int p = dmap->counts[dmap->qhead] + c;
615 
616 	if (dmap->mapping_flags & DMA_MAP_MAPPED)
617 	{
618 /*		  printk("Sound: Can't read from mmapped device (2)\n");*/
619 		return -EINVAL;
620 	}
621 	else if (dmap->qlen <= 0)
622 		return -EIO;
623 	else if (p >= dmap->fragment_size) {  /* This buffer is completely empty */
624 		dmap->counts[dmap->qhead] = 0;
625 		dmap->qlen--;
626 		dmap->qhead = (dmap->qhead + 1) % dmap->nbufs;
627 	}
628 	else dmap->counts[dmap->qhead] = p;
629 
630 	return 0;
631 }
632 /* MUST be called with dmap->lock hold */
DMAbuf_get_buffer_pointer(int dev,struct dma_buffparms * dmap,int direction)633 int DMAbuf_get_buffer_pointer(int dev, struct dma_buffparms *dmap, int direction)
634 {
635 	/*
636 	 *	Try to approximate the active byte position of the DMA pointer within the
637 	 *	buffer area as well as possible.
638 	 */
639 
640 	int pos;
641 	unsigned long f;
642 
643 	if (!(dmap->flags & DMA_ACTIVE))
644 		pos = 0;
645 	else {
646 		int chan = dmap->dma;
647 
648 		f=claim_dma_lock();
649 		clear_dma_ff(chan);
650 
651 		if(!isa_dma_bridge_buggy)
652 			disable_dma(dmap->dma);
653 
654 		pos = get_dma_residue(chan);
655 
656 		pos = dmap->bytes_in_use - pos;
657 
658 		if (!(dmap->mapping_flags & DMA_MAP_MAPPED)) {
659 			if (direction == DMODE_OUTPUT) {
660 				if (dmap->qhead == 0)
661 					if (pos > dmap->fragment_size)
662 						pos = 0;
663 			} else {
664 				if (dmap->qtail == 0)
665 					if (pos > dmap->fragment_size)
666 						pos = 0;
667 			}
668 		}
669 		if (pos < 0)
670 			pos = 0;
671 		if (pos >= dmap->bytes_in_use)
672 			pos = 0;
673 
674 		if(!isa_dma_bridge_buggy)
675 			enable_dma(dmap->dma);
676 
677 		release_dma_lock(f);
678 	}
679 	/* printk( "%04x ",  pos); */
680 
681 	return pos;
682 }
683 
684 /*
685  *	DMAbuf_start_devices() is called by the /dev/music driver to start
686  *	one or more audio devices at desired moment.
687  */
688 
DMAbuf_start_devices(unsigned int devmask)689 void DMAbuf_start_devices(unsigned int devmask)
690 {
691 	struct audio_operations *adev;
692 	int dev;
693 
694 	for (dev = 0; dev < num_audiodevs; dev++) {
695 		if (!(devmask & (1 << dev)))
696 			continue;
697 		if (!(adev = audio_devs[dev]))
698 			continue;
699 		if (adev->open_mode == 0)
700 			continue;
701 		if (adev->go)
702 			continue;
703 		/* OK to start the device */
704 		adev->go = 1;
705 		if (adev->d->trigger)
706 			adev->d->trigger(dev,adev->enable_bits * adev->go);
707 	}
708 }
709 /* via poll called without a lock ?*/
DMAbuf_space_in_queue(int dev)710 int DMAbuf_space_in_queue(int dev)
711 {
712 	struct audio_operations *adev = audio_devs[dev];
713 	int len, max, tmp;
714 	struct dma_buffparms *dmap = adev->dmap_out;
715 	int lim = dmap->nbufs;
716 
717 	if (lim < 2)
718 		lim = 2;
719 
720 	if (dmap->qlen >= lim)	/* No space at all */
721 		return 0;
722 
723 	/*
724 	 *	Verify that there are no more pending buffers than the limit
725 	 *	defined by the process.
726 	 */
727 
728 	max = dmap->max_fragments;
729 	if (max > lim)
730 		max = lim;
731 	len = dmap->qlen;
732 
733 	if (adev->d->local_qlen) {
734 		tmp = adev->d->local_qlen(dev);
735 		if (tmp && len)
736 			tmp--;	/* This buffer has been counted twice */
737 		len += tmp;
738 	}
739 	if (dmap->byte_counter % dmap->fragment_size)	/* There is a partial fragment */
740 		len = len + 1;
741 
742 	if (len >= max)
743 		return 0;
744 	return max - len;
745 }
746 /* MUST not hold the spinlock  - this function may sleep */
output_sleep(int dev,int dontblock)747 static int output_sleep(int dev, int dontblock)
748 {
749 	struct audio_operations *adev = audio_devs[dev];
750 	int err = 0;
751 	struct dma_buffparms *dmap = adev->dmap_out;
752 	long timeout;
753 	long timeout_value;
754 
755 	if (dontblock)
756 		return -EAGAIN;
757 	if (!(adev->enable_bits & PCM_ENABLE_OUTPUT))
758 		return -EAGAIN;
759 
760 	/*
761 	 * Wait for free space
762 	 */
763 	if (signal_pending(current))
764 		return -EINTR;
765 	timeout = (adev->go && !(dmap->flags & DMA_NOTIMEOUT));
766 	if (timeout)
767 		timeout_value = dmabuf_timeout(dmap);
768 	else
769 		timeout_value = MAX_SCHEDULE_TIMEOUT;
770 	timeout_value = interruptible_sleep_on_timeout(&adev->out_sleeper,
771 						       timeout_value);
772 	if (timeout != MAX_SCHEDULE_TIMEOUT && !timeout_value) {
773 		printk(KERN_WARNING "Sound: DMA (output) timed out - IRQ/DRQ config error?\n");
774 		dma_reset_output(dev);
775 	} else {
776 		if (signal_pending(current))
777 			err = -EINTR;
778 	}
779 	return err;
780 }
781 /* called with the lock held */
find_output_space(int dev,char ** buf,int * size)782 static int find_output_space(int dev, char **buf, int *size)
783 {
784 	struct audio_operations *adev = audio_devs[dev];
785 	struct dma_buffparms *dmap = adev->dmap_out;
786 	unsigned long active_offs;
787 	long len, offs;
788 	int maxfrags;
789 	int occupied_bytes = (dmap->user_counter % dmap->fragment_size);
790 
791 	*buf = dmap->raw_buf;
792 	if (!(maxfrags = DMAbuf_space_in_queue(dev)) && !occupied_bytes)
793 		return 0;
794 
795 #ifdef BE_CONSERVATIVE
796 	active_offs = dmap->byte_counter + dmap->qhead * dmap->fragment_size;
797 #else
798 	active_offs = max(DMAbuf_get_buffer_pointer(dev, dmap, DMODE_OUTPUT), 0);
799 	/* Check for pointer wrapping situation */
800 	if (active_offs >= dmap->bytes_in_use)
801 		active_offs = 0;
802 	active_offs += dmap->byte_counter;
803 #endif
804 
805 	offs = (dmap->user_counter % dmap->bytes_in_use) & ~SAMPLE_ROUNDUP;
806 	if (offs < 0 || offs >= dmap->bytes_in_use) {
807 		printk(KERN_ERR "Sound: Got unexpected offs %ld. Giving up.\n", offs);
808 		printk("Counter = %ld, bytes=%d\n", dmap->user_counter, dmap->bytes_in_use);
809 		return 0;
810 	}
811 	*buf = dmap->raw_buf + offs;
812 
813 	len = active_offs + dmap->bytes_in_use - dmap->user_counter;	/* Number of unused bytes in buffer */
814 
815 	if ((offs + len) > dmap->bytes_in_use)
816 		len = dmap->bytes_in_use - offs;
817 	if (len < 0) {
818 		return 0;
819 	}
820 	if (len > ((maxfrags * dmap->fragment_size) - occupied_bytes))
821 		len = (maxfrags * dmap->fragment_size) - occupied_bytes;
822 	*size = len & ~SAMPLE_ROUNDUP;
823 	return (*size > 0);
824 }
825 /* acquires lock  */
DMAbuf_getwrbuffer(int dev,char ** buf,int * size,int dontblock)826 int DMAbuf_getwrbuffer(int dev, char **buf, int *size, int dontblock)
827 {
828 	struct audio_operations *adev = audio_devs[dev];
829 	unsigned long flags;
830 	int err = -EIO;
831 	struct dma_buffparms *dmap = adev->dmap_out;
832 
833 	if (dmap->mapping_flags & DMA_MAP_MAPPED) {
834 /*		printk(KERN_DEBUG "Sound: Can't write to mmapped device (3)\n");*/
835 		return -EINVAL;
836 	}
837 	spin_lock_irqsave(&dmap->lock,flags);
838 	if (dmap->needs_reorg)
839 		reorganize_buffers(dev, dmap, 0);
840 
841 	if (dmap->dma_mode == DMODE_INPUT) {	/* Direction change */
842 		spin_unlock_irqrestore(&dmap->lock,flags);
843 		DMAbuf_reset(dev);
844 		spin_lock_irqsave(&dmap->lock,flags);
845 	}
846 	dmap->dma_mode = DMODE_OUTPUT;
847 
848 	while (find_output_space(dev, buf, size) <= 0) {
849 		spin_unlock_irqrestore(&dmap->lock,flags);
850 		if ((err = output_sleep(dev, dontblock)) < 0) {
851 			return err;
852 		}
853 		spin_lock_irqsave(&dmap->lock,flags);
854 	}
855 
856 	spin_unlock_irqrestore(&dmap->lock,flags);
857 	return 0;
858 }
859 /* has to acquire dmap->lock */
DMAbuf_move_wrpointer(int dev,int l)860 int DMAbuf_move_wrpointer(int dev, int l)
861 {
862 	struct audio_operations *adev = audio_devs[dev];
863 	struct dma_buffparms *dmap = adev->dmap_out;
864 	unsigned long ptr;
865 	unsigned long end_ptr, p;
866 	int post;
867 	unsigned long flags;
868 
869 	spin_lock_irqsave(&dmap->lock,flags);
870 	post= (dmap->flags & DMA_POST);
871 	ptr = (dmap->user_counter / dmap->fragment_size) * dmap->fragment_size;
872 
873 	dmap->flags &= ~DMA_POST;
874 	dmap->cfrag = -1;
875 	dmap->user_counter += l;
876 	dmap->flags |= DMA_DIRTY;
877 
878 	if (dmap->byte_counter >= dmap->max_byte_counter) {
879 		/* Wrap the byte counters */
880 		long decr = dmap->byte_counter;
881 		dmap->byte_counter = (dmap->byte_counter % dmap->bytes_in_use);
882 		decr -= dmap->byte_counter;
883 		dmap->user_counter -= decr;
884 	}
885 	end_ptr = (dmap->user_counter / dmap->fragment_size) * dmap->fragment_size;
886 
887 	p = (dmap->user_counter - 1) % dmap->bytes_in_use;
888 	dmap->neutral_byte = dmap->raw_buf[p];
889 
890 	/* Update the fragment based bookkeeping too */
891 	while (ptr < end_ptr) {
892 		dmap->counts[dmap->qtail] = dmap->fragment_size;
893 		dmap->qtail = (dmap->qtail + 1) % dmap->nbufs;
894 		dmap->qlen++;
895 		ptr += dmap->fragment_size;
896 	}
897 
898 	dmap->counts[dmap->qtail] = dmap->user_counter - ptr;
899 
900 	/*
901 	 *	Let the low level driver perform some postprocessing to
902 	 *	the written data.
903 	 */
904 	if (adev->d->postprocess_write)
905 		adev->d->postprocess_write(dev);
906 
907 	if (!(dmap->flags & DMA_ACTIVE))
908 		if (dmap->qlen > 1 || (dmap->qlen > 0 && (post || dmap->qlen >= dmap->nbufs - 1)))
909 			DMAbuf_launch_output(dev, dmap);
910 
911 	spin_unlock_irqrestore(&dmap->lock,flags);
912 	return 0;
913 }
914 
DMAbuf_start_dma(int dev,unsigned long physaddr,int count,int dma_mode)915 int DMAbuf_start_dma(int dev, unsigned long physaddr, int count, int dma_mode)
916 {
917 	struct audio_operations *adev = audio_devs[dev];
918 	struct dma_buffparms *dmap = (dma_mode == DMA_MODE_WRITE) ? adev->dmap_out : adev->dmap_in;
919 
920 	if (dmap->raw_buf == NULL) {
921 		printk(KERN_ERR "sound: DMA buffer(1) == NULL\n");
922 		printk("Device %d, chn=%s\n", dev, (dmap == adev->dmap_out) ? "out" : "in");
923 		return 0;
924 	}
925 	if (dmap->dma < 0)
926 		return 0;
927 	sound_start_dma(dmap, physaddr, count, dma_mode);
928 	return count;
929 }
930 EXPORT_SYMBOL(DMAbuf_start_dma);
931 
local_start_dma(struct audio_operations * adev,unsigned long physaddr,int count,int dma_mode)932 static int local_start_dma(struct audio_operations *adev, unsigned long physaddr, int count, int dma_mode)
933 {
934 	struct dma_buffparms *dmap = (dma_mode == DMA_MODE_WRITE) ? adev->dmap_out : adev->dmap_in;
935 
936 	if (dmap->raw_buf == NULL) {
937 		printk(KERN_ERR "sound: DMA buffer(2) == NULL\n");
938 		printk(KERN_ERR "Device %s, chn=%s\n", adev->name, (dmap == adev->dmap_out) ? "out" : "in");
939 		return 0;
940 	}
941 	if (dmap->flags & DMA_NODMA)
942 		return 1;
943 	if (dmap->dma < 0)
944 		return 0;
945 	sound_start_dma(dmap, dmap->raw_buf_phys, dmap->bytes_in_use, dma_mode | DMA_AUTOINIT);
946 	dmap->flags |= DMA_STARTED;
947 	return count;
948 }
949 
finish_output_interrupt(int dev,struct dma_buffparms * dmap)950 static void finish_output_interrupt(int dev, struct dma_buffparms *dmap)
951 {
952 	struct audio_operations *adev = audio_devs[dev];
953 
954 	if (dmap->audio_callback != NULL)
955 		dmap->audio_callback(dev, dmap->callback_parm);
956 	wake_up(&adev->out_sleeper);
957 	wake_up(&adev->poll_sleeper);
958 }
959 /* called with dmap->lock held in irq context*/
do_outputintr(int dev,int dummy)960 static void do_outputintr(int dev, int dummy)
961 {
962 	struct audio_operations *adev = audio_devs[dev];
963 	struct dma_buffparms *dmap = adev->dmap_out;
964 	int this_fragment;
965 
966 	if (dmap->raw_buf == NULL) {
967 		printk(KERN_ERR "Sound: Error. Audio interrupt (%d) after freeing buffers.\n", dev);
968 		return;
969 	}
970 	if (dmap->mapping_flags & DMA_MAP_MAPPED) {	/* Virtual memory mapped access */
971 		/* mmapped access */
972 		dmap->qhead = (dmap->qhead + 1) % dmap->nbufs;
973 		if (dmap->qhead == 0) {	    /* Wrapped */
974 			dmap->byte_counter += dmap->bytes_in_use;
975 			if (dmap->byte_counter >= dmap->max_byte_counter) {	/* Overflow */
976 				long decr = dmap->byte_counter;
977 				dmap->byte_counter = (dmap->byte_counter % dmap->bytes_in_use);
978 				decr -= dmap->byte_counter;
979 				dmap->user_counter -= decr;
980 			}
981 		}
982 		dmap->qlen++;	/* Yes increment it (don't decrement) */
983 		if (!(adev->flags & DMA_AUTOMODE))
984 			dmap->flags &= ~DMA_ACTIVE;
985 		dmap->counts[dmap->qhead] = dmap->fragment_size;
986 		DMAbuf_launch_output(dev, dmap);
987 		finish_output_interrupt(dev, dmap);
988 		return;
989 	}
990 
991 	dmap->qlen--;
992 	this_fragment = dmap->qhead;
993 	dmap->qhead = (dmap->qhead + 1) % dmap->nbufs;
994 
995 	if (dmap->qhead == 0) {	/* Wrapped */
996 		dmap->byte_counter += dmap->bytes_in_use;
997 		if (dmap->byte_counter >= dmap->max_byte_counter) {	/* Overflow */
998 			long decr = dmap->byte_counter;
999 			dmap->byte_counter = (dmap->byte_counter % dmap->bytes_in_use);
1000 			decr -= dmap->byte_counter;
1001 			dmap->user_counter -= decr;
1002 		}
1003 	}
1004 	if (!(adev->flags & DMA_AUTOMODE))
1005 		dmap->flags &= ~DMA_ACTIVE;
1006 
1007 	/*
1008 	 *	This is  dmap->qlen <= 0 except when closing when
1009 	 *	dmap->qlen < 0
1010 	 */
1011 
1012 	while (dmap->qlen <= -dmap->closing) {
1013 		dmap->underrun_count++;
1014 		dmap->qlen++;
1015 		if ((dmap->flags & DMA_DIRTY) && dmap->applic_profile != APF_CPUINTENS) {
1016 			dmap->flags &= ~DMA_DIRTY;
1017 			memset(adev->dmap_out->raw_buf, adev->dmap_out->neutral_byte,
1018 			       adev->dmap_out->buffsize);
1019 		}
1020 		dmap->user_counter += dmap->fragment_size;
1021 		dmap->qtail = (dmap->qtail + 1) % dmap->nbufs;
1022 	}
1023 	if (dmap->qlen > 0)
1024 		DMAbuf_launch_output(dev, dmap);
1025 	finish_output_interrupt(dev, dmap);
1026 }
1027 /* called in irq context */
DMAbuf_outputintr(int dev,int notify_only)1028 void DMAbuf_outputintr(int dev, int notify_only)
1029 {
1030 	struct audio_operations *adev = audio_devs[dev];
1031 	unsigned long flags;
1032 	struct dma_buffparms *dmap = adev->dmap_out;
1033 
1034 	spin_lock_irqsave(&dmap->lock,flags);
1035 	if (!(dmap->flags & DMA_NODMA)) {
1036 		int chan = dmap->dma, pos, n;
1037 		unsigned long f;
1038 
1039 		f=claim_dma_lock();
1040 
1041 		if(!isa_dma_bridge_buggy)
1042 			disable_dma(dmap->dma);
1043 		clear_dma_ff(chan);
1044 		pos = dmap->bytes_in_use - get_dma_residue(chan);
1045 		if(!isa_dma_bridge_buggy)
1046 			enable_dma(dmap->dma);
1047 		release_dma_lock(f);
1048 
1049 		pos = pos / dmap->fragment_size;	/* Actual qhead */
1050 		if (pos < 0 || pos >= dmap->nbufs)
1051 			pos = 0;
1052 		n = 0;
1053 		while (dmap->qhead != pos && n++ < dmap->nbufs)
1054 			do_outputintr(dev, notify_only);
1055 	}
1056 	else
1057 		do_outputintr(dev, notify_only);
1058 	spin_unlock_irqrestore(&dmap->lock,flags);
1059 }
1060 EXPORT_SYMBOL(DMAbuf_outputintr);
1061 
1062 /* called with dmap->lock held in irq context */
do_inputintr(int dev)1063 static void do_inputintr(int dev)
1064 {
1065 	struct audio_operations *adev = audio_devs[dev];
1066 	struct dma_buffparms *dmap = adev->dmap_in;
1067 
1068 	if (dmap->raw_buf == NULL) {
1069 		printk(KERN_ERR "Sound: Fatal error. Audio interrupt after freeing buffers.\n");
1070 		return;
1071 	}
1072 	if (dmap->mapping_flags & DMA_MAP_MAPPED) {
1073 		dmap->qtail = (dmap->qtail + 1) % dmap->nbufs;
1074 		if (dmap->qtail == 0) {		/* Wrapped */
1075 			dmap->byte_counter += dmap->bytes_in_use;
1076 			if (dmap->byte_counter >= dmap->max_byte_counter) {	/* Overflow */
1077 				long decr = dmap->byte_counter;
1078 				dmap->byte_counter = (dmap->byte_counter % dmap->bytes_in_use) + dmap->bytes_in_use;
1079 				decr -= dmap->byte_counter;
1080 				dmap->user_counter -= decr;
1081 			}
1082 		}
1083 		dmap->qlen++;
1084 
1085 		if (!(adev->flags & DMA_AUTOMODE)) {
1086 			if (dmap->needs_reorg)
1087 				reorganize_buffers(dev, dmap, 0);
1088 			local_start_dma(adev, dmap->raw_buf_phys, dmap->bytes_in_use,DMA_MODE_READ);
1089 			adev->d->start_input(dev, dmap->raw_buf_phys + dmap->qtail * dmap->fragment_size,
1090 					     dmap->fragment_size, 1);
1091 			if (adev->d->trigger)
1092 				adev->d->trigger(dev, adev->enable_bits * adev->go);
1093 		}
1094 		dmap->flags |= DMA_ACTIVE;
1095 	} else if (dmap->qlen >= (dmap->nbufs - 1)) {
1096 		printk(KERN_WARNING "Sound: Recording overrun\n");
1097 		dmap->underrun_count++;
1098 
1099 		/* Just throw away the oldest fragment but keep the engine running */
1100 		dmap->qhead = (dmap->qhead + 1) % dmap->nbufs;
1101 		dmap->qtail = (dmap->qtail + 1) % dmap->nbufs;
1102 	} else if (dmap->qlen >= 0 && dmap->qlen < dmap->nbufs) {
1103 		dmap->qlen++;
1104 		dmap->qtail = (dmap->qtail + 1) % dmap->nbufs;
1105 		if (dmap->qtail == 0) {		/* Wrapped */
1106 			dmap->byte_counter += dmap->bytes_in_use;
1107 			if (dmap->byte_counter >= dmap->max_byte_counter) {	/* Overflow */
1108 				long decr = dmap->byte_counter;
1109 				dmap->byte_counter = (dmap->byte_counter % dmap->bytes_in_use) + dmap->bytes_in_use;
1110 				decr -= dmap->byte_counter;
1111 				dmap->user_counter -= decr;
1112 			}
1113 		}
1114 	}
1115 	if (!(adev->flags & DMA_AUTOMODE) || (dmap->flags & DMA_NODMA)) {
1116 		local_start_dma(adev, dmap->raw_buf_phys, dmap->bytes_in_use, DMA_MODE_READ);
1117 		adev->d->start_input(dev, dmap->raw_buf_phys + dmap->qtail * dmap->fragment_size, dmap->fragment_size, 1);
1118 		if (adev->d->trigger)
1119 			adev->d->trigger(dev,adev->enable_bits * adev->go);
1120 	}
1121 	dmap->flags |= DMA_ACTIVE;
1122 	if (dmap->qlen > 0)
1123 	{
1124 		wake_up(&adev->in_sleeper);
1125 		wake_up(&adev->poll_sleeper);
1126 	}
1127 }
1128 /* called in irq context */
DMAbuf_inputintr(int dev)1129 void DMAbuf_inputintr(int dev)
1130 {
1131 	struct audio_operations *adev = audio_devs[dev];
1132 	struct dma_buffparms *dmap = adev->dmap_in;
1133 	unsigned long flags;
1134 
1135 	spin_lock_irqsave(&dmap->lock,flags);
1136 
1137 	if (!(dmap->flags & DMA_NODMA)) {
1138 		int chan = dmap->dma, pos, n;
1139 		unsigned long f;
1140 
1141 		f=claim_dma_lock();
1142 		if(!isa_dma_bridge_buggy)
1143 			disable_dma(dmap->dma);
1144 		clear_dma_ff(chan);
1145 		pos = dmap->bytes_in_use - get_dma_residue(chan);
1146 		if(!isa_dma_bridge_buggy)
1147 			enable_dma(dmap->dma);
1148 		release_dma_lock(f);
1149 
1150 		pos = pos / dmap->fragment_size;	/* Actual qhead */
1151 		if (pos < 0 || pos >= dmap->nbufs)
1152 			pos = 0;
1153 
1154 		n = 0;
1155 		while (dmap->qtail != pos && ++n < dmap->nbufs)
1156 			do_inputintr(dev);
1157 	} else
1158 		do_inputintr(dev);
1159 	spin_unlock_irqrestore(&dmap->lock,flags);
1160 }
1161 EXPORT_SYMBOL(DMAbuf_inputintr);
1162 
DMAbuf_init(int dev,int dma1,int dma2)1163 void DMAbuf_init(int dev, int dma1, int dma2)
1164 {
1165 	struct audio_operations *adev = audio_devs[dev];
1166 	/*
1167 	 * NOTE! This routine could be called several times.
1168 	 */
1169 
1170 	if (adev && adev->dmap_out == NULL) {
1171 		if (adev->d == NULL)
1172 			panic("OSS: audio_devs[%d]->d == NULL\n", dev);
1173 
1174 		if (adev->parent_dev) {	 /* Use DMA map of the parent dev */
1175 			int parent = adev->parent_dev - 1;
1176 			adev->dmap_out = audio_devs[parent]->dmap_out;
1177 			adev->dmap_in = audio_devs[parent]->dmap_in;
1178 		} else {
1179 			adev->dmap_out = adev->dmap_in = &adev->dmaps[0];
1180 			adev->dmap_out->dma = dma1;
1181 			if (adev->flags & DMA_DUPLEX) {
1182 				adev->dmap_in = &adev->dmaps[1];
1183 				adev->dmap_in->dma = dma2;
1184 			}
1185 		}
1186 		/* Persistent DMA buffers allocated here */
1187 		if (sound_dmap_flag == DMAP_KEEP_ON_CLOSE) {
1188 			if (adev->dmap_in->raw_buf == NULL)
1189 				sound_alloc_dmap(adev->dmap_in);
1190 			if (adev->dmap_out->raw_buf == NULL)
1191 				sound_alloc_dmap(adev->dmap_out);
1192 		}
1193 	}
1194 }
1195 
1196 /* No kernel lock - DMAbuf_activate_recording protected by global cli/sti */
poll_input(struct file * file,int dev,poll_table * wait)1197 static unsigned int poll_input(struct file * file, int dev, poll_table *wait)
1198 {
1199 	struct audio_operations *adev = audio_devs[dev];
1200 	struct dma_buffparms *dmap = adev->dmap_in;
1201 
1202 	if (!(adev->open_mode & OPEN_READ))
1203 		return 0;
1204 	if (dmap->mapping_flags & DMA_MAP_MAPPED) {
1205 		if (dmap->qlen)
1206 			return POLLIN | POLLRDNORM;
1207 		return 0;
1208 	}
1209 	if (dmap->dma_mode != DMODE_INPUT) {
1210 		if (dmap->dma_mode == DMODE_NONE &&
1211 		    adev->enable_bits & PCM_ENABLE_INPUT &&
1212 		    !dmap->qlen && adev->go) {
1213 			unsigned long flags;
1214 
1215 			spin_lock_irqsave(&dmap->lock,flags);
1216 			DMAbuf_activate_recording(dev, dmap);
1217 			spin_unlock_irqrestore(&dmap->lock,flags);
1218 		}
1219 		return 0;
1220 	}
1221 	if (!dmap->qlen)
1222 		return 0;
1223 	return POLLIN | POLLRDNORM;
1224 }
1225 
poll_output(struct file * file,int dev,poll_table * wait)1226 static unsigned int poll_output(struct file * file, int dev, poll_table *wait)
1227 {
1228 	struct audio_operations *adev = audio_devs[dev];
1229 	struct dma_buffparms *dmap = adev->dmap_out;
1230 
1231 	if (!(adev->open_mode & OPEN_WRITE))
1232 		return 0;
1233 	if (dmap->mapping_flags & DMA_MAP_MAPPED) {
1234 		if (dmap->qlen)
1235 			return POLLOUT | POLLWRNORM;
1236 		return 0;
1237 	}
1238 	if (dmap->dma_mode == DMODE_INPUT)
1239 		return 0;
1240 	if (dmap->dma_mode == DMODE_NONE)
1241 		return POLLOUT | POLLWRNORM;
1242 	if (!DMAbuf_space_in_queue(dev))
1243 		return 0;
1244 	return POLLOUT | POLLWRNORM;
1245 }
1246 
DMAbuf_poll(struct file * file,int dev,poll_table * wait)1247 unsigned int DMAbuf_poll(struct file * file, int dev, poll_table *wait)
1248 {
1249 	struct audio_operations *adev = audio_devs[dev];
1250 	poll_wait(file, &adev->poll_sleeper, wait);
1251 	return poll_input(file, dev, wait) | poll_output(file, dev, wait);
1252 }
1253 
DMAbuf_deinit(int dev)1254 void DMAbuf_deinit(int dev)
1255 {
1256 	struct audio_operations *adev = audio_devs[dev];
1257 	/* This routine is called when driver is being unloaded */
1258 	if (!adev)
1259 		return;
1260 
1261 	/* Persistent DMA buffers deallocated here */
1262 	if (sound_dmap_flag == DMAP_KEEP_ON_CLOSE) {
1263 		sound_free_dmap(adev->dmap_out);
1264 		if (adev->flags & DMA_DUPLEX)
1265 			sound_free_dmap(adev->dmap_in);
1266 	}
1267 }
1268