1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * ddbridge-core.c: Digital Devices bridge core functions
4  *
5  * Copyright (C) 2010-2017 Digital Devices GmbH
6  *                         Marcus Metzler <mocm@metzlerbros.de>
7  *                         Ralph Metzler <rjkm@metzlerbros.de>
8  */
9 
10 #include <linux/module.h>
11 #include <linux/init.h>
12 #include <linux/interrupt.h>
13 #include <linux/delay.h>
14 #include <linux/slab.h>
15 #include <linux/poll.h>
16 #include <linux/io.h>
17 #include <linux/pci.h>
18 #include <linux/pci_ids.h>
19 #include <linux/timer.h>
20 #include <linux/i2c.h>
21 #include <linux/swab.h>
22 #include <linux/vmalloc.h>
23 
24 #include "ddbridge.h"
25 #include "ddbridge-i2c.h"
26 #include "ddbridge-regs.h"
27 #include "ddbridge-max.h"
28 #include "ddbridge-ci.h"
29 #include "ddbridge-io.h"
30 
31 #include "tda18271c2dd.h"
32 #include "stv6110x.h"
33 #include "stv090x.h"
34 #include "lnbh24.h"
35 #include "drxk.h"
36 #include "stv0367.h"
37 #include "stv0367_priv.h"
38 #include "cxd2841er.h"
39 #include "tda18212.h"
40 #include "stv0910.h"
41 #include "stv6111.h"
42 #include "lnbh25.h"
43 #include "cxd2099.h"
44 #include "ddbridge-dummy-fe.h"
45 
46 /****************************************************************************/
47 
48 #define DDB_MAX_ADAPTER 64
49 
50 /****************************************************************************/
51 
52 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
53 
54 static int adapter_alloc;
55 module_param(adapter_alloc, int, 0444);
56 MODULE_PARM_DESC(adapter_alloc,
57 		 "0-one adapter per io, 1-one per tab with io, 2-one per tab, 3-one for all");
58 
59 static int ci_bitrate = 70000;
60 module_param(ci_bitrate, int, 0444);
61 MODULE_PARM_DESC(ci_bitrate, " Bitrate in KHz for output to CI.");
62 
63 static int ts_loop = -1;
64 module_param(ts_loop, int, 0444);
65 MODULE_PARM_DESC(ts_loop, "TS in/out test loop on port ts_loop");
66 
67 static int xo2_speed = 2;
68 module_param(xo2_speed, int, 0444);
69 MODULE_PARM_DESC(xo2_speed, "default transfer speed for xo2 based duoflex, 0=55,1=75,2=90,3=104 MBit/s, default=2, use attribute to change for individual cards");
70 
71 #ifdef __arm__
72 static int alt_dma = 1;
73 #else
74 static int alt_dma;
75 #endif
76 module_param(alt_dma, int, 0444);
77 MODULE_PARM_DESC(alt_dma, "use alternative DMA buffer handling");
78 
79 static int no_init;
80 module_param(no_init, int, 0444);
81 MODULE_PARM_DESC(no_init, "do not initialize most devices");
82 
83 static int stv0910_single;
84 module_param(stv0910_single, int, 0444);
85 MODULE_PARM_DESC(stv0910_single, "use stv0910 cards as single demods");
86 
87 static int dma_buf_num = 8;
88 module_param(dma_buf_num, int, 0444);
89 MODULE_PARM_DESC(dma_buf_num, "Number of DMA buffers, possible values: 8-32");
90 
91 static int dma_buf_size = 21;
92 module_param(dma_buf_size, int, 0444);
93 MODULE_PARM_DESC(dma_buf_size,
94 		 "DMA buffer size as multiple of 128*47, possible values: 1-43");
95 
96 static int dummy_tuner;
97 module_param(dummy_tuner, int, 0444);
98 MODULE_PARM_DESC(dummy_tuner,
99 		 "attach dummy tuner to port 0 on Octopus V3 or Octopus Mini cards");
100 
101 /****************************************************************************/
102 
103 static DEFINE_MUTEX(redirect_lock);
104 
105 static struct workqueue_struct *ddb_wq;
106 
107 static struct ddb *ddbs[DDB_MAX_ADAPTER];
108 
109 /****************************************************************************/
110 /****************************************************************************/
111 /****************************************************************************/
112 
113 struct ddb_irq *ddb_irq_set(struct ddb *dev, u32 link, u32 nr,
114 			    void (*handler)(void *), void *data)
115 {
116 	struct ddb_irq *irq = &dev->link[link].irq[nr];
117 
118 	irq->handler = handler;
119 	irq->data = data;
120 	return irq;
121 }
122 
123 static void ddb_set_dma_table(struct ddb_io *io)
124 {
125 	struct ddb *dev = io->port->dev;
126 	struct ddb_dma *dma = io->dma;
127 	u32 i;
128 	u64 mem;
129 
130 	if (!dma)
131 		return;
132 	for (i = 0; i < dma->num; i++) {
133 		mem = dma->pbuf[i];
134 		ddbwritel(dev, mem & 0xffffffff, dma->bufregs + i * 8);
135 		ddbwritel(dev, mem >> 32, dma->bufregs + i * 8 + 4);
136 	}
137 	dma->bufval = ((dma->div & 0x0f) << 16) |
138 		((dma->num & 0x1f) << 11) |
139 		((dma->size >> 7) & 0x7ff);
140 }
141 
142 static void ddb_set_dma_tables(struct ddb *dev)
143 {
144 	u32 i;
145 
146 	for (i = 0; i < DDB_MAX_PORT; i++) {
147 		if (dev->port[i].input[0])
148 			ddb_set_dma_table(dev->port[i].input[0]);
149 		if (dev->port[i].input[1])
150 			ddb_set_dma_table(dev->port[i].input[1]);
151 		if (dev->port[i].output)
152 			ddb_set_dma_table(dev->port[i].output);
153 	}
154 }
155 
156 /****************************************************************************/
157 /****************************************************************************/
158 /****************************************************************************/
159 
160 static void ddb_redirect_dma(struct ddb *dev,
161 			     struct ddb_dma *sdma,
162 			     struct ddb_dma *ddma)
163 {
164 	u32 i, base;
165 	u64 mem;
166 
167 	sdma->bufval = ddma->bufval;
168 	base = sdma->bufregs;
169 	for (i = 0; i < ddma->num; i++) {
170 		mem = ddma->pbuf[i];
171 		ddbwritel(dev, mem & 0xffffffff, base + i * 8);
172 		ddbwritel(dev, mem >> 32, base + i * 8 + 4);
173 	}
174 }
175 
176 static int ddb_unredirect(struct ddb_port *port)
177 {
178 	struct ddb_input *oredi, *iredi = NULL;
179 	struct ddb_output *iredo = NULL;
180 
181 	/* dev_info(port->dev->dev,
182 	 * "unredirect %d.%d\n", port->dev->nr, port->nr);
183 	 */
184 	mutex_lock(&redirect_lock);
185 	if (port->output->dma->running) {
186 		mutex_unlock(&redirect_lock);
187 		return -EBUSY;
188 	}
189 	oredi = port->output->redi;
190 	if (!oredi)
191 		goto done;
192 	if (port->input[0]) {
193 		iredi = port->input[0]->redi;
194 		iredo = port->input[0]->redo;
195 
196 		if (iredo) {
197 			iredo->port->output->redi = oredi;
198 			if (iredo->port->input[0]) {
199 				iredo->port->input[0]->redi = iredi;
200 				ddb_redirect_dma(oredi->port->dev,
201 						 oredi->dma, iredo->dma);
202 			}
203 			port->input[0]->redo = NULL;
204 			ddb_set_dma_table(port->input[0]);
205 		}
206 		oredi->redi = iredi;
207 		port->input[0]->redi = NULL;
208 	}
209 	oredi->redo = NULL;
210 	port->output->redi = NULL;
211 
212 	ddb_set_dma_table(oredi);
213 done:
214 	mutex_unlock(&redirect_lock);
215 	return 0;
216 }
217 
218 static int ddb_redirect(u32 i, u32 p)
219 {
220 	struct ddb *idev = ddbs[(i >> 4) & 0x3f];
221 	struct ddb_input *input, *input2;
222 	struct ddb *pdev = ddbs[(p >> 4) & 0x3f];
223 	struct ddb_port *port;
224 
225 	if (!idev || !pdev)
226 		return -EINVAL;
227 	if (!idev->has_dma || !pdev->has_dma)
228 		return -EINVAL;
229 
230 	port = &pdev->port[p & 0x0f];
231 	if (!port->output)
232 		return -EINVAL;
233 	if (ddb_unredirect(port))
234 		return -EBUSY;
235 
236 	if (i == 8)
237 		return 0;
238 
239 	input = &idev->input[i & 7];
240 	if (!input)
241 		return -EINVAL;
242 
243 	mutex_lock(&redirect_lock);
244 	if (port->output->dma->running || input->dma->running) {
245 		mutex_unlock(&redirect_lock);
246 		return -EBUSY;
247 	}
248 	input2 = port->input[0];
249 	if (input2) {
250 		if (input->redi) {
251 			input2->redi = input->redi;
252 			input->redi = NULL;
253 		} else {
254 			input2->redi = input;
255 		}
256 	}
257 	input->redo = port->output;
258 	port->output->redi = input;
259 
260 	ddb_redirect_dma(input->port->dev, input->dma, port->output->dma);
261 	mutex_unlock(&redirect_lock);
262 	return 0;
263 }
264 
265 /****************************************************************************/
266 /****************************************************************************/
267 /****************************************************************************/
268 
269 static void dma_free(struct pci_dev *pdev, struct ddb_dma *dma, int dir)
270 {
271 	int i;
272 
273 	if (!dma)
274 		return;
275 	for (i = 0; i < dma->num; i++) {
276 		if (dma->vbuf[i]) {
277 			if (alt_dma) {
278 				dma_unmap_single(&pdev->dev, dma->pbuf[i],
279 						 dma->size,
280 						 dir ? DMA_TO_DEVICE :
281 						 DMA_FROM_DEVICE);
282 				kfree(dma->vbuf[i]);
283 				dma->vbuf[i] = NULL;
284 			} else {
285 				dma_free_coherent(&pdev->dev, dma->size,
286 						  dma->vbuf[i], dma->pbuf[i]);
287 			}
288 
289 			dma->vbuf[i] = NULL;
290 		}
291 	}
292 }
293 
294 static int dma_alloc(struct pci_dev *pdev, struct ddb_dma *dma, int dir)
295 {
296 	int i;
297 
298 	if (!dma)
299 		return 0;
300 	for (i = 0; i < dma->num; i++) {
301 		if (alt_dma) {
302 			dma->vbuf[i] = kmalloc(dma->size, __GFP_RETRY_MAYFAIL);
303 			if (!dma->vbuf[i])
304 				return -ENOMEM;
305 			dma->pbuf[i] = dma_map_single(&pdev->dev,
306 						      dma->vbuf[i],
307 						      dma->size,
308 						      dir ? DMA_TO_DEVICE :
309 						      DMA_FROM_DEVICE);
310 			if (dma_mapping_error(&pdev->dev, dma->pbuf[i])) {
311 				kfree(dma->vbuf[i]);
312 				dma->vbuf[i] = NULL;
313 				return -ENOMEM;
314 			}
315 		} else {
316 			dma->vbuf[i] = dma_alloc_coherent(&pdev->dev,
317 							  dma->size,
318 							  &dma->pbuf[i],
319 							  GFP_KERNEL);
320 			if (!dma->vbuf[i])
321 				return -ENOMEM;
322 		}
323 	}
324 	return 0;
325 }
326 
327 int ddb_buffers_alloc(struct ddb *dev)
328 {
329 	int i;
330 	struct ddb_port *port;
331 
332 	for (i = 0; i < dev->port_num; i++) {
333 		port = &dev->port[i];
334 		switch (port->class) {
335 		case DDB_PORT_TUNER:
336 			if (port->input[0]->dma)
337 				if (dma_alloc(dev->pdev, port->input[0]->dma, 0)
338 					< 0)
339 					return -1;
340 			if (port->input[1]->dma)
341 				if (dma_alloc(dev->pdev, port->input[1]->dma, 0)
342 					< 0)
343 					return -1;
344 			break;
345 		case DDB_PORT_CI:
346 		case DDB_PORT_LOOP:
347 			if (port->input[0]->dma)
348 				if (dma_alloc(dev->pdev, port->input[0]->dma, 0)
349 					< 0)
350 					return -1;
351 			if (port->output->dma)
352 				if (dma_alloc(dev->pdev, port->output->dma, 1)
353 					< 0)
354 					return -1;
355 			break;
356 		default:
357 			break;
358 		}
359 	}
360 	ddb_set_dma_tables(dev);
361 	return 0;
362 }
363 
364 void ddb_buffers_free(struct ddb *dev)
365 {
366 	int i;
367 	struct ddb_port *port;
368 
369 	for (i = 0; i < dev->port_num; i++) {
370 		port = &dev->port[i];
371 
372 		if (port->input[0] && port->input[0]->dma)
373 			dma_free(dev->pdev, port->input[0]->dma, 0);
374 		if (port->input[1] && port->input[1]->dma)
375 			dma_free(dev->pdev, port->input[1]->dma, 0);
376 		if (port->output && port->output->dma)
377 			dma_free(dev->pdev, port->output->dma, 1);
378 	}
379 }
380 
381 static void calc_con(struct ddb_output *output, u32 *con, u32 *con2, u32 flags)
382 {
383 	struct ddb *dev = output->port->dev;
384 	u32 bitrate = output->port->obr, max_bitrate = 72000;
385 	u32 gap = 4, nco = 0;
386 
387 	*con = 0x1c;
388 	if (output->port->gap != 0xffffffff) {
389 		flags |= 1;
390 		gap = output->port->gap;
391 		max_bitrate = 0;
392 	}
393 	if (dev->link[0].info->type == DDB_OCTOPUS_CI && output->port->nr > 1) {
394 		*con = 0x10c;
395 		if (dev->link[0].ids.regmapid >= 0x10003 && !(flags & 1)) {
396 			if (!(flags & 2)) {
397 				/* NCO */
398 				max_bitrate = 0;
399 				gap = 0;
400 				if (bitrate != 72000) {
401 					if (bitrate >= 96000) {
402 						*con |= 0x800;
403 					} else {
404 						*con |= 0x1000;
405 						nco = (bitrate * 8192 + 71999)
406 							/ 72000;
407 					}
408 				}
409 			} else {
410 				/* Divider and gap */
411 				*con |= 0x1810;
412 				if (bitrate <= 64000) {
413 					max_bitrate = 64000;
414 					nco = 8;
415 				} else if (bitrate <= 72000) {
416 					max_bitrate = 72000;
417 					nco = 7;
418 				} else {
419 					max_bitrate = 96000;
420 					nco = 5;
421 				}
422 			}
423 		} else {
424 			if (bitrate > 72000) {
425 				*con |= 0x810; /* 96 MBit/s and gap */
426 				max_bitrate = 96000;
427 			}
428 			*con |= 0x10; /* enable gap */
429 		}
430 	}
431 	if (max_bitrate > 0) {
432 		if (bitrate > max_bitrate)
433 			bitrate = max_bitrate;
434 		if (bitrate < 31000)
435 			bitrate = 31000;
436 		gap = ((max_bitrate - bitrate) * 94) / bitrate;
437 		if (gap < 2)
438 			*con &= ~0x10; /* Disable gap */
439 		else
440 			gap -= 2;
441 		if (gap > 127)
442 			gap = 127;
443 	}
444 
445 	*con2 = (nco << 16) | gap;
446 }
447 
448 static void ddb_output_start(struct ddb_output *output)
449 {
450 	struct ddb *dev = output->port->dev;
451 	u32 con = 0x11c, con2 = 0;
452 
453 	spin_lock_irq(&output->dma->lock);
454 	output->dma->cbuf = 0;
455 	output->dma->coff = 0;
456 	output->dma->stat = 0;
457 	ddbwritel(dev, 0, DMA_BUFFER_CONTROL(output->dma));
458 
459 	if (output->port->input[0]->port->class == DDB_PORT_LOOP)
460 		con = (1UL << 13) | 0x14;
461 	else
462 		calc_con(output, &con, &con2, 0);
463 
464 	ddbwritel(dev, 0, TS_CONTROL(output));
465 	ddbwritel(dev, 2, TS_CONTROL(output));
466 	ddbwritel(dev, 0, TS_CONTROL(output));
467 	ddbwritel(dev, con, TS_CONTROL(output));
468 	ddbwritel(dev, con2, TS_CONTROL2(output));
469 
470 	ddbwritel(dev, output->dma->bufval,
471 		  DMA_BUFFER_SIZE(output->dma));
472 	ddbwritel(dev, 0, DMA_BUFFER_ACK(output->dma));
473 	ddbwritel(dev, 1, DMA_BASE_READ);
474 	ddbwritel(dev, 7, DMA_BUFFER_CONTROL(output->dma));
475 
476 	ddbwritel(dev, con | 1, TS_CONTROL(output));
477 
478 	output->dma->running = 1;
479 	spin_unlock_irq(&output->dma->lock);
480 }
481 
482 static void ddb_output_stop(struct ddb_output *output)
483 {
484 	struct ddb *dev = output->port->dev;
485 
486 	spin_lock_irq(&output->dma->lock);
487 
488 	ddbwritel(dev, 0, TS_CONTROL(output));
489 
490 	ddbwritel(dev, 0, DMA_BUFFER_CONTROL(output->dma));
491 	output->dma->running = 0;
492 	spin_unlock_irq(&output->dma->lock);
493 }
494 
495 static void ddb_input_stop(struct ddb_input *input)
496 {
497 	struct ddb *dev = input->port->dev;
498 	u32 tag = DDB_LINK_TAG(input->port->lnr);
499 
500 	spin_lock_irq(&input->dma->lock);
501 
502 	ddbwritel(dev, 0, tag | TS_CONTROL(input));
503 
504 	ddbwritel(dev, 0, DMA_BUFFER_CONTROL(input->dma));
505 	input->dma->running = 0;
506 	spin_unlock_irq(&input->dma->lock);
507 }
508 
509 static void ddb_input_start(struct ddb_input *input)
510 {
511 	struct ddb *dev = input->port->dev;
512 
513 	spin_lock_irq(&input->dma->lock);
514 	input->dma->cbuf = 0;
515 	input->dma->coff = 0;
516 	input->dma->stat = 0;
517 	ddbwritel(dev, 0, DMA_BUFFER_CONTROL(input->dma));
518 
519 	ddbwritel(dev, 0, TS_CONTROL(input));
520 	ddbwritel(dev, 2, TS_CONTROL(input));
521 	ddbwritel(dev, 0, TS_CONTROL(input));
522 
523 	ddbwritel(dev, input->dma->bufval,
524 		  DMA_BUFFER_SIZE(input->dma));
525 	ddbwritel(dev, 0, DMA_BUFFER_ACK(input->dma));
526 	ddbwritel(dev, 1, DMA_BASE_WRITE);
527 	ddbwritel(dev, 3, DMA_BUFFER_CONTROL(input->dma));
528 
529 	ddbwritel(dev, 0x09, TS_CONTROL(input));
530 
531 	if (input->port->type == DDB_TUNER_DUMMY)
532 		ddbwritel(dev, 0x000fff01, TS_CONTROL2(input));
533 
534 	input->dma->running = 1;
535 	spin_unlock_irq(&input->dma->lock);
536 }
537 
538 static void ddb_input_start_all(struct ddb_input *input)
539 {
540 	struct ddb_input *i = input;
541 	struct ddb_output *o;
542 
543 	mutex_lock(&redirect_lock);
544 	while (i && (o = i->redo)) {
545 		ddb_output_start(o);
546 		i = o->port->input[0];
547 		if (i)
548 			ddb_input_start(i);
549 	}
550 	ddb_input_start(input);
551 	mutex_unlock(&redirect_lock);
552 }
553 
554 static void ddb_input_stop_all(struct ddb_input *input)
555 {
556 	struct ddb_input *i = input;
557 	struct ddb_output *o;
558 
559 	mutex_lock(&redirect_lock);
560 	ddb_input_stop(input);
561 	while (i && (o = i->redo)) {
562 		ddb_output_stop(o);
563 		i = o->port->input[0];
564 		if (i)
565 			ddb_input_stop(i);
566 	}
567 	mutex_unlock(&redirect_lock);
568 }
569 
570 static u32 ddb_output_free(struct ddb_output *output)
571 {
572 	u32 idx, off, stat = output->dma->stat;
573 	s32 diff;
574 
575 	idx = (stat >> 11) & 0x1f;
576 	off = (stat & 0x7ff) << 7;
577 
578 	if (output->dma->cbuf != idx) {
579 		if ((((output->dma->cbuf + 1) % output->dma->num) == idx) &&
580 		    (output->dma->size - output->dma->coff <= (2 * 188)))
581 			return 0;
582 		return 188;
583 	}
584 	diff = off - output->dma->coff;
585 	if (diff <= 0 || diff > (2 * 188))
586 		return 188;
587 	return 0;
588 }
589 
590 static ssize_t ddb_output_write(struct ddb_output *output,
591 				const __user u8 *buf, size_t count)
592 {
593 	struct ddb *dev = output->port->dev;
594 	u32 idx, off, stat = output->dma->stat;
595 	u32 left = count, len;
596 
597 	idx = (stat >> 11) & 0x1f;
598 	off = (stat & 0x7ff) << 7;
599 
600 	while (left) {
601 		len = output->dma->size - output->dma->coff;
602 		if ((((output->dma->cbuf + 1) % output->dma->num) == idx) &&
603 		    off == 0) {
604 			if (len <= 188)
605 				break;
606 			len -= 188;
607 		}
608 		if (output->dma->cbuf == idx) {
609 			if (off > output->dma->coff) {
610 				len = off - output->dma->coff;
611 				len -= (len % 188);
612 				if (len <= 188)
613 					break;
614 				len -= 188;
615 			}
616 		}
617 		if (len > left)
618 			len = left;
619 		if (copy_from_user(output->dma->vbuf[output->dma->cbuf] +
620 				   output->dma->coff,
621 				   buf, len))
622 			return -EIO;
623 		if (alt_dma)
624 			dma_sync_single_for_device(
625 				dev->dev,
626 				output->dma->pbuf[output->dma->cbuf],
627 				output->dma->size, DMA_TO_DEVICE);
628 		left -= len;
629 		buf += len;
630 		output->dma->coff += len;
631 		if (output->dma->coff == output->dma->size) {
632 			output->dma->coff = 0;
633 			output->dma->cbuf = ((output->dma->cbuf + 1) %
634 					     output->dma->num);
635 		}
636 		ddbwritel(dev,
637 			  (output->dma->cbuf << 11) |
638 			  (output->dma->coff >> 7),
639 			  DMA_BUFFER_ACK(output->dma));
640 	}
641 	return count - left;
642 }
643 
644 static u32 ddb_input_avail(struct ddb_input *input)
645 {
646 	struct ddb *dev = input->port->dev;
647 	u32 idx, off, stat = input->dma->stat;
648 	u32 ctrl = ddbreadl(dev, DMA_BUFFER_CONTROL(input->dma));
649 
650 	idx = (stat >> 11) & 0x1f;
651 	off = (stat & 0x7ff) << 7;
652 
653 	if (ctrl & 4) {
654 		dev_err(dev->dev, "IA %d %d %08x\n", idx, off, ctrl);
655 		ddbwritel(dev, stat, DMA_BUFFER_ACK(input->dma));
656 		return 0;
657 	}
658 	if (input->dma->cbuf != idx)
659 		return 188;
660 	return 0;
661 }
662 
663 static ssize_t ddb_input_read(struct ddb_input *input,
664 			      __user u8 *buf, size_t count)
665 {
666 	struct ddb *dev = input->port->dev;
667 	u32 left = count;
668 	u32 idx, free, stat = input->dma->stat;
669 	int ret;
670 
671 	idx = (stat >> 11) & 0x1f;
672 
673 	while (left) {
674 		if (input->dma->cbuf == idx)
675 			return count - left;
676 		free = input->dma->size - input->dma->coff;
677 		if (free > left)
678 			free = left;
679 		if (alt_dma)
680 			dma_sync_single_for_cpu(
681 				dev->dev,
682 				input->dma->pbuf[input->dma->cbuf],
683 				input->dma->size, DMA_FROM_DEVICE);
684 		ret = copy_to_user(buf, input->dma->vbuf[input->dma->cbuf] +
685 				   input->dma->coff, free);
686 		if (ret)
687 			return -EFAULT;
688 		input->dma->coff += free;
689 		if (input->dma->coff == input->dma->size) {
690 			input->dma->coff = 0;
691 			input->dma->cbuf = (input->dma->cbuf + 1) %
692 				input->dma->num;
693 		}
694 		left -= free;
695 		buf += free;
696 		ddbwritel(dev,
697 			  (input->dma->cbuf << 11) | (input->dma->coff >> 7),
698 			  DMA_BUFFER_ACK(input->dma));
699 	}
700 	return count;
701 }
702 
703 /****************************************************************************/
704 /****************************************************************************/
705 
706 static ssize_t ts_write(struct file *file, const __user char *buf,
707 			size_t count, loff_t *ppos)
708 {
709 	struct dvb_device *dvbdev = file->private_data;
710 	struct ddb_output *output = dvbdev->priv;
711 	struct ddb *dev = output->port->dev;
712 	size_t left = count;
713 	int stat;
714 
715 	if (!dev->has_dma)
716 		return -EINVAL;
717 	while (left) {
718 		if (ddb_output_free(output) < 188) {
719 			if (file->f_flags & O_NONBLOCK)
720 				break;
721 			if (wait_event_interruptible(
722 				    output->dma->wq,
723 				    ddb_output_free(output) >= 188) < 0)
724 				break;
725 		}
726 		stat = ddb_output_write(output, buf, left);
727 		if (stat < 0)
728 			return stat;
729 		buf += stat;
730 		left -= stat;
731 	}
732 	return (left == count) ? -EAGAIN : (count - left);
733 }
734 
735 static ssize_t ts_read(struct file *file, __user char *buf,
736 		       size_t count, loff_t *ppos)
737 {
738 	struct dvb_device *dvbdev = file->private_data;
739 	struct ddb_output *output = dvbdev->priv;
740 	struct ddb_input *input = output->port->input[0];
741 	struct ddb *dev = output->port->dev;
742 	size_t left = count;
743 	int stat;
744 
745 	if (!dev->has_dma)
746 		return -EINVAL;
747 	while (left) {
748 		if (ddb_input_avail(input) < 188) {
749 			if (file->f_flags & O_NONBLOCK)
750 				break;
751 			if (wait_event_interruptible(
752 				    input->dma->wq,
753 				    ddb_input_avail(input) >= 188) < 0)
754 				break;
755 		}
756 		stat = ddb_input_read(input, buf, left);
757 		if (stat < 0)
758 			return stat;
759 		left -= stat;
760 		buf += stat;
761 	}
762 	return (count && (left == count)) ? -EAGAIN : (count - left);
763 }
764 
765 static __poll_t ts_poll(struct file *file, poll_table *wait)
766 {
767 	struct dvb_device *dvbdev = file->private_data;
768 	struct ddb_output *output = dvbdev->priv;
769 	struct ddb_input *input = output->port->input[0];
770 
771 	__poll_t mask = 0;
772 
773 	poll_wait(file, &input->dma->wq, wait);
774 	poll_wait(file, &output->dma->wq, wait);
775 	if (ddb_input_avail(input) >= 188)
776 		mask |= EPOLLIN | EPOLLRDNORM;
777 	if (ddb_output_free(output) >= 188)
778 		mask |= EPOLLOUT | EPOLLWRNORM;
779 	return mask;
780 }
781 
782 static int ts_release(struct inode *inode, struct file *file)
783 {
784 	struct dvb_device *dvbdev = file->private_data;
785 	struct ddb_output *output = NULL;
786 	struct ddb_input *input = NULL;
787 
788 	if (dvbdev) {
789 		output = dvbdev->priv;
790 		input = output->port->input[0];
791 	}
792 
793 	if ((file->f_flags & O_ACCMODE) == O_RDONLY) {
794 		if (!input)
795 			return -EINVAL;
796 		ddb_input_stop(input);
797 	} else if ((file->f_flags & O_ACCMODE) == O_WRONLY) {
798 		if (!output)
799 			return -EINVAL;
800 		ddb_output_stop(output);
801 	}
802 	return dvb_generic_release(inode, file);
803 }
804 
805 static int ts_open(struct inode *inode, struct file *file)
806 {
807 	int err;
808 	struct dvb_device *dvbdev = file->private_data;
809 	struct ddb_output *output = NULL;
810 	struct ddb_input *input = NULL;
811 
812 	if (dvbdev) {
813 		output = dvbdev->priv;
814 		input = output->port->input[0];
815 	}
816 
817 	if ((file->f_flags & O_ACCMODE) == O_RDONLY) {
818 		if (!input)
819 			return -EINVAL;
820 		if (input->redo || input->redi)
821 			return -EBUSY;
822 	} else if ((file->f_flags & O_ACCMODE) == O_WRONLY) {
823 		if (!output)
824 			return -EINVAL;
825 	} else {
826 		return -EINVAL;
827 	}
828 
829 	err = dvb_generic_open(inode, file);
830 	if (err < 0)
831 		return err;
832 	if ((file->f_flags & O_ACCMODE) == O_RDONLY)
833 		ddb_input_start(input);
834 	else if ((file->f_flags & O_ACCMODE) == O_WRONLY)
835 		ddb_output_start(output);
836 	return err;
837 }
838 
839 static const struct file_operations ci_fops = {
840 	.owner   = THIS_MODULE,
841 	.read    = ts_read,
842 	.write   = ts_write,
843 	.open    = ts_open,
844 	.release = ts_release,
845 	.poll    = ts_poll,
846 	.mmap    = NULL,
847 };
848 
849 static struct dvb_device dvbdev_ci = {
850 	.priv    = NULL,
851 	.readers = 1,
852 	.writers = 1,
853 	.users   = 2,
854 	.fops    = &ci_fops,
855 };
856 
857 /****************************************************************************/
858 /****************************************************************************/
859 
860 static int locked_gate_ctrl(struct dvb_frontend *fe, int enable)
861 {
862 	struct ddb_input *input = fe->sec_priv;
863 	struct ddb_port *port = input->port;
864 	struct ddb_dvb *dvb = &port->dvb[input->nr & 1];
865 	int status;
866 
867 	if (enable) {
868 		mutex_lock(&port->i2c_gate_lock);
869 		status = dvb->i2c_gate_ctrl(fe, 1);
870 	} else {
871 		status = dvb->i2c_gate_ctrl(fe, 0);
872 		mutex_unlock(&port->i2c_gate_lock);
873 	}
874 	return status;
875 }
876 
877 static int demod_attach_drxk(struct ddb_input *input)
878 {
879 	struct i2c_adapter *i2c = &input->port->i2c->adap;
880 	struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
881 	struct device *dev = input->port->dev->dev;
882 	struct drxk_config config;
883 
884 	memset(&config, 0, sizeof(config));
885 	config.adr = 0x29 + (input->nr & 1);
886 	config.microcode_name = "drxk_a3.mc";
887 
888 	dvb->fe = dvb_attach(drxk_attach, &config, i2c);
889 	if (!dvb->fe) {
890 		dev_err(dev, "No DRXK found!\n");
891 		return -ENODEV;
892 	}
893 	dvb->fe->sec_priv = input;
894 	dvb->i2c_gate_ctrl = dvb->fe->ops.i2c_gate_ctrl;
895 	dvb->fe->ops.i2c_gate_ctrl = locked_gate_ctrl;
896 	return 0;
897 }
898 
899 static int tuner_attach_tda18271(struct ddb_input *input)
900 {
901 	struct i2c_adapter *i2c = &input->port->i2c->adap;
902 	struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
903 	struct device *dev = input->port->dev->dev;
904 	struct dvb_frontend *fe;
905 
906 	if (dvb->fe->ops.i2c_gate_ctrl)
907 		dvb->fe->ops.i2c_gate_ctrl(dvb->fe, 1);
908 	fe = dvb_attach(tda18271c2dd_attach, dvb->fe, i2c, 0x60);
909 	if (dvb->fe->ops.i2c_gate_ctrl)
910 		dvb->fe->ops.i2c_gate_ctrl(dvb->fe, 0);
911 	if (!fe) {
912 		dev_err(dev, "No TDA18271 found!\n");
913 		return -ENODEV;
914 	}
915 	return 0;
916 }
917 
918 /******************************************************************************/
919 /******************************************************************************/
920 /******************************************************************************/
921 
922 static struct stv0367_config ddb_stv0367_config[] = {
923 	{
924 		.demod_address = 0x1f,
925 		.xtal = 27000000,
926 		.if_khz = 0,
927 		.if_iq_mode = FE_TER_NORMAL_IF_TUNER,
928 		.ts_mode = STV0367_SERIAL_PUNCT_CLOCK,
929 		.clk_pol = STV0367_CLOCKPOLARITY_DEFAULT,
930 	}, {
931 		.demod_address = 0x1e,
932 		.xtal = 27000000,
933 		.if_khz = 0,
934 		.if_iq_mode = FE_TER_NORMAL_IF_TUNER,
935 		.ts_mode = STV0367_SERIAL_PUNCT_CLOCK,
936 		.clk_pol = STV0367_CLOCKPOLARITY_DEFAULT,
937 	},
938 };
939 
940 static int demod_attach_stv0367(struct ddb_input *input)
941 {
942 	struct i2c_adapter *i2c = &input->port->i2c->adap;
943 	struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
944 	struct device *dev = input->port->dev->dev;
945 
946 	/* attach frontend */
947 	dvb->fe = dvb_attach(stv0367ddb_attach,
948 			     &ddb_stv0367_config[(input->nr & 1)], i2c);
949 
950 	if (!dvb->fe) {
951 		dev_err(dev, "No stv0367 found!\n");
952 		return -ENODEV;
953 	}
954 	dvb->fe->sec_priv = input;
955 	dvb->i2c_gate_ctrl = dvb->fe->ops.i2c_gate_ctrl;
956 	dvb->fe->ops.i2c_gate_ctrl = locked_gate_ctrl;
957 	return 0;
958 }
959 
960 static int tuner_tda18212_ping(struct ddb_input *input, unsigned short adr)
961 {
962 	struct i2c_adapter *adapter = &input->port->i2c->adap;
963 	struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
964 	struct device *dev = input->port->dev->dev;
965 	u8 tda_id[2];
966 	u8 subaddr = 0x00;
967 
968 	dev_dbg(dev, "stv0367-tda18212 tuner ping\n");
969 	if (dvb->fe->ops.i2c_gate_ctrl)
970 		dvb->fe->ops.i2c_gate_ctrl(dvb->fe, 1);
971 
972 	if (i2c_read_regs(adapter, adr, subaddr, tda_id, sizeof(tda_id)) < 0)
973 		dev_dbg(dev, "tda18212 ping 1 fail\n");
974 	if (i2c_read_regs(adapter, adr, subaddr, tda_id, sizeof(tda_id)) < 0)
975 		dev_warn(dev, "tda18212 ping failed, expect problems\n");
976 
977 	if (dvb->fe->ops.i2c_gate_ctrl)
978 		dvb->fe->ops.i2c_gate_ctrl(dvb->fe, 0);
979 
980 	return 0;
981 }
982 
983 static int demod_attach_cxd28xx(struct ddb_input *input, int par, int osc24)
984 {
985 	struct i2c_adapter *i2c = &input->port->i2c->adap;
986 	struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
987 	struct device *dev = input->port->dev->dev;
988 	struct cxd2841er_config cfg;
989 
990 	/* the cxd2841er driver expects 8bit/shifted I2C addresses */
991 	cfg.i2c_addr = ((input->nr & 1) ? 0x6d : 0x6c) << 1;
992 
993 	cfg.xtal = osc24 ? SONY_XTAL_24000 : SONY_XTAL_20500;
994 	cfg.flags = CXD2841ER_AUTO_IFHZ | CXD2841ER_EARLY_TUNE |
995 		CXD2841ER_NO_WAIT_LOCK | CXD2841ER_NO_AGCNEG |
996 		CXD2841ER_TSBITS;
997 
998 	if (!par)
999 		cfg.flags |= CXD2841ER_TS_SERIAL;
1000 
1001 	/* attach frontend */
1002 	dvb->fe = dvb_attach(cxd2841er_attach_t_c, &cfg, i2c);
1003 
1004 	if (!dvb->fe) {
1005 		dev_err(dev, "No cxd2837/38/43/54 found!\n");
1006 		return -ENODEV;
1007 	}
1008 	dvb->fe->sec_priv = input;
1009 	dvb->i2c_gate_ctrl = dvb->fe->ops.i2c_gate_ctrl;
1010 	dvb->fe->ops.i2c_gate_ctrl = locked_gate_ctrl;
1011 	return 0;
1012 }
1013 
1014 static int tuner_attach_tda18212(struct ddb_input *input, u32 porttype)
1015 {
1016 	struct i2c_adapter *adapter = &input->port->i2c->adap;
1017 	struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
1018 	struct device *dev = input->port->dev->dev;
1019 	struct i2c_client *client;
1020 	struct tda18212_config config = {
1021 		.fe = dvb->fe,
1022 		.if_dvbt_6 = 3550,
1023 		.if_dvbt_7 = 3700,
1024 		.if_dvbt_8 = 4150,
1025 		.if_dvbt2_6 = 3250,
1026 		.if_dvbt2_7 = 4000,
1027 		.if_dvbt2_8 = 4000,
1028 		.if_dvbc = 5000,
1029 	};
1030 	u8 addr = (input->nr & 1) ? 0x63 : 0x60;
1031 
1032 	/* due to a hardware quirk with the I2C gate on the stv0367+tda18212
1033 	 * combo, the tda18212 must be probed by reading it's id _twice_ when
1034 	 * cold started, or it very likely will fail.
1035 	 */
1036 	if (porttype == DDB_TUNER_DVBCT_ST)
1037 		tuner_tda18212_ping(input, addr);
1038 
1039 	/* perform tuner probe/init/attach */
1040 	client = dvb_module_probe("tda18212", NULL, adapter, addr, &config);
1041 	if (!client)
1042 		goto err;
1043 
1044 	dvb->i2c_client[0] = client;
1045 	return 0;
1046 err:
1047 	dev_err(dev, "TDA18212 tuner not found. Device is not fully operational.\n");
1048 	return -ENODEV;
1049 }
1050 
1051 /****************************************************************************/
1052 /****************************************************************************/
1053 /****************************************************************************/
1054 
1055 static struct stv090x_config stv0900 = {
1056 	.device         = STV0900,
1057 	.demod_mode     = STV090x_DUAL,
1058 	.clk_mode       = STV090x_CLK_EXT,
1059 
1060 	.xtal           = 27000000,
1061 	.address        = 0x69,
1062 
1063 	.ts1_mode       = STV090x_TSMODE_SERIAL_PUNCTURED,
1064 	.ts2_mode       = STV090x_TSMODE_SERIAL_PUNCTURED,
1065 
1066 	.ts1_tei        = 1,
1067 	.ts2_tei        = 1,
1068 
1069 	.repeater_level = STV090x_RPTLEVEL_16,
1070 
1071 	.adc1_range	= STV090x_ADC_1Vpp,
1072 	.adc2_range	= STV090x_ADC_1Vpp,
1073 
1074 	.diseqc_envelope_mode = true,
1075 };
1076 
1077 static struct stv090x_config stv0900_aa = {
1078 	.device         = STV0900,
1079 	.demod_mode     = STV090x_DUAL,
1080 	.clk_mode       = STV090x_CLK_EXT,
1081 
1082 	.xtal           = 27000000,
1083 	.address        = 0x68,
1084 
1085 	.ts1_mode       = STV090x_TSMODE_SERIAL_PUNCTURED,
1086 	.ts2_mode       = STV090x_TSMODE_SERIAL_PUNCTURED,
1087 
1088 	.ts1_tei        = 1,
1089 	.ts2_tei        = 1,
1090 
1091 	.repeater_level = STV090x_RPTLEVEL_16,
1092 
1093 	.adc1_range	= STV090x_ADC_1Vpp,
1094 	.adc2_range	= STV090x_ADC_1Vpp,
1095 
1096 	.diseqc_envelope_mode = true,
1097 };
1098 
1099 static struct stv6110x_config stv6110a = {
1100 	.addr    = 0x60,
1101 	.refclk	 = 27000000,
1102 	.clk_div = 1,
1103 };
1104 
1105 static struct stv6110x_config stv6110b = {
1106 	.addr    = 0x63,
1107 	.refclk	 = 27000000,
1108 	.clk_div = 1,
1109 };
1110 
1111 static int demod_attach_stv0900(struct ddb_input *input, int type)
1112 {
1113 	struct i2c_adapter *i2c = &input->port->i2c->adap;
1114 	struct stv090x_config *feconf = type ? &stv0900_aa : &stv0900;
1115 	struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
1116 	struct device *dev = input->port->dev->dev;
1117 
1118 	dvb->fe = dvb_attach(stv090x_attach, feconf, i2c,
1119 			     (input->nr & 1) ? STV090x_DEMODULATOR_1
1120 			     : STV090x_DEMODULATOR_0);
1121 	if (!dvb->fe) {
1122 		dev_err(dev, "No STV0900 found!\n");
1123 		return -ENODEV;
1124 	}
1125 	if (!dvb_attach(lnbh24_attach, dvb->fe, i2c, 0,
1126 			0, (input->nr & 1) ?
1127 			(0x09 - type) : (0x0b - type))) {
1128 		dev_err(dev, "No LNBH24 found!\n");
1129 		dvb_frontend_detach(dvb->fe);
1130 		return -ENODEV;
1131 	}
1132 	return 0;
1133 }
1134 
1135 static int tuner_attach_stv6110(struct ddb_input *input, int type)
1136 {
1137 	struct i2c_adapter *i2c = &input->port->i2c->adap;
1138 	struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
1139 	struct device *dev = input->port->dev->dev;
1140 	struct stv090x_config *feconf = type ? &stv0900_aa : &stv0900;
1141 	struct stv6110x_config *tunerconf = (input->nr & 1) ?
1142 		&stv6110b : &stv6110a;
1143 	const struct stv6110x_devctl *ctl;
1144 
1145 	ctl = dvb_attach(stv6110x_attach, dvb->fe, tunerconf, i2c);
1146 	if (!ctl) {
1147 		dev_err(dev, "No STV6110X found!\n");
1148 		return -ENODEV;
1149 	}
1150 	dev_info(dev, "attach tuner input %d adr %02x\n",
1151 		 input->nr, tunerconf->addr);
1152 
1153 	feconf->tuner_init          = ctl->tuner_init;
1154 	feconf->tuner_sleep         = ctl->tuner_sleep;
1155 	feconf->tuner_set_mode      = ctl->tuner_set_mode;
1156 	feconf->tuner_set_frequency = ctl->tuner_set_frequency;
1157 	feconf->tuner_get_frequency = ctl->tuner_get_frequency;
1158 	feconf->tuner_set_bandwidth = ctl->tuner_set_bandwidth;
1159 	feconf->tuner_get_bandwidth = ctl->tuner_get_bandwidth;
1160 	feconf->tuner_set_bbgain    = ctl->tuner_set_bbgain;
1161 	feconf->tuner_get_bbgain    = ctl->tuner_get_bbgain;
1162 	feconf->tuner_set_refclk    = ctl->tuner_set_refclk;
1163 	feconf->tuner_get_status    = ctl->tuner_get_status;
1164 
1165 	return 0;
1166 }
1167 
1168 static const struct stv0910_cfg stv0910_p = {
1169 	.adr      = 0x68,
1170 	.parallel = 1,
1171 	.rptlvl   = 4,
1172 	.clk      = 30000000,
1173 	.tsspeed  = 0x28,
1174 };
1175 
1176 static const struct lnbh25_config lnbh25_cfg = {
1177 	.i2c_address = 0x0c << 1,
1178 	.data2_config = LNBH25_TEN
1179 };
1180 
1181 static int has_lnbh25(struct i2c_adapter *i2c, u8 adr)
1182 {
1183 	u8 val;
1184 
1185 	return i2c_read_reg(i2c, adr, 0, &val) ? 0 : 1;
1186 }
1187 
1188 static int demod_attach_stv0910(struct ddb_input *input, int type, int tsfast)
1189 {
1190 	struct i2c_adapter *i2c = &input->port->i2c->adap;
1191 	struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
1192 	struct device *dev = input->port->dev->dev;
1193 	struct stv0910_cfg cfg = stv0910_p;
1194 	struct lnbh25_config lnbcfg = lnbh25_cfg;
1195 
1196 	if (stv0910_single)
1197 		cfg.single = 1;
1198 
1199 	if (type)
1200 		cfg.parallel = 2;
1201 
1202 	if (tsfast) {
1203 		dev_info(dev, "Enabling stv0910 higher speed TS\n");
1204 		cfg.tsspeed = 0x10;
1205 	}
1206 
1207 	dvb->fe = dvb_attach(stv0910_attach, i2c, &cfg, (input->nr & 1));
1208 	if (!dvb->fe) {
1209 		cfg.adr = 0x6c;
1210 		dvb->fe = dvb_attach(stv0910_attach, i2c,
1211 				     &cfg, (input->nr & 1));
1212 	}
1213 	if (!dvb->fe) {
1214 		dev_err(dev, "No STV0910 found!\n");
1215 		return -ENODEV;
1216 	}
1217 
1218 	/* attach lnbh25 - leftshift by one as the lnbh25 driver expects 8bit
1219 	 * i2c addresses
1220 	 */
1221 	if (has_lnbh25(i2c, 0x0d))
1222 		lnbcfg.i2c_address = (((input->nr & 1) ? 0x0d : 0x0c) << 1);
1223 	else
1224 		lnbcfg.i2c_address = (((input->nr & 1) ? 0x09 : 0x08) << 1);
1225 
1226 	if (!dvb_attach(lnbh25_attach, dvb->fe, &lnbcfg, i2c)) {
1227 		dev_err(dev, "No LNBH25 found!\n");
1228 		dvb_frontend_detach(dvb->fe);
1229 		return -ENODEV;
1230 	}
1231 
1232 	return 0;
1233 }
1234 
1235 static int tuner_attach_stv6111(struct ddb_input *input, int type)
1236 {
1237 	struct i2c_adapter *i2c = &input->port->i2c->adap;
1238 	struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
1239 	struct device *dev = input->port->dev->dev;
1240 	struct dvb_frontend *fe;
1241 	u8 adr = (type ? 0 : 4) + ((input->nr & 1) ? 0x63 : 0x60);
1242 
1243 	fe = dvb_attach(stv6111_attach, dvb->fe, i2c, adr);
1244 	if (!fe) {
1245 		fe = dvb_attach(stv6111_attach, dvb->fe, i2c, adr & ~4);
1246 		if (!fe) {
1247 			dev_err(dev, "No STV6111 found at 0x%02x!\n", adr);
1248 			return -ENODEV;
1249 		}
1250 	}
1251 	return 0;
1252 }
1253 
1254 static int demod_attach_dummy(struct ddb_input *input)
1255 {
1256 	struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
1257 	struct device *dev = input->port->dev->dev;
1258 
1259 	dvb->fe = dvb_attach(ddbridge_dummy_fe_qam_attach);
1260 	if (!dvb->fe) {
1261 		dev_err(dev, "QAM dummy attach failed!\n");
1262 		return -ENODEV;
1263 	}
1264 
1265 	return 0;
1266 }
1267 
1268 static int start_feed(struct dvb_demux_feed *dvbdmxfeed)
1269 {
1270 	struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
1271 	struct ddb_input *input = dvbdmx->priv;
1272 	struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
1273 
1274 	if (!dvb->users)
1275 		ddb_input_start_all(input);
1276 
1277 	return ++dvb->users;
1278 }
1279 
1280 static int stop_feed(struct dvb_demux_feed *dvbdmxfeed)
1281 {
1282 	struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
1283 	struct ddb_input *input = dvbdmx->priv;
1284 	struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
1285 
1286 	if (--dvb->users)
1287 		return dvb->users;
1288 
1289 	ddb_input_stop_all(input);
1290 	return 0;
1291 }
1292 
1293 static void dvb_input_detach(struct ddb_input *input)
1294 {
1295 	struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
1296 	struct dvb_demux *dvbdemux = &dvb->demux;
1297 
1298 	switch (dvb->attached) {
1299 	case 0x31:
1300 		if (dvb->fe2)
1301 			dvb_unregister_frontend(dvb->fe2);
1302 		if (dvb->fe)
1303 			dvb_unregister_frontend(dvb->fe);
1304 		fallthrough;
1305 	case 0x30:
1306 		dvb_module_release(dvb->i2c_client[0]);
1307 		dvb->i2c_client[0] = NULL;
1308 
1309 		if (dvb->fe2)
1310 			dvb_frontend_detach(dvb->fe2);
1311 		if (dvb->fe)
1312 			dvb_frontend_detach(dvb->fe);
1313 		dvb->fe = NULL;
1314 		dvb->fe2 = NULL;
1315 		fallthrough;
1316 	case 0x20:
1317 		dvb_net_release(&dvb->dvbnet);
1318 		fallthrough;
1319 	case 0x12:
1320 		dvbdemux->dmx.remove_frontend(&dvbdemux->dmx,
1321 					      &dvb->hw_frontend);
1322 		dvbdemux->dmx.remove_frontend(&dvbdemux->dmx,
1323 					      &dvb->mem_frontend);
1324 		fallthrough;
1325 	case 0x11:
1326 		dvb_dmxdev_release(&dvb->dmxdev);
1327 		fallthrough;
1328 	case 0x10:
1329 		dvb_dmx_release(&dvb->demux);
1330 		fallthrough;
1331 	case 0x01:
1332 		break;
1333 	}
1334 	dvb->attached = 0x00;
1335 }
1336 
1337 static int dvb_register_adapters(struct ddb *dev)
1338 {
1339 	int i, ret = 0;
1340 	struct ddb_port *port;
1341 	struct dvb_adapter *adap;
1342 
1343 	if (adapter_alloc == 3) {
1344 		port = &dev->port[0];
1345 		adap = port->dvb[0].adap;
1346 		ret = dvb_register_adapter(adap, "DDBridge", THIS_MODULE,
1347 					   port->dev->dev,
1348 					   adapter_nr);
1349 		if (ret < 0)
1350 			return ret;
1351 		port->dvb[0].adap_registered = 1;
1352 		for (i = 0; i < dev->port_num; i++) {
1353 			port = &dev->port[i];
1354 			port->dvb[0].adap = adap;
1355 			port->dvb[1].adap = adap;
1356 		}
1357 		return 0;
1358 	}
1359 
1360 	for (i = 0; i < dev->port_num; i++) {
1361 		port = &dev->port[i];
1362 		switch (port->class) {
1363 		case DDB_PORT_TUNER:
1364 			adap = port->dvb[0].adap;
1365 			ret = dvb_register_adapter(adap, "DDBridge",
1366 						   THIS_MODULE,
1367 						   port->dev->dev,
1368 						   adapter_nr);
1369 			if (ret < 0)
1370 				return ret;
1371 			port->dvb[0].adap_registered = 1;
1372 
1373 			if (adapter_alloc > 0) {
1374 				port->dvb[1].adap = port->dvb[0].adap;
1375 				break;
1376 			}
1377 			adap = port->dvb[1].adap;
1378 			ret = dvb_register_adapter(adap, "DDBridge",
1379 						   THIS_MODULE,
1380 						   port->dev->dev,
1381 						   adapter_nr);
1382 			if (ret < 0)
1383 				return ret;
1384 			port->dvb[1].adap_registered = 1;
1385 			break;
1386 
1387 		case DDB_PORT_CI:
1388 		case DDB_PORT_LOOP:
1389 			adap = port->dvb[0].adap;
1390 			ret = dvb_register_adapter(adap, "DDBridge",
1391 						   THIS_MODULE,
1392 						   port->dev->dev,
1393 						   adapter_nr);
1394 			if (ret < 0)
1395 				return ret;
1396 			port->dvb[0].adap_registered = 1;
1397 			break;
1398 		default:
1399 			if (adapter_alloc < 2)
1400 				break;
1401 			adap = port->dvb[0].adap;
1402 			ret = dvb_register_adapter(adap, "DDBridge",
1403 						   THIS_MODULE,
1404 						   port->dev->dev,
1405 						   adapter_nr);
1406 			if (ret < 0)
1407 				return ret;
1408 			port->dvb[0].adap_registered = 1;
1409 			break;
1410 		}
1411 	}
1412 	return ret;
1413 }
1414 
1415 static void dvb_unregister_adapters(struct ddb *dev)
1416 {
1417 	int i;
1418 	struct ddb_port *port;
1419 	struct ddb_dvb *dvb;
1420 
1421 	for (i = 0; i < dev->link[0].info->port_num; i++) {
1422 		port = &dev->port[i];
1423 
1424 		dvb = &port->dvb[0];
1425 		if (dvb->adap_registered)
1426 			dvb_unregister_adapter(dvb->adap);
1427 		dvb->adap_registered = 0;
1428 
1429 		dvb = &port->dvb[1];
1430 		if (dvb->adap_registered)
1431 			dvb_unregister_adapter(dvb->adap);
1432 		dvb->adap_registered = 0;
1433 	}
1434 }
1435 
1436 static int dvb_input_attach(struct ddb_input *input)
1437 {
1438 	int ret = 0;
1439 	struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
1440 	struct ddb_port *port = input->port;
1441 	struct dvb_adapter *adap = dvb->adap;
1442 	struct dvb_demux *dvbdemux = &dvb->demux;
1443 	struct ddb_ids *devids = &input->port->dev->link[input->port->lnr].ids;
1444 	int par = 0, osc24 = 0, tsfast = 0;
1445 
1446 	/*
1447 	 * Determine if bridges with stv0910 demods can run with fast TS and
1448 	 * thus support high bandwidth transponders.
1449 	 * STV0910_PR and STV0910_P tuner types covers all relevant bridges,
1450 	 * namely the CineS2 V7(A) and the Octopus CI S2 Pro/Advanced. All
1451 	 * DuoFlex S2 V4(A) have type=DDB_TUNER_DVBS_STV0910 without any suffix
1452 	 * and are limited by the serial link to the bridge, thus won't work
1453 	 * in fast TS mode.
1454 	 */
1455 	if (port->nr == 0 &&
1456 	    (port->type == DDB_TUNER_DVBS_STV0910_PR ||
1457 	     port->type == DDB_TUNER_DVBS_STV0910_P)) {
1458 		/* fast TS on port 0 requires FPGA version >= 1.7 */
1459 		if ((devids->hwid & 0x00ffffff) >= 0x00010007)
1460 			tsfast = 1;
1461 	}
1462 
1463 	dvb->attached = 0x01;
1464 
1465 	dvbdemux->priv = input;
1466 	dvbdemux->dmx.capabilities = DMX_TS_FILTERING |
1467 		DMX_SECTION_FILTERING | DMX_MEMORY_BASED_FILTERING;
1468 	dvbdemux->start_feed = start_feed;
1469 	dvbdemux->stop_feed = stop_feed;
1470 	dvbdemux->filternum = 256;
1471 	dvbdemux->feednum = 256;
1472 	ret = dvb_dmx_init(dvbdemux);
1473 	if (ret < 0)
1474 		return ret;
1475 	dvb->attached = 0x10;
1476 
1477 	dvb->dmxdev.filternum = 256;
1478 	dvb->dmxdev.demux = &dvbdemux->dmx;
1479 	ret = dvb_dmxdev_init(&dvb->dmxdev, adap);
1480 	if (ret < 0)
1481 		goto err_detach;
1482 	dvb->attached = 0x11;
1483 
1484 	dvb->mem_frontend.source = DMX_MEMORY_FE;
1485 	dvb->demux.dmx.add_frontend(&dvb->demux.dmx, &dvb->mem_frontend);
1486 	dvb->hw_frontend.source = DMX_FRONTEND_0;
1487 	dvb->demux.dmx.add_frontend(&dvb->demux.dmx, &dvb->hw_frontend);
1488 	ret = dvbdemux->dmx.connect_frontend(&dvbdemux->dmx, &dvb->hw_frontend);
1489 	if (ret < 0)
1490 		goto err_detach;
1491 	dvb->attached = 0x12;
1492 
1493 	ret = dvb_net_init(adap, &dvb->dvbnet, dvb->dmxdev.demux);
1494 	if (ret < 0)
1495 		goto err_detach;
1496 	dvb->attached = 0x20;
1497 
1498 	dvb->fe = NULL;
1499 	dvb->fe2 = NULL;
1500 	switch (port->type) {
1501 	case DDB_TUNER_MXL5XX:
1502 		if (ddb_fe_attach_mxl5xx(input) < 0)
1503 			goto err_detach;
1504 		break;
1505 	case DDB_TUNER_DVBS_ST:
1506 		if (demod_attach_stv0900(input, 0) < 0)
1507 			goto err_detach;
1508 		if (tuner_attach_stv6110(input, 0) < 0)
1509 			goto err_tuner;
1510 		break;
1511 	case DDB_TUNER_DVBS_ST_AA:
1512 		if (demod_attach_stv0900(input, 1) < 0)
1513 			goto err_detach;
1514 		if (tuner_attach_stv6110(input, 1) < 0)
1515 			goto err_tuner;
1516 		break;
1517 	case DDB_TUNER_DVBS_STV0910:
1518 		if (demod_attach_stv0910(input, 0, tsfast) < 0)
1519 			goto err_detach;
1520 		if (tuner_attach_stv6111(input, 0) < 0)
1521 			goto err_tuner;
1522 		break;
1523 	case DDB_TUNER_DVBS_STV0910_PR:
1524 		if (demod_attach_stv0910(input, 1, tsfast) < 0)
1525 			goto err_detach;
1526 		if (tuner_attach_stv6111(input, 1) < 0)
1527 			goto err_tuner;
1528 		break;
1529 	case DDB_TUNER_DVBS_STV0910_P:
1530 		if (demod_attach_stv0910(input, 0, tsfast) < 0)
1531 			goto err_detach;
1532 		if (tuner_attach_stv6111(input, 1) < 0)
1533 			goto err_tuner;
1534 		break;
1535 	case DDB_TUNER_DVBCT_TR:
1536 		if (demod_attach_drxk(input) < 0)
1537 			goto err_detach;
1538 		if (tuner_attach_tda18271(input) < 0)
1539 			goto err_tuner;
1540 		break;
1541 	case DDB_TUNER_DVBCT_ST:
1542 		if (demod_attach_stv0367(input) < 0)
1543 			goto err_detach;
1544 		if (tuner_attach_tda18212(input, port->type) < 0)
1545 			goto err_tuner;
1546 		break;
1547 	case DDB_TUNER_DVBC2T2I_SONY_P:
1548 		if (input->port->dev->link[input->port->lnr].info->ts_quirks &
1549 		    TS_QUIRK_ALT_OSC)
1550 			osc24 = 0;
1551 		else
1552 			osc24 = 1;
1553 		fallthrough;
1554 	case DDB_TUNER_DVBCT2_SONY_P:
1555 	case DDB_TUNER_DVBC2T2_SONY_P:
1556 	case DDB_TUNER_ISDBT_SONY_P:
1557 		if (input->port->dev->link[input->port->lnr].info->ts_quirks
1558 			& TS_QUIRK_SERIAL)
1559 			par = 0;
1560 		else
1561 			par = 1;
1562 		if (demod_attach_cxd28xx(input, par, osc24) < 0)
1563 			goto err_detach;
1564 		if (tuner_attach_tda18212(input, port->type) < 0)
1565 			goto err_tuner;
1566 		break;
1567 	case DDB_TUNER_DVBC2T2I_SONY:
1568 		osc24 = 1;
1569 		fallthrough;
1570 	case DDB_TUNER_DVBCT2_SONY:
1571 	case DDB_TUNER_DVBC2T2_SONY:
1572 	case DDB_TUNER_ISDBT_SONY:
1573 		if (demod_attach_cxd28xx(input, 0, osc24) < 0)
1574 			goto err_detach;
1575 		if (tuner_attach_tda18212(input, port->type) < 0)
1576 			goto err_tuner;
1577 		break;
1578 	case DDB_TUNER_DUMMY:
1579 		if (demod_attach_dummy(input) < 0)
1580 			goto err_detach;
1581 		break;
1582 	case DDB_TUNER_MCI_SX8:
1583 		if (ddb_fe_attach_mci(input, port->type) < 0)
1584 			goto err_detach;
1585 		break;
1586 	default:
1587 		return 0;
1588 	}
1589 	dvb->attached = 0x30;
1590 
1591 	if (dvb->fe) {
1592 		if (dvb_register_frontend(adap, dvb->fe) < 0)
1593 			goto err_detach;
1594 
1595 		if (dvb->fe2) {
1596 			if (dvb_register_frontend(adap, dvb->fe2) < 0) {
1597 				dvb_unregister_frontend(dvb->fe);
1598 				goto err_detach;
1599 			}
1600 			dvb->fe2->tuner_priv = dvb->fe->tuner_priv;
1601 			memcpy(&dvb->fe2->ops.tuner_ops,
1602 			       &dvb->fe->ops.tuner_ops,
1603 			       sizeof(struct dvb_tuner_ops));
1604 		}
1605 	}
1606 
1607 	dvb->attached = 0x31;
1608 	return 0;
1609 
1610 err_tuner:
1611 	dev_err(port->dev->dev, "tuner attach failed!\n");
1612 
1613 	if (dvb->fe2)
1614 		dvb_frontend_detach(dvb->fe2);
1615 	if (dvb->fe)
1616 		dvb_frontend_detach(dvb->fe);
1617 err_detach:
1618 	dvb_input_detach(input);
1619 
1620 	/* return error from ret if set */
1621 	if (ret < 0)
1622 		return ret;
1623 
1624 	return -ENODEV;
1625 }
1626 
1627 static int port_has_encti(struct ddb_port *port)
1628 {
1629 	struct device *dev = port->dev->dev;
1630 	u8 val;
1631 	int ret = i2c_read_reg(&port->i2c->adap, 0x20, 0, &val);
1632 
1633 	if (!ret)
1634 		dev_info(dev, "[0x20]=0x%02x\n", val);
1635 	return ret ? 0 : 1;
1636 }
1637 
1638 static int port_has_cxd(struct ddb_port *port, u8 *type)
1639 {
1640 	u8 val;
1641 	u8 probe[4] = { 0xe0, 0x00, 0x00, 0x00 }, data[4];
1642 	struct i2c_msg msgs[2] = {{ .addr = 0x40,  .flags = 0,
1643 				    .buf  = probe, .len   = 4 },
1644 				  { .addr = 0x40,  .flags = I2C_M_RD,
1645 				    .buf  = data,  .len   = 4 } };
1646 	val = i2c_transfer(&port->i2c->adap, msgs, 2);
1647 	if (val != 2)
1648 		return 0;
1649 
1650 	if (data[0] == 0x02 && data[1] == 0x2b && data[3] == 0x43)
1651 		*type = 2;
1652 	else
1653 		*type = 1;
1654 	return 1;
1655 }
1656 
1657 static int port_has_xo2(struct ddb_port *port, u8 *type, u8 *id)
1658 {
1659 	u8 probe[1] = { 0x00 }, data[4];
1660 
1661 	if (i2c_io(&port->i2c->adap, 0x10, probe, 1, data, 4))
1662 		return 0;
1663 	if (data[0] == 'D' && data[1] == 'F') {
1664 		*id = data[2];
1665 		*type = 1;
1666 		return 1;
1667 	}
1668 	if (data[0] == 'C' && data[1] == 'I') {
1669 		*id = data[2];
1670 		*type = 2;
1671 		return 1;
1672 	}
1673 	return 0;
1674 }
1675 
1676 static int port_has_stv0900(struct ddb_port *port)
1677 {
1678 	u8 val;
1679 
1680 	if (i2c_read_reg16(&port->i2c->adap, 0x69, 0xf100, &val) < 0)
1681 		return 0;
1682 	return 1;
1683 }
1684 
1685 static int port_has_stv0900_aa(struct ddb_port *port, u8 *id)
1686 {
1687 	if (i2c_read_reg16(&port->i2c->adap, 0x68, 0xf100, id) < 0)
1688 		return 0;
1689 	return 1;
1690 }
1691 
1692 static int port_has_drxks(struct ddb_port *port)
1693 {
1694 	u8 val;
1695 
1696 	if (i2c_read(&port->i2c->adap, 0x29, &val) < 0)
1697 		return 0;
1698 	if (i2c_read(&port->i2c->adap, 0x2a, &val) < 0)
1699 		return 0;
1700 	return 1;
1701 }
1702 
1703 static int port_has_stv0367(struct ddb_port *port)
1704 {
1705 	u8 val;
1706 
1707 	if (i2c_read_reg16(&port->i2c->adap, 0x1e, 0xf000, &val) < 0)
1708 		return 0;
1709 	if (val != 0x60)
1710 		return 0;
1711 	if (i2c_read_reg16(&port->i2c->adap, 0x1f, 0xf000, &val) < 0)
1712 		return 0;
1713 	if (val != 0x60)
1714 		return 0;
1715 	return 1;
1716 }
1717 
1718 static int init_xo2(struct ddb_port *port)
1719 {
1720 	struct i2c_adapter *i2c = &port->i2c->adap;
1721 	struct ddb *dev = port->dev;
1722 	u8 val, data[2];
1723 	int res;
1724 
1725 	res = i2c_read_regs(i2c, 0x10, 0x04, data, 2);
1726 	if (res < 0)
1727 		return res;
1728 
1729 	if (data[0] != 0x01)  {
1730 		dev_info(dev->dev, "Port %d: invalid XO2\n", port->nr);
1731 		return -1;
1732 	}
1733 
1734 	i2c_read_reg(i2c, 0x10, 0x08, &val);
1735 	if (val != 0) {
1736 		i2c_write_reg(i2c, 0x10, 0x08, 0x00);
1737 		msleep(100);
1738 	}
1739 	/* Enable tuner power, disable pll, reset demods */
1740 	i2c_write_reg(i2c, 0x10, 0x08, 0x04);
1741 	usleep_range(2000, 3000);
1742 	/* Release demod resets */
1743 	i2c_write_reg(i2c, 0x10, 0x08, 0x07);
1744 
1745 	/* speed: 0=55,1=75,2=90,3=104 MBit/s */
1746 	i2c_write_reg(i2c, 0x10, 0x09, xo2_speed);
1747 
1748 	if (dev->link[port->lnr].info->con_clock) {
1749 		dev_info(dev->dev, "Setting continuous clock for XO2\n");
1750 		i2c_write_reg(i2c, 0x10, 0x0a, 0x03);
1751 		i2c_write_reg(i2c, 0x10, 0x0b, 0x03);
1752 	} else {
1753 		i2c_write_reg(i2c, 0x10, 0x0a, 0x01);
1754 		i2c_write_reg(i2c, 0x10, 0x0b, 0x01);
1755 	}
1756 
1757 	usleep_range(2000, 3000);
1758 	/* Start XO2 PLL */
1759 	i2c_write_reg(i2c, 0x10, 0x08, 0x87);
1760 
1761 	return 0;
1762 }
1763 
1764 static int init_xo2_ci(struct ddb_port *port)
1765 {
1766 	struct i2c_adapter *i2c = &port->i2c->adap;
1767 	struct ddb *dev = port->dev;
1768 	u8 val, data[2];
1769 	int res;
1770 
1771 	res = i2c_read_regs(i2c, 0x10, 0x04, data, 2);
1772 	if (res < 0)
1773 		return res;
1774 
1775 	if (data[0] > 1)  {
1776 		dev_info(dev->dev, "Port %d: invalid XO2 CI %02x\n",
1777 			 port->nr, data[0]);
1778 		return -1;
1779 	}
1780 	dev_info(dev->dev, "Port %d: DuoFlex CI %u.%u\n",
1781 		 port->nr, data[0], data[1]);
1782 
1783 	i2c_read_reg(i2c, 0x10, 0x08, &val);
1784 	if (val != 0) {
1785 		i2c_write_reg(i2c, 0x10, 0x08, 0x00);
1786 		msleep(100);
1787 	}
1788 	/* Enable both CI */
1789 	i2c_write_reg(i2c, 0x10, 0x08, 3);
1790 	usleep_range(2000, 3000);
1791 
1792 	/* speed: 0=55,1=75,2=90,3=104 MBit/s */
1793 	i2c_write_reg(i2c, 0x10, 0x09, 1);
1794 
1795 	i2c_write_reg(i2c, 0x10, 0x08, 0x83);
1796 	usleep_range(2000, 3000);
1797 
1798 	if (dev->link[port->lnr].info->con_clock) {
1799 		dev_info(dev->dev, "Setting continuous clock for DuoFlex CI\n");
1800 		i2c_write_reg(i2c, 0x10, 0x0a, 0x03);
1801 		i2c_write_reg(i2c, 0x10, 0x0b, 0x03);
1802 	} else {
1803 		i2c_write_reg(i2c, 0x10, 0x0a, 0x01);
1804 		i2c_write_reg(i2c, 0x10, 0x0b, 0x01);
1805 	}
1806 	return 0;
1807 }
1808 
1809 static int port_has_cxd28xx(struct ddb_port *port, u8 *id)
1810 {
1811 	struct i2c_adapter *i2c = &port->i2c->adap;
1812 	int status;
1813 
1814 	status = i2c_write_reg(&port->i2c->adap, 0x6e, 0, 0);
1815 	if (status)
1816 		return 0;
1817 	status = i2c_read_reg(i2c, 0x6e, 0xfd, id);
1818 	if (status)
1819 		return 0;
1820 	return 1;
1821 }
1822 
1823 static char *xo2names[] = {
1824 	"DUAL DVB-S2", "DUAL DVB-C/T/T2",
1825 	"DUAL DVB-ISDBT", "DUAL DVB-C/C2/T/T2",
1826 	"DUAL ATSC", "DUAL DVB-C/C2/T/T2,ISDB-T",
1827 	"", ""
1828 };
1829 
1830 static char *xo2types[] = {
1831 	"DVBS_ST", "DVBCT2_SONY",
1832 	"ISDBT_SONY", "DVBC2T2_SONY",
1833 	"ATSC_ST", "DVBC2T2I_SONY"
1834 };
1835 
1836 static void ddb_port_probe(struct ddb_port *port)
1837 {
1838 	struct ddb *dev = port->dev;
1839 	u32 l = port->lnr;
1840 	struct ddb_link *link = &dev->link[l];
1841 	u8 id, type;
1842 
1843 	port->name = "NO MODULE";
1844 	port->type_name = "NONE";
1845 	port->class = DDB_PORT_NONE;
1846 
1847 	/* Handle missing ports and ports without I2C */
1848 
1849 	if (dummy_tuner && !port->nr &&
1850 	    link->ids.device == 0x0005) {
1851 		port->name = "DUMMY";
1852 		port->class = DDB_PORT_TUNER;
1853 		port->type = DDB_TUNER_DUMMY;
1854 		port->type_name = "DUMMY";
1855 		return;
1856 	}
1857 
1858 	if (port->nr == ts_loop) {
1859 		port->name = "TS LOOP";
1860 		port->class = DDB_PORT_LOOP;
1861 		return;
1862 	}
1863 
1864 	if (port->nr == 1 && link->info->type == DDB_OCTOPUS_CI &&
1865 	    link->info->i2c_mask == 1) {
1866 		port->name = "NO TAB";
1867 		port->class = DDB_PORT_NONE;
1868 		return;
1869 	}
1870 
1871 	if (link->info->type == DDB_OCTOPUS_MAX) {
1872 		port->name = "DUAL DVB-S2 MAX";
1873 		port->type_name = "MXL5XX";
1874 		port->class = DDB_PORT_TUNER;
1875 		port->type = DDB_TUNER_MXL5XX;
1876 		if (port->i2c)
1877 			ddbwritel(dev, I2C_SPEED_400,
1878 				  port->i2c->regs + I2C_TIMING);
1879 		return;
1880 	}
1881 
1882 	if (link->info->type == DDB_OCTOPUS_MCI) {
1883 		if (port->nr >= link->info->mci_ports)
1884 			return;
1885 		port->name = "DUAL MCI";
1886 		port->type_name = "MCI";
1887 		port->class = DDB_PORT_TUNER;
1888 		port->type = DDB_TUNER_MCI + link->info->mci_type;
1889 		return;
1890 	}
1891 
1892 	if (port->nr > 1 && link->info->type == DDB_OCTOPUS_CI) {
1893 		port->name = "CI internal";
1894 		port->type_name = "INTERNAL";
1895 		port->class = DDB_PORT_CI;
1896 		port->type = DDB_CI_INTERNAL;
1897 	}
1898 
1899 	if (!port->i2c)
1900 		return;
1901 
1902 	/* Probe ports with I2C */
1903 
1904 	if (port_has_cxd(port, &id)) {
1905 		if (id == 1) {
1906 			port->name = "CI";
1907 			port->type_name = "CXD2099";
1908 			port->class = DDB_PORT_CI;
1909 			port->type = DDB_CI_EXTERNAL_SONY;
1910 			ddbwritel(dev, I2C_SPEED_400,
1911 				  port->i2c->regs + I2C_TIMING);
1912 		} else {
1913 			dev_info(dev->dev, "Port %d: Uninitialized DuoFlex\n",
1914 				 port->nr);
1915 			return;
1916 		}
1917 	} else if (port_has_xo2(port, &type, &id)) {
1918 		ddbwritel(dev, I2C_SPEED_400, port->i2c->regs + I2C_TIMING);
1919 		/*dev_info(dev->dev, "XO2 ID %02x\n", id);*/
1920 		if (type == 2) {
1921 			port->name = "DuoFlex CI";
1922 			port->class = DDB_PORT_CI;
1923 			port->type = DDB_CI_EXTERNAL_XO2;
1924 			port->type_name = "CI_XO2";
1925 			init_xo2_ci(port);
1926 			return;
1927 		}
1928 		id >>= 2;
1929 		if (id > 5) {
1930 			port->name = "unknown XO2 DuoFlex";
1931 			port->type_name = "UNKNOWN";
1932 		} else {
1933 			port->name = xo2names[id];
1934 			port->class = DDB_PORT_TUNER;
1935 			port->type = DDB_TUNER_XO2 + id;
1936 			port->type_name = xo2types[id];
1937 			init_xo2(port);
1938 		}
1939 	} else if (port_has_cxd28xx(port, &id)) {
1940 		switch (id) {
1941 		case 0xa4:
1942 			port->name = "DUAL DVB-C2T2 CXD2843";
1943 			port->type = DDB_TUNER_DVBC2T2_SONY_P;
1944 			port->type_name = "DVBC2T2_SONY";
1945 			break;
1946 		case 0xb1:
1947 			port->name = "DUAL DVB-CT2 CXD2837";
1948 			port->type = DDB_TUNER_DVBCT2_SONY_P;
1949 			port->type_name = "DVBCT2_SONY";
1950 			break;
1951 		case 0xb0:
1952 			port->name = "DUAL ISDB-T CXD2838";
1953 			port->type = DDB_TUNER_ISDBT_SONY_P;
1954 			port->type_name = "ISDBT_SONY";
1955 			break;
1956 		case 0xc1:
1957 			port->name = "DUAL DVB-C2T2 ISDB-T CXD2854";
1958 			port->type = DDB_TUNER_DVBC2T2I_SONY_P;
1959 			port->type_name = "DVBC2T2I_ISDBT_SONY";
1960 			break;
1961 		default:
1962 			return;
1963 		}
1964 		port->class = DDB_PORT_TUNER;
1965 		ddbwritel(dev, I2C_SPEED_400, port->i2c->regs + I2C_TIMING);
1966 	} else if (port_has_stv0900(port)) {
1967 		port->name = "DUAL DVB-S2";
1968 		port->class = DDB_PORT_TUNER;
1969 		port->type = DDB_TUNER_DVBS_ST;
1970 		port->type_name = "DVBS_ST";
1971 		ddbwritel(dev, I2C_SPEED_100, port->i2c->regs + I2C_TIMING);
1972 	} else if (port_has_stv0900_aa(port, &id)) {
1973 		port->name = "DUAL DVB-S2";
1974 		port->class = DDB_PORT_TUNER;
1975 		if (id == 0x51) {
1976 			if (port->nr == 0 &&
1977 			    link->info->ts_quirks & TS_QUIRK_REVERSED)
1978 				port->type = DDB_TUNER_DVBS_STV0910_PR;
1979 			else
1980 				port->type = DDB_TUNER_DVBS_STV0910_P;
1981 			port->type_name = "DVBS_ST_0910";
1982 		} else {
1983 			port->type = DDB_TUNER_DVBS_ST_AA;
1984 			port->type_name = "DVBS_ST_AA";
1985 		}
1986 		ddbwritel(dev, I2C_SPEED_100, port->i2c->regs + I2C_TIMING);
1987 	} else if (port_has_drxks(port)) {
1988 		port->name = "DUAL DVB-C/T";
1989 		port->class = DDB_PORT_TUNER;
1990 		port->type = DDB_TUNER_DVBCT_TR;
1991 		port->type_name = "DVBCT_TR";
1992 		ddbwritel(dev, I2C_SPEED_400, port->i2c->regs + I2C_TIMING);
1993 	} else if (port_has_stv0367(port)) {
1994 		port->name = "DUAL DVB-C/T";
1995 		port->class = DDB_PORT_TUNER;
1996 		port->type = DDB_TUNER_DVBCT_ST;
1997 		port->type_name = "DVBCT_ST";
1998 		ddbwritel(dev, I2C_SPEED_100, port->i2c->regs + I2C_TIMING);
1999 	} else if (port_has_encti(port)) {
2000 		port->name = "ENCTI";
2001 		port->class = DDB_PORT_LOOP;
2002 	}
2003 }
2004 
2005 /****************************************************************************/
2006 /****************************************************************************/
2007 /****************************************************************************/
2008 
2009 static int ddb_port_attach(struct ddb_port *port)
2010 {
2011 	int ret = 0;
2012 
2013 	switch (port->class) {
2014 	case DDB_PORT_TUNER:
2015 		ret = dvb_input_attach(port->input[0]);
2016 		if (ret < 0)
2017 			break;
2018 		ret = dvb_input_attach(port->input[1]);
2019 		if (ret < 0) {
2020 			dvb_input_detach(port->input[0]);
2021 			break;
2022 		}
2023 		port->input[0]->redi = port->input[0];
2024 		port->input[1]->redi = port->input[1];
2025 		break;
2026 	case DDB_PORT_CI:
2027 		ret = ddb_ci_attach(port, ci_bitrate);
2028 		if (ret < 0)
2029 			break;
2030 		fallthrough;
2031 	case DDB_PORT_LOOP:
2032 		ret = dvb_register_device(port->dvb[0].adap,
2033 					  &port->dvb[0].dev,
2034 					  &dvbdev_ci, (void *)port->output,
2035 					  DVB_DEVICE_SEC, 0);
2036 		break;
2037 	default:
2038 		break;
2039 	}
2040 	if (ret < 0)
2041 		dev_err(port->dev->dev, "port_attach on port %d failed\n",
2042 			port->nr);
2043 	return ret;
2044 }
2045 
2046 int ddb_ports_attach(struct ddb *dev)
2047 {
2048 	int i, numports, err_ports = 0, ret = 0;
2049 	struct ddb_port *port;
2050 
2051 	if (dev->port_num) {
2052 		ret = dvb_register_adapters(dev);
2053 		if (ret < 0) {
2054 			dev_err(dev->dev, "Registering adapters failed. Check DVB_MAX_ADAPTERS in config.\n");
2055 			return ret;
2056 		}
2057 	}
2058 
2059 	numports = dev->port_num;
2060 
2061 	for (i = 0; i < dev->port_num; i++) {
2062 		port = &dev->port[i];
2063 		if (port->class != DDB_PORT_NONE) {
2064 			ret = ddb_port_attach(port);
2065 			if (ret)
2066 				err_ports++;
2067 		} else {
2068 			numports--;
2069 		}
2070 	}
2071 
2072 	if (err_ports) {
2073 		if (err_ports == numports) {
2074 			dev_err(dev->dev, "All connected ports failed to initialise!\n");
2075 			return -ENODEV;
2076 		}
2077 
2078 		dev_warn(dev->dev, "%d of %d connected ports failed to initialise!\n",
2079 			 err_ports, numports);
2080 	}
2081 
2082 	return 0;
2083 }
2084 
2085 void ddb_ports_detach(struct ddb *dev)
2086 {
2087 	int i;
2088 	struct ddb_port *port;
2089 
2090 	for (i = 0; i < dev->port_num; i++) {
2091 		port = &dev->port[i];
2092 
2093 		switch (port->class) {
2094 		case DDB_PORT_TUNER:
2095 			dvb_input_detach(port->input[1]);
2096 			dvb_input_detach(port->input[0]);
2097 			break;
2098 		case DDB_PORT_CI:
2099 		case DDB_PORT_LOOP:
2100 			ddb_ci_detach(port);
2101 			break;
2102 		}
2103 	}
2104 	dvb_unregister_adapters(dev);
2105 }
2106 
2107 /* Copy input DMA pointers to output DMA and ACK. */
2108 
2109 static void input_write_output(struct ddb_input *input,
2110 			       struct ddb_output *output)
2111 {
2112 	ddbwritel(output->port->dev,
2113 		  input->dma->stat, DMA_BUFFER_ACK(output->dma));
2114 	output->dma->cbuf = (input->dma->stat >> 11) & 0x1f;
2115 	output->dma->coff = (input->dma->stat & 0x7ff) << 7;
2116 }
2117 
2118 static void output_ack_input(struct ddb_output *output,
2119 			     struct ddb_input *input)
2120 {
2121 	ddbwritel(input->port->dev,
2122 		  output->dma->stat, DMA_BUFFER_ACK(input->dma));
2123 }
2124 
2125 static void input_write_dvb(struct ddb_input *input,
2126 			    struct ddb_input *input2)
2127 {
2128 	struct ddb_dvb *dvb = &input2->port->dvb[input2->nr & 1];
2129 	struct ddb_dma *dma, *dma2;
2130 	struct ddb *dev = input->port->dev;
2131 	int ack = 1;
2132 
2133 	dma = input->dma;
2134 	dma2 = input->dma;
2135 	/*
2136 	 * if there also is an output connected, do not ACK.
2137 	 * input_write_output will ACK.
2138 	 */
2139 	if (input->redo) {
2140 		dma2 = input->redo->dma;
2141 		ack = 0;
2142 	}
2143 	while (dma->cbuf != ((dma->stat >> 11) & 0x1f) ||
2144 	       (4 & dma->ctrl)) {
2145 		if (4 & dma->ctrl) {
2146 			/* dev_err(dev->dev, "Overflow dma %d\n", dma->nr); */
2147 			ack = 1;
2148 		}
2149 		if (alt_dma)
2150 			dma_sync_single_for_cpu(dev->dev, dma2->pbuf[dma->cbuf],
2151 						dma2->size, DMA_FROM_DEVICE);
2152 		dvb_dmx_swfilter_packets(&dvb->demux,
2153 					 dma2->vbuf[dma->cbuf],
2154 					 dma2->size / 188);
2155 		dma->cbuf = (dma->cbuf + 1) % dma2->num;
2156 		if (ack)
2157 			ddbwritel(dev, (dma->cbuf << 11),
2158 				  DMA_BUFFER_ACK(dma));
2159 		dma->stat = safe_ddbreadl(dev, DMA_BUFFER_CURRENT(dma));
2160 		dma->ctrl = safe_ddbreadl(dev, DMA_BUFFER_CONTROL(dma));
2161 	}
2162 }
2163 
2164 static void input_work(struct work_struct *work)
2165 {
2166 	struct ddb_dma *dma = container_of(work, struct ddb_dma, work);
2167 	struct ddb_input *input = (struct ddb_input *)dma->io;
2168 	struct ddb *dev = input->port->dev;
2169 	unsigned long flags;
2170 
2171 	spin_lock_irqsave(&dma->lock, flags);
2172 	if (!dma->running) {
2173 		spin_unlock_irqrestore(&dma->lock, flags);
2174 		return;
2175 	}
2176 	dma->stat = ddbreadl(dev, DMA_BUFFER_CURRENT(dma));
2177 	dma->ctrl = ddbreadl(dev, DMA_BUFFER_CONTROL(dma));
2178 
2179 	if (input->redi)
2180 		input_write_dvb(input, input->redi);
2181 	if (input->redo)
2182 		input_write_output(input, input->redo);
2183 	wake_up(&dma->wq);
2184 	spin_unlock_irqrestore(&dma->lock, flags);
2185 }
2186 
2187 static void input_handler(void *data)
2188 {
2189 	struct ddb_input *input = (struct ddb_input *)data;
2190 	struct ddb_dma *dma = input->dma;
2191 
2192 	queue_work(ddb_wq, &dma->work);
2193 }
2194 
2195 static void output_work(struct work_struct *work)
2196 {
2197 	struct ddb_dma *dma = container_of(work, struct ddb_dma, work);
2198 	struct ddb_output *output = (struct ddb_output *)dma->io;
2199 	struct ddb *dev = output->port->dev;
2200 	unsigned long flags;
2201 
2202 	spin_lock_irqsave(&dma->lock, flags);
2203 	if (!dma->running)
2204 		goto unlock_exit;
2205 	dma->stat = ddbreadl(dev, DMA_BUFFER_CURRENT(dma));
2206 	dma->ctrl = ddbreadl(dev, DMA_BUFFER_CONTROL(dma));
2207 	if (output->redi)
2208 		output_ack_input(output, output->redi);
2209 	wake_up(&dma->wq);
2210 unlock_exit:
2211 	spin_unlock_irqrestore(&dma->lock, flags);
2212 }
2213 
2214 static void output_handler(void *data)
2215 {
2216 	struct ddb_output *output = (struct ddb_output *)data;
2217 	struct ddb_dma *dma = output->dma;
2218 
2219 	queue_work(ddb_wq, &dma->work);
2220 }
2221 
2222 /****************************************************************************/
2223 /****************************************************************************/
2224 
2225 static const struct ddb_regmap *io_regmap(struct ddb_io *io, int link)
2226 {
2227 	const struct ddb_info *info;
2228 
2229 	if (link)
2230 		info = io->port->dev->link[io->port->lnr].info;
2231 	else
2232 		info = io->port->dev->link[0].info;
2233 
2234 	if (!info)
2235 		return NULL;
2236 
2237 	return info->regmap;
2238 }
2239 
2240 static void ddb_dma_init(struct ddb_io *io, int nr, int out)
2241 {
2242 	struct ddb_dma *dma;
2243 	const struct ddb_regmap *rm = io_regmap(io, 0);
2244 
2245 	dma = out ? &io->port->dev->odma[nr] : &io->port->dev->idma[nr];
2246 	io->dma = dma;
2247 	dma->io = io;
2248 
2249 	spin_lock_init(&dma->lock);
2250 	init_waitqueue_head(&dma->wq);
2251 	if (out) {
2252 		INIT_WORK(&dma->work, output_work);
2253 		dma->regs = rm->odma->base + rm->odma->size * nr;
2254 		dma->bufregs = rm->odma_buf->base + rm->odma_buf->size * nr;
2255 		dma->num = dma_buf_num;
2256 		dma->size = dma_buf_size * 128 * 47;
2257 		dma->div = 1;
2258 	} else {
2259 		INIT_WORK(&dma->work, input_work);
2260 		dma->regs = rm->idma->base + rm->idma->size * nr;
2261 		dma->bufregs = rm->idma_buf->base + rm->idma_buf->size * nr;
2262 		dma->num = dma_buf_num;
2263 		dma->size = dma_buf_size * 128 * 47;
2264 		dma->div = 1;
2265 	}
2266 	ddbwritel(io->port->dev, 0, DMA_BUFFER_ACK(dma));
2267 	dev_dbg(io->port->dev->dev, "init link %u, io %u, dma %u, dmaregs %08x bufregs %08x\n",
2268 		io->port->lnr, io->nr, nr, dma->regs, dma->bufregs);
2269 }
2270 
2271 static void ddb_input_init(struct ddb_port *port, int nr, int pnr, int anr)
2272 {
2273 	struct ddb *dev = port->dev;
2274 	struct ddb_input *input = &dev->input[anr];
2275 	const struct ddb_regmap *rm;
2276 
2277 	port->input[pnr] = input;
2278 	input->nr = nr;
2279 	input->port = port;
2280 	rm = io_regmap(input, 1);
2281 	input->regs = DDB_LINK_TAG(port->lnr) |
2282 		(rm->input->base + rm->input->size * nr);
2283 	dev_dbg(dev->dev, "init link %u, input %u, regs %08x\n",
2284 		port->lnr, nr, input->regs);
2285 
2286 	if (dev->has_dma) {
2287 		const struct ddb_regmap *rm0 = io_regmap(input, 0);
2288 		u32 base = rm0->irq_base_idma;
2289 		u32 dma_nr = nr;
2290 
2291 		if (port->lnr)
2292 			dma_nr += 32 + (port->lnr - 1) * 8;
2293 
2294 		dev_dbg(dev->dev, "init link %u, input %u, handler %u\n",
2295 			port->lnr, nr, dma_nr + base);
2296 
2297 		ddb_irq_set(dev, 0, dma_nr + base, &input_handler, input);
2298 		ddb_dma_init(input, dma_nr, 0);
2299 	}
2300 }
2301 
2302 static void ddb_output_init(struct ddb_port *port, int nr)
2303 {
2304 	struct ddb *dev = port->dev;
2305 	struct ddb_output *output = &dev->output[nr];
2306 	const struct ddb_regmap *rm;
2307 
2308 	port->output = output;
2309 	output->nr = nr;
2310 	output->port = port;
2311 	rm = io_regmap(output, 1);
2312 	output->regs = DDB_LINK_TAG(port->lnr) |
2313 		(rm->output->base + rm->output->size * nr);
2314 
2315 	dev_dbg(dev->dev, "init link %u, output %u, regs %08x\n",
2316 		port->lnr, nr, output->regs);
2317 
2318 	if (dev->has_dma) {
2319 		const struct ddb_regmap *rm0 = io_regmap(output, 0);
2320 		u32 base = rm0->irq_base_odma;
2321 
2322 		ddb_irq_set(dev, 0, nr + base, &output_handler, output);
2323 		ddb_dma_init(output, nr, 1);
2324 	}
2325 }
2326 
2327 static int ddb_port_match_i2c(struct ddb_port *port)
2328 {
2329 	struct ddb *dev = port->dev;
2330 	u32 i;
2331 
2332 	for (i = 0; i < dev->i2c_num; i++) {
2333 		if (dev->i2c[i].link == port->lnr &&
2334 		    dev->i2c[i].nr == port->nr) {
2335 			port->i2c = &dev->i2c[i];
2336 			return 1;
2337 		}
2338 	}
2339 	return 0;
2340 }
2341 
2342 static int ddb_port_match_link_i2c(struct ddb_port *port)
2343 {
2344 	struct ddb *dev = port->dev;
2345 	u32 i;
2346 
2347 	for (i = 0; i < dev->i2c_num; i++) {
2348 		if (dev->i2c[i].link == port->lnr) {
2349 			port->i2c = &dev->i2c[i];
2350 			return 1;
2351 		}
2352 	}
2353 	return 0;
2354 }
2355 
2356 void ddb_ports_init(struct ddb *dev)
2357 {
2358 	u32 i, l, p;
2359 	struct ddb_port *port;
2360 	const struct ddb_info *info;
2361 	const struct ddb_regmap *rm;
2362 
2363 	for (p = l = 0; l < DDB_MAX_LINK; l++) {
2364 		info = dev->link[l].info;
2365 		if (!info)
2366 			continue;
2367 		rm = info->regmap;
2368 		if (!rm)
2369 			continue;
2370 		for (i = 0; i < info->port_num; i++, p++) {
2371 			port = &dev->port[p];
2372 			port->dev = dev;
2373 			port->nr = i;
2374 			port->lnr = l;
2375 			port->pnr = p;
2376 			port->gap = 0xffffffff;
2377 			port->obr = ci_bitrate;
2378 			mutex_init(&port->i2c_gate_lock);
2379 
2380 			if (!ddb_port_match_i2c(port)) {
2381 				if (info->type == DDB_OCTOPUS_MAX)
2382 					ddb_port_match_link_i2c(port);
2383 			}
2384 
2385 			ddb_port_probe(port);
2386 
2387 			port->dvb[0].adap = &dev->adap[2 * p];
2388 			port->dvb[1].adap = &dev->adap[2 * p + 1];
2389 
2390 			if (port->class == DDB_PORT_NONE && i && p &&
2391 			    dev->port[p - 1].type == DDB_CI_EXTERNAL_XO2) {
2392 				port->class = DDB_PORT_CI;
2393 				port->type = DDB_CI_EXTERNAL_XO2_B;
2394 				port->name = "DuoFlex CI_B";
2395 				port->i2c = dev->port[p - 1].i2c;
2396 			}
2397 
2398 			dev_info(dev->dev, "Port %u: Link %u, Link Port %u (TAB %u): %s\n",
2399 				 port->pnr, port->lnr, port->nr, port->nr + 1,
2400 				 port->name);
2401 
2402 			if (port->class == DDB_PORT_CI &&
2403 			    port->type == DDB_CI_EXTERNAL_XO2) {
2404 				ddb_input_init(port, 2 * i, 0, 2 * i);
2405 				ddb_output_init(port, i);
2406 				continue;
2407 			}
2408 
2409 			if (port->class == DDB_PORT_CI &&
2410 			    port->type == DDB_CI_EXTERNAL_XO2_B) {
2411 				ddb_input_init(port, 2 * i - 1, 0, 2 * i - 1);
2412 				ddb_output_init(port, i);
2413 				continue;
2414 			}
2415 
2416 			if (port->class == DDB_PORT_NONE)
2417 				continue;
2418 
2419 			switch (dev->link[l].info->type) {
2420 			case DDB_OCTOPUS_CI:
2421 				if (i >= 2) {
2422 					ddb_input_init(port, 2 + i, 0, 2 + i);
2423 					ddb_input_init(port, 4 + i, 1, 4 + i);
2424 					ddb_output_init(port, i);
2425 					break;
2426 				}
2427 				fallthrough;
2428 			case DDB_OCTOPUS:
2429 				ddb_input_init(port, 2 * i, 0, 2 * i);
2430 				ddb_input_init(port, 2 * i + 1, 1, 2 * i + 1);
2431 				ddb_output_init(port, i);
2432 				break;
2433 			case DDB_OCTOPUS_MAX:
2434 			case DDB_OCTOPUS_MAX_CT:
2435 			case DDB_OCTOPUS_MCI:
2436 				ddb_input_init(port, 2 * i, 0, 2 * p);
2437 				ddb_input_init(port, 2 * i + 1, 1, 2 * p + 1);
2438 				break;
2439 			default:
2440 				break;
2441 			}
2442 		}
2443 	}
2444 	dev->port_num = p;
2445 }
2446 
2447 void ddb_ports_release(struct ddb *dev)
2448 {
2449 	int i;
2450 	struct ddb_port *port;
2451 
2452 	for (i = 0; i < dev->port_num; i++) {
2453 		port = &dev->port[i];
2454 		if (port->input[0] && port->input[0]->dma)
2455 			cancel_work_sync(&port->input[0]->dma->work);
2456 		if (port->input[1] && port->input[1]->dma)
2457 			cancel_work_sync(&port->input[1]->dma->work);
2458 		if (port->output && port->output->dma)
2459 			cancel_work_sync(&port->output->dma->work);
2460 	}
2461 }
2462 
2463 /****************************************************************************/
2464 /****************************************************************************/
2465 /****************************************************************************/
2466 
2467 #define IRQ_HANDLE(_nr) \
2468 	do { if ((s & (1UL << ((_nr) & 0x1f))) && \
2469 		 dev->link[0].irq[_nr].handler) \
2470 		dev->link[0].irq[_nr].handler(dev->link[0].irq[_nr].data); } \
2471 	while (0)
2472 
2473 #define IRQ_HANDLE_NIBBLE(_shift) {		     \
2474 	if (s & (0x0000000f << ((_shift) & 0x1f))) { \
2475 		IRQ_HANDLE(0 + (_shift));	     \
2476 		IRQ_HANDLE(1 + (_shift));	     \
2477 		IRQ_HANDLE(2 + (_shift));	     \
2478 		IRQ_HANDLE(3 + (_shift));	     \
2479 	}					     \
2480 }
2481 
2482 #define IRQ_HANDLE_BYTE(_shift) {		     \
2483 	if (s & (0x000000ff << ((_shift) & 0x1f))) { \
2484 		IRQ_HANDLE(0 + (_shift));	     \
2485 		IRQ_HANDLE(1 + (_shift));	     \
2486 		IRQ_HANDLE(2 + (_shift));	     \
2487 		IRQ_HANDLE(3 + (_shift));	     \
2488 		IRQ_HANDLE(4 + (_shift));	     \
2489 		IRQ_HANDLE(5 + (_shift));	     \
2490 		IRQ_HANDLE(6 + (_shift));	     \
2491 		IRQ_HANDLE(7 + (_shift));	     \
2492 	}					     \
2493 }
2494 
2495 static void irq_handle_msg(struct ddb *dev, u32 s)
2496 {
2497 	dev->i2c_irq++;
2498 	IRQ_HANDLE_NIBBLE(0);
2499 }
2500 
2501 static void irq_handle_io(struct ddb *dev, u32 s)
2502 {
2503 	dev->ts_irq++;
2504 	IRQ_HANDLE_NIBBLE(4);
2505 	IRQ_HANDLE_BYTE(8);
2506 	IRQ_HANDLE_BYTE(16);
2507 	IRQ_HANDLE_BYTE(24);
2508 }
2509 
2510 irqreturn_t ddb_irq_handler0(int irq, void *dev_id)
2511 {
2512 	struct ddb *dev = (struct ddb *)dev_id;
2513 	u32 mask = 0x8fffff00;
2514 	u32 s = mask & ddbreadl(dev, INTERRUPT_STATUS);
2515 
2516 	if (!s)
2517 		return IRQ_NONE;
2518 	do {
2519 		if (s & 0x80000000)
2520 			return IRQ_NONE;
2521 		ddbwritel(dev, s, INTERRUPT_ACK);
2522 		irq_handle_io(dev, s);
2523 	} while ((s = mask & ddbreadl(dev, INTERRUPT_STATUS)));
2524 
2525 	return IRQ_HANDLED;
2526 }
2527 
2528 irqreturn_t ddb_irq_handler1(int irq, void *dev_id)
2529 {
2530 	struct ddb *dev = (struct ddb *)dev_id;
2531 	u32 mask = 0x8000000f;
2532 	u32 s = mask & ddbreadl(dev, INTERRUPT_STATUS);
2533 
2534 	if (!s)
2535 		return IRQ_NONE;
2536 	do {
2537 		if (s & 0x80000000)
2538 			return IRQ_NONE;
2539 		ddbwritel(dev, s, INTERRUPT_ACK);
2540 		irq_handle_msg(dev, s);
2541 	} while ((s = mask & ddbreadl(dev, INTERRUPT_STATUS)));
2542 
2543 	return IRQ_HANDLED;
2544 }
2545 
2546 irqreturn_t ddb_irq_handler(int irq, void *dev_id)
2547 {
2548 	struct ddb *dev = (struct ddb *)dev_id;
2549 	u32 s = ddbreadl(dev, INTERRUPT_STATUS);
2550 	int ret = IRQ_HANDLED;
2551 
2552 	if (!s)
2553 		return IRQ_NONE;
2554 	do {
2555 		if (s & 0x80000000)
2556 			return IRQ_NONE;
2557 		ddbwritel(dev, s, INTERRUPT_ACK);
2558 
2559 		if (s & 0x0000000f)
2560 			irq_handle_msg(dev, s);
2561 		if (s & 0x0fffff00)
2562 			irq_handle_io(dev, s);
2563 	} while ((s = ddbreadl(dev, INTERRUPT_STATUS)));
2564 
2565 	return ret;
2566 }
2567 
2568 /****************************************************************************/
2569 /****************************************************************************/
2570 /****************************************************************************/
2571 
2572 static int reg_wait(struct ddb *dev, u32 reg, u32 bit)
2573 {
2574 	u32 count = 0;
2575 
2576 	while (safe_ddbreadl(dev, reg) & bit) {
2577 		ndelay(10);
2578 		if (++count == 100)
2579 			return -1;
2580 	}
2581 	return 0;
2582 }
2583 
2584 static int flashio(struct ddb *dev, u32 lnr, u8 *wbuf, u32 wlen, u8 *rbuf,
2585 		   u32 rlen)
2586 {
2587 	u32 data, shift;
2588 	u32 tag = DDB_LINK_TAG(lnr);
2589 	struct ddb_link *link = &dev->link[lnr];
2590 
2591 	mutex_lock(&link->flash_mutex);
2592 	if (wlen > 4)
2593 		ddbwritel(dev, 1, tag | SPI_CONTROL);
2594 	while (wlen > 4) {
2595 		/* FIXME: check for big-endian */
2596 		data = swab32(*(u32 *)wbuf);
2597 		wbuf += 4;
2598 		wlen -= 4;
2599 		ddbwritel(dev, data, tag | SPI_DATA);
2600 		if (reg_wait(dev, tag | SPI_CONTROL, 4))
2601 			goto fail;
2602 	}
2603 	if (rlen)
2604 		ddbwritel(dev, 0x0001 | ((wlen << (8 + 3)) & 0x1f00),
2605 			  tag | SPI_CONTROL);
2606 	else
2607 		ddbwritel(dev, 0x0003 | ((wlen << (8 + 3)) & 0x1f00),
2608 			  tag | SPI_CONTROL);
2609 
2610 	data = 0;
2611 	shift = ((4 - wlen) * 8);
2612 	while (wlen) {
2613 		data <<= 8;
2614 		data |= *wbuf;
2615 		wlen--;
2616 		wbuf++;
2617 	}
2618 	if (shift)
2619 		data <<= shift;
2620 	ddbwritel(dev, data, tag | SPI_DATA);
2621 	if (reg_wait(dev, tag | SPI_CONTROL, 4))
2622 		goto fail;
2623 
2624 	if (!rlen) {
2625 		ddbwritel(dev, 0, tag | SPI_CONTROL);
2626 		goto exit;
2627 	}
2628 	if (rlen > 4)
2629 		ddbwritel(dev, 1, tag | SPI_CONTROL);
2630 
2631 	while (rlen > 4) {
2632 		ddbwritel(dev, 0xffffffff, tag | SPI_DATA);
2633 		if (reg_wait(dev, tag | SPI_CONTROL, 4))
2634 			goto fail;
2635 		data = ddbreadl(dev, tag | SPI_DATA);
2636 		*(u32 *)rbuf = swab32(data);
2637 		rbuf += 4;
2638 		rlen -= 4;
2639 	}
2640 	ddbwritel(dev, 0x0003 | ((rlen << (8 + 3)) & 0x1F00),
2641 		  tag | SPI_CONTROL);
2642 	ddbwritel(dev, 0xffffffff, tag | SPI_DATA);
2643 	if (reg_wait(dev, tag | SPI_CONTROL, 4))
2644 		goto fail;
2645 
2646 	data = ddbreadl(dev, tag | SPI_DATA);
2647 	ddbwritel(dev, 0, tag | SPI_CONTROL);
2648 
2649 	if (rlen < 4)
2650 		data <<= ((4 - rlen) * 8);
2651 
2652 	while (rlen > 0) {
2653 		*rbuf = ((data >> 24) & 0xff);
2654 		data <<= 8;
2655 		rbuf++;
2656 		rlen--;
2657 	}
2658 exit:
2659 	mutex_unlock(&link->flash_mutex);
2660 	return 0;
2661 fail:
2662 	mutex_unlock(&link->flash_mutex);
2663 	return -1;
2664 }
2665 
2666 int ddbridge_flashread(struct ddb *dev, u32 link, u8 *buf, u32 addr, u32 len)
2667 {
2668 	u8 cmd[4] = {0x03, (addr >> 16) & 0xff,
2669 		     (addr >> 8) & 0xff, addr & 0xff};
2670 
2671 	return flashio(dev, link, cmd, 4, buf, len);
2672 }
2673 
2674 /*
2675  * TODO/FIXME: add/implement IOCTLs from upstream driver
2676  */
2677 
2678 #define DDB_NAME "ddbridge"
2679 
2680 static u32 ddb_num;
2681 static int ddb_major;
2682 static DEFINE_MUTEX(ddb_mutex);
2683 
2684 static int ddb_release(struct inode *inode, struct file *file)
2685 {
2686 	struct ddb *dev = file->private_data;
2687 
2688 	dev->ddb_dev_users--;
2689 	return 0;
2690 }
2691 
2692 static int ddb_open(struct inode *inode, struct file *file)
2693 {
2694 	struct ddb *dev = ddbs[iminor(inode)];
2695 
2696 	if (dev->ddb_dev_users)
2697 		return -EBUSY;
2698 	dev->ddb_dev_users++;
2699 	file->private_data = dev;
2700 	return 0;
2701 }
2702 
2703 static long ddb_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
2704 {
2705 	struct ddb *dev = file->private_data;
2706 
2707 	dev_warn(dev->dev, "DDB IOCTLs unsupported (cmd: %d, arg: %lu)\n",
2708 		 cmd, arg);
2709 
2710 	return -ENOTTY;
2711 }
2712 
2713 static const struct file_operations ddb_fops = {
2714 	.unlocked_ioctl = ddb_ioctl,
2715 	.open           = ddb_open,
2716 	.release        = ddb_release,
2717 };
2718 
2719 static char *ddb_devnode(const struct device *device, umode_t *mode)
2720 {
2721 	const struct ddb *dev = dev_get_drvdata(device);
2722 
2723 	return kasprintf(GFP_KERNEL, "ddbridge/card%d", dev->nr);
2724 }
2725 
2726 #define __ATTR_MRO(_name, _show) {				\
2727 	.attr	= { .name = __stringify(_name), .mode = 0444 },	\
2728 	.show	= _show,					\
2729 }
2730 
2731 #define __ATTR_MWO(_name, _store) {				\
2732 	.attr	= { .name = __stringify(_name), .mode = 0222 },	\
2733 	.store	= _store,					\
2734 }
2735 
2736 static ssize_t ports_show(struct device *device,
2737 			  struct device_attribute *attr, char *buf)
2738 {
2739 	struct ddb *dev = dev_get_drvdata(device);
2740 
2741 	return sprintf(buf, "%d\n", dev->port_num);
2742 }
2743 
2744 static ssize_t ts_irq_show(struct device *device,
2745 			   struct device_attribute *attr, char *buf)
2746 {
2747 	struct ddb *dev = dev_get_drvdata(device);
2748 
2749 	return sprintf(buf, "%d\n", dev->ts_irq);
2750 }
2751 
2752 static ssize_t i2c_irq_show(struct device *device,
2753 			    struct device_attribute *attr, char *buf)
2754 {
2755 	struct ddb *dev = dev_get_drvdata(device);
2756 
2757 	return sprintf(buf, "%d\n", dev->i2c_irq);
2758 }
2759 
2760 static ssize_t fan_show(struct device *device,
2761 			struct device_attribute *attr, char *buf)
2762 {
2763 	struct ddb *dev = dev_get_drvdata(device);
2764 	u32 val;
2765 
2766 	val = ddbreadl(dev, GPIO_OUTPUT) & 1;
2767 	return sprintf(buf, "%d\n", val);
2768 }
2769 
2770 static ssize_t fan_store(struct device *device, struct device_attribute *d,
2771 			 const char *buf, size_t count)
2772 {
2773 	struct ddb *dev = dev_get_drvdata(device);
2774 	u32 val;
2775 
2776 	if (sscanf(buf, "%u\n", &val) != 1)
2777 		return -EINVAL;
2778 	ddbwritel(dev, 1, GPIO_DIRECTION);
2779 	ddbwritel(dev, val & 1, GPIO_OUTPUT);
2780 	return count;
2781 }
2782 
2783 static ssize_t fanspeed_show(struct device *device,
2784 			     struct device_attribute *attr, char *buf)
2785 {
2786 	struct ddb *dev = dev_get_drvdata(device);
2787 	int num = attr->attr.name[8] - 0x30;
2788 	struct ddb_link *link = &dev->link[num];
2789 	u32 spd;
2790 
2791 	spd = ddblreadl(link, TEMPMON_FANCONTROL) & 0xff;
2792 	return sprintf(buf, "%u\n", spd * 100);
2793 }
2794 
2795 static ssize_t temp_show(struct device *device,
2796 			 struct device_attribute *attr, char *buf)
2797 {
2798 	struct ddb *dev = dev_get_drvdata(device);
2799 	struct ddb_link *link = &dev->link[0];
2800 	struct i2c_adapter *adap;
2801 	int temp, temp2;
2802 	u8 tmp[2];
2803 
2804 	if (!link->info->temp_num)
2805 		return sprintf(buf, "no sensor\n");
2806 	adap = &dev->i2c[link->info->temp_bus].adap;
2807 	if (i2c_read_regs(adap, 0x48, 0, tmp, 2) < 0)
2808 		return sprintf(buf, "read_error\n");
2809 	temp = (tmp[0] << 3) | (tmp[1] >> 5);
2810 	temp *= 125;
2811 	if (link->info->temp_num == 2) {
2812 		if (i2c_read_regs(adap, 0x49, 0, tmp, 2) < 0)
2813 			return sprintf(buf, "read_error\n");
2814 		temp2 = (tmp[0] << 3) | (tmp[1] >> 5);
2815 		temp2 *= 125;
2816 		return sprintf(buf, "%d %d\n", temp, temp2);
2817 	}
2818 	return sprintf(buf, "%d\n", temp);
2819 }
2820 
2821 static ssize_t ctemp_show(struct device *device,
2822 			  struct device_attribute *attr, char *buf)
2823 {
2824 	struct ddb *dev = dev_get_drvdata(device);
2825 	struct i2c_adapter *adap;
2826 	int temp;
2827 	u8 tmp[2];
2828 	int num = attr->attr.name[4] - 0x30;
2829 
2830 	adap = &dev->i2c[num].adap;
2831 	if (!adap)
2832 		return 0;
2833 	if (i2c_read_regs(adap, 0x49, 0, tmp, 2) < 0)
2834 		if (i2c_read_regs(adap, 0x4d, 0, tmp, 2) < 0)
2835 			return sprintf(buf, "no sensor\n");
2836 	temp = tmp[0] * 1000;
2837 	return sprintf(buf, "%d\n", temp);
2838 }
2839 
2840 static ssize_t led_show(struct device *device,
2841 			struct device_attribute *attr, char *buf)
2842 {
2843 	struct ddb *dev = dev_get_drvdata(device);
2844 	int num = attr->attr.name[3] - 0x30;
2845 
2846 	return sprintf(buf, "%d\n", dev->leds & (1 << num) ? 1 : 0);
2847 }
2848 
2849 static void ddb_set_led(struct ddb *dev, int num, int val)
2850 {
2851 	if (!dev->link[0].info->led_num)
2852 		return;
2853 	switch (dev->port[num].class) {
2854 	case DDB_PORT_TUNER:
2855 		switch (dev->port[num].type) {
2856 		case DDB_TUNER_DVBS_ST:
2857 			i2c_write_reg16(&dev->i2c[num].adap,
2858 					0x69, 0xf14c, val ? 2 : 0);
2859 			break;
2860 		case DDB_TUNER_DVBCT_ST:
2861 			i2c_write_reg16(&dev->i2c[num].adap,
2862 					0x1f, 0xf00e, 0);
2863 			i2c_write_reg16(&dev->i2c[num].adap,
2864 					0x1f, 0xf00f, val ? 1 : 0);
2865 			break;
2866 		case DDB_TUNER_XO2 ... DDB_TUNER_DVBC2T2I_SONY:
2867 		{
2868 			u8 v;
2869 
2870 			i2c_read_reg(&dev->i2c[num].adap, 0x10, 0x08, &v);
2871 			v = (v & ~0x10) | (val ? 0x10 : 0);
2872 			i2c_write_reg(&dev->i2c[num].adap, 0x10, 0x08, v);
2873 			break;
2874 		}
2875 		default:
2876 			break;
2877 		}
2878 		break;
2879 	}
2880 }
2881 
2882 static ssize_t led_store(struct device *device,
2883 			 struct device_attribute *attr,
2884 			 const char *buf, size_t count)
2885 {
2886 	struct ddb *dev = dev_get_drvdata(device);
2887 	int num = attr->attr.name[3] - 0x30;
2888 	u32 val;
2889 
2890 	if (sscanf(buf, "%u\n", &val) != 1)
2891 		return -EINVAL;
2892 	if (val)
2893 		dev->leds |= (1 << num);
2894 	else
2895 		dev->leds &= ~(1 << num);
2896 	ddb_set_led(dev, num, val);
2897 	return count;
2898 }
2899 
2900 static ssize_t snr_show(struct device *device,
2901 			struct device_attribute *attr, char *buf)
2902 {
2903 	struct ddb *dev = dev_get_drvdata(device);
2904 	char snr[32];
2905 	int num = attr->attr.name[3] - 0x30;
2906 
2907 	if (dev->port[num].type >= DDB_TUNER_XO2) {
2908 		if (i2c_read_regs(&dev->i2c[num].adap, 0x10, 0x10, snr, 16) < 0)
2909 			return sprintf(buf, "NO SNR\n");
2910 		snr[16] = 0;
2911 	} else {
2912 		/* serial number at 0x100-0x11f */
2913 		if (i2c_read_regs16(&dev->i2c[num].adap,
2914 				    0x57, 0x100, snr, 32) < 0)
2915 			if (i2c_read_regs16(&dev->i2c[num].adap,
2916 					    0x50, 0x100, snr, 32) < 0)
2917 				return sprintf(buf, "NO SNR\n");
2918 		snr[31] = 0; /* in case it is not terminated on EEPROM */
2919 	}
2920 	return sprintf(buf, "%s\n", snr);
2921 }
2922 
2923 static ssize_t bsnr_show(struct device *device,
2924 			 struct device_attribute *attr, char *buf)
2925 {
2926 	struct ddb *dev = dev_get_drvdata(device);
2927 	char snr[16];
2928 
2929 	ddbridge_flashread(dev, 0, snr, 0x10, 15);
2930 	snr[15] = 0; /* in case it is not terminated on EEPROM */
2931 	return sprintf(buf, "%s\n", snr);
2932 }
2933 
2934 static ssize_t bpsnr_show(struct device *device,
2935 			  struct device_attribute *attr, char *buf)
2936 {
2937 	struct ddb *dev = dev_get_drvdata(device);
2938 	unsigned char snr[32];
2939 
2940 	if (!dev->i2c_num)
2941 		return 0;
2942 
2943 	if (i2c_read_regs16(&dev->i2c[0].adap,
2944 			    0x50, 0x0000, snr, 32) < 0 ||
2945 	    snr[0] == 0xff)
2946 		return sprintf(buf, "NO SNR\n");
2947 	snr[31] = 0; /* in case it is not terminated on EEPROM */
2948 	return sprintf(buf, "%s\n", snr);
2949 }
2950 
2951 static ssize_t redirect_show(struct device *device,
2952 			     struct device_attribute *attr, char *buf)
2953 {
2954 	return 0;
2955 }
2956 
2957 static ssize_t redirect_store(struct device *device,
2958 			      struct device_attribute *attr,
2959 			      const char *buf, size_t count)
2960 {
2961 	unsigned int i, p;
2962 	int res;
2963 
2964 	if (sscanf(buf, "%x %x\n", &i, &p) != 2)
2965 		return -EINVAL;
2966 	res = ddb_redirect(i, p);
2967 	if (res < 0)
2968 		return res;
2969 	dev_info(device, "redirect: %02x, %02x\n", i, p);
2970 	return count;
2971 }
2972 
2973 static ssize_t gap_show(struct device *device,
2974 			struct device_attribute *attr, char *buf)
2975 {
2976 	struct ddb *dev = dev_get_drvdata(device);
2977 	int num = attr->attr.name[3] - 0x30;
2978 
2979 	return sprintf(buf, "%d\n", dev->port[num].gap);
2980 }
2981 
2982 static ssize_t gap_store(struct device *device, struct device_attribute *attr,
2983 			 const char *buf, size_t count)
2984 {
2985 	struct ddb *dev = dev_get_drvdata(device);
2986 	int num = attr->attr.name[3] - 0x30;
2987 	unsigned int val;
2988 
2989 	if (sscanf(buf, "%u\n", &val) != 1)
2990 		return -EINVAL;
2991 	if (val > 128)
2992 		return -EINVAL;
2993 	if (val == 128)
2994 		val = 0xffffffff;
2995 	dev->port[num].gap = val;
2996 	return count;
2997 }
2998 
2999 static ssize_t version_show(struct device *device,
3000 			    struct device_attribute *attr, char *buf)
3001 {
3002 	struct ddb *dev = dev_get_drvdata(device);
3003 
3004 	return sprintf(buf, "%08x %08x\n",
3005 		       dev->link[0].ids.hwid, dev->link[0].ids.regmapid);
3006 }
3007 
3008 static ssize_t hwid_show(struct device *device,
3009 			 struct device_attribute *attr, char *buf)
3010 {
3011 	struct ddb *dev = dev_get_drvdata(device);
3012 
3013 	return sprintf(buf, "0x%08X\n", dev->link[0].ids.hwid);
3014 }
3015 
3016 static ssize_t regmap_show(struct device *device,
3017 			   struct device_attribute *attr, char *buf)
3018 {
3019 	struct ddb *dev = dev_get_drvdata(device);
3020 
3021 	return sprintf(buf, "0x%08X\n", dev->link[0].ids.regmapid);
3022 }
3023 
3024 static ssize_t fmode_show(struct device *device,
3025 			  struct device_attribute *attr, char *buf)
3026 {
3027 	int num = attr->attr.name[5] - 0x30;
3028 	struct ddb *dev = dev_get_drvdata(device);
3029 
3030 	return sprintf(buf, "%u\n", dev->link[num].lnb.fmode);
3031 }
3032 
3033 static ssize_t devid_show(struct device *device,
3034 			  struct device_attribute *attr, char *buf)
3035 {
3036 	int num = attr->attr.name[5] - 0x30;
3037 	struct ddb *dev = dev_get_drvdata(device);
3038 
3039 	return sprintf(buf, "%08x\n", dev->link[num].ids.devid);
3040 }
3041 
3042 static ssize_t fmode_store(struct device *device, struct device_attribute *attr,
3043 			   const char *buf, size_t count)
3044 {
3045 	struct ddb *dev = dev_get_drvdata(device);
3046 	int num = attr->attr.name[5] - 0x30;
3047 	unsigned int val;
3048 
3049 	if (sscanf(buf, "%u\n", &val) != 1)
3050 		return -EINVAL;
3051 	if (val > 3)
3052 		return -EINVAL;
3053 	ddb_lnb_init_fmode(dev, &dev->link[num], val);
3054 	return count;
3055 }
3056 
3057 static struct device_attribute ddb_attrs[] = {
3058 	__ATTR_RO(version),
3059 	__ATTR_RO(ports),
3060 	__ATTR_RO(ts_irq),
3061 	__ATTR_RO(i2c_irq),
3062 	__ATTR(gap0, 0664, gap_show, gap_store),
3063 	__ATTR(gap1, 0664, gap_show, gap_store),
3064 	__ATTR(gap2, 0664, gap_show, gap_store),
3065 	__ATTR(gap3, 0664, gap_show, gap_store),
3066 	__ATTR(fmode0, 0664, fmode_show, fmode_store),
3067 	__ATTR(fmode1, 0664, fmode_show, fmode_store),
3068 	__ATTR(fmode2, 0664, fmode_show, fmode_store),
3069 	__ATTR(fmode3, 0664, fmode_show, fmode_store),
3070 	__ATTR_MRO(devid0, devid_show),
3071 	__ATTR_MRO(devid1, devid_show),
3072 	__ATTR_MRO(devid2, devid_show),
3073 	__ATTR_MRO(devid3, devid_show),
3074 	__ATTR_RO(hwid),
3075 	__ATTR_RO(regmap),
3076 	__ATTR(redirect, 0664, redirect_show, redirect_store),
3077 	__ATTR_MRO(snr,  bsnr_show),
3078 	__ATTR_RO(bpsnr),
3079 	__ATTR_NULL,
3080 };
3081 
3082 static struct device_attribute ddb_attrs_temp[] = {
3083 	__ATTR_RO(temp),
3084 };
3085 
3086 static struct device_attribute ddb_attrs_fan[] = {
3087 	__ATTR(fan, 0664, fan_show, fan_store),
3088 };
3089 
3090 static struct device_attribute ddb_attrs_snr[] = {
3091 	__ATTR_MRO(snr0, snr_show),
3092 	__ATTR_MRO(snr1, snr_show),
3093 	__ATTR_MRO(snr2, snr_show),
3094 	__ATTR_MRO(snr3, snr_show),
3095 };
3096 
3097 static struct device_attribute ddb_attrs_ctemp[] = {
3098 	__ATTR_MRO(temp0, ctemp_show),
3099 	__ATTR_MRO(temp1, ctemp_show),
3100 	__ATTR_MRO(temp2, ctemp_show),
3101 	__ATTR_MRO(temp3, ctemp_show),
3102 };
3103 
3104 static struct device_attribute ddb_attrs_led[] = {
3105 	__ATTR(led0, 0664, led_show, led_store),
3106 	__ATTR(led1, 0664, led_show, led_store),
3107 	__ATTR(led2, 0664, led_show, led_store),
3108 	__ATTR(led3, 0664, led_show, led_store),
3109 };
3110 
3111 static struct device_attribute ddb_attrs_fanspeed[] = {
3112 	__ATTR_MRO(fanspeed0, fanspeed_show),
3113 	__ATTR_MRO(fanspeed1, fanspeed_show),
3114 	__ATTR_MRO(fanspeed2, fanspeed_show),
3115 	__ATTR_MRO(fanspeed3, fanspeed_show),
3116 };
3117 
3118 static struct class ddb_class = {
3119 	.name		= "ddbridge",
3120 	.devnode        = ddb_devnode,
3121 };
3122 
3123 static int ddb_class_create(void)
3124 {
3125 	ddb_major = register_chrdev(0, DDB_NAME, &ddb_fops);
3126 	if (ddb_major < 0)
3127 		return ddb_major;
3128 	if (class_register(&ddb_class) < 0)
3129 		return -1;
3130 	return 0;
3131 }
3132 
3133 static void ddb_class_destroy(void)
3134 {
3135 	class_unregister(&ddb_class);
3136 	unregister_chrdev(ddb_major, DDB_NAME);
3137 }
3138 
3139 static void ddb_device_attrs_del(struct ddb *dev)
3140 {
3141 	int i;
3142 
3143 	for (i = 0; i < 4; i++)
3144 		if (dev->link[i].info && dev->link[i].info->tempmon_irq)
3145 			device_remove_file(dev->ddb_dev,
3146 					   &ddb_attrs_fanspeed[i]);
3147 	for (i = 0; i < dev->link[0].info->temp_num; i++)
3148 		device_remove_file(dev->ddb_dev, &ddb_attrs_temp[i]);
3149 	for (i = 0; i < dev->link[0].info->fan_num; i++)
3150 		device_remove_file(dev->ddb_dev, &ddb_attrs_fan[i]);
3151 	for (i = 0; i < dev->i2c_num && i < 4; i++) {
3152 		if (dev->link[0].info->led_num)
3153 			device_remove_file(dev->ddb_dev, &ddb_attrs_led[i]);
3154 		device_remove_file(dev->ddb_dev, &ddb_attrs_snr[i]);
3155 		device_remove_file(dev->ddb_dev, &ddb_attrs_ctemp[i]);
3156 	}
3157 	for (i = 0; ddb_attrs[i].attr.name; i++)
3158 		device_remove_file(dev->ddb_dev, &ddb_attrs[i]);
3159 }
3160 
3161 static int ddb_device_attrs_add(struct ddb *dev)
3162 {
3163 	int i;
3164 
3165 	for (i = 0; ddb_attrs[i].attr.name; i++)
3166 		if (device_create_file(dev->ddb_dev, &ddb_attrs[i]))
3167 			goto fail;
3168 	for (i = 0; i < dev->link[0].info->temp_num; i++)
3169 		if (device_create_file(dev->ddb_dev, &ddb_attrs_temp[i]))
3170 			goto fail;
3171 	for (i = 0; i < dev->link[0].info->fan_num; i++)
3172 		if (device_create_file(dev->ddb_dev, &ddb_attrs_fan[i]))
3173 			goto fail;
3174 	for (i = 0; (i < dev->i2c_num) && (i < 4); i++) {
3175 		if (device_create_file(dev->ddb_dev, &ddb_attrs_snr[i]))
3176 			goto fail;
3177 		if (device_create_file(dev->ddb_dev, &ddb_attrs_ctemp[i]))
3178 			goto fail;
3179 		if (dev->link[0].info->led_num)
3180 			if (device_create_file(dev->ddb_dev,
3181 					       &ddb_attrs_led[i]))
3182 				goto fail;
3183 	}
3184 	for (i = 0; i < 4; i++)
3185 		if (dev->link[i].info && dev->link[i].info->tempmon_irq)
3186 			if (device_create_file(dev->ddb_dev,
3187 					       &ddb_attrs_fanspeed[i]))
3188 				goto fail;
3189 	return 0;
3190 fail:
3191 	return -1;
3192 }
3193 
3194 int ddb_device_create(struct ddb *dev)
3195 {
3196 	int res = 0;
3197 
3198 	if (ddb_num == DDB_MAX_ADAPTER)
3199 		return -ENOMEM;
3200 	mutex_lock(&ddb_mutex);
3201 	dev->nr = ddb_num;
3202 	ddbs[dev->nr] = dev;
3203 	dev->ddb_dev = device_create(&ddb_class, dev->dev,
3204 				     MKDEV(ddb_major, dev->nr),
3205 				     dev, "ddbridge%d", dev->nr);
3206 	if (IS_ERR(dev->ddb_dev)) {
3207 		res = PTR_ERR(dev->ddb_dev);
3208 		dev_info(dev->dev, "Could not create ddbridge%d\n", dev->nr);
3209 		goto fail;
3210 	}
3211 	res = ddb_device_attrs_add(dev);
3212 	if (res) {
3213 		ddb_device_attrs_del(dev);
3214 		device_destroy(&ddb_class, MKDEV(ddb_major, dev->nr));
3215 		ddbs[dev->nr] = NULL;
3216 		dev->ddb_dev = ERR_PTR(-ENODEV);
3217 	} else {
3218 		ddb_num++;
3219 	}
3220 fail:
3221 	mutex_unlock(&ddb_mutex);
3222 	return res;
3223 }
3224 
3225 void ddb_device_destroy(struct ddb *dev)
3226 {
3227 	if (IS_ERR(dev->ddb_dev))
3228 		return;
3229 	ddb_device_attrs_del(dev);
3230 	device_destroy(&ddb_class, MKDEV(ddb_major, dev->nr));
3231 }
3232 
3233 /****************************************************************************/
3234 /****************************************************************************/
3235 /****************************************************************************/
3236 
3237 static void tempmon_setfan(struct ddb_link *link)
3238 {
3239 	u32 temp, temp2, pwm;
3240 
3241 	if ((ddblreadl(link, TEMPMON_CONTROL) &
3242 	    TEMPMON_CONTROL_OVERTEMP) != 0) {
3243 		dev_info(link->dev->dev, "Over temperature condition\n");
3244 		link->overtemperature_error = 1;
3245 	}
3246 	temp  = (ddblreadl(link, TEMPMON_SENSOR0) >> 8) & 0xFF;
3247 	if (temp & 0x80)
3248 		temp = 0;
3249 	temp2  = (ddblreadl(link, TEMPMON_SENSOR1) >> 8) & 0xFF;
3250 	if (temp2 & 0x80)
3251 		temp2 = 0;
3252 	if (temp2 > temp)
3253 		temp = temp2;
3254 
3255 	pwm = (ddblreadl(link, TEMPMON_FANCONTROL) >> 8) & 0x0F;
3256 	if (pwm > 10)
3257 		pwm = 10;
3258 
3259 	if (temp >= link->temp_tab[pwm]) {
3260 		while (pwm < 10 && temp >= link->temp_tab[pwm + 1])
3261 			pwm += 1;
3262 	} else {
3263 		while (pwm > 1 && temp < link->temp_tab[pwm - 2])
3264 			pwm -= 1;
3265 	}
3266 	ddblwritel(link, (pwm << 8), TEMPMON_FANCONTROL);
3267 }
3268 
3269 static void temp_handler(void *data)
3270 {
3271 	struct ddb_link *link = (struct ddb_link *)data;
3272 
3273 	spin_lock(&link->temp_lock);
3274 	tempmon_setfan(link);
3275 	spin_unlock(&link->temp_lock);
3276 }
3277 
3278 static int tempmon_init(struct ddb_link *link, int first_time)
3279 {
3280 	struct ddb *dev = link->dev;
3281 	int status = 0;
3282 	u32 l = link->nr;
3283 
3284 	spin_lock_irq(&link->temp_lock);
3285 	if (first_time) {
3286 		static u8 temperature_table[11] = {
3287 			30, 35, 40, 45, 50, 55, 60, 65, 70, 75, 80 };
3288 
3289 		memcpy(link->temp_tab, temperature_table,
3290 		       sizeof(temperature_table));
3291 	}
3292 	ddb_irq_set(dev, l, link->info->tempmon_irq, temp_handler, link);
3293 	ddblwritel(link, (TEMPMON_CONTROL_OVERTEMP | TEMPMON_CONTROL_AUTOSCAN |
3294 			  TEMPMON_CONTROL_INTENABLE),
3295 		   TEMPMON_CONTROL);
3296 	ddblwritel(link, (3 << 8), TEMPMON_FANCONTROL);
3297 
3298 	link->overtemperature_error =
3299 		((ddblreadl(link, TEMPMON_CONTROL) &
3300 			TEMPMON_CONTROL_OVERTEMP) != 0);
3301 	if (link->overtemperature_error) {
3302 		dev_info(link->dev->dev, "Over temperature condition\n");
3303 		status = -1;
3304 	}
3305 	tempmon_setfan(link);
3306 	spin_unlock_irq(&link->temp_lock);
3307 	return status;
3308 }
3309 
3310 static int ddb_init_tempmon(struct ddb_link *link)
3311 {
3312 	const struct ddb_info *info = link->info;
3313 
3314 	if (!info->tempmon_irq)
3315 		return 0;
3316 	if (info->type == DDB_OCTOPUS_MAX_CT)
3317 		if (link->ids.regmapid < 0x00010002)
3318 			return 0;
3319 	spin_lock_init(&link->temp_lock);
3320 	dev_dbg(link->dev->dev, "init_tempmon\n");
3321 	return tempmon_init(link, 1);
3322 }
3323 
3324 /****************************************************************************/
3325 /****************************************************************************/
3326 /****************************************************************************/
3327 
3328 static int ddb_init_boards(struct ddb *dev)
3329 {
3330 	const struct ddb_info *info;
3331 	struct ddb_link *link;
3332 	u32 l;
3333 
3334 	for (l = 0; l < DDB_MAX_LINK; l++) {
3335 		link = &dev->link[l];
3336 		info = link->info;
3337 
3338 		if (!info)
3339 			continue;
3340 		if (info->board_control) {
3341 			ddbwritel(dev, 0, DDB_LINK_TAG(l) | BOARD_CONTROL);
3342 			msleep(100);
3343 			ddbwritel(dev, info->board_control_2,
3344 				  DDB_LINK_TAG(l) | BOARD_CONTROL);
3345 			usleep_range(2000, 3000);
3346 			ddbwritel(dev,
3347 				  info->board_control_2 | info->board_control,
3348 				  DDB_LINK_TAG(l) | BOARD_CONTROL);
3349 			usleep_range(2000, 3000);
3350 		}
3351 		ddb_init_tempmon(link);
3352 	}
3353 	return 0;
3354 }
3355 
3356 int ddb_init(struct ddb *dev)
3357 {
3358 	mutex_init(&dev->link[0].lnb.lock);
3359 	mutex_init(&dev->link[0].flash_mutex);
3360 	if (no_init) {
3361 		ddb_device_create(dev);
3362 		return 0;
3363 	}
3364 
3365 	ddb_init_boards(dev);
3366 
3367 	if (ddb_i2c_init(dev) < 0)
3368 		goto fail1;
3369 	ddb_ports_init(dev);
3370 	if (ddb_buffers_alloc(dev) < 0) {
3371 		dev_info(dev->dev, "Could not allocate buffer memory\n");
3372 		goto fail2;
3373 	}
3374 	if (ddb_ports_attach(dev) < 0)
3375 		goto fail3;
3376 
3377 	ddb_device_create(dev);
3378 
3379 	if (dev->link[0].info->fan_num)	{
3380 		ddbwritel(dev, 1, GPIO_DIRECTION);
3381 		ddbwritel(dev, 1, GPIO_OUTPUT);
3382 	}
3383 	return 0;
3384 
3385 fail3:
3386 	dev_err(dev->dev, "fail3\n");
3387 	ddb_ports_detach(dev);
3388 	ddb_buffers_free(dev);
3389 fail2:
3390 	dev_err(dev->dev, "fail2\n");
3391 	ddb_ports_release(dev);
3392 	ddb_i2c_release(dev);
3393 fail1:
3394 	dev_err(dev->dev, "fail1\n");
3395 	return -1;
3396 }
3397 
3398 void ddb_unmap(struct ddb *dev)
3399 {
3400 	if (dev->regs)
3401 		iounmap(dev->regs);
3402 	vfree(dev);
3403 }
3404 
3405 int ddb_exit_ddbridge(int stage, int error)
3406 {
3407 	switch (stage) {
3408 	default:
3409 	case 2:
3410 		destroy_workqueue(ddb_wq);
3411 		fallthrough;
3412 	case 1:
3413 		ddb_class_destroy();
3414 		break;
3415 	}
3416 
3417 	return error;
3418 }
3419 
3420 int ddb_init_ddbridge(void)
3421 {
3422 	if (dma_buf_num < 8)
3423 		dma_buf_num = 8;
3424 	if (dma_buf_num > 32)
3425 		dma_buf_num = 32;
3426 	if (dma_buf_size < 1)
3427 		dma_buf_size = 1;
3428 	if (dma_buf_size > 43)
3429 		dma_buf_size = 43;
3430 
3431 	if (ddb_class_create() < 0)
3432 		return -1;
3433 	ddb_wq = alloc_workqueue("ddbridge", 0, 0);
3434 	if (!ddb_wq)
3435 		return ddb_exit_ddbridge(1, -1);
3436 
3437 	return 0;
3438 }
3439