xref: /openbmc/linux/drivers/media/pci/ivtv/ivtv-irq.c (revision 3cf3cdea)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /* interrupt handling
3     Copyright (C) 2003-2004  Kevin Thayer <nufan_wfk at yahoo.com>
4     Copyright (C) 2004  Chris Kennedy <c@groovy.org>
5     Copyright (C) 2005-2007  Hans Verkuil <hverkuil@xs4all.nl>
6 
7  */
8 
9 #include "ivtv-driver.h"
10 #include "ivtv-queue.h"
11 #include "ivtv-udma.h"
12 #include "ivtv-irq.h"
13 #include "ivtv-mailbox.h"
14 #include "ivtv-vbi.h"
15 #include "ivtv-yuv.h"
16 #include <media/v4l2-event.h>
17 
18 #define DMA_MAGIC_COOKIE 0x000001fe
19 
20 static void ivtv_dma_dec_start(struct ivtv_stream *s);
21 
22 static const int ivtv_stream_map[] = {
23 	IVTV_ENC_STREAM_TYPE_MPG,
24 	IVTV_ENC_STREAM_TYPE_YUV,
25 	IVTV_ENC_STREAM_TYPE_PCM,
26 	IVTV_ENC_STREAM_TYPE_VBI,
27 };
28 
29 static void ivtv_pcm_work_handler(struct ivtv *itv)
30 {
31 	struct ivtv_stream *s = &itv->streams[IVTV_ENC_STREAM_TYPE_PCM];
32 	struct ivtv_buffer *buf;
33 
34 	/* Pass the PCM data to ivtv-alsa */
35 
36 	while (1) {
37 		/*
38 		 * Users should not be using both the ALSA and V4L2 PCM audio
39 		 * capture interfaces at the same time.  If the user is doing
40 		 * this, there maybe a buffer in q_io to grab, use, and put
41 		 * back in rotation.
42 		 */
43 		buf = ivtv_dequeue(s, &s->q_io);
44 		if (buf == NULL)
45 			buf = ivtv_dequeue(s, &s->q_full);
46 		if (buf == NULL)
47 			break;
48 
49 		if (buf->readpos < buf->bytesused)
50 			itv->pcm_announce_callback(itv->alsa,
51 				(u8 *)(buf->buf + buf->readpos),
52 				(size_t)(buf->bytesused - buf->readpos));
53 
54 		ivtv_enqueue(s, buf, &s->q_free);
55 	}
56 }
57 
58 static void ivtv_pio_work_handler(struct ivtv *itv)
59 {
60 	struct ivtv_stream *s = &itv->streams[itv->cur_pio_stream];
61 	struct ivtv_buffer *buf;
62 	int i = 0;
63 
64 	IVTV_DEBUG_HI_DMA("ivtv_pio_work_handler\n");
65 	if (itv->cur_pio_stream < 0 || itv->cur_pio_stream >= IVTV_MAX_STREAMS ||
66 			s->vdev.v4l2_dev == NULL || !ivtv_use_pio(s)) {
67 		itv->cur_pio_stream = -1;
68 		/* trigger PIO complete user interrupt */
69 		write_reg(IVTV_IRQ_ENC_PIO_COMPLETE, 0x44);
70 		return;
71 	}
72 	IVTV_DEBUG_HI_DMA("Process PIO %s\n", s->name);
73 	list_for_each_entry(buf, &s->q_dma.list, list) {
74 		u32 size = s->sg_processing[i].size & 0x3ffff;
75 
76 		/* Copy the data from the card to the buffer */
77 		if (s->type == IVTV_DEC_STREAM_TYPE_VBI) {
78 			memcpy_fromio(buf->buf, itv->dec_mem + s->sg_processing[i].src - IVTV_DECODER_OFFSET, size);
79 		}
80 		else {
81 			memcpy_fromio(buf->buf, itv->enc_mem + s->sg_processing[i].src, size);
82 		}
83 		i++;
84 		if (i == s->sg_processing_size)
85 			break;
86 	}
87 	write_reg(IVTV_IRQ_ENC_PIO_COMPLETE, 0x44);
88 }
89 
90 void ivtv_irq_work_handler(struct kthread_work *work)
91 {
92 	struct ivtv *itv = container_of(work, struct ivtv, irq_work);
93 
94 	if (test_and_clear_bit(IVTV_F_I_WORK_HANDLER_PIO, &itv->i_flags))
95 		ivtv_pio_work_handler(itv);
96 
97 	if (test_and_clear_bit(IVTV_F_I_WORK_HANDLER_VBI, &itv->i_flags))
98 		ivtv_vbi_work_handler(itv);
99 
100 	if (test_and_clear_bit(IVTV_F_I_WORK_HANDLER_YUV, &itv->i_flags))
101 		ivtv_yuv_work_handler(itv);
102 
103 	if (test_and_clear_bit(IVTV_F_I_WORK_HANDLER_PCM, &itv->i_flags))
104 		ivtv_pcm_work_handler(itv);
105 }
106 
107 /* Determine the required DMA size, setup enough buffers in the predma queue and
108    actually copy the data from the card to the buffers in case a PIO transfer is
109    required for this stream.
110  */
111 static int stream_enc_dma_append(struct ivtv_stream *s, u32 data[CX2341X_MBOX_MAX_DATA])
112 {
113 	struct ivtv *itv = s->itv;
114 	struct ivtv_buffer *buf;
115 	u32 bytes_needed = 0;
116 	u32 offset, size;
117 	u32 UVoffset = 0, UVsize = 0;
118 	int skip_bufs = s->q_predma.buffers;
119 	int idx = s->sg_pending_size;
120 	int rc;
121 
122 	/* sanity checks */
123 	if (s->vdev.v4l2_dev == NULL) {
124 		IVTV_DEBUG_WARN("Stream %s not started\n", s->name);
125 		return -1;
126 	}
127 	if (!test_bit(IVTV_F_S_CLAIMED, &s->s_flags)) {
128 		IVTV_DEBUG_WARN("Stream %s not open\n", s->name);
129 		return -1;
130 	}
131 
132 	/* determine offset, size and PTS for the various streams */
133 	switch (s->type) {
134 		case IVTV_ENC_STREAM_TYPE_MPG:
135 			offset = data[1];
136 			size = data[2];
137 			s->pending_pts = 0;
138 			break;
139 
140 		case IVTV_ENC_STREAM_TYPE_YUV:
141 			offset = data[1];
142 			size = data[2];
143 			UVoffset = data[3];
144 			UVsize = data[4];
145 			s->pending_pts = ((u64) data[5] << 32) | data[6];
146 			break;
147 
148 		case IVTV_ENC_STREAM_TYPE_PCM:
149 			offset = data[1] + 12;
150 			size = data[2] - 12;
151 			s->pending_pts = read_dec(offset - 8) |
152 				((u64)(read_dec(offset - 12)) << 32);
153 			if (itv->has_cx23415)
154 				offset += IVTV_DECODER_OFFSET;
155 			break;
156 
157 		case IVTV_ENC_STREAM_TYPE_VBI:
158 			size = itv->vbi.enc_size * itv->vbi.fpi;
159 			offset = read_enc(itv->vbi.enc_start - 4) + 12;
160 			if (offset == 12) {
161 				IVTV_DEBUG_INFO("VBI offset == 0\n");
162 				return -1;
163 			}
164 			s->pending_pts = read_enc(offset - 4) | ((u64)read_enc(offset - 8) << 32);
165 			break;
166 
167 		case IVTV_DEC_STREAM_TYPE_VBI:
168 			size = read_dec(itv->vbi.dec_start + 4) + 8;
169 			offset = read_dec(itv->vbi.dec_start) + itv->vbi.dec_start;
170 			s->pending_pts = 0;
171 			offset += IVTV_DECODER_OFFSET;
172 			break;
173 		default:
174 			/* shouldn't happen */
175 			return -1;
176 	}
177 
178 	/* if this is the start of the DMA then fill in the magic cookie */
179 	if (s->sg_pending_size == 0 && ivtv_use_dma(s)) {
180 		if (itv->has_cx23415 && (s->type == IVTV_ENC_STREAM_TYPE_PCM ||
181 		    s->type == IVTV_DEC_STREAM_TYPE_VBI)) {
182 			s->pending_backup = read_dec(offset - IVTV_DECODER_OFFSET);
183 			write_dec_sync(DMA_MAGIC_COOKIE, offset - IVTV_DECODER_OFFSET);
184 		}
185 		else {
186 			s->pending_backup = read_enc(offset);
187 			write_enc_sync(DMA_MAGIC_COOKIE, offset);
188 		}
189 		s->pending_offset = offset;
190 	}
191 
192 	bytes_needed = size;
193 	if (s->type == IVTV_ENC_STREAM_TYPE_YUV) {
194 		/* The size for the Y samples needs to be rounded upwards to a
195 		   multiple of the buf_size. The UV samples then start in the
196 		   next buffer. */
197 		bytes_needed = s->buf_size * ((bytes_needed + s->buf_size - 1) / s->buf_size);
198 		bytes_needed += UVsize;
199 	}
200 
201 	IVTV_DEBUG_HI_DMA("%s %s: 0x%08x bytes at 0x%08x\n",
202 		ivtv_use_pio(s) ? "PIO" : "DMA", s->name, bytes_needed, offset);
203 
204 	rc = ivtv_queue_move(s, &s->q_free, &s->q_full, &s->q_predma, bytes_needed);
205 	if (rc < 0) { /* Insufficient buffers */
206 		IVTV_DEBUG_WARN("Cannot obtain %d bytes for %s data transfer\n",
207 				bytes_needed, s->name);
208 		return -1;
209 	}
210 	if (rc && !s->buffers_stolen && test_bit(IVTV_F_S_APPL_IO, &s->s_flags)) {
211 		IVTV_WARN("All %s stream buffers are full. Dropping data.\n", s->name);
212 		IVTV_WARN("Cause: the application is not reading fast enough.\n");
213 	}
214 	s->buffers_stolen = rc;
215 
216 	/* got the buffers, now fill in sg_pending */
217 	buf = list_entry(s->q_predma.list.next, struct ivtv_buffer, list);
218 	memset(buf->buf, 0, 128);
219 	list_for_each_entry(buf, &s->q_predma.list, list) {
220 		if (skip_bufs-- > 0)
221 			continue;
222 		s->sg_pending[idx].dst = buf->dma_handle;
223 		s->sg_pending[idx].src = offset;
224 		s->sg_pending[idx].size = s->buf_size;
225 		buf->bytesused = min(size, s->buf_size);
226 		buf->dma_xfer_cnt = s->dma_xfer_cnt;
227 
228 		s->q_predma.bytesused += buf->bytesused;
229 		size -= buf->bytesused;
230 		offset += s->buf_size;
231 
232 		/* Sync SG buffers */
233 		ivtv_buf_sync_for_device(s, buf);
234 
235 		if (size == 0) {	/* YUV */
236 			/* process the UV section */
237 			offset = UVoffset;
238 			size = UVsize;
239 		}
240 		idx++;
241 	}
242 	s->sg_pending_size = idx;
243 	return 0;
244 }
245 
246 static void dma_post(struct ivtv_stream *s)
247 {
248 	struct ivtv *itv = s->itv;
249 	struct ivtv_buffer *buf = NULL;
250 	struct list_head *p;
251 	u32 offset;
252 	__le32 *u32buf;
253 	int x = 0;
254 
255 	IVTV_DEBUG_HI_DMA("%s %s completed (%x)\n", ivtv_use_pio(s) ? "PIO" : "DMA",
256 			s->name, s->dma_offset);
257 	list_for_each(p, &s->q_dma.list) {
258 		buf = list_entry(p, struct ivtv_buffer, list);
259 		u32buf = (__le32 *)buf->buf;
260 
261 		/* Sync Buffer */
262 		ivtv_buf_sync_for_cpu(s, buf);
263 
264 		if (x == 0 && ivtv_use_dma(s)) {
265 			offset = s->dma_last_offset;
266 			if (le32_to_cpu(u32buf[offset / 4]) != DMA_MAGIC_COOKIE)
267 			{
268 				for (offset = 0; offset < 64; offset++)
269 					if (le32_to_cpu(u32buf[offset]) == DMA_MAGIC_COOKIE)
270 						break;
271 				offset *= 4;
272 				if (offset == 256) {
273 					IVTV_DEBUG_WARN("%s: Couldn't find start of buffer within the first 256 bytes\n", s->name);
274 					offset = s->dma_last_offset;
275 				}
276 				if (s->dma_last_offset != offset)
277 					IVTV_DEBUG_WARN("%s: offset %d -> %d\n", s->name, s->dma_last_offset, offset);
278 				s->dma_last_offset = offset;
279 			}
280 			if (itv->has_cx23415 && (s->type == IVTV_ENC_STREAM_TYPE_PCM ||
281 						s->type == IVTV_DEC_STREAM_TYPE_VBI)) {
282 				write_dec_sync(0, s->dma_offset - IVTV_DECODER_OFFSET);
283 			}
284 			else {
285 				write_enc_sync(0, s->dma_offset);
286 			}
287 			if (offset) {
288 				buf->bytesused -= offset;
289 				memcpy(buf->buf, buf->buf + offset, buf->bytesused + offset);
290 			}
291 			*u32buf = cpu_to_le32(s->dma_backup);
292 		}
293 		x++;
294 		/* flag byteswap ABCD -> DCBA for MPG & VBI data outside irq */
295 		if (s->type == IVTV_ENC_STREAM_TYPE_MPG ||
296 		    s->type == IVTV_ENC_STREAM_TYPE_VBI)
297 			buf->b_flags |= IVTV_F_B_NEED_BUF_SWAP;
298 	}
299 	if (buf)
300 		buf->bytesused += s->dma_last_offset;
301 	if (buf && s->type == IVTV_DEC_STREAM_TYPE_VBI) {
302 		list_for_each_entry(buf, &s->q_dma.list, list) {
303 			/* Parse and Groom VBI Data */
304 			s->q_dma.bytesused -= buf->bytesused;
305 			ivtv_process_vbi_data(itv, buf, 0, s->type);
306 			s->q_dma.bytesused += buf->bytesused;
307 		}
308 		if (s->fh == NULL) {
309 			ivtv_queue_move(s, &s->q_dma, NULL, &s->q_free, 0);
310 			return;
311 		}
312 	}
313 
314 	ivtv_queue_move(s, &s->q_dma, NULL, &s->q_full, s->q_dma.bytesused);
315 
316 	if (s->type == IVTV_ENC_STREAM_TYPE_PCM &&
317 	    itv->pcm_announce_callback != NULL) {
318 		/*
319 		 * Set up the work handler to pass the data to ivtv-alsa.
320 		 *
321 		 * We just use q_full and let the work handler race with users
322 		 * making ivtv-fileops.c calls on the PCM device node.
323 		 *
324 		 * Users should not be using both the ALSA and V4L2 PCM audio
325 		 * capture interfaces at the same time.  If the user does this,
326 		 * fragments of data will just go out each interface as they
327 		 * race for PCM data.
328 		 */
329 		set_bit(IVTV_F_I_WORK_HANDLER_PCM, &itv->i_flags);
330 		set_bit(IVTV_F_I_HAVE_WORK, &itv->i_flags);
331 	}
332 
333 	if (s->fh)
334 		wake_up(&s->waitq);
335 }
336 
337 void ivtv_dma_stream_dec_prepare(struct ivtv_stream *s, u32 offset, int lock)
338 {
339 	struct ivtv *itv = s->itv;
340 	struct yuv_playback_info *yi = &itv->yuv_info;
341 	u8 frame = yi->draw_frame;
342 	struct yuv_frame_info *f = &yi->new_frame_info[frame];
343 	struct ivtv_buffer *buf;
344 	u32 y_size = 720 * ((f->src_h + 31) & ~31);
345 	u32 uv_offset = offset + IVTV_YUV_BUFFER_UV_OFFSET;
346 	int y_done = 0;
347 	int bytes_written = 0;
348 	int idx = 0;
349 
350 	IVTV_DEBUG_HI_DMA("DEC PREPARE DMA %s: %08x %08x\n", s->name, s->q_predma.bytesused, offset);
351 
352 	/* Insert buffer block for YUV if needed */
353 	if (s->type == IVTV_DEC_STREAM_TYPE_YUV && f->offset_y) {
354 		if (yi->blanking_dmaptr) {
355 			s->sg_pending[idx].src = yi->blanking_dmaptr;
356 			s->sg_pending[idx].dst = offset;
357 			s->sg_pending[idx].size = 720 * 16;
358 		}
359 		offset += 720 * 16;
360 		idx++;
361 	}
362 
363 	list_for_each_entry(buf, &s->q_predma.list, list) {
364 		/* YUV UV Offset from Y Buffer */
365 		if (s->type == IVTV_DEC_STREAM_TYPE_YUV && !y_done &&
366 				(bytes_written + buf->bytesused) >= y_size) {
367 			s->sg_pending[idx].src = buf->dma_handle;
368 			s->sg_pending[idx].dst = offset;
369 			s->sg_pending[idx].size = y_size - bytes_written;
370 			offset = uv_offset;
371 			if (s->sg_pending[idx].size != buf->bytesused) {
372 				idx++;
373 				s->sg_pending[idx].src =
374 				  buf->dma_handle + s->sg_pending[idx - 1].size;
375 				s->sg_pending[idx].dst = offset;
376 				s->sg_pending[idx].size =
377 				   buf->bytesused - s->sg_pending[idx - 1].size;
378 				offset += s->sg_pending[idx].size;
379 			}
380 			y_done = 1;
381 		} else {
382 			s->sg_pending[idx].src = buf->dma_handle;
383 			s->sg_pending[idx].dst = offset;
384 			s->sg_pending[idx].size = buf->bytesused;
385 			offset += buf->bytesused;
386 		}
387 		bytes_written += buf->bytesused;
388 
389 		/* Sync SG buffers */
390 		ivtv_buf_sync_for_device(s, buf);
391 		idx++;
392 	}
393 	s->sg_pending_size = idx;
394 
395 	/* Sync Hardware SG List of buffers */
396 	ivtv_stream_sync_for_device(s);
397 	if (lock) {
398 		unsigned long flags = 0;
399 
400 		spin_lock_irqsave(&itv->dma_reg_lock, flags);
401 		if (!test_bit(IVTV_F_I_DMA, &itv->i_flags))
402 			ivtv_dma_dec_start(s);
403 		else
404 			set_bit(IVTV_F_S_DMA_PENDING, &s->s_flags);
405 		spin_unlock_irqrestore(&itv->dma_reg_lock, flags);
406 	} else {
407 		if (!test_bit(IVTV_F_I_DMA, &itv->i_flags))
408 			ivtv_dma_dec_start(s);
409 		else
410 			set_bit(IVTV_F_S_DMA_PENDING, &s->s_flags);
411 	}
412 }
413 
414 static void ivtv_dma_enc_start_xfer(struct ivtv_stream *s)
415 {
416 	struct ivtv *itv = s->itv;
417 
418 	s->sg_dma->src = cpu_to_le32(s->sg_processing[s->sg_processed].src);
419 	s->sg_dma->dst = cpu_to_le32(s->sg_processing[s->sg_processed].dst);
420 	s->sg_dma->size = cpu_to_le32(s->sg_processing[s->sg_processed].size | 0x80000000);
421 	s->sg_processed++;
422 	/* Sync Hardware SG List of buffers */
423 	ivtv_stream_sync_for_device(s);
424 	write_reg(s->sg_handle, IVTV_REG_ENCDMAADDR);
425 	write_reg_sync(read_reg(IVTV_REG_DMAXFER) | 0x02, IVTV_REG_DMAXFER);
426 	itv->dma_timer.expires = jiffies + msecs_to_jiffies(300);
427 	add_timer(&itv->dma_timer);
428 }
429 
430 static void ivtv_dma_dec_start_xfer(struct ivtv_stream *s)
431 {
432 	struct ivtv *itv = s->itv;
433 
434 	s->sg_dma->src = cpu_to_le32(s->sg_processing[s->sg_processed].src);
435 	s->sg_dma->dst = cpu_to_le32(s->sg_processing[s->sg_processed].dst);
436 	s->sg_dma->size = cpu_to_le32(s->sg_processing[s->sg_processed].size | 0x80000000);
437 	s->sg_processed++;
438 	/* Sync Hardware SG List of buffers */
439 	ivtv_stream_sync_for_device(s);
440 	write_reg(s->sg_handle, IVTV_REG_DECDMAADDR);
441 	write_reg_sync(read_reg(IVTV_REG_DMAXFER) | 0x01, IVTV_REG_DMAXFER);
442 	itv->dma_timer.expires = jiffies + msecs_to_jiffies(300);
443 	add_timer(&itv->dma_timer);
444 }
445 
446 /* start the encoder DMA */
447 static void ivtv_dma_enc_start(struct ivtv_stream *s)
448 {
449 	struct ivtv *itv = s->itv;
450 	struct ivtv_stream *s_vbi = &itv->streams[IVTV_ENC_STREAM_TYPE_VBI];
451 	int i;
452 
453 	IVTV_DEBUG_HI_DMA("start %s for %s\n", ivtv_use_dma(s) ? "DMA" : "PIO", s->name);
454 
455 	if (s->q_predma.bytesused)
456 		ivtv_queue_move(s, &s->q_predma, NULL, &s->q_dma, s->q_predma.bytesused);
457 
458 	if (ivtv_use_dma(s))
459 		s->sg_pending[s->sg_pending_size - 1].size += 256;
460 
461 	/* If this is an MPEG stream, and VBI data is also pending, then append the
462 	   VBI DMA to the MPEG DMA and transfer both sets of data at once.
463 
464 	   VBI DMA is a second class citizen compared to MPEG and mixing them together
465 	   will confuse the firmware (the end of a VBI DMA is seen as the end of a
466 	   MPEG DMA, thus effectively dropping an MPEG frame). So instead we make
467 	   sure we only use the MPEG DMA to transfer the VBI DMA if both are in
468 	   use. This way no conflicts occur. */
469 	clear_bit(IVTV_F_S_DMA_HAS_VBI, &s->s_flags);
470 	if (s->type == IVTV_ENC_STREAM_TYPE_MPG && s_vbi->sg_pending_size &&
471 			s->sg_pending_size + s_vbi->sg_pending_size <= s->buffers) {
472 		ivtv_queue_move(s_vbi, &s_vbi->q_predma, NULL, &s_vbi->q_dma, s_vbi->q_predma.bytesused);
473 		if (ivtv_use_dma(s_vbi))
474 			s_vbi->sg_pending[s_vbi->sg_pending_size - 1].size += 256;
475 		for (i = 0; i < s_vbi->sg_pending_size; i++) {
476 			s->sg_pending[s->sg_pending_size++] = s_vbi->sg_pending[i];
477 		}
478 		s_vbi->dma_offset = s_vbi->pending_offset;
479 		s_vbi->sg_pending_size = 0;
480 		s_vbi->dma_xfer_cnt++;
481 		set_bit(IVTV_F_S_DMA_HAS_VBI, &s->s_flags);
482 		IVTV_DEBUG_HI_DMA("include DMA for %s\n", s_vbi->name);
483 	}
484 
485 	s->dma_xfer_cnt++;
486 	memcpy(s->sg_processing, s->sg_pending, sizeof(struct ivtv_sg_host_element) * s->sg_pending_size);
487 	s->sg_processing_size = s->sg_pending_size;
488 	s->sg_pending_size = 0;
489 	s->sg_processed = 0;
490 	s->dma_offset = s->pending_offset;
491 	s->dma_backup = s->pending_backup;
492 	s->dma_pts = s->pending_pts;
493 
494 	if (ivtv_use_pio(s)) {
495 		set_bit(IVTV_F_I_WORK_HANDLER_PIO, &itv->i_flags);
496 		set_bit(IVTV_F_I_HAVE_WORK, &itv->i_flags);
497 		set_bit(IVTV_F_I_PIO, &itv->i_flags);
498 		itv->cur_pio_stream = s->type;
499 	}
500 	else {
501 		itv->dma_retries = 0;
502 		ivtv_dma_enc_start_xfer(s);
503 		set_bit(IVTV_F_I_DMA, &itv->i_flags);
504 		itv->cur_dma_stream = s->type;
505 	}
506 }
507 
508 static void ivtv_dma_dec_start(struct ivtv_stream *s)
509 {
510 	struct ivtv *itv = s->itv;
511 
512 	if (s->q_predma.bytesused)
513 		ivtv_queue_move(s, &s->q_predma, NULL, &s->q_dma, s->q_predma.bytesused);
514 	s->dma_xfer_cnt++;
515 	memcpy(s->sg_processing, s->sg_pending, sizeof(struct ivtv_sg_host_element) * s->sg_pending_size);
516 	s->sg_processing_size = s->sg_pending_size;
517 	s->sg_pending_size = 0;
518 	s->sg_processed = 0;
519 
520 	IVTV_DEBUG_HI_DMA("start DMA for %s\n", s->name);
521 	itv->dma_retries = 0;
522 	ivtv_dma_dec_start_xfer(s);
523 	set_bit(IVTV_F_I_DMA, &itv->i_flags);
524 	itv->cur_dma_stream = s->type;
525 }
526 
527 static void ivtv_irq_dma_read(struct ivtv *itv)
528 {
529 	struct ivtv_stream *s = NULL;
530 	struct ivtv_buffer *buf;
531 	int hw_stream_type = 0;
532 
533 	IVTV_DEBUG_HI_IRQ("DEC DMA READ\n");
534 
535 	del_timer(&itv->dma_timer);
536 
537 	if (!test_bit(IVTV_F_I_UDMA, &itv->i_flags) && itv->cur_dma_stream < 0)
538 		return;
539 
540 	if (!test_bit(IVTV_F_I_UDMA, &itv->i_flags)) {
541 		s = &itv->streams[itv->cur_dma_stream];
542 		ivtv_stream_sync_for_cpu(s);
543 
544 		if (read_reg(IVTV_REG_DMASTATUS) & 0x14) {
545 			IVTV_DEBUG_WARN("DEC DMA ERROR %x (xfer %d of %d, retry %d)\n",
546 					read_reg(IVTV_REG_DMASTATUS),
547 					s->sg_processed, s->sg_processing_size, itv->dma_retries);
548 			write_reg(read_reg(IVTV_REG_DMASTATUS) & 3, IVTV_REG_DMASTATUS);
549 			if (itv->dma_retries == 3) {
550 				/* Too many retries, give up on this frame */
551 				itv->dma_retries = 0;
552 				s->sg_processed = s->sg_processing_size;
553 			}
554 			else {
555 				/* Retry, starting with the first xfer segment.
556 				   Just retrying the current segment is not sufficient. */
557 				s->sg_processed = 0;
558 				itv->dma_retries++;
559 			}
560 		}
561 		if (s->sg_processed < s->sg_processing_size) {
562 			/* DMA next buffer */
563 			ivtv_dma_dec_start_xfer(s);
564 			return;
565 		}
566 		if (s->type == IVTV_DEC_STREAM_TYPE_YUV)
567 			hw_stream_type = 2;
568 		IVTV_DEBUG_HI_DMA("DEC DATA READ %s: %d\n", s->name, s->q_dma.bytesused);
569 
570 		/* For some reason must kick the firmware, like PIO mode,
571 		   I think this tells the firmware we are done and the size
572 		   of the xfer so it can calculate what we need next.
573 		   I think we can do this part ourselves but would have to
574 		   fully calculate xfer info ourselves and not use interrupts
575 		 */
576 		ivtv_vapi(itv, CX2341X_DEC_SCHED_DMA_FROM_HOST, 3, 0, s->q_dma.bytesused,
577 				hw_stream_type);
578 
579 		/* Free last DMA call */
580 		while ((buf = ivtv_dequeue(s, &s->q_dma)) != NULL) {
581 			ivtv_buf_sync_for_cpu(s, buf);
582 			ivtv_enqueue(s, buf, &s->q_free);
583 		}
584 		wake_up(&s->waitq);
585 	}
586 	clear_bit(IVTV_F_I_UDMA, &itv->i_flags);
587 	clear_bit(IVTV_F_I_DMA, &itv->i_flags);
588 	itv->cur_dma_stream = -1;
589 	wake_up(&itv->dma_waitq);
590 }
591 
592 static void ivtv_irq_enc_dma_complete(struct ivtv *itv)
593 {
594 	u32 data[CX2341X_MBOX_MAX_DATA];
595 	struct ivtv_stream *s;
596 
597 	ivtv_api_get_data(&itv->enc_mbox, IVTV_MBOX_DMA_END, 2, data);
598 	IVTV_DEBUG_HI_IRQ("ENC DMA COMPLETE %x %d (%d)\n", data[0], data[1], itv->cur_dma_stream);
599 
600 	del_timer(&itv->dma_timer);
601 
602 	if (itv->cur_dma_stream < 0)
603 		return;
604 
605 	s = &itv->streams[itv->cur_dma_stream];
606 	ivtv_stream_sync_for_cpu(s);
607 
608 	if (data[0] & 0x18) {
609 		IVTV_DEBUG_WARN("ENC DMA ERROR %x (offset %08x, xfer %d of %d, retry %d)\n", data[0],
610 			s->dma_offset, s->sg_processed, s->sg_processing_size, itv->dma_retries);
611 		write_reg(read_reg(IVTV_REG_DMASTATUS) & 3, IVTV_REG_DMASTATUS);
612 		if (itv->dma_retries == 3) {
613 			/* Too many retries, give up on this frame */
614 			itv->dma_retries = 0;
615 			s->sg_processed = s->sg_processing_size;
616 		}
617 		else {
618 			/* Retry, starting with the first xfer segment.
619 			   Just retrying the current segment is not sufficient. */
620 			s->sg_processed = 0;
621 			itv->dma_retries++;
622 		}
623 	}
624 	if (s->sg_processed < s->sg_processing_size) {
625 		/* DMA next buffer */
626 		ivtv_dma_enc_start_xfer(s);
627 		return;
628 	}
629 	clear_bit(IVTV_F_I_DMA, &itv->i_flags);
630 	itv->cur_dma_stream = -1;
631 	dma_post(s);
632 	if (test_and_clear_bit(IVTV_F_S_DMA_HAS_VBI, &s->s_flags)) {
633 		s = &itv->streams[IVTV_ENC_STREAM_TYPE_VBI];
634 		dma_post(s);
635 	}
636 	s->sg_processing_size = 0;
637 	s->sg_processed = 0;
638 	wake_up(&itv->dma_waitq);
639 }
640 
641 static void ivtv_irq_enc_pio_complete(struct ivtv *itv)
642 {
643 	struct ivtv_stream *s;
644 
645 	if (itv->cur_pio_stream < 0 || itv->cur_pio_stream >= IVTV_MAX_STREAMS) {
646 		itv->cur_pio_stream = -1;
647 		return;
648 	}
649 	s = &itv->streams[itv->cur_pio_stream];
650 	IVTV_DEBUG_HI_IRQ("ENC PIO COMPLETE %s\n", s->name);
651 	clear_bit(IVTV_F_I_PIO, &itv->i_flags);
652 	itv->cur_pio_stream = -1;
653 	dma_post(s);
654 	if (s->type == IVTV_ENC_STREAM_TYPE_MPG)
655 		ivtv_vapi(itv, CX2341X_ENC_SCHED_DMA_TO_HOST, 3, 0, 0, 0);
656 	else if (s->type == IVTV_ENC_STREAM_TYPE_YUV)
657 		ivtv_vapi(itv, CX2341X_ENC_SCHED_DMA_TO_HOST, 3, 0, 0, 1);
658 	else if (s->type == IVTV_ENC_STREAM_TYPE_PCM)
659 		ivtv_vapi(itv, CX2341X_ENC_SCHED_DMA_TO_HOST, 3, 0, 0, 2);
660 	clear_bit(IVTV_F_I_PIO, &itv->i_flags);
661 	if (test_and_clear_bit(IVTV_F_S_DMA_HAS_VBI, &s->s_flags)) {
662 		s = &itv->streams[IVTV_ENC_STREAM_TYPE_VBI];
663 		dma_post(s);
664 	}
665 	wake_up(&itv->dma_waitq);
666 }
667 
668 static void ivtv_irq_dma_err(struct ivtv *itv)
669 {
670 	u32 data[CX2341X_MBOX_MAX_DATA];
671 	u32 status;
672 
673 	del_timer(&itv->dma_timer);
674 
675 	ivtv_api_get_data(&itv->enc_mbox, IVTV_MBOX_DMA_END, 2, data);
676 	status = read_reg(IVTV_REG_DMASTATUS);
677 	IVTV_DEBUG_WARN("DMA ERROR %08x %08x %08x %d\n", data[0], data[1],
678 				status, itv->cur_dma_stream);
679 	/*
680 	 * We do *not* write back to the IVTV_REG_DMASTATUS register to
681 	 * clear the error status, if either the encoder write (0x02) or
682 	 * decoder read (0x01) bus master DMA operation do not indicate
683 	 * completed.  We can race with the DMA engine, which may have
684 	 * transitioned to completed status *after* we read the register.
685 	 * Setting a IVTV_REG_DMASTATUS flag back to "busy" status, after the
686 	 * DMA engine has completed, will cause the DMA engine to stop working.
687 	 */
688 	status &= 0x3;
689 	if (status == 0x3)
690 		write_reg(status, IVTV_REG_DMASTATUS);
691 
692 	if (!test_bit(IVTV_F_I_UDMA, &itv->i_flags) &&
693 	    itv->cur_dma_stream >= 0 && itv->cur_dma_stream < IVTV_MAX_STREAMS) {
694 		struct ivtv_stream *s = &itv->streams[itv->cur_dma_stream];
695 
696 		if (s->type >= IVTV_DEC_STREAM_TYPE_MPG) {
697 			/* retry */
698 			/*
699 			 * FIXME - handle cases of DMA error similar to
700 			 * encoder below, except conditioned on status & 0x1
701 			 */
702 			ivtv_dma_dec_start(s);
703 			return;
704 		} else {
705 			if ((status & 0x2) == 0) {
706 				/*
707 				 * CX2341x Bus Master DMA write is ongoing.
708 				 * Reset the timer and let it complete.
709 				 */
710 				itv->dma_timer.expires =
711 						jiffies + msecs_to_jiffies(600);
712 				add_timer(&itv->dma_timer);
713 				return;
714 			}
715 
716 			if (itv->dma_retries < 3) {
717 				/*
718 				 * CX2341x Bus Master DMA write has ended.
719 				 * Retry the write, starting with the first
720 				 * xfer segment. Just retrying the current
721 				 * segment is not sufficient.
722 				 */
723 				s->sg_processed = 0;
724 				itv->dma_retries++;
725 				ivtv_dma_enc_start_xfer(s);
726 				return;
727 			}
728 			/* Too many retries, give up on this one */
729 		}
730 
731 	}
732 	if (test_bit(IVTV_F_I_UDMA, &itv->i_flags)) {
733 		ivtv_udma_start(itv);
734 		return;
735 	}
736 	clear_bit(IVTV_F_I_UDMA, &itv->i_flags);
737 	clear_bit(IVTV_F_I_DMA, &itv->i_flags);
738 	itv->cur_dma_stream = -1;
739 	wake_up(&itv->dma_waitq);
740 }
741 
742 static void ivtv_irq_enc_start_cap(struct ivtv *itv)
743 {
744 	u32 data[CX2341X_MBOX_MAX_DATA];
745 	struct ivtv_stream *s;
746 
747 	/* Get DMA destination and size arguments from card */
748 	ivtv_api_get_data(&itv->enc_mbox, IVTV_MBOX_DMA, 7, data);
749 	IVTV_DEBUG_HI_IRQ("ENC START CAP %d: %08x %08x\n", data[0], data[1], data[2]);
750 
751 	if (data[0] > 2 || data[1] == 0 || data[2] == 0) {
752 		IVTV_DEBUG_WARN("Unknown input: %08x %08x %08x\n",
753 				data[0], data[1], data[2]);
754 		return;
755 	}
756 	s = &itv->streams[ivtv_stream_map[data[0]]];
757 	if (!stream_enc_dma_append(s, data)) {
758 		set_bit(ivtv_use_pio(s) ? IVTV_F_S_PIO_PENDING : IVTV_F_S_DMA_PENDING, &s->s_flags);
759 	}
760 }
761 
762 static void ivtv_irq_enc_vbi_cap(struct ivtv *itv)
763 {
764 	u32 data[CX2341X_MBOX_MAX_DATA];
765 	struct ivtv_stream *s;
766 
767 	IVTV_DEBUG_HI_IRQ("ENC START VBI CAP\n");
768 	s = &itv->streams[IVTV_ENC_STREAM_TYPE_VBI];
769 
770 	if (!stream_enc_dma_append(s, data))
771 		set_bit(ivtv_use_pio(s) ? IVTV_F_S_PIO_PENDING : IVTV_F_S_DMA_PENDING, &s->s_flags);
772 }
773 
774 static void ivtv_irq_dec_vbi_reinsert(struct ivtv *itv)
775 {
776 	u32 data[CX2341X_MBOX_MAX_DATA];
777 	struct ivtv_stream *s = &itv->streams[IVTV_DEC_STREAM_TYPE_VBI];
778 
779 	IVTV_DEBUG_HI_IRQ("DEC VBI REINSERT\n");
780 	if (test_bit(IVTV_F_S_CLAIMED, &s->s_flags) &&
781 			!stream_enc_dma_append(s, data)) {
782 		set_bit(IVTV_F_S_PIO_PENDING, &s->s_flags);
783 	}
784 }
785 
786 static void ivtv_irq_dec_data_req(struct ivtv *itv)
787 {
788 	u32 data[CX2341X_MBOX_MAX_DATA];
789 	struct ivtv_stream *s;
790 
791 	/* YUV or MPG */
792 
793 	if (test_bit(IVTV_F_I_DEC_YUV, &itv->i_flags)) {
794 		ivtv_api_get_data(&itv->dec_mbox, IVTV_MBOX_DMA, 2, data);
795 		itv->dma_data_req_size =
796 				 1080 * ((itv->yuv_info.v4l2_src_h + 31) & ~31);
797 		itv->dma_data_req_offset = data[1];
798 		if (atomic_read(&itv->yuv_info.next_dma_frame) >= 0)
799 			ivtv_yuv_frame_complete(itv);
800 		s = &itv->streams[IVTV_DEC_STREAM_TYPE_YUV];
801 	}
802 	else {
803 		ivtv_api_get_data(&itv->dec_mbox, IVTV_MBOX_DMA, 3, data);
804 		itv->dma_data_req_size = min_t(u32, data[2], 0x10000);
805 		itv->dma_data_req_offset = data[1];
806 		s = &itv->streams[IVTV_DEC_STREAM_TYPE_MPG];
807 	}
808 	IVTV_DEBUG_HI_IRQ("DEC DATA REQ %s: %d %08x %u\n", s->name, s->q_full.bytesused,
809 		       itv->dma_data_req_offset, itv->dma_data_req_size);
810 	if (itv->dma_data_req_size == 0 || s->q_full.bytesused < itv->dma_data_req_size) {
811 		set_bit(IVTV_F_S_NEEDS_DATA, &s->s_flags);
812 	}
813 	else {
814 		if (test_bit(IVTV_F_I_DEC_YUV, &itv->i_flags))
815 			ivtv_yuv_setup_stream_frame(itv);
816 		clear_bit(IVTV_F_S_NEEDS_DATA, &s->s_flags);
817 		ivtv_queue_move(s, &s->q_full, NULL, &s->q_predma, itv->dma_data_req_size);
818 		ivtv_dma_stream_dec_prepare(s, itv->dma_data_req_offset + IVTV_DECODER_OFFSET, 0);
819 	}
820 }
821 
822 static void ivtv_irq_vsync(struct ivtv *itv)
823 {
824 	/* The vsync interrupt is unusual in that it won't clear until
825 	 * the end of the first line for the current field, at which
826 	 * point it clears itself. This can result in repeated vsync
827 	 * interrupts, or a missed vsync. Read some of the registers
828 	 * to determine the line being displayed and ensure we handle
829 	 * one vsync per frame.
830 	 */
831 	unsigned int frame = read_reg(IVTV_REG_DEC_LINE_FIELD) & 1;
832 	struct yuv_playback_info *yi = &itv->yuv_info;
833 	int last_dma_frame = atomic_read(&yi->next_dma_frame);
834 	struct yuv_frame_info *f = &yi->new_frame_info[last_dma_frame];
835 
836 	if (0) IVTV_DEBUG_IRQ("DEC VSYNC\n");
837 
838 	if (((frame ^ f->sync_field) == 0 &&
839 		((itv->last_vsync_field & 1) ^ f->sync_field)) ||
840 			(frame != (itv->last_vsync_field & 1) && !f->interlaced)) {
841 		int next_dma_frame = last_dma_frame;
842 
843 		if (!(f->interlaced && f->delay && yi->fields_lapsed < 1)) {
844 			if (next_dma_frame >= 0 && next_dma_frame != atomic_read(&yi->next_fill_frame)) {
845 				write_reg(yuv_offset[next_dma_frame] >> 4, 0x82c);
846 				write_reg((yuv_offset[next_dma_frame] + IVTV_YUV_BUFFER_UV_OFFSET) >> 4, 0x830);
847 				write_reg(yuv_offset[next_dma_frame] >> 4, 0x834);
848 				write_reg((yuv_offset[next_dma_frame] + IVTV_YUV_BUFFER_UV_OFFSET) >> 4, 0x838);
849 				next_dma_frame = (next_dma_frame + 1) % IVTV_YUV_BUFFERS;
850 				atomic_set(&yi->next_dma_frame, next_dma_frame);
851 				yi->fields_lapsed = -1;
852 				yi->running = 1;
853 			}
854 		}
855 	}
856 	if (frame != (itv->last_vsync_field & 1)) {
857 		static const struct v4l2_event evtop = {
858 			.type = V4L2_EVENT_VSYNC,
859 			.u.vsync.field = V4L2_FIELD_TOP,
860 		};
861 		static const struct v4l2_event evbottom = {
862 			.type = V4L2_EVENT_VSYNC,
863 			.u.vsync.field = V4L2_FIELD_BOTTOM,
864 		};
865 		struct ivtv_stream *s = ivtv_get_output_stream(itv);
866 
867 		itv->last_vsync_field += 1;
868 		if (frame == 0) {
869 			clear_bit(IVTV_F_I_VALID_DEC_TIMINGS, &itv->i_flags);
870 			clear_bit(IVTV_F_I_EV_VSYNC_FIELD, &itv->i_flags);
871 		}
872 		else {
873 			set_bit(IVTV_F_I_EV_VSYNC_FIELD, &itv->i_flags);
874 		}
875 		if (test_bit(IVTV_F_I_EV_VSYNC_ENABLED, &itv->i_flags)) {
876 			set_bit(IVTV_F_I_EV_VSYNC, &itv->i_flags);
877 			wake_up(&itv->event_waitq);
878 			if (s)
879 				wake_up(&s->waitq);
880 		}
881 		if (s && s->vdev.v4l2_dev)
882 			v4l2_event_queue(&s->vdev, frame ? &evtop : &evbottom);
883 		wake_up(&itv->vsync_waitq);
884 
885 		/* Send VBI to saa7127 */
886 		if (frame && (itv->output_mode == OUT_PASSTHROUGH ||
887 			test_bit(IVTV_F_I_UPDATE_WSS, &itv->i_flags) ||
888 			test_bit(IVTV_F_I_UPDATE_VPS, &itv->i_flags) ||
889 			test_bit(IVTV_F_I_UPDATE_CC, &itv->i_flags))) {
890 			set_bit(IVTV_F_I_WORK_HANDLER_VBI, &itv->i_flags);
891 			set_bit(IVTV_F_I_HAVE_WORK, &itv->i_flags);
892 		}
893 
894 		/* Check if we need to update the yuv registers */
895 		if (yi->running && (yi->yuv_forced_update || f->update)) {
896 			if (!f->update) {
897 				last_dma_frame =
898 					(u8)(atomic_read(&yi->next_dma_frame) -
899 						 1) % IVTV_YUV_BUFFERS;
900 				f = &yi->new_frame_info[last_dma_frame];
901 			}
902 
903 			if (f->src_w) {
904 				yi->update_frame = last_dma_frame;
905 				f->update = 0;
906 				yi->yuv_forced_update = 0;
907 				set_bit(IVTV_F_I_WORK_HANDLER_YUV, &itv->i_flags);
908 				set_bit(IVTV_F_I_HAVE_WORK, &itv->i_flags);
909 			}
910 		}
911 
912 		yi->fields_lapsed++;
913 	}
914 }
915 
916 #define IVTV_IRQ_DMA (IVTV_IRQ_DMA_READ | IVTV_IRQ_ENC_DMA_COMPLETE | IVTV_IRQ_DMA_ERR | IVTV_IRQ_ENC_START_CAP | IVTV_IRQ_ENC_VBI_CAP | IVTV_IRQ_DEC_DATA_REQ | IVTV_IRQ_DEC_VBI_RE_INSERT)
917 
918 irqreturn_t ivtv_irq_handler(int irq, void *dev_id)
919 {
920 	struct ivtv *itv = (struct ivtv *)dev_id;
921 	u32 combo;
922 	u32 stat;
923 	int i;
924 	u8 vsync_force = 0;
925 
926 	spin_lock(&itv->dma_reg_lock);
927 	/* get contents of irq status register */
928 	stat = read_reg(IVTV_REG_IRQSTATUS);
929 
930 	combo = ~itv->irqmask & stat;
931 
932 	/* Clear out IRQ */
933 	if (combo) write_reg(combo, IVTV_REG_IRQSTATUS);
934 
935 	if (0 == combo) {
936 		/* The vsync interrupt is unusual and clears itself. If we
937 		 * took too long, we may have missed it. Do some checks
938 		 */
939 		if (~itv->irqmask & IVTV_IRQ_DEC_VSYNC) {
940 			/* vsync is enabled, see if we're in a new field */
941 			if ((itv->last_vsync_field & 1) !=
942 			    (read_reg(IVTV_REG_DEC_LINE_FIELD) & 1)) {
943 				/* New field, looks like we missed it */
944 				IVTV_DEBUG_YUV("VSync interrupt missed %d\n",
945 				       read_reg(IVTV_REG_DEC_LINE_FIELD) >> 16);
946 				vsync_force = 1;
947 			}
948 		}
949 
950 		if (!vsync_force) {
951 			/* No Vsync expected, wasn't for us */
952 			spin_unlock(&itv->dma_reg_lock);
953 			return IRQ_NONE;
954 		}
955 	}
956 
957 	/* Exclude interrupts noted below from the output, otherwise the log is flooded with
958 	   these messages */
959 	if (combo & ~0xff6d0400)
960 		IVTV_DEBUG_HI_IRQ("======= valid IRQ bits: 0x%08x ======\n", combo);
961 
962 	if (combo & IVTV_IRQ_DEC_DMA_COMPLETE) {
963 		IVTV_DEBUG_HI_IRQ("DEC DMA COMPLETE\n");
964 	}
965 
966 	if (combo & IVTV_IRQ_DMA_READ) {
967 		ivtv_irq_dma_read(itv);
968 	}
969 
970 	if (combo & IVTV_IRQ_ENC_DMA_COMPLETE) {
971 		ivtv_irq_enc_dma_complete(itv);
972 	}
973 
974 	if (combo & IVTV_IRQ_ENC_PIO_COMPLETE) {
975 		ivtv_irq_enc_pio_complete(itv);
976 	}
977 
978 	if (combo & IVTV_IRQ_DMA_ERR) {
979 		ivtv_irq_dma_err(itv);
980 	}
981 
982 	if (combo & IVTV_IRQ_ENC_START_CAP) {
983 		ivtv_irq_enc_start_cap(itv);
984 	}
985 
986 	if (combo & IVTV_IRQ_ENC_VBI_CAP) {
987 		ivtv_irq_enc_vbi_cap(itv);
988 	}
989 
990 	if (combo & IVTV_IRQ_DEC_VBI_RE_INSERT) {
991 		ivtv_irq_dec_vbi_reinsert(itv);
992 	}
993 
994 	if (combo & IVTV_IRQ_ENC_EOS) {
995 		IVTV_DEBUG_IRQ("ENC EOS\n");
996 		set_bit(IVTV_F_I_EOS, &itv->i_flags);
997 		wake_up(&itv->eos_waitq);
998 	}
999 
1000 	if (combo & IVTV_IRQ_DEC_DATA_REQ) {
1001 		ivtv_irq_dec_data_req(itv);
1002 	}
1003 
1004 	/* Decoder Vertical Sync - We can't rely on 'combo', so check if vsync enabled */
1005 	if (~itv->irqmask & IVTV_IRQ_DEC_VSYNC) {
1006 		ivtv_irq_vsync(itv);
1007 	}
1008 
1009 	if (combo & IVTV_IRQ_ENC_VIM_RST) {
1010 		IVTV_DEBUG_IRQ("VIM RST\n");
1011 		/*ivtv_vapi(itv, CX2341X_ENC_REFRESH_INPUT, 0); */
1012 	}
1013 
1014 	if (combo & IVTV_IRQ_DEC_AUD_MODE_CHG) {
1015 		IVTV_DEBUG_INFO("Stereo mode changed\n");
1016 	}
1017 
1018 	if ((combo & IVTV_IRQ_DMA) && !test_bit(IVTV_F_I_DMA, &itv->i_flags)) {
1019 		itv->irq_rr_idx++;
1020 		for (i = 0; i < IVTV_MAX_STREAMS; i++) {
1021 			int idx = (i + itv->irq_rr_idx) % IVTV_MAX_STREAMS;
1022 			struct ivtv_stream *s = &itv->streams[idx];
1023 
1024 			if (!test_and_clear_bit(IVTV_F_S_DMA_PENDING, &s->s_flags))
1025 				continue;
1026 			if (s->type >= IVTV_DEC_STREAM_TYPE_MPG)
1027 				ivtv_dma_dec_start(s);
1028 			else
1029 				ivtv_dma_enc_start(s);
1030 			break;
1031 		}
1032 
1033 		if (i == IVTV_MAX_STREAMS &&
1034 		    test_bit(IVTV_F_I_UDMA_PENDING, &itv->i_flags))
1035 			ivtv_udma_start(itv);
1036 	}
1037 
1038 	if ((combo & IVTV_IRQ_DMA) && !test_bit(IVTV_F_I_PIO, &itv->i_flags)) {
1039 		itv->irq_rr_idx++;
1040 		for (i = 0; i < IVTV_MAX_STREAMS; i++) {
1041 			int idx = (i + itv->irq_rr_idx) % IVTV_MAX_STREAMS;
1042 			struct ivtv_stream *s = &itv->streams[idx];
1043 
1044 			if (!test_and_clear_bit(IVTV_F_S_PIO_PENDING, &s->s_flags))
1045 				continue;
1046 			if (s->type == IVTV_DEC_STREAM_TYPE_VBI || s->type < IVTV_DEC_STREAM_TYPE_MPG)
1047 				ivtv_dma_enc_start(s);
1048 			break;
1049 		}
1050 	}
1051 
1052 	if (test_and_clear_bit(IVTV_F_I_HAVE_WORK, &itv->i_flags)) {
1053 		kthread_queue_work(&itv->irq_worker, &itv->irq_work);
1054 	}
1055 
1056 	spin_unlock(&itv->dma_reg_lock);
1057 
1058 	/* If we've just handled a 'forced' vsync, it's safest to say it
1059 	 * wasn't ours. Another device may have triggered it at just
1060 	 * the right time.
1061 	 */
1062 	return vsync_force ? IRQ_NONE : IRQ_HANDLED;
1063 }
1064 
1065 void ivtv_unfinished_dma(struct timer_list *t)
1066 {
1067 	struct ivtv *itv = from_timer(itv, t, dma_timer);
1068 
1069 	if (!test_bit(IVTV_F_I_DMA, &itv->i_flags))
1070 		return;
1071 	IVTV_ERR("DMA TIMEOUT %08x %d\n", read_reg(IVTV_REG_DMASTATUS), itv->cur_dma_stream);
1072 
1073 	write_reg(read_reg(IVTV_REG_DMASTATUS) & 3, IVTV_REG_DMASTATUS);
1074 	clear_bit(IVTV_F_I_UDMA, &itv->i_flags);
1075 	clear_bit(IVTV_F_I_DMA, &itv->i_flags);
1076 	itv->cur_dma_stream = -1;
1077 	wake_up(&itv->dma_waitq);
1078 }
1079