af9015.c 41.9 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21
/*
 * DVB USB Linux driver for Afatech AF9015 DVB-T USB2.0 receiver
 *
 * Copyright (C) 2007 Antti Palosaari <crope@iki.fi>
 *
 * Thanks to Afatech who kindly provided information.
 *
 *    This program is free software; you can redistribute it and/or modify
 *    it under the terms of the GNU General Public License as published by
 *    the Free Software Foundation; either version 2 of the License, or
 *    (at your option) any later version.
 *
 *    This program is distributed in the hope that it will be useful,
 *    but WITHOUT ANY WARRANTY; without even the implied warranty of
 *    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *    GNU General Public License for more details.
 *
 */

#include "af9015.h"

22
static int dvb_usb_af9015_remote;
23 24 25 26
module_param_named(remote, dvb_usb_af9015_remote, int, 0644);
MODULE_PARM_DESC(remote, "select remote");
DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);

27
static int af9015_ctrl_msg(struct dvb_usb_device *d, struct req_t *req)
28
{
29 30
#define REQ_HDR_LEN 8 /* send header size */
#define ACK_HDR_LEN 2 /* rece header size */
31
	struct af9015_state *state = d_to_priv(d);
32
	int ret, wlen, rlen;
33 34
	u8 write = 1;

35 36 37 38
	mutex_lock(&d->usb_mutex);

	state->buf[0] = req->cmd;
	state->buf[1] = state->seq++;
39
	state->buf[2] = req->i2c_addr << 1;
40 41 42 43 44
	state->buf[3] = req->addr >> 8;
	state->buf[4] = req->addr & 0xff;
	state->buf[5] = req->mbox;
	state->buf[6] = req->addr_len;
	state->buf[7] = req->data_len;
45 46 47 48 49 50 51 52 53

	switch (req->cmd) {
	case GET_CONFIG:
	case READ_MEMORY:
	case RECONNECT_USB:
		write = 0;
		break;
	case READ_I2C:
		write = 0;
54
		state->buf[2] |= 0x01; /* set I2C direction */
55
		/* fall through */
56
	case WRITE_I2C:
57
		state->buf[0] = READ_WRITE_I2C;
58 59 60
		break;
	case WRITE_MEMORY:
		if (((req->addr & 0xff00) == 0xff00) ||
61
		    ((req->addr & 0xff00) == 0xae00))
62
			state->buf[0] = WRITE_VIRTUAL_MEMORY;
63 64 65
	case WRITE_VIRTUAL_MEMORY:
	case COPY_FIRMWARE:
	case DOWNLOAD_FIRMWARE:
66
	case BOOT:
67 68
		break;
	default:
69 70
		dev_err(&d->udev->dev, "%s: unknown command=%d\n",
				KBUILD_MODNAME, req->cmd);
71
		ret = -EIO;
72
		goto error;
73 74
	}

75 76
	/* buffer overflow check */
	if ((write && (req->data_len > BUF_LEN - REQ_HDR_LEN)) ||
77 78 79
			(!write && (req->data_len > BUF_LEN - ACK_HDR_LEN))) {
		dev_err(&d->udev->dev, "%s: too much data; cmd=%d len=%d\n",
				KBUILD_MODNAME, req->cmd, req->data_len);
80
		ret = -EINVAL;
81
		goto error;
82 83
	}

84 85 86 87
	/* write receives seq + status = 2 bytes
	   read receives seq + status + data = 2 + N bytes */
	wlen = REQ_HDR_LEN;
	rlen = ACK_HDR_LEN;
88
	if (write) {
89
		wlen += req->data_len;
90
		memcpy(&state->buf[REQ_HDR_LEN], req->data, req->data_len);
91 92
	} else {
		rlen += req->data_len;
93
	}
94

95
	/* no ack for these packets */
96
	if (req->cmd == DOWNLOAD_FIRMWARE || req->cmd == RECONNECT_USB)
97
		rlen = 0;
98

99 100
	ret = dvb_usbv2_generic_rw_locked(d,
			state->buf, wlen, state->buf, rlen);
101 102
	if (ret)
		goto error;
103 104

	/* check status */
105
	if (rlen && state->buf[1]) {
106
		dev_err(&d->udev->dev, "%s: command failed=%d\n",
107
				KBUILD_MODNAME, state->buf[1]);
108
		ret = -EIO;
109
		goto error;
110 111 112 113
	}

	/* read request, copy returned data to return buf */
	if (!write)
114
		memcpy(req->data, &state->buf[ACK_HDR_LEN], req->data_len);
115
error:
116 117
	mutex_unlock(&d->usb_mutex);

118 119 120 121 122 123 124 125 126 127 128
	return ret;
}

static int af9015_write_regs(struct dvb_usb_device *d, u16 addr, u8 *val,
	u8 len)
{
	struct req_t req = {WRITE_MEMORY, AF9015_I2C_DEMOD, addr, 0, 0, len,
		val};
	return af9015_ctrl_msg(d, &req);
}

129
static int af9015_read_regs(struct dvb_usb_device *d, u16 addr, u8 *val, u8 len)
130
{
131 132
	struct req_t req = {READ_MEMORY, AF9015_I2C_DEMOD, addr, 0, 0, len,
		val};
133 134 135
	return af9015_ctrl_msg(d, &req);
}

136 137 138 139 140
static int af9015_write_reg(struct dvb_usb_device *d, u16 addr, u8 val)
{
	return af9015_write_regs(d, addr, &val, 1);
}

141 142 143 144 145
static int af9015_read_reg(struct dvb_usb_device *d, u16 addr, u8 *val)
{
	return af9015_read_regs(d, addr, val, 1);
}

146 147 148
static int af9015_write_reg_i2c(struct dvb_usb_device *d, u8 addr, u16 reg,
	u8 val)
{
149
	struct af9015_state *state = d_to_priv(d);
150 151
	struct req_t req = {WRITE_I2C, addr, reg, 1, 1, 1, &val};

152 153
	if (addr == state->af9013_config[0].i2c_addr ||
	    addr == state->af9013_config[1].i2c_addr)
154 155 156 157 158 159 160 161
		req.addr_len = 3;

	return af9015_ctrl_msg(d, &req);
}

static int af9015_read_reg_i2c(struct dvb_usb_device *d, u8 addr, u16 reg,
	u8 *val)
{
162
	struct af9015_state *state = d_to_priv(d);
163 164
	struct req_t req = {READ_I2C, addr, reg, 0, 1, 1, val};

165 166
	if (addr == state->af9013_config[0].i2c_addr ||
	    addr == state->af9013_config[1].i2c_addr)
167 168 169 170 171
		req.addr_len = 3;

	return af9015_ctrl_msg(d, &req);
}

172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203
static int af9015_do_reg_bit(struct dvb_usb_device *d, u16 addr, u8 bit, u8 op)
{
	int ret;
	u8 val, mask = 0x01;

	ret = af9015_read_reg(d, addr, &val);
	if (ret)
		return ret;

	mask <<= bit;
	if (op) {
		/* set bit */
		val |= mask;
	} else {
		/* clear bit */
		mask ^= 0xff;
		val &= mask;
	}

	return af9015_write_reg(d, addr, val);
}

static int af9015_set_reg_bit(struct dvb_usb_device *d, u16 addr, u8 bit)
{
	return af9015_do_reg_bit(d, addr, bit, 1);
}

static int af9015_clear_reg_bit(struct dvb_usb_device *d, u16 addr, u8 bit)
{
	return af9015_do_reg_bit(d, addr, bit, 0);
}

204 205 206 207
static int af9015_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msg[],
	int num)
{
	struct dvb_usb_device *d = i2c_get_adapdata(adap);
208
	struct af9015_state *state = d_to_priv(d);
209
	int ret;
210
	u16 addr;
211
	u8 mbox, addr_len;
212 213
	struct req_t req;

214
/*
215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236
The bus lock is needed because there is two tuners both using same I2C-address.
Due to that the only way to select correct tuner is use demodulator I2C-gate.

................................................
. AF9015 includes integrated AF9013 demodulator.
. ____________                   ____________  .                ____________
.|     uC     |                 |   demod    | .               |    tuner   |
.|------------|                 |------------| .               |------------|
.|   AF9015   |                 |  AF9013/5  | .               |   MXL5003  |
.|            |--+----I2C-------|-----/ -----|-.-----I2C-------|            |
.|            |  |              | addr 0x38  | .               |  addr 0xc6 |
.|____________|  |              |____________| .               |____________|
.................|..............................
		 |               ____________                   ____________
		 |              |   demod    |                 |    tuner   |
		 |              |------------|                 |------------|
		 |              |   AF9013   |                 |   MXL5003  |
		 +----I2C-------|-----/ -----|-------I2C-------|            |
				| addr 0x3a  |                 |  addr 0xc6 |
				|____________|                 |____________|
*/

237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281
	if (msg[0].len == 0 || msg[0].flags & I2C_M_RD) {
		addr = 0x0000;
		mbox = 0;
		addr_len = 0;
	} else if (msg[0].len == 1) {
		addr = msg[0].buf[0];
		mbox = 0;
		addr_len = 1;
	} else if (msg[0].len == 2) {
		addr = msg[0].buf[0] << 8|msg[0].buf[1] << 0;
		mbox = 0;
		addr_len = 2;
	} else {
		addr = msg[0].buf[0] << 8|msg[0].buf[1] << 0;
		mbox = msg[0].buf[2];
		addr_len = 3;
	}

	if (num == 1 && !(msg[0].flags & I2C_M_RD)) {
		/* i2c write */
		if (msg[0].len > 21) {
			ret = -EOPNOTSUPP;
			goto err;
		}
		if (msg[0].addr == state->af9013_config[0].i2c_addr)
			req.cmd = WRITE_MEMORY;
		else
			req.cmd = WRITE_I2C;
		req.i2c_addr = msg[0].addr;
		req.addr = addr;
		req.mbox = mbox;
		req.addr_len = addr_len;
		req.data_len = msg[0].len-addr_len;
		req.data = &msg[0].buf[addr_len];
		ret = af9015_ctrl_msg(d, &req);
	} else if (num == 2 && !(msg[0].flags & I2C_M_RD) &&
		   (msg[1].flags & I2C_M_RD)) {
		/* i2c write + read */
		if (msg[0].len > 3 || msg[1].len > 61) {
			ret = -EOPNOTSUPP;
			goto err;
		}
		if (msg[0].addr == state->af9013_config[0].i2c_addr)
			req.cmd = READ_MEMORY;
		else
282
			req.cmd = READ_I2C;
283 284 285 286 287 288 289 290 291 292 293 294
		req.i2c_addr = msg[0].addr;
		req.addr = addr;
		req.mbox = mbox;
		req.addr_len = addr_len;
		req.data_len = msg[1].len;
		req.data = &msg[1].buf[0];
		ret = af9015_ctrl_msg(d, &req);
	} else if (num == 1 && (msg[0].flags & I2C_M_RD)) {
		/* i2c read */
		if (msg[0].len > 61) {
			ret = -EOPNOTSUPP;
			goto err;
295
		}
296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311
		if (msg[0].addr == state->af9013_config[0].i2c_addr) {
			ret = -EINVAL;
			goto err;
		}
		req.cmd = READ_I2C;
		req.i2c_addr = msg[0].addr;
		req.addr = addr;
		req.mbox = mbox;
		req.addr_len = addr_len;
		req.data_len = msg[0].len;
		req.data = &msg[0].buf[0];
		ret = af9015_ctrl_msg(d, &req);
	} else {
		ret = -EOPNOTSUPP;
		dev_dbg(&d->udev->dev, "%s: unknown msg, num %u\n",
			__func__, num);
312
	}
313 314
	if (ret)
		goto err;
315

316 317 318
	return num;
err:
	dev_dbg(&d->udev->dev, "%s: failed %d\n", __func__, ret);
319 320 321 322 323 324 325 326 327 328 329 330 331
	return ret;
}

static u32 af9015_i2c_func(struct i2c_adapter *adapter)
{
	return I2C_FUNC_I2C;
}

static struct i2c_algorithm af9015_i2c_algo = {
	.master_xfer = af9015_i2c_xfer,
	.functionality = af9015_i2c_func,
};

332
static int af9015_identify_state(struct dvb_usb_device *d, const char **name)
333 334
{
	int ret;
335 336
	u8 reply;
	struct req_t req = {GET_CONFIG, 0, 0, 0, 0, 1, &reply};
337

338
	ret = af9015_ctrl_msg(d, &req);
339 340 341
	if (ret)
		return ret;

342 343
	dev_dbg(&d->udev->dev, "%s: reply=%02x\n", __func__, reply);

344 345 346 347
	if (reply == 0x02)
		ret = WARM;
	else
		ret = COLD;
348

349
	return ret;
350 351
}

352 353
static int af9015_download_firmware(struct dvb_usb_device *d,
	const struct firmware *fw)
354
{
355
	struct af9015_state *state = d_to_priv(d);
356 357 358
	int i, len, remaining, ret;
	struct req_t req = {DOWNLOAD_FIRMWARE, 0, 0, 0, 0, 0, NULL};
	u16 checksum = 0;
359
	dev_dbg(&d->udev->dev, "%s:\n", __func__);
360

361 362 363
	/* calc checksum */
	for (i = 0; i < fw->size; i++)
		checksum += fw->data[i];
364

365 366
	state->firmware_size = fw->size;
	state->firmware_checksum = checksum;
367

368 369 370 371 372 373
	#define FW_ADDR 0x5100 /* firmware start address */
	#define LEN_MAX 55 /* max packet size */
	for (remaining = fw->size; remaining > 0; remaining -= LEN_MAX) {
		len = remaining;
		if (len > LEN_MAX)
			len = LEN_MAX;
374

375 376 377
		req.data_len = len;
		req.data = (u8 *) &fw->data[fw->size - remaining];
		req.addr = FW_ADDR + fw->size - remaining;
378

379 380
		ret = af9015_ctrl_msg(d, &req);
		if (ret) {
381 382 383
			dev_err(&d->udev->dev,
					"%s: firmware download failed=%d\n",
					KBUILD_MODNAME, ret);
384 385
			goto error;
		}
386 387
	}

388 389 390 391 392
	/* firmware loaded, request boot */
	req.cmd = BOOT;
	req.data_len = 0;
	ret = af9015_ctrl_msg(d, &req);
	if (ret) {
393 394
		dev_err(&d->udev->dev, "%s: firmware boot failed=%d\n",
				KBUILD_MODNAME, ret);
395 396
		goto error;
	}
397 398 399 400 401

error:
	return ret;
}

402
#define AF9015_EEPROM_SIZE 256
403 404
/* 2^31 + 2^29 - 2^25 + 2^22 - 2^19 - 2^16 + 1 */
#define GOLDEN_RATIO_PRIME_32 0x9e370001UL
405

406 407 408
/* hash (and dump) eeprom */
static int af9015_eeprom_hash(struct dvb_usb_device *d)
{
409
	struct af9015_state *state = d_to_priv(d);
410 411 412 413 414 415 416 417
	int ret, i;
	u8 buf[AF9015_EEPROM_SIZE];
	struct req_t req = {READ_I2C, AF9015_I2C_EEPROM, 0, 0, 1, 1, NULL};

	/* read eeprom */
	for (i = 0; i < AF9015_EEPROM_SIZE; i++) {
		req.addr = i;
		req.data = &buf[i];
418
		ret = af9015_ctrl_msg(d, &req);
419 420
		if (ret < 0)
			goto err;
421
	}
422

423 424
	/* calculate checksum */
	for (i = 0; i < AF9015_EEPROM_SIZE / sizeof(u32); i++) {
425
		state->eeprom_sum *= GOLDEN_RATIO_PRIME_32;
426
		state->eeprom_sum += le32_to_cpu(((__le32 *)buf)[i]);
427 428
	}

429 430 431
	for (i = 0; i < AF9015_EEPROM_SIZE; i += 16)
		dev_dbg(&d->udev->dev, "%s: %*ph\n", __func__, 16, buf + i);

432 433
	dev_dbg(&d->udev->dev, "%s: eeprom sum=%.8x\n",
			__func__, state->eeprom_sum);
434 435 436
	return 0;
err:
	dev_err(&d->udev->dev, "%s: eeprom failed=%d\n", KBUILD_MODNAME, ret);
437 438 439
	return ret;
}

440
static int af9015_read_config(struct dvb_usb_device *d)
441
{
442
	struct af9015_state *state = d_to_priv(d);
443
	int ret;
444 445
	u8 val, i, offset = 0;
	struct req_t req = {READ_I2C, AF9015_I2C_EEPROM, 0, 0, 1, 1, &val};
446

447
	dev_dbg(&d->udev->dev, "%s:\n", __func__);
448

449 450 451 452 453 454 455 456 457 458
	/* IR remote controller */
	req.addr = AF9015_EEPROM_IR_MODE;
	/* first message will timeout often due to possible hw bug */
	for (i = 0; i < 4; i++) {
		ret = af9015_ctrl_msg(d, &req);
		if (!ret)
			break;
	}
	if (ret)
		goto error;
459

460
	ret = af9015_eeprom_hash(d);
461 462 463
	if (ret)
		goto error;

464
	state->ir_mode = val;
465
	dev_dbg(&d->udev->dev, "%s: IR mode=%d\n", __func__, val);
466

467 468
	/* TS mode - one or two receivers */
	req.addr = AF9015_EEPROM_TS_MODE;
469 470 471
	ret = af9015_ctrl_msg(d, &req);
	if (ret)
		goto error;
472

473
	state->dual_mode = val;
474
	dev_dbg(&d->udev->dev, "%s: TS mode=%d\n", __func__, state->dual_mode);
475

476 477 478
	/* disable 2nd adapter because we don't have PID-filters */
	if (d->udev->speed == USB_SPEED_FULL)
		state->dual_mode = 0;
479

480 481
	state->af9013_config[0].i2c_addr = AF9015_I2C_DEMOD;

482
	if (state->dual_mode) {
483 484
		/* read 2nd demodulator I2C address */
		req.addr = AF9015_EEPROM_DEMOD2_I2C;
485
		ret = af9015_ctrl_msg(d, &req);
486 487 488
		if (ret)
			goto error;

489
		state->af9013_config[1].i2c_addr = val >> 1;
490 491
	}

492
	for (i = 0; i < state->dual_mode + 1; i++) {
493 494 495 496
		if (i == 1)
			offset = AF9015_EEPROM_OFFSET;
		/* xtal */
		req.addr = AF9015_EEPROM_XTAL_TYPE1 + offset;
497
		ret = af9015_ctrl_msg(d, &req);
498 499 500 501
		if (ret)
			goto error;
		switch (val) {
		case 0:
502
			state->af9013_config[i].clock = 28800000;
503 504
			break;
		case 1:
505
			state->af9013_config[i].clock = 20480000;
506 507
			break;
		case 2:
508
			state->af9013_config[i].clock = 28000000;
509 510
			break;
		case 3:
511
			state->af9013_config[i].clock = 25000000;
512
			break;
513
		}
514 515 516
		dev_dbg(&d->udev->dev, "%s: [%d] xtal=%d set clock=%d\n",
				__func__, i, val,
				state->af9013_config[i].clock);
517

518
		/* IF frequency */
519
		req.addr = AF9015_EEPROM_IF1H + offset;
520
		ret = af9015_ctrl_msg(d, &req);
521 522
		if (ret)
			goto error;
523

524
		state->af9013_config[i].if_frequency = val << 8;
525

526
		req.addr = AF9015_EEPROM_IF1L + offset;
527
		ret = af9015_ctrl_msg(d, &req);
528 529
		if (ret)
			goto error;
530

531 532
		state->af9013_config[i].if_frequency += val;
		state->af9013_config[i].if_frequency *= 1000;
533 534
		dev_dbg(&d->udev->dev, "%s: [%d] IF frequency=%d\n", __func__,
				i, state->af9013_config[i].if_frequency);
535 536 537

		/* MT2060 IF1 */
		req.addr = AF9015_EEPROM_MT2060_IF1H  + offset;
538
		ret = af9015_ctrl_msg(d, &req);
539 540
		if (ret)
			goto error;
541
		state->mt2060_if1[i] = val << 8;
542
		req.addr = AF9015_EEPROM_MT2060_IF1L + offset;
543
		ret = af9015_ctrl_msg(d, &req);
544 545
		if (ret)
			goto error;
546
		state->mt2060_if1[i] += val;
547
		dev_dbg(&d->udev->dev, "%s: [%d] MT2060 IF1=%d\n", __func__, i,
548
				state->mt2060_if1[i]);
549 550 551

		/* tuner */
		req.addr =  AF9015_EEPROM_TUNER_ID1 + offset;
552
		ret = af9015_ctrl_msg(d, &req);
553 554 555 556 557 558 559 560 561 562
		if (ret)
			goto error;
		switch (val) {
		case AF9013_TUNER_ENV77H11D5:
		case AF9013_TUNER_MT2060:
		case AF9013_TUNER_QT1010:
		case AF9013_TUNER_UNKNOWN:
		case AF9013_TUNER_MT2060_2:
		case AF9013_TUNER_TDA18271:
		case AF9013_TUNER_QT1010A:
563
		case AF9013_TUNER_TDA18218:
564
			state->af9013_config[i].spec_inv = 1;
565 566 567 568
			break;
		case AF9013_TUNER_MXL5003D:
		case AF9013_TUNER_MXL5005D:
		case AF9013_TUNER_MXL5005R:
569
		case AF9013_TUNER_MXL5007T:
570
			state->af9013_config[i].spec_inv = 0;
571
			break;
572
		case AF9013_TUNER_MC44S803:
573 574
			state->af9013_config[i].gpio[1] = AF9013_GPIO_LO;
			state->af9013_config[i].spec_inv = 1;
575
			break;
576
		default:
577 578 579
			dev_err(&d->udev->dev, "%s: tuner id=%d not " \
					"supported, please report!\n",
					KBUILD_MODNAME, val);
580
			return -ENODEV;
581
		}
582

583
		state->af9013_config[i].tuner = val;
584 585
		dev_dbg(&d->udev->dev, "%s: [%d] tuner id=%d\n",
				__func__, i, val);
586 587 588 589
	}

error:
	if (ret)
590 591
		dev_err(&d->udev->dev, "%s: eeprom read failed=%d\n",
				KBUILD_MODNAME, ret);
592

593
	/* AverMedia AVerTV Volar Black HD (A850) device have bad EEPROM
594 595
	   content :-( Override some wrong values here. Ditto for the
	   AVerTV Red HD+ (A850T) device. */
596 597
	if (le16_to_cpu(d->udev->descriptor.idVendor) == USB_VID_AVERMEDIA &&
		((le16_to_cpu(d->udev->descriptor.idProduct) ==
598
			USB_PID_AVERMEDIA_A850) ||
599
		(le16_to_cpu(d->udev->descriptor.idProduct) ==
600
			USB_PID_AVERMEDIA_A850T))) {
601 602 603
		dev_dbg(&d->udev->dev,
				"%s: AverMedia A850: overriding config\n",
				__func__);
604
		/* disable dual mode */
605
		state->dual_mode = 0;
606 607

		/* set correct IF */
608
		state->af9013_config[0].if_frequency = 4570000;
609 610
	}

611 612 613
	return ret;
}

614
static int af9015_get_stream_config(struct dvb_frontend *fe, u8 *ts_type,
615
		struct usb_data_stream_properties *stream)
616
{
617 618
	struct dvb_usb_device *d = fe_to_d(fe);
	dev_dbg(&d->udev->dev, "%s: adap=%d\n", __func__, fe_to_adap(fe)->id);
619

620
	if (d->udev->speed == USB_SPEED_FULL)
621
		stream->u.bulk.buffersize = TS_USB11_FRAME_SIZE;
622

623 624
	return 0;
}
625

626 627
static int af9015_get_adapter_count(struct dvb_usb_device *d)
{
628
	struct af9015_state *state = d_to_priv(d);
629
	return state->dual_mode + 1;
630 631
}

632
/* override demod callbacks for resource locking */
633
static int af9015_af9013_set_frontend(struct dvb_frontend *fe)
634 635
{
	int ret;
636
	struct af9015_state *state = fe_to_priv(fe);
637

638
	if (mutex_lock_interruptible(&state->fe_mutex))
639 640
		return -EAGAIN;

641
	ret = state->set_frontend[fe_to_adap(fe)->id](fe);
642

643
	mutex_unlock(&state->fe_mutex);
644 645 646 647 648 649

	return ret;
}

/* override demod callbacks for resource locking */
static int af9015_af9013_read_status(struct dvb_frontend *fe,
650
	enum fe_status *status)
651 652
{
	int ret;
653
	struct af9015_state *state = fe_to_priv(fe);
654

655
	if (mutex_lock_interruptible(&state->fe_mutex))
656 657
		return -EAGAIN;

658
	ret = state->read_status[fe_to_adap(fe)->id](fe, status);
659

660
	mutex_unlock(&state->fe_mutex);
661 662 663 664 665 666 667 668

	return ret;
}

/* override demod callbacks for resource locking */
static int af9015_af9013_init(struct dvb_frontend *fe)
{
	int ret;
669
	struct af9015_state *state = fe_to_priv(fe);
670

671
	if (mutex_lock_interruptible(&state->fe_mutex))
672 673
		return -EAGAIN;

674
	ret = state->init[fe_to_adap(fe)->id](fe);
675

676
	mutex_unlock(&state->fe_mutex);
677 678 679 680 681 682 683 684

	return ret;
}

/* override demod callbacks for resource locking */
static int af9015_af9013_sleep(struct dvb_frontend *fe)
{
	int ret;
685
	struct af9015_state *state = fe_to_priv(fe);
686

687
	if (mutex_lock_interruptible(&state->fe_mutex))
688 689
		return -EAGAIN;

690
	ret = state->sleep[fe_to_adap(fe)->id](fe);
691

692
	mutex_unlock(&state->fe_mutex);
693 694 695 696

	return ret;
}

697 698 699 700
/* override tuner callbacks for resource locking */
static int af9015_tuner_init(struct dvb_frontend *fe)
{
	int ret;
701
	struct af9015_state *state = fe_to_priv(fe);
702

703
	if (mutex_lock_interruptible(&state->fe_mutex))
704 705
		return -EAGAIN;

706
	ret = state->tuner_init[fe_to_adap(fe)->id](fe);
707

708
	mutex_unlock(&state->fe_mutex);
709 710 711 712 713 714 715 716

	return ret;
}

/* override tuner callbacks for resource locking */
static int af9015_tuner_sleep(struct dvb_frontend *fe)
{
	int ret;
717
	struct af9015_state *state = fe_to_priv(fe);
718

719
	if (mutex_lock_interruptible(&state->fe_mutex))
720 721
		return -EAGAIN;

722
	ret = state->tuner_sleep[fe_to_adap(fe)->id](fe);
723 724 725 726 727 728 729 730

	mutex_unlock(&state->fe_mutex);

	return ret;
}

static int af9015_copy_firmware(struct dvb_usb_device *d)
{
731
	struct af9015_state *state = d_to_priv(d);
732 733 734 735 736
	int ret;
	u8 fw_params[4];
	u8 val, i;
	struct req_t req = {COPY_FIRMWARE, 0, 0x5100, 0, 0, sizeof(fw_params),
		fw_params };
737
	dev_dbg(&d->udev->dev, "%s:\n", __func__);
738 739 740 741 742 743 744 745 746 747 748 749 750 751

	fw_params[0] = state->firmware_size >> 8;
	fw_params[1] = state->firmware_size & 0xff;
	fw_params[2] = state->firmware_checksum >> 8;
	fw_params[3] = state->firmware_checksum & 0xff;

	/* wait 2nd demodulator ready */
	msleep(100);

	ret = af9015_read_reg_i2c(d, state->af9013_config[1].i2c_addr,
			0x98be, &val);
	if (ret)
		goto error;
	else
752 753
		dev_dbg(&d->udev->dev, "%s: firmware status=%02x\n",
				__func__, val);
754 755 756 757 758 759 760 761 762 763 764 765 766 767

	if (val == 0x0c) /* fw is running, no need for download */
		goto exit;

	/* set I2C master clock to fast (to speed up firmware copy) */
	ret = af9015_write_reg(d, 0xd416, 0x04); /* 0x04 * 400ns */
	if (ret)
		goto error;

	msleep(50);

	/* copy firmware */
	ret = af9015_ctrl_msg(d, &req);
	if (ret)
768 769 770 771
		dev_err(&d->udev->dev, "%s: firmware copy cmd failed=%d\n",
				KBUILD_MODNAME, ret);

	dev_dbg(&d->udev->dev, "%s: firmware copy done\n", __func__);
772 773 774 775 776 777 778 779 780

	/* set I2C master clock back to normal */
	ret = af9015_write_reg(d, 0xd416, 0x14); /* 0x14 * 400ns */
	if (ret)
		goto error;

	/* request boot firmware */
	ret = af9015_write_reg_i2c(d, state->af9013_config[1].i2c_addr,
			0xe205, 1);
781 782
	dev_dbg(&d->udev->dev, "%s: firmware boot cmd status=%d\n",
			__func__, ret);
783 784 785 786 787
	if (ret)
		goto error;

	for (i = 0; i < 15; i++) {
		msleep(100);
788

789 790 791
		/* check firmware status */
		ret = af9015_read_reg_i2c(d, state->af9013_config[1].i2c_addr,
				0x98be, &val);
792 793
		dev_dbg(&d->udev->dev, "%s: firmware status cmd status=%d " \
				"firmware status=%02x\n", __func__, ret, val);
794 795
		if (ret)
			goto error;
796

797 798 799 800 801
		if (val == 0x0c || val == 0x04) /* success or fail */
			break;
	}

	if (val == 0x04) {
802 803
		dev_err(&d->udev->dev, "%s: firmware did not run\n",
				KBUILD_MODNAME);
804
		ret = -ETIMEDOUT;
805
	} else if (val != 0x0c) {
806 807
		dev_err(&d->udev->dev, "%s: firmware boot timeout\n",
				KBUILD_MODNAME);
808
		ret = -ETIMEDOUT;
809 810 811 812
	}

error:
exit:
813 814 815
	return ret;
}

816 817 818
static int af9015_af9013_frontend_attach(struct dvb_usb_adapter *adap)
{
	int ret;
819
	struct af9015_state *state = adap_to_priv(adap);
820

821 822 823 824 825 826 827 828 829 830 831
	if (adap->id == 0) {
		state->af9013_config[0].ts_mode = AF9013_TS_USB;
		memcpy(state->af9013_config[0].api_version, "\x0\x1\x9\x0", 4);
		state->af9013_config[0].gpio[0] = AF9013_GPIO_HI;
		state->af9013_config[0].gpio[3] = AF9013_GPIO_TUNER_ON;
	} else if (adap->id == 1) {
		state->af9013_config[1].ts_mode = AF9013_TS_SERIAL;
		memcpy(state->af9013_config[1].api_version, "\x0\x1\x9\x0", 4);
		state->af9013_config[1].gpio[0] = AF9013_GPIO_TUNER_ON;
		state->af9013_config[1].gpio[1] = AF9013_GPIO_LO;

832
		/* copy firmware to 2nd demodulator */
833
		if (state->dual_mode) {
834
			ret = af9015_copy_firmware(adap_to_d(adap));
835
			if (ret) {
836 837 838 839
				dev_err(&adap_to_d(adap)->udev->dev,
						"%s: firmware copy to 2nd " \
						"frontend failed, will " \
						"disable it\n", KBUILD_MODNAME);
840
				state->dual_mode = 0;
841 842 843 844 845 846 847 848
				return -ENODEV;
			}
		} else {
			return -ENODEV;
		}
	}

	/* attach demodulator */
849
	adap->fe[0] = dvb_attach(af9013_attach,
850
		&state->af9013_config[adap->id], &adap_to_d(adap)->i2c_adap);
851

852 853 854 855 856 857 858
	/*
	 * AF9015 firmware does not like if it gets interrupted by I2C adapter
	 * request on some critical phases. During normal operation I2C adapter
	 * is used only 2nd demodulator and tuner on dual tuner devices.
	 * Override demodulator callbacks and use mutex for limit access to
	 * those "critical" paths to keep AF9015 happy.
	 */
859
	if (adap->fe[0]) {
860
		state->set_frontend[adap->id] =
861 862
			adap->fe[0]->ops.set_frontend;
		adap->fe[0]->ops.set_frontend =
863 864 865
			af9015_af9013_set_frontend;

		state->read_status[adap->id] =
866 867
			adap->fe[0]->ops.read_status;
		adap->fe[0]->ops.read_status =
868 869
			af9015_af9013_read_status;

870 871
		state->init[adap->id] = adap->fe[0]->ops.init;
		adap->fe[0]->ops.init = af9015_af9013_init;
872

873 874
		state->sleep[adap->id] = adap->fe[0]->ops.sleep;
		adap->fe[0]->ops.sleep = af9015_af9013_sleep;
875 876
	}

877
	return adap->fe[0] == NULL ? -ENODEV : 0;
878 879 880
}

static struct mt2060_config af9015_mt2060_config = {
881
	.i2c_address = 0x60,
882 883 884 885
	.clock_out = 0,
};

static struct qt1010_config af9015_qt1010_config = {
886
	.i2c_address = 0x62,
887 888 889 890
};

static struct tda18271_config af9015_tda18271_config = {
	.gate = TDA18271_GATE_DIGITAL,
891
	.small_i2c = TDA18271_16_BYTE_CHUNK_INIT,
892 893 894
};

static struct mxl5005s_config af9015_mxl5003_config = {
895
	.i2c_address     = 0x63,
896 897 898 899
	.if_freq         = IF_FREQ_4570000HZ,
	.xtal_freq       = CRYSTAL_FREQ_16000000HZ,
	.agc_mode        = MXL_SINGLE_AGC,
	.tracking_filter = MXL_TF_DEFAULT,
900
	.rssi_enable     = MXL_RSSI_ENABLE,
901 902 903 904 905 906 907 908 909 910 911
	.cap_select      = MXL_CAP_SEL_ENABLE,
	.div_out         = MXL_DIV_OUT_4,
	.clock_out       = MXL_CLOCK_OUT_DISABLE,
	.output_load     = MXL5005S_IF_OUTPUT_LOAD_200_OHM,
	.top		 = MXL5005S_TOP_25P2,
	.mod_mode        = MXL_DIGITAL_MODE,
	.if_mode         = MXL_ZERO_IF,
	.AgcMasterByte   = 0x00,
};

static struct mxl5005s_config af9015_mxl5005_config = {
912
	.i2c_address     = 0x63,
913 914 915 916
	.if_freq         = IF_FREQ_4570000HZ,
	.xtal_freq       = CRYSTAL_FREQ_16000000HZ,
	.agc_mode        = MXL_SINGLE_AGC,
	.tracking_filter = MXL_TF_OFF,
917
	.rssi_enable     = MXL_RSSI_ENABLE,
918 919 920 921 922 923 924 925 926 927
	.cap_select      = MXL_CAP_SEL_ENABLE,
	.div_out         = MXL_DIV_OUT_4,
	.clock_out       = MXL_CLOCK_OUT_DISABLE,
	.output_load     = MXL5005S_IF_OUTPUT_LOAD_200_OHM,
	.top		 = MXL5005S_TOP_25P2,
	.mod_mode        = MXL_DIGITAL_MODE,
	.if_mode         = MXL_ZERO_IF,
	.AgcMasterByte   = 0x00,
};

928
static struct mc44s803_config af9015_mc44s803_config = {
929
	.i2c_address = 0x60,
930 931 932
	.dig_out = 1,
};

933
static struct tda18218_config af9015_tda18218_config = {
934
	.i2c_address = 0x60,
935 936 937
	.i2c_wr_max = 21, /* max wr bytes AF9015 I2C adap can handle at once */
};

938 939 940 941 942
static struct mxl5007t_config af9015_mxl5007t_config = {
	.xtal_freq_hz = MxL_XTAL_24_MHZ,
	.if_freq_hz = MxL_IF_4_57_MHZ,
};

943 944
static int af9015_tuner_attach(struct dvb_usb_adapter *adap)
{
945 946
	struct dvb_usb_device *d = adap_to_d(adap);
	struct af9015_state *state = d_to_priv(d);
947
	int ret;
948
	dev_dbg(&d->udev->dev, "%s:\n", __func__);
949

950
	switch (state->af9013_config[adap->id].tuner) {
951 952
	case AF9013_TUNER_MT2060:
	case AF9013_TUNER_MT2060_2:
953
		ret = dvb_attach(mt2060_attach, adap->fe[0],
954
			&adap_to_d(adap)->i2c_adap, &af9015_mt2060_config,
955
			state->mt2060_if1[adap->id])
956 957 958 959
			== NULL ? -ENODEV : 0;
		break;
	case AF9013_TUNER_QT1010:
	case AF9013_TUNER_QT1010A:
960
		ret = dvb_attach(qt1010_attach, adap->fe[0],
961
			&adap_to_d(adap)->i2c_adap,
962 963 964
			&af9015_qt1010_config) == NULL ? -ENODEV : 0;
		break;
	case AF9013_TUNER_TDA18271:
965
		ret = dvb_attach(tda18271_attach, adap->fe[0], 0x60,
966
			&adap_to_d(adap)->i2c_adap,
967 968
			&af9015_tda18271_config) == NULL ? -ENODEV : 0;
		break;
969
	case AF9013_TUNER_TDA18218:
970
		ret = dvb_attach(tda18218_attach, adap->fe[0],
971
			&adap_to_d(adap)->i2c_adap,
972 973
			&af9015_tda18218_config) == NULL ? -ENODEV : 0;
		break;
974
	case AF9013_TUNER_MXL5003D:
975
		ret = dvb_attach(mxl5005s_attach, adap->fe[0],
976
			&adap_to_d(adap)->i2c_adap,
977 978 979 980
			&af9015_mxl5003_config) == NULL ? -ENODEV : 0;
		break;
	case AF9013_TUNER_MXL5005D:
	case AF9013_TUNER_MXL5005R:
981
		ret = dvb_attach(mxl5005s_attach, adap->fe[0],
982
			&adap_to_d(adap)->i2c_adap,
983 984 985
			&af9015_mxl5005_config) == NULL ? -ENODEV : 0;
		break;
	case AF9013_TUNER_ENV77H11D5:
986
		ret = dvb_attach(dvb_pll_attach, adap->fe[0], 0x60,
987
			&adap_to_d(adap)->i2c_adap,
988 989 990
			DVB_PLL_TDA665X) == NULL ? -ENODEV : 0;
		break;
	case AF9013_TUNER_MC44S803:
991
		ret = dvb_attach(mc44s803_attach, adap->fe[0],
992
			&adap_to_d(adap)->i2c_adap,
993
			&af9015_mc44s803_config) == NULL ? -ENODEV : 0;
994
		break;
995
	case AF9013_TUNER_MXL5007T:
996
		ret = dvb_attach(mxl5007t_attach, adap->fe[0],
997
			&adap_to_d(adap)->i2c_adap,
998
			0x60, &af9015_mxl5007t_config) == NULL ? -ENODEV : 0;
999
		break;
1000 1001
	case AF9013_TUNER_UNKNOWN:
	default:
1002 1003 1004
		dev_err(&d->udev->dev, "%s: unknown tuner id=%d\n",
				KBUILD_MODNAME,
				state->af9013_config[adap->id].tuner);
1005 1006
		ret = -ENODEV;
	}
1007

1008
	if (adap->fe[0]->ops.tuner_ops.init) {
1009
		state->tuner_init[adap->id] =
1010 1011
			adap->fe[0]->ops.tuner_ops.init;
		adap->fe[0]->ops.tuner_ops.init = af9015_tuner_init;
1012 1013
	}

1014
	if (adap->fe[0]->ops.tuner_ops.sleep) {
1015
		state->tuner_sleep[adap->id] =
1016 1017 1018 1019 1020 1021 1022 1023 1024
			adap->fe[0]->ops.tuner_ops.sleep;
		adap->fe[0]->ops.tuner_ops.sleep = af9015_tuner_sleep;
	}

	return ret;
}

static int af9015_pid_filter_ctrl(struct dvb_usb_adapter *adap, int onoff)
{
1025
	struct dvb_usb_device *d = adap_to_d(adap);
1026
	int ret;
1027
	dev_dbg(&d->udev->dev, "%s: onoff=%d\n", __func__, onoff);
1028 1029

	if (onoff)
1030
		ret = af9015_set_reg_bit(d, 0xd503, 0);
1031
	else
1032
		ret = af9015_clear_reg_bit(d, 0xd503, 0);
1033 1034 1035 1036 1037 1038 1039

	return ret;
}

static int af9015_pid_filter(struct dvb_usb_adapter *adap, int index, u16 pid,
	int onoff)
{
1040
	struct dvb_usb_device *d = adap_to_d(adap);
1041 1042
	int ret;
	u8 idx;
1043 1044
	dev_dbg(&d->udev->dev, "%s: index=%d pid=%04x onoff=%d\n",
			__func__, index, pid, onoff);
1045

1046
	ret = af9015_write_reg(d, 0xd505, (pid & 0xff));
1047 1048 1049
	if (ret)
		goto error;

1050
	ret = af9015_write_reg(d, 0xd506, (pid >> 8));
1051 1052 1053 1054
	if (ret)
		goto error;

	idx = ((index & 0x1f) | (1 << 5));
1055
	ret = af9015_write_reg(d, 0xd504, idx);
1056 1057 1058 1059 1060 1061 1062

error:
	return ret;
}

static int af9015_init_endpoint(struct dvb_usb_device *d)
{
1063
	struct af9015_state *state = d_to_priv(d);
1064 1065 1066
	int ret;
	u16 frame_size;
	u8  packet_size;
1067
	dev_dbg(&d->udev->dev, "%s: USB speed=%d\n", __func__, d->udev->speed);
1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131

	if (d->udev->speed == USB_SPEED_FULL) {
		frame_size = TS_USB11_FRAME_SIZE/4;
		packet_size = TS_USB11_MAX_PACKET_SIZE/4;
	} else {
		frame_size = TS_USB20_FRAME_SIZE/4;
		packet_size = TS_USB20_MAX_PACKET_SIZE/4;
	}

	ret = af9015_set_reg_bit(d, 0xd507, 2); /* assert EP4 reset */
	if (ret)
		goto error;
	ret = af9015_set_reg_bit(d, 0xd50b, 1); /* assert EP5 reset */
	if (ret)
		goto error;
	ret = af9015_clear_reg_bit(d, 0xdd11, 5); /* disable EP4 */
	if (ret)
		goto error;
	ret = af9015_clear_reg_bit(d, 0xdd11, 6); /* disable EP5 */
	if (ret)
		goto error;
	ret = af9015_set_reg_bit(d, 0xdd11, 5); /* enable EP4 */
	if (ret)
		goto error;
	if (state->dual_mode) {
		ret = af9015_set_reg_bit(d, 0xdd11, 6); /* enable EP5 */
		if (ret)
			goto error;
	}
	ret = af9015_clear_reg_bit(d, 0xdd13, 5); /* disable EP4 NAK */
	if (ret)
		goto error;
	if (state->dual_mode) {
		ret = af9015_clear_reg_bit(d, 0xdd13, 6); /* disable EP5 NAK */
		if (ret)
			goto error;
	}
	/* EP4 xfer length */
	ret = af9015_write_reg(d, 0xdd88, frame_size & 0xff);
	if (ret)
		goto error;
	ret = af9015_write_reg(d, 0xdd89, frame_size >> 8);
	if (ret)
		goto error;
	/* EP5 xfer length */
	ret = af9015_write_reg(d, 0xdd8a, frame_size & 0xff);
	if (ret)
		goto error;
	ret = af9015_write_reg(d, 0xdd8b, frame_size >> 8);
	if (ret)
		goto error;
	ret = af9015_write_reg(d, 0xdd0c, packet_size); /* EP4 packet size */
	if (ret)
		goto error;
	ret = af9015_write_reg(d, 0xdd0d, packet_size); /* EP5 packet size */
	if (ret)
		goto error;
	ret = af9015_clear_reg_bit(d, 0xd507, 2); /* negate EP4 reset */
	if (ret)
		goto error;
	if (state->dual_mode) {
		ret = af9015_clear_reg_bit(d, 0xd50b, 1); /* negate EP5 reset */
		if (ret)
			goto error;
1132
	}
1133

1134 1135 1136 1137 1138 1139 1140 1141
	/* enable / disable mp2if2 */
	if (state->dual_mode)
		ret = af9015_set_reg_bit(d, 0xd50b, 0);
	else
		ret = af9015_clear_reg_bit(d, 0xd50b, 0);

error:
	if (ret)
1142 1143 1144
		dev_err(&d->udev->dev, "%s: endpoint init failed=%d\n",
				KBUILD_MODNAME, ret);

1145 1146 1147 1148 1149
	return ret;
}

static int af9015_init(struct dvb_usb_device *d)
{
1150
	struct af9015_state *state = d_to_priv(d);
1151
	int ret;
1152
	dev_dbg(&d->udev->dev, "%s:\n", __func__);
1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165

	mutex_init(&state->fe_mutex);

	/* init RC canary */
	ret = af9015_write_reg(d, 0x98e9, 0xff);
	if (ret)
		goto error;

	ret = af9015_init_endpoint(d);
	if (ret)
		goto error;

error:
1166 1167 1168
	return ret;
}

1169
#if IS_ENABLED(CONFIG_RC_CORE)
1170 1171 1172
struct af9015_rc_setup {
	unsigned int id;
	char *rc_codes;
1173 1174
};

1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189
static char *af9015_rc_setup_match(unsigned int id,
	const struct af9015_rc_setup *table)
{
	for (; table->rc_codes; table++)
		if (table->id == id)
			return table->rc_codes;
	return NULL;
}

static const struct af9015_rc_setup af9015_rc_setup_modparam[] = {
	{ AF9015_REMOTE_A_LINK_DTU_M, RC_MAP_ALINK_DTU_M },
	{ AF9015_REMOTE_MSI_DIGIVOX_MINI_II_V3, RC_MAP_MSI_DIGIVOX_II },
	{ AF9015_REMOTE_MYGICTV_U718, RC_MAP_TOTAL_MEDIA_IN_HAND },
	{ AF9015_REMOTE_DIGITTRADE_DVB_T, RC_MAP_DIGITTRADE },
	{ AF9015_REMOTE_AVERMEDIA_KS, RC_MAP_AVERMEDIA_RM_KS },
1190
	{ }
1191 1192
};

1193 1194 1195 1196 1197 1198 1199
static const struct af9015_rc_setup af9015_rc_setup_hashes[] = {
	{ 0xb8feb708, RC_MAP_MSI_DIGIVOX_II },
	{ 0xa3703d00, RC_MAP_ALINK_DTU_M },
	{ 0x9b7dc64e, RC_MAP_TOTAL_MEDIA_IN_HAND }, /* MYGICTV U718 */
	{ 0x5d49e3db, RC_MAP_DIGITTRADE }, /* LC-Power LC-USB-DVBT */
	{ }
};
1200

1201 1202
static int af9015_rc_query(struct dvb_usb_device *d)
{
1203
	struct af9015_state *state = d_to_priv(d);
1204 1205
	int ret;
	u8 buf[17];
1206

1207 1208 1209 1210
	/* read registers needed to detect remote controller code */
	ret = af9015_read_regs(d, 0x98d9, buf, sizeof(buf));
	if (ret)
		goto error;
1211

1212
	/* If any of these are non-zero, assume invalid data */
1213 1214
	if (buf[1] || buf[2] || buf[3]) {
		dev_dbg(&d->udev->dev, "%s: invalid data\n", __func__);
1215
		return ret;
1216
	}
1217

1218 1219 1220
	/* Check for repeat of previous code */
	if ((state->rc_repeat != buf[6] || buf[0]) &&
			!memcmp(&buf[12], state->rc_last, 4)) {
1221
		dev_dbg(&d->udev->dev, "%s: key repeated\n", __func__);
1222
		rc_repeat(d->rc_dev);
1223 1224 1225
		state->rc_repeat = buf[6];
		return ret;
	}
1226

1227 1228
	/* Only process key if canary killed */
	if (buf[16] != 0xff && buf[0] != 0x01) {
1229
		enum rc_type proto;
1230 1231
		dev_dbg(&d->udev->dev, "%s: key pressed %*ph\n",
				__func__, 4, buf + 12);
1232

1233 1234 1235 1236
		/* Reset the canary */
		ret = af9015_write_reg(d, 0x98e9, 0xff);
		if (ret)
			goto error;
1237

1238 1239 1240 1241 1242
		/* Remember this key */
		memcpy(state->rc_last, &buf[12], 4);
		if (buf[14] == (u8) ~buf[15]) {
			if (buf[12] == (u8) ~buf[13]) {
				/* NEC */
1243 1244
				state->rc_keycode = RC_SCANCODE_NEC(buf[12],
								    buf[14]);
1245
				proto = RC_TYPE_NEC;
1246 1247
			} else {
				/* NEC extended*/
1248 1249 1250
				state->rc_keycode = RC_SCANCODE_NECX(buf[12] << 8 |
								     buf[13],
								     buf[14]);
1251
				proto = RC_TYPE_NECX;
1252 1253 1254
			}
		} else {
			/* 32 bit NEC */
1255 1256 1257 1258
			state->rc_keycode = RC_SCANCODE_NEC32(buf[12] << 24 |
							      buf[13] << 16 |
							      buf[14] << 8  |
							      buf[15]);
1259
			proto = RC_TYPE_NEC32;
1260
		}
1261
		rc_keydown(d->rc_dev, proto, state->rc_keycode, 0);
1262
	} else {
1263
		dev_dbg(&d->udev->dev, "%s: no key press\n", __func__);
1264 1265 1266 1267 1268 1269
		/* Invalidate last keypress */
		/* Not really needed, but helps with debug */
		state->rc_last[2] = state->rc_last[3];
	}

	state->rc_repeat = buf[6];
1270
	state->rc_failed = false;
1271 1272

error:
1273
	if (ret) {
1274 1275
		dev_warn(&d->udev->dev, "%s: rc query failed=%d\n",
				KBUILD_MODNAME, ret);
1276

1277 1278 1279 1280 1281 1282 1283
		/* allow random errors as dvb-usb will stop polling on error */
		if (!state->rc_failed)
			ret = 0;

		state->rc_failed = true;
	}

1284 1285
	return ret;
}
1286

1287
static int af9015_get_rc_config(struct dvb_usb_device *d, struct dvb_usb_rc *rc)
1288
{
1289
	struct af9015_state *state = d_to_priv(d);
1290 1291 1292 1293 1294 1295
	u16 vid = le16_to_cpu(d->udev->descriptor.idVendor);

	if (state->ir_mode == AF9015_IR_MODE_DISABLED)
		return 0;

	/* try to load remote based module param */
1296 1297 1298
	if (!rc->map_name)
		rc->map_name = af9015_rc_setup_match(dvb_usb_af9015_remote,
				af9015_rc_setup_modparam);
1299

1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321
	/* try to load remote based eeprom hash */
	if (!rc->map_name)
		rc->map_name = af9015_rc_setup_match(state->eeprom_sum,
				af9015_rc_setup_hashes);

	/* try to load remote based USB iManufacturer string */
	if (!rc->map_name && vid == USB_VID_AFATECH) {
		/* Check USB manufacturer and product strings and try
		   to determine correct remote in case of chip vendor
		   reference IDs are used.
		   DO NOT ADD ANYTHING NEW HERE. Use hashes instead. */
		char manufacturer[10];
		memset(manufacturer, 0, sizeof(manufacturer));
		usb_string(d->udev, d->udev->descriptor.iManufacturer,
			manufacturer, sizeof(manufacturer));
		if (!strcmp("MSI", manufacturer)) {
			/* iManufacturer 1 MSI
			   iProduct      2 MSI K-VOX */
			rc->map_name = af9015_rc_setup_match(
					AF9015_REMOTE_MSI_DIGIVOX_MINI_II_V3,
					af9015_rc_setup_modparam);
		}
1322 1323
	}

1324 1325 1326 1327
	/* load empty to enable rc */
	if (!rc->map_name)
		rc->map_name = RC_MAP_EMPTY;

1328
	rc->allowed_protos = RC_BIT_NEC | RC_BIT_NECX | RC_BIT_NEC32;
1329 1330 1331 1332
	rc->query = af9015_rc_query;
	rc->interval = 500;

	return 0;
1333
}
1334 1335 1336
#else
	#define af9015_get_rc_config NULL
#endif
1337

1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374
static int af9015_probe(struct usb_interface *intf,
		const struct usb_device_id *id)
{
	struct usb_device *udev = interface_to_usbdev(intf);
	char manufacturer[sizeof("ITE Technologies, Inc.")];

	memset(manufacturer, 0, sizeof(manufacturer));
	usb_string(udev, udev->descriptor.iManufacturer,
			manufacturer, sizeof(manufacturer));
	/*
	 * There is two devices having same ID but different chipset. One uses
	 * AF9015 and the other IT9135 chipset. Only difference seen on lsusb
	 * is iManufacturer string.
	 *
	 * idVendor           0x0ccd TerraTec Electronic GmbH
	 * idProduct          0x0099
	 * bcdDevice            2.00
	 * iManufacturer           1 Afatech
	 * iProduct                2 DVB-T 2
	 *
	 * idVendor           0x0ccd TerraTec Electronic GmbH
	 * idProduct          0x0099
	 * bcdDevice            2.00
	 * iManufacturer           1 ITE Technologies, Inc.
	 * iProduct                2 DVB-T TV Stick
	 */
	if ((le16_to_cpu(udev->descriptor.idVendor) == USB_VID_TERRATEC) &&
			(le16_to_cpu(udev->descriptor.idProduct) == 0x0099)) {
		if (!strcmp("ITE Technologies, Inc.", manufacturer)) {
			dev_dbg(&udev->dev, "%s: rejecting device\n", __func__);
			return -ENODEV;
		}
	}

	return dvb_usbv2_probe(intf, id);
}

1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386
/* interface 0 is used by DVB-T receiver and
   interface 1 is for remote controller (HID) */
static struct dvb_usb_device_properties af9015_props = {
	.driver_name = KBUILD_MODNAME,
	.owner = THIS_MODULE,
	.adapter_nr = adapter_nr,
	.size_of_priv = sizeof(struct af9015_state),

	.generic_bulk_ctrl_endpoint = 0x02,
	.generic_bulk_ctrl_endpoint_response = 0x81,

	.identify_state = af9015_identify_state,
1387
	.firmware = AF9015_FIRMWARE,
1388 1389 1390
	.download_firmware = af9015_download_firmware,

	.i2c_algo = &af9015_i2c_algo,
1391 1392 1393
	.read_config = af9015_read_config,
	.frontend_attach = af9015_af9013_frontend_attach,
	.tuner_attach = af9015_tuner_attach,
1394 1395
	.init = af9015_init,
	.get_rc_config = af9015_get_rc_config,
1396
	.get_stream_config = af9015_get_stream_config,
1397 1398 1399 1400 1401 1402 1403 1404 1405

	.get_adapter_count = af9015_get_adapter_count,
	.adapter = {
		{
			.caps = DVB_USB_ADAP_HAS_PID_FILTER |
				DVB_USB_ADAP_PID_FILTER_CAN_BE_TURNED_OFF,
			.pid_filter_count = 32,
			.pid_filter = af9015_pid_filter,
			.pid_filter_ctrl = af9015_pid_filter_ctrl,
1406 1407 1408 1409

			.stream = DVB_USB_STREAM_BULK(0x84, 8, TS_USB20_FRAME_SIZE),
		}, {
			.stream = DVB_USB_STREAM_BULK(0x85, 8, TS_USB20_FRAME_SIZE),
1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461
		},
	},
};

static const struct usb_device_id af9015_id_table[] = {
	{ DVB_USB_DEVICE(USB_VID_AFATECH, USB_PID_AFATECH_AF9015_9015,
		&af9015_props, "Afatech AF9015 reference design", NULL) },
	{ DVB_USB_DEVICE(USB_VID_AFATECH, USB_PID_AFATECH_AF9015_9016,
		&af9015_props, "Afatech AF9015 reference design", NULL) },
	{ DVB_USB_DEVICE(USB_VID_LEADTEK, USB_PID_WINFAST_DTV_DONGLE_GOLD,
		&af9015_props, "Leadtek WinFast DTV Dongle Gold", RC_MAP_LEADTEK_Y04G0051) },
	{ DVB_USB_DEVICE(USB_VID_PINNACLE, USB_PID_PINNACLE_PCTV71E,
		&af9015_props, "Pinnacle PCTV 71e", NULL) },
	{ DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_KWORLD_399U,
		&af9015_props, "KWorld PlusTV Dual DVB-T Stick (DVB-T 399U)", NULL) },
	{ DVB_USB_DEVICE(USB_VID_VISIONPLUS, USB_PID_TINYTWIN,
		&af9015_props, "DigitalNow TinyTwin", RC_MAP_AZUREWAVE_AD_TU700) },
	{ DVB_USB_DEVICE(USB_VID_VISIONPLUS, USB_PID_AZUREWAVE_AD_TU700,
		&af9015_props, "TwinHan AzureWave AD-TU700(704J)", RC_MAP_AZUREWAVE_AD_TU700) },
	{ DVB_USB_DEVICE(USB_VID_TERRATEC, USB_PID_TERRATEC_CINERGY_T_USB_XE_REV2,
		&af9015_props, "TerraTec Cinergy T USB XE", NULL) },
	{ DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_KWORLD_PC160_2T,
		&af9015_props, "KWorld PlusTV Dual DVB-T PCI (DVB-T PC160-2T)", NULL) },
	{ DVB_USB_DEVICE(USB_VID_AVERMEDIA, USB_PID_AVERMEDIA_VOLAR_X,
		&af9015_props, "AVerMedia AVerTV DVB-T Volar X", RC_MAP_AVERMEDIA_M135A) },
	{ DVB_USB_DEVICE(USB_VID_XTENSIONS, USB_PID_XTENSIONS_XD_380,
		&af9015_props, "Xtensions XD-380", NULL) },
	{ DVB_USB_DEVICE(USB_VID_MSI_2, USB_PID_MSI_DIGIVOX_DUO,
		&af9015_props, "MSI DIGIVOX Duo", RC_MAP_MSI_DIGIVOX_III) },
	{ DVB_USB_DEVICE(USB_VID_AVERMEDIA, USB_PID_AVERMEDIA_VOLAR_X_2,
		&af9015_props, "Fujitsu-Siemens Slim Mobile USB DVB-T", NULL) },
	{ DVB_USB_DEVICE(USB_VID_TELESTAR,  USB_PID_TELESTAR_STARSTICK_2,
		&af9015_props, "Telestar Starstick 2", NULL) },
	{ DVB_USB_DEVICE(USB_VID_AVERMEDIA, USB_PID_AVERMEDIA_A309,
		&af9015_props, "AVerMedia A309", NULL) },
	{ DVB_USB_DEVICE(USB_VID_MSI_2, USB_PID_MSI_DIGI_VOX_MINI_III,
		&af9015_props, "MSI Digi VOX mini III", RC_MAP_MSI_DIGIVOX_III) },
	{ DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_KWORLD_395U,
		&af9015_props, "KWorld USB DVB-T TV Stick II (VS-DVB-T 395U)", NULL) },
	{ DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_KWORLD_395U_2,
		&af9015_props, "KWorld USB DVB-T TV Stick II (VS-DVB-T 395U)", NULL) },
	{ DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_KWORLD_395U_3,
		&af9015_props, "KWorld USB DVB-T TV Stick II (VS-DVB-T 395U)", NULL) },
	{ DVB_USB_DEVICE(USB_VID_AFATECH, USB_PID_TREKSTOR_DVBT,
		&af9015_props, "TrekStor DVB-T USB Stick", RC_MAP_TREKSTOR) },
	{ DVB_USB_DEVICE(USB_VID_AVERMEDIA, USB_PID_AVERMEDIA_A850,
		&af9015_props, "AverMedia AVerTV Volar Black HD (A850)", NULL) },
	{ DVB_USB_DEVICE(USB_VID_AVERMEDIA, USB_PID_AVERMEDIA_A805,
		&af9015_props, "AverMedia AVerTV Volar GPS 805 (A805)", NULL) },
	{ DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_CONCEPTRONIC_CTVDIGRCU,
		&af9015_props, "Conceptronic USB2.0 DVB-T CTVDIGRCU V3.0", NULL) },
	{ DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_KWORLD_MC810,
1462
		&af9015_props, "KWorld Digital MC-810", NULL) },
1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482
	{ DVB_USB_DEVICE(USB_VID_KYE, USB_PID_GENIUS_TVGO_DVB_T03,
		&af9015_props, "Genius TVGo DVB-T03", NULL) },
	{ DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_KWORLD_399U_2,
		&af9015_props, "KWorld PlusTV Dual DVB-T Stick (DVB-T 399U)", NULL) },
	{ DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_KWORLD_PC160_T,
		&af9015_props, "KWorld PlusTV DVB-T PCI Pro Card (DVB-T PC160-T)", NULL) },
	{ DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_SVEON_STV20,
		&af9015_props, "Sveon STV20 Tuner USB DVB-T HDTV", NULL) },
	{ DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_TINYTWIN_2,
		&af9015_props, "DigitalNow TinyTwin v2", RC_MAP_DIGITALNOW_TINYTWIN) },
	{ DVB_USB_DEVICE(USB_VID_LEADTEK, USB_PID_WINFAST_DTV2000DS,
		&af9015_props, "Leadtek WinFast DTV2000DS", RC_MAP_LEADTEK_Y04G0051) },
	{ DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_KWORLD_UB383_T,
		&af9015_props, "KWorld USB DVB-T Stick Mobile (UB383-T)", NULL) },
	{ DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_KWORLD_395U_4,
		&af9015_props, "KWorld USB DVB-T TV Stick II (VS-DVB-T 395U)", NULL) },
	{ DVB_USB_DEVICE(USB_VID_AVERMEDIA, USB_PID_AVERMEDIA_A815M,
		&af9015_props, "AverMedia AVerTV Volar M (A815Mac)", NULL) },
	{ DVB_USB_DEVICE(USB_VID_TERRATEC, USB_PID_TERRATEC_CINERGY_T_STICK_RC,
		&af9015_props, "TerraTec Cinergy T Stick RC", RC_MAP_TERRATEC_SLIM_2) },
1483
	/* XXX: that same ID [0ccd:0099] is used by af9035 driver too */
1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495
	{ DVB_USB_DEVICE(USB_VID_TERRATEC, USB_PID_TERRATEC_CINERGY_T_STICK_DUAL_RC,
		&af9015_props, "TerraTec Cinergy T Stick Dual RC", RC_MAP_TERRATEC_SLIM) },
	{ DVB_USB_DEVICE(USB_VID_AVERMEDIA, USB_PID_AVERMEDIA_A850T,
		&af9015_props, "AverMedia AVerTV Red HD+ (A850T)", NULL) },
	{ DVB_USB_DEVICE(USB_VID_GTEK, USB_PID_TINYTWIN_3,
		&af9015_props, "DigitalNow TinyTwin v3", RC_MAP_DIGITALNOW_TINYTWIN) },
	{ DVB_USB_DEVICE(USB_VID_KWORLD_2, USB_PID_SVEON_STV22,
		&af9015_props, "Sveon STV22 Dual USB DVB-T Tuner HDTV", RC_MAP_MSI_DIGIVOX_III) },
	{ }
};
MODULE_DEVICE_TABLE(usb, af9015_id_table);

1496 1497
/* usb specific object needed to register this driver with the usb subsystem */
static struct usb_driver af9015_usb_driver = {
1498
	.name = KBUILD_MODNAME,
1499
	.id_table = af9015_id_table,
1500
	.probe = af9015_probe,
1501
	.disconnect = dvb_usbv2_disconnect,
A
Antti Palosaari 已提交
1502 1503
	.suspend = dvb_usbv2_suspend,
	.resume = dvb_usbv2_resume,
1504
	.reset_resume = dvb_usbv2_reset_resume,
1505
	.no_dynamic_id = 1,
1506
	.soft_unbind = 1,
1507 1508
};

1509
module_usb_driver(af9015_usb_driver);
1510 1511

MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
1512
MODULE_DESCRIPTION("Afatech AF9015 driver");
1513
MODULE_LICENSE("GPL");
1514
MODULE_FIRMWARE(AF9015_FIRMWARE);