lgdt3306a.c 52.2 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18
/*
 *    Support for LGDT3306A - 8VSB/QAM-B
 *
 *    Copyright (C) 2013 Fred Richter <frichter@hauppauge.com>
 *    - driver structure based on lgdt3305.[ch] by Michael Krufky
 *    - code based on LG3306_V0.35 API by LG Electronics Inc.
 *
 *    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.
 */

19 20
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

21 22 23 24 25 26 27 28 29 30 31 32
#include <asm/div64.h>
#include <linux/dvb/frontend.h>
#include "dvb_math.h"
#include "lgdt3306a.h"


static int debug;
module_param(debug, int, 0644);
MODULE_PARM_DESC(debug, "set debug level (info=1, reg=2 (or-able))");

#define DBG_INFO 1
#define DBG_REG  2
33
#define DBG_DUMP 4 /* FGR - comment out to remove dump code */
34

35 36 37 38 39 40 41 42
#define lg_debug(fmt, arg...) \
	printk(KERN_DEBUG pr_fmt(fmt), ## arg)

#define dbg_info(fmt, arg...)					\
	do {							\
		if (debug & DBG_INFO)				\
			lg_debug(fmt, ## arg);			\
	} while (0)
43

44 45 46 47 48
#define dbg_reg(fmt, arg...)					\
	do {							\
		if (debug & DBG_REG)				\
			lg_debug(fmt, ## arg);			\
	} while (0)
49 50 51 52 53 54

#define lg_chkerr(ret)							\
({									\
	int __ret;							\
	__ret = (ret < 0);						\
	if (__ret)							\
55
		pr_err("error %d on line %d\n",	ret, __LINE__);		\
56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80
	__ret;								\
})

struct lgdt3306a_state {
	struct i2c_adapter *i2c_adap;
	const struct lgdt3306a_config *cfg;

	struct dvb_frontend frontend;

	fe_modulation_t current_modulation;
	u32 current_frequency;
	u32 snr;
};

/* -----------------------------------------------
 LG3306A Register Usage
   (LG does not really name the registers, so this code does not either)
 0000 -> 00FF Common control and status
 1000 -> 10FF Synchronizer control and status
 1F00 -> 1FFF Smart Antenna control and status
 2100 -> 21FF VSB Equalizer control and status
 2800 -> 28FF QAM Equalizer control and status
 3000 -> 30FF FEC control and status
 ---------------------------------------------- */

81 82 83
enum lgdt3306a_lock_status {
	LG3306_UNLOCK       = 0x00,
	LG3306_LOCK         = 0x01,
84
	LG3306_UNKNOWN_LOCK = 0xff
85
};
86

87
enum lgdt3306a_neverlock_status {
88 89 90 91
	LG3306_NL_INIT    = 0x00,
	LG3306_NL_PROCESS = 0x01,
	LG3306_NL_LOCK    = 0x02,
	LG3306_NL_FAIL    = 0x03,
92
	LG3306_NL_UNKNOWN = 0xff
93
};
94

95 96 97 98
enum lgdt3306a_modulation {
	LG3306_VSB          = 0x00,
	LG3306_QAM64        = 0x01,
	LG3306_QAM256       = 0x02,
99
	LG3306_UNKNOWN_MODE = 0xff
100
};
101

102
enum lgdt3306a_lock_check {
103 104 105 106
	LG3306_SYNC_LOCK,
	LG3306_FEC_LOCK,
	LG3306_TR_LOCK,
	LG3306_AGC_LOCK,
107
};
108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124


#ifdef DBG_DUMP
static void lgdt3306a_DumpAllRegs(struct lgdt3306a_state *state);
static void lgdt3306a_DumpRegs(struct lgdt3306a_state *state);
#endif


static int lgdt3306a_write_reg(struct lgdt3306a_state *state, u16 reg, u8 val)
{
	int ret;
	u8 buf[] = { reg >> 8, reg & 0xff, val };
	struct i2c_msg msg = {
		.addr = state->cfg->i2c_addr, .flags = 0,
		.buf = buf, .len = 3,
	};

125
	dbg_reg("reg: 0x%04x, val: 0x%02x\n", reg, val);
126 127 128 129

	ret = i2c_transfer(state->i2c_adap, &msg, 1);

	if (ret != 1) {
130
		pr_err("error (addr %02x %02x <- %02x, err = %i)\n",
131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153
		       msg.buf[0], msg.buf[1], msg.buf[2], ret);
		if (ret < 0)
			return ret;
		else
			return -EREMOTEIO;
	}
	return 0;
}

static int lgdt3306a_read_reg(struct lgdt3306a_state *state, u16 reg, u8 *val)
{
	int ret;
	u8 reg_buf[] = { reg >> 8, reg & 0xff };
	struct i2c_msg msg[] = {
		{ .addr = state->cfg->i2c_addr,
		  .flags = 0, .buf = reg_buf, .len = 2 },
		{ .addr = state->cfg->i2c_addr,
		  .flags = I2C_M_RD, .buf = val, .len = 1 },
	};

	ret = i2c_transfer(state->i2c_adap, msg, 2);

	if (ret != 2) {
154
		pr_err("error (addr %02x reg %04x error (ret == %i)\n",
155 156 157 158 159 160
		       state->cfg->i2c_addr, reg, ret);
		if (ret < 0)
			return ret;
		else
			return -EREMOTEIO;
	}
161
	dbg_reg("reg: 0x%04x, val: 0x%02x\n", reg, *val);
162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180

	return 0;
}

#define read_reg(state, reg)						\
({									\
	u8 __val;							\
	int ret = lgdt3306a_read_reg(state, reg, &__val);		\
	if (lg_chkerr(ret))						\
		__val = 0;						\
	__val;								\
})

static int lgdt3306a_set_reg_bit(struct lgdt3306a_state *state,
				u16 reg, int bit, int onoff)
{
	u8 val;
	int ret;

181
	dbg_reg("reg: 0x%04x, bit: %d, level: %d\n", reg, bit, onoff);
182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201

	ret = lgdt3306a_read_reg(state, reg, &val);
	if (lg_chkerr(ret))
		goto fail;

	val &= ~(1 << bit);
	val |= (onoff & 1) << bit;

	ret = lgdt3306a_write_reg(state, reg, val);
	lg_chkerr(ret);
fail:
	return ret;
}

/* ------------------------------------------------------------------------ */

static int lgdt3306a_soft_reset(struct lgdt3306a_state *state)
{
	int ret;

202
	dbg_info("\n");
203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221

	ret = lgdt3306a_set_reg_bit(state, 0x0000, 7, 0);
	if (lg_chkerr(ret))
		goto fail;

	msleep(20);
	ret = lgdt3306a_set_reg_bit(state, 0x0000, 7, 1);
	lg_chkerr(ret);

fail:
	return ret;
}

static int lgdt3306a_mpeg_mode(struct lgdt3306a_state *state,
				     enum lgdt3306a_mpeg_mode mode)
{
	u8 val;
	int ret;

222
	dbg_info("(%d)\n", mode);
223 224 225
	/* transport packet format - TPSENB=0x80 */
	ret = lgdt3306a_set_reg_bit(state, 0x0071, 7,
				     mode == LGDT3306A_MPEG_PARALLEL ? 1 : 0);
226 227 228
	if (lg_chkerr(ret))
		goto fail;

229 230 231 232 233
	/*
	 * start of packet signal duration
	 * TPSSOPBITEN=0x40; 0=byte duration, 1=bit duration
	 */
	ret = lgdt3306a_set_reg_bit(state, 0x0071, 6, 0);
234 235 236 237 238 239 240
	if (lg_chkerr(ret))
		goto fail;

	ret = lgdt3306a_read_reg(state, 0x0070, &val);
	if (lg_chkerr(ret))
		goto fail;

241
	val |= 0x10; /* TPCLKSUPB=0x10 */
242

243
	if (mode == LGDT3306A_MPEG_PARALLEL)
244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259
		val &= ~0x10;

	ret = lgdt3306a_write_reg(state, 0x0070, val);
	lg_chkerr(ret);

fail:
	return ret;
}

static int lgdt3306a_mpeg_mode_polarity(struct lgdt3306a_state *state,
				       enum lgdt3306a_tp_clock_edge edge,
				       enum lgdt3306a_tp_valid_polarity valid)
{
	u8 val;
	int ret;

260
	dbg_info("edge=%d, valid=%d\n", edge, valid);
261 262 263 264 265

	ret = lgdt3306a_read_reg(state, 0x0070, &val);
	if (lg_chkerr(ret))
		goto fail;

266
	val &= ~0x06; /* TPCLKPOL=0x04, TPVALPOL=0x02 */
267

268
	if (edge == LGDT3306A_TPCLK_RISING_EDGE)
269
		val |= 0x04;
270
	if (valid == LGDT3306A_TP_VALID_HIGH)
271 272 273 274 275 276 277 278 279 280 281 282 283 284 285
		val |= 0x02;

	ret = lgdt3306a_write_reg(state, 0x0070, val);
	lg_chkerr(ret);

fail:
	return ret;
}

static int lgdt3306a_mpeg_tristate(struct lgdt3306a_state *state,
				     int mode)
{
	u8 val;
	int ret;

286
	dbg_info("(%d)\n", mode);
287

288
	if (mode) {
289 290 291
		ret = lgdt3306a_read_reg(state, 0x0070, &val);
		if (lg_chkerr(ret))
			goto fail;
292 293 294 295 296
		/*
		 * Tristate bus; TPOUTEN=0x80, TPCLKOUTEN=0x20,
		 * TPDATAOUTEN=0x08
		 */
		val &= ~0xa8;
297 298 299 300
		ret = lgdt3306a_write_reg(state, 0x0070, val);
		if (lg_chkerr(ret))
			goto fail;

301 302
		/* AGCIFOUTENB=0x40; 1=Disable IFAGC pin */
		ret = lgdt3306a_set_reg_bit(state, 0x0003, 6, 1);
303 304 305 306
		if (lg_chkerr(ret))
			goto fail;

	} else {
307 308
		/* enable IFAGC pin */
		ret = lgdt3306a_set_reg_bit(state, 0x0003, 6, 0);
309 310 311 312 313 314 315
		if (lg_chkerr(ret))
			goto fail;

		ret = lgdt3306a_read_reg(state, 0x0070, &val);
		if (lg_chkerr(ret))
			goto fail;

316
		val |= 0xa8; /* enable bus */
317 318 319 320 321 322 323 324 325
		ret = lgdt3306a_write_reg(state, 0x0070, val);
		if (lg_chkerr(ret))
			goto fail;
	}

fail:
	return ret;
}

326
static int lgdt3306a_ts_bus_ctrl(struct dvb_frontend *fe, int acquire)
327 328 329
{
	struct lgdt3306a_state *state = fe->demodulator_priv;

330
	dbg_info("acquire=%d\n", acquire);
331 332 333 334 335 336 337 338 339 340

	return lgdt3306a_mpeg_tristate(state, acquire ? 0 : 1);

}

static int lgdt3306a_power(struct lgdt3306a_state *state,
				     int mode)
{
	int ret;

341
	dbg_info("(%d)\n", mode);
342

343
	if (mode == 0) {
344 345
		/* into reset */
		ret = lgdt3306a_set_reg_bit(state, 0x0000, 7, 0);
346 347 348
		if (lg_chkerr(ret))
			goto fail;

349 350
		/* power down */
		ret = lgdt3306a_set_reg_bit(state, 0x0000, 0, 0);
351 352 353 354
		if (lg_chkerr(ret))
			goto fail;

	} else {
355 356
		/* out of reset */
		ret = lgdt3306a_set_reg_bit(state, 0x0000, 7, 1);
357 358 359
		if (lg_chkerr(ret))
			goto fail;

360 361
		/* power up */
		ret = lgdt3306a_set_reg_bit(state, 0x0000, 0, 1);
362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378
		if (lg_chkerr(ret))
			goto fail;
	}

#ifdef DBG_DUMP
	lgdt3306a_DumpAllRegs(state);
#endif
fail:
	return ret;
}


static int lgdt3306a_set_vsb(struct lgdt3306a_state *state)
{
	u8 val;
	int ret;

379
	dbg_info("\n");
380

381
	/* 0. Spectrum inversion detection manual; spectrum inverted */
382
	ret = lgdt3306a_read_reg(state, 0x0002, &val);
383
	val &= 0xf7; /* SPECINVAUTO Off */
384
	val |= 0x04; /* SPECINV On */
385 386 387 388
	ret = lgdt3306a_write_reg(state, 0x0002, val);
	if (lg_chkerr(ret))
		goto fail;

389
	/* 1. Selection of standard mode(0x08=QAM, 0x80=VSB) */
390 391 392 393
	ret = lgdt3306a_write_reg(state, 0x0008, 0x80);
	if (lg_chkerr(ret))
		goto fail;

394
	/* 2. Bandwidth mode for VSB(6MHz) */
395
	ret = lgdt3306a_read_reg(state, 0x0009, &val);
396 397
	val &= 0xe3;
	val |= 0x0c; /* STDOPDETTMODE[2:0]=3 */
398 399 400 401
	ret = lgdt3306a_write_reg(state, 0x0009, val);
	if (lg_chkerr(ret))
		goto fail;

402
	/* 3. QAM mode detection mode(None) */
403
	ret = lgdt3306a_read_reg(state, 0x0009, &val);
404
	val &= 0xfc; /* STDOPDETCMODE[1:0]=0 */
405 406 407 408
	ret = lgdt3306a_write_reg(state, 0x0009, val);
	if (lg_chkerr(ret))
		goto fail;

409
	/* 4. ADC sampling frequency rate(2x sampling) */
410 411 412
	ret = lgdt3306a_read_reg(state, 0x000d, &val);
	val &= 0xbf; /* SAMPLING4XFEN=0 */
	ret = lgdt3306a_write_reg(state, 0x000d, val);
413 414 415
	if (lg_chkerr(ret))
		goto fail;

416 417 418
#if 0
	/* FGR - disable any AICC filtering, testing only */

419 420 421 422
	ret = lgdt3306a_write_reg(state, 0x0024, 0x00);
	if (lg_chkerr(ret))
		goto fail;

423
	/* AICCFIXFREQ0 NT N-1(Video rejection) */
424 425
	ret = lgdt3306a_write_reg(state, 0x002e, 0x00);
	ret = lgdt3306a_write_reg(state, 0x002f, 0x00);
426 427
	ret = lgdt3306a_write_reg(state, 0x0030, 0x00);

428
	/* AICCFIXFREQ1 NT N-1(Audio rejection) */
429 430 431
	ret = lgdt3306a_write_reg(state, 0x002b, 0x00);
	ret = lgdt3306a_write_reg(state, 0x002c, 0x00);
	ret = lgdt3306a_write_reg(state, 0x002d, 0x00);
432

433
	/* AICCFIXFREQ2 NT Co-Channel(Video rejection) */
434 435
	ret = lgdt3306a_write_reg(state, 0x0028, 0x00);
	ret = lgdt3306a_write_reg(state, 0x0029, 0x00);
436
	ret = lgdt3306a_write_reg(state, 0x002a, 0x00);
437

438
	/* AICCFIXFREQ3 NT Co-Channel(Audio rejection) */
439 440 441 442
	ret = lgdt3306a_write_reg(state, 0x0025, 0x00);
	ret = lgdt3306a_write_reg(state, 0x0026, 0x00);
	ret = lgdt3306a_write_reg(state, 0x0027, 0x00);

443 444 445 446
#else
	/* FGR - this works well for HVR-1955,1975 */

	/* 5. AICCOPMODE  NT N-1 Adj. */
447 448 449 450
	ret = lgdt3306a_write_reg(state, 0x0024, 0x5A);
	if (lg_chkerr(ret))
		goto fail;

451
	/* AICCFIXFREQ0 NT N-1(Video rejection) */
452 453
	ret = lgdt3306a_write_reg(state, 0x002e, 0x5A);
	ret = lgdt3306a_write_reg(state, 0x002f, 0x00);
454 455
	ret = lgdt3306a_write_reg(state, 0x0030, 0x00);

456
	/* AICCFIXFREQ1 NT N-1(Audio rejection) */
457 458 459
	ret = lgdt3306a_write_reg(state, 0x002b, 0x36);
	ret = lgdt3306a_write_reg(state, 0x002c, 0x00);
	ret = lgdt3306a_write_reg(state, 0x002d, 0x00);
460

461
	/* AICCFIXFREQ2 NT Co-Channel(Video rejection) */
462 463
	ret = lgdt3306a_write_reg(state, 0x0028, 0x2A);
	ret = lgdt3306a_write_reg(state, 0x0029, 0x00);
464
	ret = lgdt3306a_write_reg(state, 0x002a, 0x00);
465

466
	/* AICCFIXFREQ3 NT Co-Channel(Audio rejection) */
467 468 469 470 471
	ret = lgdt3306a_write_reg(state, 0x0025, 0x06);
	ret = lgdt3306a_write_reg(state, 0x0026, 0x00);
	ret = lgdt3306a_write_reg(state, 0x0027, 0x00);
#endif

472 473 474 475
	ret = lgdt3306a_read_reg(state, 0x001e, &val);
	val &= 0x0f;
	val |= 0xa0;
	ret = lgdt3306a_write_reg(state, 0x001e, val);
476 477 478 479 480

	ret = lgdt3306a_write_reg(state, 0x0022, 0x08);

	ret = lgdt3306a_write_reg(state, 0x0023, 0xFF);

481 482 483
	ret = lgdt3306a_read_reg(state, 0x211f, &val);
	val &= 0xef;
	ret = lgdt3306a_write_reg(state, 0x211f, val);
484 485 486 487

	ret = lgdt3306a_write_reg(state, 0x2173, 0x01);

	ret = lgdt3306a_read_reg(state, 0x1061, &val);
488
	val &= 0xf8;
489 490 491
	val |= 0x04;
	ret = lgdt3306a_write_reg(state, 0x1061, val);

492 493 494
	ret = lgdt3306a_read_reg(state, 0x103d, &val);
	val &= 0xcf;
	ret = lgdt3306a_write_reg(state, 0x103d, val);
495 496 497 498

	ret = lgdt3306a_write_reg(state, 0x2122, 0x40);

	ret = lgdt3306a_read_reg(state, 0x2141, &val);
499
	val &= 0x3f;
500 501 502
	ret = lgdt3306a_write_reg(state, 0x2141, val);

	ret = lgdt3306a_read_reg(state, 0x2135, &val);
503
	val &= 0x0f;
504 505 506 507
	val |= 0x70;
	ret = lgdt3306a_write_reg(state, 0x2135, val);

	ret = lgdt3306a_read_reg(state, 0x0003, &val);
508
	val &= 0xf7;
509 510
	ret = lgdt3306a_write_reg(state, 0x0003, val);

511 512 513
	ret = lgdt3306a_read_reg(state, 0x001c, &val);
	val &= 0x7f;
	ret = lgdt3306a_write_reg(state, 0x001c, val);
514

515
	/* 6. EQ step size */
516
	ret = lgdt3306a_read_reg(state, 0x2179, &val);
517
	val &= 0xf8;
518 519
	ret = lgdt3306a_write_reg(state, 0x2179, val);

520 521 522
	ret = lgdt3306a_read_reg(state, 0x217a, &val);
	val &= 0xf8;
	ret = lgdt3306a_write_reg(state, 0x217a, val);
523

524
	/* 7. Reset */
525 526 527 528
	ret = lgdt3306a_soft_reset(state);
	if (lg_chkerr(ret))
		goto fail;

529
	dbg_info("complete\n");
530 531 532 533 534 535 536 537 538
fail:
	return ret;
}

static int lgdt3306a_set_qam(struct lgdt3306a_state *state, int modulation)
{
	u8 val;
	int ret;

539
	dbg_info("modulation=%d\n", modulation);
540

541
	/* 1. Selection of standard mode(0x08=QAM, 0x80=VSB) */
542 543 544 545
	ret = lgdt3306a_write_reg(state, 0x0008, 0x08);
	if (lg_chkerr(ret))
		goto fail;

546
	/* 1a. Spectrum inversion detection to Auto */
547
	ret = lgdt3306a_read_reg(state, 0x0002, &val);
548
	val &= 0xfb; /* SPECINV Off */
549
	val |= 0x08; /* SPECINVAUTO On */
550 551 552 553
	ret = lgdt3306a_write_reg(state, 0x0002, val);
	if (lg_chkerr(ret))
		goto fail;

554
	/* 2. Bandwidth mode for QAM */
555
	ret = lgdt3306a_read_reg(state, 0x0009, &val);
556
	val &= 0xe3; /* STDOPDETTMODE[2:0]=0 VSB Off */
557 558 559 560
	ret = lgdt3306a_write_reg(state, 0x0009, val);
	if (lg_chkerr(ret))
		goto fail;

561
	/* 3. : 64QAM/256QAM detection(manual, auto) */
562
	ret = lgdt3306a_read_reg(state, 0x0009, &val);
563
	val &= 0xfc;
564
	val |= 0x02; /* STDOPDETCMODE[1:0]=1=Manual 2=Auto */
565 566 567 568
	ret = lgdt3306a_write_reg(state, 0x0009, val);
	if (lg_chkerr(ret))
		goto fail;

569
	/* 3a. : 64QAM/256QAM selection for manual */
570
	ret = lgdt3306a_read_reg(state, 0x101a, &val);
571
	val &= 0xf8;
572 573 574 575 576
	if (modulation == QAM_64)
		val |= 0x02; /* QMDQMODE[2:0]=2=QAM64 */
	else
		val |= 0x04; /* QMDQMODE[2:0]=4=QAM256 */

577 578 579 580
	ret = lgdt3306a_write_reg(state, 0x101a, val);
	if (lg_chkerr(ret))
		goto fail;

581
	/* 4. ADC sampling frequency rate(4x sampling) */
582 583
	ret = lgdt3306a_read_reg(state, 0x000d, &val);
	val &= 0xbf;
584
	val |= 0x40; /* SAMPLING4XFEN=1 */
585
	ret = lgdt3306a_write_reg(state, 0x000d, val);
586 587 588
	if (lg_chkerr(ret))
		goto fail;

589
	/* 5. No AICC operation in QAM mode */
590 591 592 593 594 595
	ret = lgdt3306a_read_reg(state, 0x0024, &val);
	val &= 0x00;
	ret = lgdt3306a_write_reg(state, 0x0024, val);
	if (lg_chkerr(ret))
		goto fail;

596
	/* 6. Reset */
597 598 599 600
	ret = lgdt3306a_soft_reset(state);
	if (lg_chkerr(ret))
		goto fail;

601
	dbg_info("complete\n");
602 603 604 605 606 607 608 609 610
fail:
	return ret;
}

static int lgdt3306a_set_modulation(struct lgdt3306a_state *state,
				   struct dtv_frontend_properties *p)
{
	int ret;

611
	dbg_info("\n");
612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639

	switch (p->modulation) {
	case VSB_8:
		ret = lgdt3306a_set_vsb(state);
		break;
	case QAM_64:
		ret = lgdt3306a_set_qam(state, QAM_64);
		break;
	case QAM_256:
		ret = lgdt3306a_set_qam(state, QAM_256);
		break;
	default:
		return -EINVAL;
	}
	if (lg_chkerr(ret))
		goto fail;

	state->current_modulation = p->modulation;

fail:
	return ret;
}

/* ------------------------------------------------------------------------ */

static int lgdt3306a_agc_setup(struct lgdt3306a_state *state,
			      struct dtv_frontend_properties *p)
{
640
	/* TODO: anything we want to do here??? */
641
	dbg_info("\n");
642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661

	switch (p->modulation) {
	case VSB_8:
		break;
	case QAM_64:
	case QAM_256:
		break;
	default:
		return -EINVAL;
	}
	return 0;
}

/* ------------------------------------------------------------------------ */

static int lgdt3306a_set_inversion(struct lgdt3306a_state *state,
				       int inversion)
{
	int ret;

662
	dbg_info("(%d)\n", inversion);
663

664
	ret = lgdt3306a_set_reg_bit(state, 0x0002, 2, inversion ? 1 : 0);
665 666 667 668 669 670 671 672
	return ret;
}

static int lgdt3306a_set_inversion_auto(struct lgdt3306a_state *state,
				       int enabled)
{
	int ret;

673
	dbg_info("(%d)\n", enabled);
674

675 676
	/* 0=Manual 1=Auto(QAM only) - SPECINVAUTO=0x04 */
	ret = lgdt3306a_set_reg_bit(state, 0x0002, 3, enabled);
677 678 679 680 681 682 683 684 685
	return ret;
}

static int lgdt3306a_spectral_inversion(struct lgdt3306a_state *state,
				       struct dtv_frontend_properties *p,
				       int inversion)
{
	int ret = 0;

686
	dbg_info("(%d)\n", inversion);
687
#if 0
688 689 690 691
	/*
	 * FGR - spectral_inversion defaults already set for VSB and QAM;
	 * can enable later if desired
	 */
692 693 694 695 696

	ret = lgdt3306a_set_inversion(state, inversion);

	switch (p->modulation) {
	case VSB_8:
697 698
		/* Manual only for VSB */
		ret = lgdt3306a_set_inversion_auto(state, 0);
699 700 701
		break;
	case QAM_64:
	case QAM_256:
702 703
		/* Auto ok for QAM */
		ret = lgdt3306a_set_inversion_auto(state, 1);
704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730
		break;
	default:
		ret = -EINVAL;
	}
#endif
	return ret;
}

static int lgdt3306a_set_if(struct lgdt3306a_state *state,
			   struct dtv_frontend_properties *p)
{
	int ret;
	u16 if_freq_khz;
	u8 nco1, nco2;

	switch (p->modulation) {
	case VSB_8:
		if_freq_khz = state->cfg->vsb_if_khz;
		break;
	case QAM_64:
	case QAM_256:
		if_freq_khz = state->cfg->qam_if_khz;
		break;
	default:
		return -EINVAL;
	}

731
	switch (if_freq_khz) {
732
	default:
733 734
		pr_warn("IF=%d KHz is not supportted, 3250 assumed\n",
			if_freq_khz);
735
		/* fallthrough */
736
	case 3250: /* 3.25Mhz */
737 738 739
		nco1 = 0x34;
		nco2 = 0x00;
		break;
740
	case 3500: /* 3.50Mhz */
741 742 743
		nco1 = 0x38;
		nco2 = 0x00;
		break;
744
	case 4000: /* 4.00Mhz */
745 746 747
		nco1 = 0x40;
		nco2 = 0x00;
		break;
748
	case 5000: /* 5.00Mhz */
749 750 751
		nco1 = 0x50;
		nco2 = 0x00;
		break;
752
	case 5380: /* 5.38Mhz */
753 754 755 756 757
		nco1 = 0x56;
		nco2 = 0x14;
		break;
	}
	ret = lgdt3306a_write_reg(state, 0x0010, nco1);
758 759
	if (ret)
		return ret;
760
	ret = lgdt3306a_write_reg(state, 0x0011, nco2);
761 762
	if (ret)
		return ret;
763

764
	dbg_info("if_freq=%d KHz->[%04x]\n", if_freq_khz, nco1<<8 | nco2);
765 766 767 768 769 770 771 772 773 774

	return 0;
}

/* ------------------------------------------------------------------------ */

static int lgdt3306a_i2c_gate_ctrl(struct dvb_frontend *fe, int enable)
{
	struct lgdt3306a_state *state = fe->demodulator_priv;

775
	if (state->cfg->deny_i2c_rptr) {
776
		dbg_info("deny_i2c_rptr=%d\n", state->cfg->deny_i2c_rptr);
777 778
		return 0;
	}
779
	dbg_info("(%d)\n", enable);
780

781 782
	/* NI2CRPTEN=0x80 */
	return lgdt3306a_set_reg_bit(state, 0x0002, 7, enable ? 0 : 1);
783 784 785 786 787 788
}

static int lgdt3306a_sleep(struct lgdt3306a_state *state)
{
	int ret;

789
	dbg_info("\n");
790
	state->current_frequency = -1; /* force re-tune, when we wake */
791

792
	ret = lgdt3306a_mpeg_tristate(state, 1); /* disable data bus */
793 794 795
	if (lg_chkerr(ret))
		goto fail;

796
	ret = lgdt3306a_power(state, 0); /* power down */
797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815
	lg_chkerr(ret);

fail:
	return 0;
}

static int lgdt3306a_fe_sleep(struct dvb_frontend *fe)
{
	struct lgdt3306a_state *state = fe->demodulator_priv;

	return lgdt3306a_sleep(state);
}

static int lgdt3306a_init(struct dvb_frontend *fe)
{
	struct lgdt3306a_state *state = fe->demodulator_priv;
	u8 val;
	int ret;

816
	dbg_info("\n");
817

818 819
	/* 1. Normal operation mode */
	ret = lgdt3306a_set_reg_bit(state, 0x0001, 0, 1); /* SIMFASTENB=0x01 */
820 821 822
	if (lg_chkerr(ret))
		goto fail;

823
	/* 2. Spectrum inversion auto detection (Not valid for VSB) */
824 825 826 827
	ret = lgdt3306a_set_inversion_auto(state, 0);
	if (lg_chkerr(ret))
		goto fail;

828
	/* 3. Spectrum inversion(According to the tuner configuration) */
829 830 831 832
	ret = lgdt3306a_set_inversion(state, 1);
	if (lg_chkerr(ret))
		goto fail;

833
	/* 4. Peak-to-peak voltage of ADC input signal */
834 835 836

	/* ADCSEL1V=0x80=1Vpp; 0x00=2Vpp */
	ret = lgdt3306a_set_reg_bit(state, 0x0004, 7, 1);
837 838 839
	if (lg_chkerr(ret))
		goto fail;

840
	/* 5. ADC output data capture clock phase */
841 842 843

	/* 0=same phase as ADC clock */
	ret = lgdt3306a_set_reg_bit(state, 0x0004, 2, 0);
844 845 846
	if (lg_chkerr(ret))
		goto fail;

847
	/* 5a. ADC sampling clock source */
848 849 850

	/* ADCCLKPLLSEL=0x08; 0=use ext clock, not PLL */
	ret = lgdt3306a_set_reg_bit(state, 0x0004, 3, 0);
851 852 853
	if (lg_chkerr(ret))
		goto fail;

854
	/* 6. Automatic PLL set */
855 856 857

	/* PLLSETAUTO=0x40; 0=off */
	ret = lgdt3306a_set_reg_bit(state, 0x0005, 6, 0);
858 859 860
	if (lg_chkerr(ret))
		goto fail;

861 862
	if (state->cfg->xtalMHz == 24) {	/* 24MHz */
		/* 7. Frequency for PLL output(0x2564 for 192MHz for 24MHz) */
863 864 865
		ret = lgdt3306a_read_reg(state, 0x0005, &val);
		if (lg_chkerr(ret))
			goto fail;
866
		val &= 0xc0;
867 868 869 870 871 872 873 874
		val |= 0x25;
		ret = lgdt3306a_write_reg(state, 0x0005, val);
		if (lg_chkerr(ret))
			goto fail;
		ret = lgdt3306a_write_reg(state, 0x0006, 0x64);
		if (lg_chkerr(ret))
			goto fail;

875
		/* 8. ADC sampling frequency(0x180000 for 24MHz sampling) */
876
		ret = lgdt3306a_read_reg(state, 0x000d, &val);
877 878
		if (lg_chkerr(ret))
			goto fail;
879
		val &= 0xc0;
880
		val |= 0x18;
881
		ret = lgdt3306a_write_reg(state, 0x000d, val);
882 883 884
		if (lg_chkerr(ret))
			goto fail;

885 886
	} else if (state->cfg->xtalMHz == 25) { /* 25MHz */
		/* 7. Frequency for PLL output */
887 888 889
		ret = lgdt3306a_read_reg(state, 0x0005, &val);
		if (lg_chkerr(ret))
			goto fail;
890
		val &= 0xc0;
891 892 893 894 895 896 897 898
		val |= 0x25;
		ret = lgdt3306a_write_reg(state, 0x0005, val);
		if (lg_chkerr(ret))
			goto fail;
		ret = lgdt3306a_write_reg(state, 0x0006, 0x64);
		if (lg_chkerr(ret))
			goto fail;

899
		/* 8. ADC sampling frequency(0x190000 for 25MHz sampling) */
900
		ret = lgdt3306a_read_reg(state, 0x000d, &val);
901 902
		if (lg_chkerr(ret))
			goto fail;
903
		val &= 0xc0;
904
		val |= 0x19;
905
		ret = lgdt3306a_write_reg(state, 0x000d, val);
906 907 908
		if (lg_chkerr(ret))
			goto fail;
	} else {
909
		pr_err("Bad xtalMHz=%d\n", state->cfg->xtalMHz);
910
	}
911
#if 0
912 913
	ret = lgdt3306a_write_reg(state, 0x000e, 0x00);
	ret = lgdt3306a_write_reg(state, 0x000f, 0x00);
914
#endif
915

916 917 918
	/* 9. Center frequency of input signal of ADC */
	ret = lgdt3306a_write_reg(state, 0x0010, 0x34); /* 3.25MHz */
	ret = lgdt3306a_write_reg(state, 0x0011, 0x00);
919

920 921
	/* 10. Fixed gain error value */
	ret = lgdt3306a_write_reg(state, 0x0014, 0); /* gain error=0 */
922

923
	/* 10a. VSB TR BW gear shift initial step */
924 925
	ret = lgdt3306a_read_reg(state, 0x103c, &val);
	val &= 0x0f;
926
	val |= 0x20; /* SAMGSAUTOSTL_V[3:0] = 2 */
927
	ret = lgdt3306a_write_reg(state, 0x103c, val);
928

929
	/* 10b. Timing offset calibration in low temperature for VSB */
930 931
	ret = lgdt3306a_read_reg(state, 0x103d, &val);
	val &= 0xfc;
932
	val |= 0x03;
933
	ret = lgdt3306a_write_reg(state, 0x103d, val);
934

935
	/* 10c. Timing offset calibration in low temperature for QAM */
936
	ret = lgdt3306a_read_reg(state, 0x1036, &val);
937 938
	val &= 0xf0;
	val |= 0x0c;
939 940
	ret = lgdt3306a_write_reg(state, 0x1036, val);

941
	/* 11. Using the imaginary part of CIR in CIR loading */
942 943 944
	ret = lgdt3306a_read_reg(state, 0x211f, &val);
	val &= 0xef; /* do not use imaginary of CIR */
	ret = lgdt3306a_write_reg(state, 0x211f, val);
945

946
	/* 12. Control of no signal detector function */
947
	ret = lgdt3306a_read_reg(state, 0x2849, &val);
948
	val &= 0xef; /* NOUSENOSIGDET=0, enable no signal detector */
949 950
	ret = lgdt3306a_write_reg(state, 0x2849, val);

951
	/* FGR - put demod in some known mode */
952 953
	ret = lgdt3306a_set_vsb(state);

954
	/* 13. TP stream format */
955 956
	ret = lgdt3306a_mpeg_mode(state, state->cfg->mpeg_mode);

957
	/* 14. disable output buses */
958 959
	ret = lgdt3306a_mpeg_tristate(state, 1);

960
	/* 15. Sleep (in reset) */
961 962 963 964 965 966 967 968 969 970 971 972 973
	ret = lgdt3306a_sleep(state);
	lg_chkerr(ret);

fail:
	return ret;
}

static int lgdt3306a_set_parameters(struct dvb_frontend *fe)
{
	struct dtv_frontend_properties *p = &fe->dtv_property_cache;
	struct lgdt3306a_state *state = fe->demodulator_priv;
	int ret;

974
	dbg_info("(%d, %d)\n", p->frequency, p->modulation);
975

976 977
	if (state->current_frequency  == p->frequency &&
	   state->current_modulation == p->modulation) {
978
		dbg_info(" (already set, skipping ...)\n");
979 980 981 982 983
		return 0;
	}
	state->current_frequency = -1;
	state->current_modulation = -1;

984
	ret = lgdt3306a_power(state, 1); /* power up */
985 986 987 988 989 990 991
	if (lg_chkerr(ret))
		goto fail;

	if (fe->ops.tuner_ops.set_params) {
		ret = fe->ops.tuner_ops.set_params(fe);
		if (fe->ops.i2c_gate_ctrl)
			fe->ops.i2c_gate_ctrl(fe, 0);
992 993 994 995 996
#if 0
		if (lg_chkerr(ret))
			goto fail;
		state->current_frequency = p->frequency;
#endif
997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011
	}

	ret = lgdt3306a_set_modulation(state, p);
	if (lg_chkerr(ret))
		goto fail;

	ret = lgdt3306a_agc_setup(state, p);
	if (lg_chkerr(ret))
		goto fail;

	ret = lgdt3306a_set_if(state, p);
	if (lg_chkerr(ret))
		goto fail;

	ret = lgdt3306a_spectral_inversion(state, p,
1012
					state->cfg->spectral_inversion ? 1 : 0);
1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025
	if (lg_chkerr(ret))
		goto fail;

	ret = lgdt3306a_mpeg_mode(state, state->cfg->mpeg_mode);
	if (lg_chkerr(ret))
		goto fail;

	ret = lgdt3306a_mpeg_mode_polarity(state,
					  state->cfg->tpclk_edge,
					  state->cfg->tpvalid_polarity);
	if (lg_chkerr(ret))
		goto fail;

1026
	ret = lgdt3306a_mpeg_tristate(state, 0); /* enable data bus */
1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046
	if (lg_chkerr(ret))
		goto fail;

	ret = lgdt3306a_soft_reset(state);
	if (lg_chkerr(ret))
		goto fail;

#ifdef DBG_DUMP
	lgdt3306a_DumpAllRegs(state);
#endif
	state->current_frequency = p->frequency;
fail:
	return ret;
}

static int lgdt3306a_get_frontend(struct dvb_frontend *fe)
{
	struct lgdt3306a_state *state = fe->demodulator_priv;
	struct dtv_frontend_properties *p = &fe->dtv_property_cache;

1047 1048
	dbg_info("(%u, %d)\n",
		 state->current_frequency, state->current_modulation);
1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064

	p->modulation = state->current_modulation;
	p->frequency = state->current_frequency;
	return 0;
}

static enum dvbfe_algo lgdt3306a_get_frontend_algo(struct dvb_frontend *fe)
{
#if 1
	return DVBFE_ALGO_CUSTOM;
#else
	return DVBFE_ALGO_HW;
#endif
}

/* ------------------------------------------------------------------------ */
1065
static int lgdt3306a_monitor_vsb(struct lgdt3306a_state *state)
1066 1067 1068
{
	u8 val;
	int ret;
1069 1070
	u8 snrRef, maxPowerMan, nCombDet;
	u16 fbDlyCir;
1071

1072
	ret = lgdt3306a_read_reg(state, 0x21a1, &val);
1073 1074
	if (ret)
		return ret;
1075
	snrRef = val & 0x3f;
1076 1077

	ret = lgdt3306a_read_reg(state, 0x2185, &maxPowerMan);
1078 1079
	if (ret)
		return ret;
1080 1081

	ret = lgdt3306a_read_reg(state, 0x2191, &val);
1082 1083
	if (ret)
		return ret;
1084 1085 1086
	nCombDet = (val & 0x80) >> 7;

	ret = lgdt3306a_read_reg(state, 0x2180, &val);
1087 1088
	if (ret)
		return ret;
1089
	fbDlyCir = (val & 0x03) << 8;
1090

1091
	ret = lgdt3306a_read_reg(state, 0x2181, &val);
1092 1093
	if (ret)
		return ret;
1094 1095
	fbDlyCir |= val;

1096
	dbg_info("snrRef=%d maxPowerMan=0x%x nCombDet=%d fbDlyCir=0x%x\n",
1097 1098
		snrRef, maxPowerMan, nCombDet, fbDlyCir);

1099
	/* Carrier offset sub loop bandwidth */
1100
	ret = lgdt3306a_read_reg(state, 0x1061, &val);
1101 1102
	if (ret)
		return ret;
1103
	val &= 0xf8;
1104 1105 1106
	if ((snrRef > 18) && (maxPowerMan > 0x68)
	    && (nCombDet == 0x01)
	    && ((fbDlyCir == 0x03FF) || (fbDlyCir < 0x6C))) {
1107 1108
		/* SNR is over 18dB and no ghosting */
		val |= 0x00; /* final bandwidth = 0 */
1109
	} else {
1110
		val |= 0x04; /* final bandwidth = 4 */
1111 1112
	}
	ret = lgdt3306a_write_reg(state, 0x1061, val);
1113 1114
	if (ret)
		return ret;
1115

1116
	/* Adjust Notch Filter */
1117
	ret = lgdt3306a_read_reg(state, 0x0024, &val);
1118 1119
	if (ret)
		return ret;
1120
	val &= 0x0f;
1121
	if (nCombDet == 0) { /* Turn on the Notch Filter */
1122 1123 1124
		val |= 0x50;
	}
	ret = lgdt3306a_write_reg(state, 0x0024, val);
1125 1126
	if (ret)
		return ret;
1127

1128
	/* VSB Timing Recovery output normalization */
1129
	ret = lgdt3306a_read_reg(state, 0x103d, &val);
1130 1131
	if (ret)
		return ret;
1132
	val &= 0xcf;
1133
	val |= 0x20;
1134
	ret = lgdt3306a_write_reg(state, 0x103d, val);
1135 1136

	return ret;
1137 1138
}

1139 1140
static enum lgdt3306a_modulation
lgdt3306a_check_oper_mode(struct lgdt3306a_state *state)
1141 1142 1143 1144 1145
{
	u8 val = 0;
	int ret;

	ret = lgdt3306a_read_reg(state, 0x0081, &val);
1146 1147
	if (ret)
		goto err;
1148 1149

	if (val & 0x80)	{
1150
		dbg_info("VSB\n");
1151
		return LG3306_VSB;
1152
	}
1153
	if (val & 0x08) {
1154
		ret = lgdt3306a_read_reg(state, 0x00a6, &val);
1155 1156
		if (ret)
			goto err;
1157 1158
		val = val >> 2;
		if (val & 0x01) {
1159
			dbg_info("QAM256\n");
1160
			return LG3306_QAM256;
1161
		}
1162 1163
		dbg_info("QAM64\n");
		return LG3306_QAM64;
1164
	}
1165
err:
1166
	pr_warn("UNKNOWN\n");
1167
	return LG3306_UNKNOWN_MODE;
1168 1169
}

1170 1171 1172
static enum lgdt3306a_lock_status
lgdt3306a_check_lock_status(struct lgdt3306a_state *state,
			    enum lgdt3306a_lock_check whatLock)
1173 1174 1175
{
	u8 val = 0;
	int ret;
1176 1177
	enum lgdt3306a_modulation	modeOper;
	enum lgdt3306a_lock_status lockStatus;
1178 1179 1180

	modeOper = LG3306_UNKNOWN_MODE;

1181 1182 1183
	switch (whatLock) {
	case LG3306_SYNC_LOCK:
	{
1184
		ret = lgdt3306a_read_reg(state, 0x00a6, &val);
1185 1186
		if (ret)
			return ret;
1187 1188 1189 1190 1191 1192

		if ((val & 0x80) == 0x80)
			lockStatus = LG3306_LOCK;
		else
			lockStatus = LG3306_UNLOCK;

1193
		dbg_info("SYNC_LOCK=%x\n", lockStatus);
1194 1195 1196 1197 1198
		break;
	}
	case LG3306_AGC_LOCK:
	{
		ret = lgdt3306a_read_reg(state, 0x0080, &val);
1199 1200
		if (ret)
			return ret;
1201 1202 1203 1204 1205 1206

		if ((val & 0x40) == 0x40)
			lockStatus = LG3306_LOCK;
		else
			lockStatus = LG3306_UNLOCK;

1207
		dbg_info("AGC_LOCK=%x\n", lockStatus);
1208 1209 1210
		break;
	}
	case LG3306_TR_LOCK:
1211
	{
1212 1213 1214
		modeOper = lgdt3306a_check_oper_mode(state);
		if ((modeOper == LG3306_QAM64) || (modeOper == LG3306_QAM256)) {
			ret = lgdt3306a_read_reg(state, 0x1094, &val);
1215 1216
			if (ret)
				return ret;
1217 1218 1219 1220 1221

			if ((val & 0x80) == 0x80)
				lockStatus = LG3306_LOCK;
			else
				lockStatus = LG3306_UNLOCK;
1222 1223
		} else
			lockStatus = LG3306_UNKNOWN_LOCK;
1224

1225
		dbg_info("TR_LOCK=%x\n", lockStatus);
1226 1227 1228 1229 1230 1231
		break;
	}
	case LG3306_FEC_LOCK:
	{
		modeOper = lgdt3306a_check_oper_mode(state);
		if ((modeOper == LG3306_QAM64) || (modeOper == LG3306_QAM256)) {
1232
			ret = lgdt3306a_read_reg(state, 0x0080, &val);
1233 1234
			if (ret)
				return ret;
1235

1236
			if ((val & 0x10) == 0x10)
1237 1238 1239
				lockStatus = LG3306_LOCK;
			else
				lockStatus = LG3306_UNLOCK;
1240 1241
		} else
			lockStatus = LG3306_UNKNOWN_LOCK;
1242

1243
		dbg_info("FEC_LOCK=%x\n", lockStatus);
1244 1245
		break;
	}
1246

1247 1248
	default:
		lockStatus = LG3306_UNKNOWN_LOCK;
1249
		pr_warn("UNKNOWN whatLock=%d\n", whatLock);
1250
		break;
1251 1252
	}

1253
	return lockStatus;
1254 1255
}

1256 1257
static enum lgdt3306a_neverlock_status
lgdt3306a_check_neverlock_status(struct lgdt3306a_state *state)
1258 1259 1260
{
	u8 val = 0;
	int ret;
1261
	enum lgdt3306a_neverlock_status lockStatus;
1262 1263

	ret = lgdt3306a_read_reg(state, 0x0080, &val);
1264 1265
	if (ret)
		return ret;
1266
	lockStatus = (enum lgdt3306a_neverlock_status)(val & 0x03);
1267

1268
	dbg_info("NeverLock=%d", lockStatus);
1269

1270
	return lockStatus;
1271 1272
}

1273
static int lgdt3306a_pre_monitoring(struct lgdt3306a_state *state)
1274 1275 1276 1277 1278
{
	u8 val = 0;
	int ret;
	u8 currChDiffACQ, snrRef, mainStrong, aiccrejStatus;

1279
	/* Channel variation */
1280
	ret = lgdt3306a_read_reg(state, 0x21bc, &currChDiffACQ);
1281 1282
	if (ret)
		return ret;
1283

1284
	/* SNR of Frame sync */
1285
	ret = lgdt3306a_read_reg(state, 0x21a1, &val);
1286 1287
	if (ret)
		return ret;
1288
	snrRef = val & 0x3f;
1289

1290
	/* Strong Main CIR */
1291
	ret = lgdt3306a_read_reg(state, 0x2199, &val);
1292 1293
	if (ret)
		return ret;
1294 1295 1296
	mainStrong = (val & 0x40) >> 6;

	ret = lgdt3306a_read_reg(state, 0x0090, &val);
1297 1298
	if (ret)
		return ret;
1299
	aiccrejStatus = (val & 0xf0) >> 4;
1300

1301
	dbg_info("snrRef=%d mainStrong=%d aiccrejStatus=%d currChDiffACQ=0x%x\n",
1302 1303
		snrRef, mainStrong, aiccrejStatus, currChDiffACQ);

1304
#if 0
1305 1306
	/* Dynamic ghost exists */
	if ((mainStrong == 0) && (currChDiffACQ > 0x70))
1307 1308
#endif
	if (mainStrong == 0) {
1309
		ret = lgdt3306a_read_reg(state, 0x2135, &val);
1310 1311
		if (ret)
			return ret;
1312 1313
		val &= 0x0f;
		val |= 0xa0;
1314
		ret = lgdt3306a_write_reg(state, 0x2135, val);
1315 1316
		if (ret)
			return ret;
1317 1318

		ret = lgdt3306a_read_reg(state, 0x2141, &val);
1319 1320
		if (ret)
			return ret;
1321
		val &= 0x3f;
1322 1323
		val |= 0x80;
		ret = lgdt3306a_write_reg(state, 0x2141, val);
1324 1325
		if (ret)
			return ret;
1326 1327

		ret = lgdt3306a_write_reg(state, 0x2122, 0x70);
1328 1329
		if (ret)
			return ret;
1330
	} else { /* Weak ghost or static channel */
1331
		ret = lgdt3306a_read_reg(state, 0x2135, &val);
1332 1333
		if (ret)
			return ret;
1334
		val &= 0x0f;
1335 1336
		val |= 0x70;
		ret = lgdt3306a_write_reg(state, 0x2135, val);
1337 1338
		if (ret)
			return ret;
1339 1340

		ret = lgdt3306a_read_reg(state, 0x2141, &val);
1341 1342
		if (ret)
			return ret;
1343
		val &= 0x3f;
1344 1345
		val |= 0x40;
		ret = lgdt3306a_write_reg(state, 0x2141, val);
1346 1347
		if (ret)
			return ret;
1348 1349

		ret = lgdt3306a_write_reg(state, 0x2122, 0x40);
1350 1351
		if (ret)
			return ret;
1352
	}
1353
	return 0;
1354 1355
}

1356 1357
static enum lgdt3306a_lock_status
lgdt3306a_sync_lock_poll(struct lgdt3306a_state *state)
1358
{
1359
	enum lgdt3306a_lock_status syncLockStatus = LG3306_UNLOCK;
1360 1361 1362 1363 1364
	int	i;

	for (i = 0; i < 2; i++)	{
		msleep(30);

1365 1366
		syncLockStatus = lgdt3306a_check_lock_status(state,
							     LG3306_SYNC_LOCK);
1367 1368

		if (syncLockStatus == LG3306_LOCK) {
1369
			dbg_info("locked(%d)\n", i);
1370
			return LG3306_LOCK;
1371 1372
		}
	}
1373
	dbg_info("not locked\n");
1374
	return LG3306_UNLOCK;
1375 1376
}

1377 1378
static enum lgdt3306a_lock_status
lgdt3306a_fec_lock_poll(struct lgdt3306a_state *state)
1379
{
1380
	enum lgdt3306a_lock_status FECLockStatus = LG3306_UNLOCK;
1381 1382 1383 1384 1385
	int	i;

	for (i = 0; i < 2; i++)	{
		msleep(30);

1386 1387
		FECLockStatus = lgdt3306a_check_lock_status(state,
							    LG3306_FEC_LOCK);
1388 1389

		if (FECLockStatus == LG3306_LOCK) {
1390
			dbg_info("locked(%d)\n", i);
1391
			return FECLockStatus;
1392 1393
		}
	}
1394
	dbg_info("not locked\n");
1395
	return FECLockStatus;
1396 1397
}

1398 1399
static enum lgdt3306a_neverlock_status
lgdt3306a_neverlock_poll(struct lgdt3306a_state *state)
1400
{
1401
	enum lgdt3306a_neverlock_status NLLockStatus = LG3306_NL_FAIL;
1402 1403
	int	i;

1404
	for (i = 0; i < 5; i++) {
1405 1406 1407 1408 1409
		msleep(30);

		NLLockStatus = lgdt3306a_check_neverlock_status(state);

		if (NLLockStatus == LG3306_NL_LOCK) {
1410
			dbg_info("NL_LOCK(%d)\n", i);
1411
			return NLLockStatus;
1412 1413
		}
	}
1414
	dbg_info("NLLockStatus=%d\n", NLLockStatus);
1415
	return NLLockStatus;
1416 1417 1418 1419 1420 1421 1422
}

static u8 lgdt3306a_get_packet_error(struct lgdt3306a_state *state)
{
	u8 val;
	int ret;

1423
	ret = lgdt3306a_read_reg(state, 0x00fa, &val);
1424 1425
	if (ret)
		return ret;
1426

1427
	return val;
1428 1429
}

1430 1431 1432 1433 1434 1435 1436
static const u32 valx_x10[] = {
	10,  11,  13,  15,  17,  20,  25,  33,  41,  50,  59,  73,  87,  100
};
static const u32 log10x_x1000[] = {
	0,  41, 114, 176, 230, 301, 398, 518, 613, 699, 771, 863, 939, 1000
};

1437 1438
static u32 log10_x1000(u32 x)
{
1439
	u32 diff_val, step_val, step_log10;
1440
	u32 log_val = 0;
1441
	u32 i;
1442

1443 1444
	if (x <= 0)
		return -1000000; /* signal error */
1445

1446 1447 1448
	if (x == 10)
		return 0; /* log(1)=0 */

1449 1450 1451
	if (x < 10) {
		while (x < 10) {
			x = x * 10;
1452 1453
			log_val--;
		}
1454
	} else {	/* x > 10 */
1455 1456
		while (x >= 100) {
			x = x / 10;
1457 1458
			log_val++;
		}
1459
	}
1460 1461
	log_val *= 1000;

1462 1463
	if (x == 10) /* was our input an exact multiple of 10 */
		return log_val;	/* don't need to interpolate */
1464

1465
	/* find our place on the log curve */
1466
	for (i = 1; i < ARRAY_SIZE(valx_x10); i++) {
1467 1468
		if (valx_x10[i] >= x)
			break;
1469
	}
1470
	if (i == ARRAY_SIZE(valx_x10))
1471
		return log_val + log10x_x1000[i - 1];
1472

1473 1474 1475 1476 1477 1478 1479
	diff_val   = x - valx_x10[i-1];
	step_val   = valx_x10[i] - valx_x10[i - 1];
	step_log10 = log10x_x1000[i] - log10x_x1000[i - 1];

	/* do a linear interpolation to get in-between values */
	return log_val + log10x_x1000[i - 1] +
		((diff_val*step_log10) / step_val);
1480 1481 1482 1483
}

static u32 lgdt3306a_calculate_snr_x100(struct lgdt3306a_state *state)
{
1484 1485
	u32 mse; /* Mean-Square Error */
	u32 pwr; /* Constelation power */
1486 1487
	u32 snr_x100;

1488 1489 1490 1491
	mse = (read_reg(state, 0x00ec) << 8) |
	      (read_reg(state, 0x00ed));
	pwr = (read_reg(state, 0x00e8) << 8) |
	      (read_reg(state, 0x00e9));
1492 1493 1494 1495

	if (mse == 0) /* no signal */
		return 0;

1496
	snr_x100 = log10_x1000((pwr * 10000) / mse) - 3000;
1497
	dbg_info("mse=%u, pwr=%u, snr_x100=%d\n", mse, pwr, snr_x100);
1498 1499 1500 1501

	return snr_x100;
}

1502 1503
static enum lgdt3306a_lock_status
lgdt3306a_vsb_lock_poll(struct lgdt3306a_state *state)
1504
{
1505
	int ret;
1506 1507 1508
	u8 cnt = 0;
	u8 packet_error;
	u32 snr;
1509

1510
	for (cnt = 0; cnt < 10; cnt++) {
1511
		if (lgdt3306a_sync_lock_poll(state) == LG3306_UNLOCK) {
1512
			dbg_info("no sync lock!\n");
1513
			return LG3306_UNLOCK;
1514
		}
1515

1516 1517 1518 1519
		msleep(20);
		ret = lgdt3306a_pre_monitoring(state);
		if (ret)
			break;
1520

1521 1522 1523
		packet_error = lgdt3306a_get_packet_error(state);
		snr = lgdt3306a_calculate_snr_x100(state);
		dbg_info("cnt=%d errors=%d snr=%d\n", cnt, packet_error, snr);
1524

1525 1526
		if ((snr >= 1500) && (packet_error < 0xff))
			return LG3306_LOCK;
1527
	}
1528 1529

	dbg_info("not locked!\n");
1530
	return LG3306_UNLOCK;
1531 1532
}

1533 1534
static enum lgdt3306a_lock_status
lgdt3306a_qam_lock_poll(struct lgdt3306a_state *state)
1535
{
1536
	u8 cnt;
1537 1538 1539
	u8 packet_error;
	u32	snr;

1540
	for (cnt = 0; cnt < 10; cnt++) {
1541
		if (lgdt3306a_fec_lock_poll(state) == LG3306_UNLOCK) {
1542
			dbg_info("no fec lock!\n");
1543
			return LG3306_UNLOCK;
1544
		}
1545

1546
		msleep(20);
1547

1548 1549 1550
		packet_error = lgdt3306a_get_packet_error(state);
		snr = lgdt3306a_calculate_snr_x100(state);
		dbg_info("cnt=%d errors=%d snr=%d\n", cnt, packet_error, snr);
1551

1552 1553
		if ((snr >= 1500) && (packet_error < 0xff))
			return LG3306_LOCK;
1554
	}
1555 1556

	dbg_info("not locked!\n");
1557
	return LG3306_UNLOCK;
1558 1559 1560 1561 1562 1563
}

static int lgdt3306a_read_status(struct dvb_frontend *fe, fe_status_t *status)
{
	struct lgdt3306a_state *state = fe->demodulator_priv;
	u16 strength = 0;
1564 1565
	int ret = 0;

1566 1567
	if (fe->ops.tuner_ops.get_rf_strength) {
		ret = fe->ops.tuner_ops.get_rf_strength(fe, &strength);
1568
		if (ret == 0)
1569
			dbg_info("strength=%d\n", strength);
1570
		else
1571
			dbg_info("fe->ops.tuner_ops.get_rf_strength() failed\n");
1572 1573 1574
	}

	*status = 0;
1575
	if (lgdt3306a_neverlock_poll(state) == LG3306_NL_LOCK) {
1576 1577 1578 1579 1580 1581
		*status |= FE_HAS_SIGNAL;
		*status |= FE_HAS_CARRIER;

		switch (state->current_modulation) {
		case QAM_256:
		case QAM_64:
1582
			if (lgdt3306a_qam_lock_poll(state) == LG3306_LOCK) {
1583 1584 1585 1586 1587 1588 1589
				*status |= FE_HAS_VITERBI;
				*status |= FE_HAS_SYNC;

				*status |= FE_HAS_LOCK;
			}
			break;
		case VSB_8:
1590
			if (lgdt3306a_vsb_lock_poll(state) == LG3306_LOCK) {
1591 1592 1593 1594 1595
				*status |= FE_HAS_VITERBI;
				*status |= FE_HAS_SYNC;

				*status |= FE_HAS_LOCK;

1596
				ret = lgdt3306a_monitor_vsb(state);
1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624
			}
			break;
		default:
			ret = -EINVAL;
		}
	}
	return ret;
}


static int lgdt3306a_read_snr(struct dvb_frontend *fe, u16 *snr)
{
	struct lgdt3306a_state *state = fe->demodulator_priv;

	state->snr = lgdt3306a_calculate_snr_x100(state);
	/* report SNR in dB * 10 */
	*snr = state->snr/10;

	return 0;
}

static int lgdt3306a_read_signal_strength(struct dvb_frontend *fe,
					 u16 *strength)
{
	/*
	 * Calculate some sort of "strength" from SNR
	 */
	struct lgdt3306a_state *state = fe->demodulator_priv;
1625
	u16 snr; /* snr_x10 */
1626
	int ret;
1627
	u32 ref_snr; /* snr*100 */
1628 1629 1630 1631 1632 1633
	u32 str;

	*strength = 0;

	switch (state->current_modulation) {
	case VSB_8:
1634
		 ref_snr = 1600; /* 16dB */
1635 1636
		 break;
	case QAM_64:
1637
		 ref_snr = 2200; /* 22dB */
1638 1639
		 break;
	case QAM_256:
1640
		 ref_snr = 2800; /* 28dB */
1641 1642 1643 1644 1645 1646 1647 1648 1649
		 break;
	default:
		return -EINVAL;
	}

	ret = fe->ops.read_snr(fe, &snr);
	if (lg_chkerr(ret))
		goto fail;

1650
	if (state->snr <= (ref_snr - 100))
1651
		str = 0;
1652 1653
	else if (state->snr <= ref_snr)
		str = (0xffff * 65) / 100; /* 65% */
1654 1655 1656
	else {
		str = state->snr - ref_snr;
		str /= 50;
1657 1658
		str += 78; /* 78%-100% */
		if (str > 100)
1659 1660 1661 1662
			str = 100;
		str = (0xffff * str) / 100;
	}
	*strength = (u16)str;
1663
	dbg_info("strength=%u\n", *strength);
1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677

fail:
	return ret;
}

/* ------------------------------------------------------------------------ */

static int lgdt3306a_read_ber(struct dvb_frontend *fe, u32 *ber)
{
	struct lgdt3306a_state *state = fe->demodulator_priv;
	u32 tmp;

	*ber = 0;
#if 1
1678
	/* FGR - FIXME - I don't know what value is expected by dvb_core
1679
	 * what is the scale of the value?? */
1680 1681 1682 1683
	tmp =              read_reg(state, 0x00fc); /* NBERVALUE[24-31] */
	tmp = (tmp << 8) | read_reg(state, 0x00fd); /* NBERVALUE[16-23] */
	tmp = (tmp << 8) | read_reg(state, 0x00fe); /* NBERVALUE[8-15] */
	tmp = (tmp << 8) | read_reg(state, 0x00ff); /* NBERVALUE[0-7] */
1684
	*ber = tmp;
1685
	dbg_info("ber=%u\n", tmp);
1686 1687 1688 1689 1690 1691 1692 1693
#endif
	return 0;
}

static int lgdt3306a_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
{
	struct lgdt3306a_state *state = fe->demodulator_priv;

1694
	*ucblocks = 0;
1695
#if 1
1696
	/* FGR - FIXME - I don't know what value is expected by dvb_core
1697
	 * what happens when value wraps? */
1698
	*ucblocks = read_reg(state, 0x00f4); /* TPIFTPERRCNT[0-7] */
1699
	dbg_info("ucblocks=%u\n", *ucblocks);
1700 1701 1702 1703 1704
#endif

	return 0;
}

1705 1706 1707
static int lgdt3306a_tune(struct dvb_frontend *fe, bool re_tune,
			  unsigned int mode_flags, unsigned int *delay,
			  fe_status_t *status)
1708 1709 1710 1711
{
	int ret = 0;
	struct lgdt3306a_state *state = fe->demodulator_priv;

1712
	dbg_info("re_tune=%u\n", re_tune);
1713 1714

	if (re_tune) {
1715
		state->current_frequency = -1; /* force re-tune */
1716 1717
		ret = lgdt3306a_set_parameters(fe);
		if (ret != 0)
1718 1719 1720 1721 1722 1723 1724 1725 1726
			return ret;
	}
	*delay = 125;
	ret = lgdt3306a_read_status(fe, status);

	return ret;
}

static int lgdt3306a_get_tune_settings(struct dvb_frontend *fe,
1727 1728
				       struct dvb_frontend_tune_settings
				       *fe_tune_settings)
1729 1730
{
	fe_tune_settings->min_delay_ms = 100;
1731
	dbg_info("\n");
1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746
	return 0;
}

static int lgdt3306a_search(struct dvb_frontend *fe)
{
	fe_status_t status = 0;
	int i, ret;

	/* set frontend */
	ret = lgdt3306a_set_parameters(fe);
	if (ret)
		goto error;

	/* wait frontend lock */
	for (i = 20; i > 0; i--) {
1747
		dbg_info(": loop=%d\n", i);
1748 1749 1750 1751 1752 1753 1754 1755 1756 1757
		msleep(50);
		ret = lgdt3306a_read_status(fe, &status);
		if (ret)
			goto error;

		if (status & FE_HAS_LOCK)
			break;
	}

	/* check if we have a valid signal */
1758
	if (status & FE_HAS_LOCK)
1759
		return DVBFE_ALGO_SEARCH_SUCCESS;
1760
	else
1761 1762 1763
		return DVBFE_ALGO_SEARCH_AGAIN;

error:
1764
	dbg_info("failed (%d)\n", ret);
1765 1766 1767 1768 1769 1770
	return DVBFE_ALGO_SEARCH_ERROR;
}

static void lgdt3306a_release(struct dvb_frontend *fe)
{
	struct lgdt3306a_state *state = fe->demodulator_priv;
1771

1772
	dbg_info("\n");
1773 1774 1775 1776 1777 1778
	kfree(state);
}

static struct dvb_frontend_ops lgdt3306a_ops;

struct dvb_frontend *lgdt3306a_attach(const struct lgdt3306a_config *config,
1779
				      struct i2c_adapter *i2c_adap)
1780 1781 1782 1783 1784
{
	struct lgdt3306a_state *state = NULL;
	int ret;
	u8 val;

1785
	dbg_info("(%d-%04x)\n",
1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800
	       i2c_adap ? i2c_adapter_id(i2c_adap) : 0,
	       config ? config->i2c_addr : 0);

	state = kzalloc(sizeof(struct lgdt3306a_state), GFP_KERNEL);
	if (state == NULL)
		goto fail;

	state->cfg = config;
	state->i2c_adap = i2c_adap;

	memcpy(&state->frontend.ops, &lgdt3306a_ops,
	       sizeof(struct dvb_frontend_ops));
	state->frontend.demodulator_priv = state;

	/* verify that we're talking to a lg3306a */
1801 1802
	/* FGR - NOTE - there is no obvious ChipId to check; we check
	 * some "known" bits after reset, but it's still just a guess */
1803 1804 1805
	ret = lgdt3306a_read_reg(state, 0x0000, &val);
	if (lg_chkerr(ret))
		goto fail;
1806
	if ((val & 0x74) != 0x74) {
1807
		pr_warn("expected 0x74, got 0x%x\n", (val & 0x74));
1808
#if 0
1809 1810
		/* FIXME - re-enable when we know this is right */
		goto fail;
1811
#endif
1812 1813 1814 1815
	}
	ret = lgdt3306a_read_reg(state, 0x0001, &val);
	if (lg_chkerr(ret))
		goto fail;
1816
	if ((val & 0xf6) != 0xc6) {
1817
		pr_warn("expected 0xc6, got 0x%x\n", (val & 0xf6));
1818
#if 0
1819 1820
		/* FIXME - re-enable when we know this is right */
		goto fail;
1821
#endif
1822 1823 1824 1825
	}
	ret = lgdt3306a_read_reg(state, 0x0002, &val);
	if (lg_chkerr(ret))
		goto fail;
1826
	if ((val & 0x73) != 0x03) {
1827
		pr_warn("expected 0x03, got 0x%x\n", (val & 0x73));
1828
#if 0
1829 1830
		/* FIXME - re-enable when we know this is right */
		goto fail;
1831
#endif
1832 1833 1834 1835 1836 1837 1838 1839 1840 1841
	}

	state->current_frequency = -1;
	state->current_modulation = -1;

	lgdt3306a_sleep(state);

	return &state->frontend;

fail:
1842
	pr_warn("unable to detect LGDT3306A hardware\n");
1843 1844 1845
	kfree(state);
	return NULL;
}
1846
EXPORT_SYMBOL(lgdt3306a_attach);
1847 1848 1849 1850

#ifdef DBG_DUMP

static const short regtab[] = {
1851 1852 1853 1854 1855 1856 1857 1858 1859 1860
	0x0000, /* SOFTRSTB 1'b1 1'b1 1'b1 ADCPDB 1'b1 PLLPDB GBBPDB 11111111 */
	0x0001, /* 1'b1 1'b1 1'b0 1'b0 AUTORPTRS */
	0x0002, /* NI2CRPTEN 1'b0 1'b0 1'b0 SPECINVAUT */
	0x0003, /* AGCRFOUT */
	0x0004, /* ADCSEL1V ADCCNT ADCCNF ADCCNS ADCCLKPLL */
	0x0005, /* PLLINDIVSE */
	0x0006, /* PLLCTRL[7:0] 11100001 */
	0x0007, /* SYSINITWAITTIME[7:0] (msec) 00001000 */
	0x0008, /* STDOPMODE[7:0] 10000000 */
	0x0009, /* 1'b0 1'b0 1'b0 STDOPDETTMODE[2:0] STDOPDETCMODE[1:0] 00011110 */
1861 1862 1863 1864 1865
	0x000a, /* DAFTEN 1'b1 x x SCSYSLOCK */
	0x000b, /* SCSYSLOCKCHKTIME[7:0] (10msec) 01100100 */
	0x000d, /* x SAMPLING4 */
	0x000e, /* SAMFREQ[15:8] 00000000 */
	0x000f, /* SAMFREQ[7:0] 00000000 */
1866 1867 1868 1869 1870 1871 1872 1873 1874 1875
	0x0010, /* IFFREQ[15:8] 01100000 */
	0x0011, /* IFFREQ[7:0] 00000000 */
	0x0012, /* AGCEN AGCREFMO */
	0x0013, /* AGCRFFIXB AGCIFFIXB AGCLOCKDETRNGSEL[1:0] 1'b1 1'b0 1'b0 1'b0 11101000 */
	0x0014, /* AGCFIXVALUE[7:0] 01111111 */
	0x0015, /* AGCREF[15:8] 00001010 */
	0x0016, /* AGCREF[7:0] 11100100 */
	0x0017, /* AGCDELAY[7:0] 00100000 */
	0x0018, /* AGCRFBW[3:0] AGCIFBW[3:0] 10001000 */
	0x0019, /* AGCUDOUTMODE[1:0] AGCUDCTRLLEN[1:0] AGCUDCTRL */
1876 1877 1878 1879
	0x001c, /* 1'b1 PFEN MFEN AICCVSYNC */
	0x001d, /* 1'b0 1'b1 1'b0 1'b1 AICCVSYNC */
	0x001e, /* AICCALPHA[3:0] 1'b1 1'b0 1'b1 1'b0 01111010 */
	0x001f, /* AICCDETTH[19:16] AICCOFFTH[19:16] 00000000 */
1880 1881 1882 1883 1884 1885 1886 1887 1888 1889
	0x0020, /* AICCDETTH[15:8] 01111100 */
	0x0021, /* AICCDETTH[7:0] 00000000 */
	0x0022, /* AICCOFFTH[15:8] 00000101 */
	0x0023, /* AICCOFFTH[7:0] 11100000 */
	0x0024, /* AICCOPMODE3[1:0] AICCOPMODE2[1:0] AICCOPMODE1[1:0] AICCOPMODE0[1:0] 00000000 */
	0x0025, /* AICCFIXFREQ3[23:16] 00000000 */
	0x0026, /* AICCFIXFREQ3[15:8] 00000000 */
	0x0027, /* AICCFIXFREQ3[7:0] 00000000 */
	0x0028, /* AICCFIXFREQ2[23:16] 00000000 */
	0x0029, /* AICCFIXFREQ2[15:8] 00000000 */
1890 1891 1892 1893 1894 1895
	0x002a, /* AICCFIXFREQ2[7:0] 00000000 */
	0x002b, /* AICCFIXFREQ1[23:16] 00000000 */
	0x002c, /* AICCFIXFREQ1[15:8] 00000000 */
	0x002d, /* AICCFIXFREQ1[7:0] 00000000 */
	0x002e, /* AICCFIXFREQ0[23:16] 00000000 */
	0x002f, /* AICCFIXFREQ0[15:8] 00000000 */
1896 1897 1898 1899 1900 1901 1902 1903 1904
	0x0030, /* AICCFIXFREQ0[7:0] 00000000 */
	0x0031, /* 1'b0 1'b1 1'b0 1'b0 x DAGC1STER */
	0x0032, /* DAGC1STEN DAGC1STER */
	0x0033, /* DAGC1STREF[15:8] 00001010 */
	0x0034, /* DAGC1STREF[7:0] 11100100 */
	0x0035, /* DAGC2NDE */
	0x0036, /* DAGC2NDREF[15:8] 00001010 */
	0x0037, /* DAGC2NDREF[7:0] 10000000 */
	0x0038, /* DAGC2NDLOCKDETRNGSEL[1:0] */
1905
	0x003d, /* 1'b1 SAMGEARS */
1906 1907 1908 1909 1910 1911 1912 1913
	0x0040, /* SAMLFGMA */
	0x0041, /* SAMLFBWM */
	0x0044, /* 1'b1 CRGEARSHE */
	0x0045, /* CRLFGMAN */
	0x0046, /* CFLFBWMA */
	0x0047, /* CRLFGMAN */
	0x0048, /* x x x x CRLFGSTEP_VS[3:0] xxxx1001 */
	0x0049, /* CRLFBWMA */
1914
	0x004a, /* CRLFBWMA */
1915 1916 1917 1918 1919 1920 1921 1922 1923
	0x0050, /* 1'b0 1'b1 1'b1 1'b0 MSECALCDA */
	0x0070, /* TPOUTEN TPIFEN TPCLKOUTE */
	0x0071, /* TPSENB TPSSOPBITE */
	0x0073, /* TP47HINS x x CHBERINT PERMODE[1:0] PERINT[1:0] 1xx11100 */
	0x0075, /* x x x x x IQSWAPCTRL[2:0] xxxxx000 */
	0x0076, /* NBERCON NBERST NBERPOL NBERWSYN */
	0x0077, /* x NBERLOSTTH[2:0] NBERACQTH[3:0] x0000000 */
	0x0078, /* NBERPOLY[31:24] 00000000 */
	0x0079, /* NBERPOLY[23:16] 00000000 */
1924 1925 1926 1927 1928 1929
	0x007a, /* NBERPOLY[15:8] 00000000 */
	0x007b, /* NBERPOLY[7:0] 00000000 */
	0x007c, /* NBERPED[31:24] 00000000 */
	0x007d, /* NBERPED[23:16] 00000000 */
	0x007e, /* NBERPED[15:8] 00000000 */
	0x007f, /* NBERPED[7:0] 00000000 */
1930 1931 1932 1933
	0x0080, /* x AGCLOCK DAGCLOCK SYSLOCK x x NEVERLOCK[1:0] */
	0x0085, /* SPECINVST */
	0x0088, /* SYSLOCKTIME[15:8] */
	0x0089, /* SYSLOCKTIME[7:0] */
1934 1935 1936 1937
	0x008c, /* FECLOCKTIME[15:8] */
	0x008d, /* FECLOCKTIME[7:0] */
	0x008e, /* AGCACCOUT[15:8] */
	0x008f, /* AGCACCOUT[7:0] */
1938 1939
	0x0090, /* AICCREJSTATUS[3:0] AICCREJBUSY[3:0] */
	0x0091, /* AICCVSYNC */
1940 1941 1942 1943 1944 1945
	0x009c, /* CARRFREQOFFSET[15:8] */
	0x009d, /* CARRFREQOFFSET[7:0] */
	0x00a1, /* SAMFREQOFFSET[23:16] */
	0x00a2, /* SAMFREQOFFSET[15:8] */
	0x00a3, /* SAMFREQOFFSET[7:0] */
	0x00a6, /* SYNCLOCK SYNCLOCKH */
1946
#if 0 /* covered elsewhere */
1947 1948 1949 1950 1951 1952 1953 1954
	0x00e8, /* CONSTPWR[15:8] */
	0x00e9, /* CONSTPWR[7:0] */
	0x00ea, /* BMSE[15:8] */
	0x00eb, /* BMSE[7:0] */
	0x00ec, /* MSE[15:8] */
	0x00ed, /* MSE[7:0] */
	0x00ee, /* CONSTI[7:0] */
	0x00ef, /* CONSTQ[7:0] */
1955
#endif
1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967
	0x00f4, /* TPIFTPERRCNT[7:0] */
	0x00f5, /* TPCORREC */
	0x00f6, /* VBBER[15:8] */
	0x00f7, /* VBBER[7:0] */
	0x00f8, /* VABER[15:8] */
	0x00f9, /* VABER[7:0] */
	0x00fa, /* TPERRCNT[7:0] */
	0x00fb, /* NBERLOCK x x x x x x x */
	0x00fc, /* NBERVALUE[31:24] */
	0x00fd, /* NBERVALUE[23:16] */
	0x00fe, /* NBERVALUE[15:8] */
	0x00ff, /* NBERVALUE[7:0] */
1968 1969 1970
	0x1000, /* 1'b0 WODAGCOU */
	0x1005, /* x x 1'b1 1'b1 x SRD_Q_QM */
	0x1009, /* SRDWAITTIME[7:0] (10msec) 00100011 */
1971 1972
	0x100a, /* SRDWAITTIME_CQS[7:0] (msec) 01100100 */
	0x101a, /* x 1'b1 1'b0 1'b0 x QMDQAMMODE[2:0] x100x010 */
1973
	0x1036, /* 1'b0 1'b1 1'b0 1'b0 SAMGSEND_CQS[3:0] 01001110 */
1974 1975 1976 1977 1978
	0x103c, /* SAMGSAUTOSTL_V[3:0] SAMGSAUTOEDL_V[3:0] 01000110 */
	0x103d, /* 1'b1 1'b1 SAMCNORMBP_V[1:0] 1'b0 1'b0 SAMMODESEL_V[1:0] 11100001 */
	0x103f, /* SAMZTEDSE */
	0x105d, /* EQSTATUSE */
	0x105f, /* x PMAPG2_V[2:0] x DMAPG2_V[2:0] x001x011 */
1979 1980 1981 1982 1983
	0x1060, /* 1'b1 EQSTATUSE */
	0x1061, /* CRMAPBWSTL_V[3:0] CRMAPBWEDL_V[3:0] 00000100 */
	0x1065, /* 1'b0 x CRMODE_V[1:0] 1'b1 x 1'b1 x 0x111x1x */
	0x1066, /* 1'b0 1'b0 1'b1 1'b0 1'b1 PNBOOSTSE */
	0x1068, /* CREPHNGAIN2_V[3:0] CREPHNPBW_V[3:0] 10010001 */
1984 1985
	0x106e, /* x x x x x CREPHNEN_ */
	0x106f, /* CREPHNTH_V[7:0] 00010101 */
1986 1987 1988 1989 1990
	0x1072, /* CRSWEEPN */
	0x1073, /* CRPGAIN_V[3:0] x x 1'b1 1'b1 1001xx11 */
	0x1074, /* CRPBW_V[3:0] x x 1'b1 1'b1 0001xx11 */
	0x1080, /* DAFTSTATUS[1:0] x x x x x x */
	0x1081, /* SRDSTATUS[1:0] x x x x x SRDLOCK */
1991 1992
	0x10a9, /* EQSTATUS_CQS[1:0] x x x x x x */
	0x10b7, /* EQSTATUS_V[1:0] x x x x x x */
1993
#if 0 /* SMART_ANT */
1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042
	0x1f00, /* MODEDETE */
	0x1f01, /* x x x x x x x SFNRST xxxxxxx0 */
	0x1f03, /* NUMOFANT[7:0] 10000000 */
	0x1f04, /* x SELMASK[6:0] x0000000 */
	0x1f05, /* x SETMASK[6:0] x0000000 */
	0x1f06, /* x TXDATA[6:0] x0000000 */
	0x1f07, /* x CHNUMBER[6:0] x0000000 */
	0x1f09, /* AGCTIME[23:16] 10011000 */
	0x1f0a, /* AGCTIME[15:8] 10010110 */
	0x1f0b, /* AGCTIME[7:0] 10000000 */
	0x1f0c, /* ANTTIME[31:24] 00000000 */
	0x1f0d, /* ANTTIME[23:16] 00000011 */
	0x1f0e, /* ANTTIME[15:8] 10010000 */
	0x1f0f, /* ANTTIME[7:0] 10010000 */
	0x1f11, /* SYNCTIME[23:16] 10011000 */
	0x1f12, /* SYNCTIME[15:8] 10010110 */
	0x1f13, /* SYNCTIME[7:0] 10000000 */
	0x1f14, /* SNRTIME[31:24] 00000001 */
	0x1f15, /* SNRTIME[23:16] 01111101 */
	0x1f16, /* SNRTIME[15:8] 01111000 */
	0x1f17, /* SNRTIME[7:0] 01000000 */
	0x1f19, /* FECTIME[23:16] 00000000 */
	0x1f1a, /* FECTIME[15:8] 01110010 */
	0x1f1b, /* FECTIME[7:0] 01110000 */
	0x1f1d, /* FECTHD[7:0] 00000011 */
	0x1f1f, /* SNRTHD[23:16] 00001000 */
	0x1f20, /* SNRTHD[15:8] 01111111 */
	0x1f21, /* SNRTHD[7:0] 10000101 */
	0x1f80, /* IRQFLG x x SFSDRFLG MODEBFLG SAVEFLG SCANFLG TRACKFLG */
	0x1f81, /* x SYNCCON SNRCON FECCON x STDBUSY SYNCRST AGCFZCO */
	0x1f82, /* x x x SCANOPCD[4:0] */
	0x1f83, /* x x x x MAINOPCD[3:0] */
	0x1f84, /* x x RXDATA[13:8] */
	0x1f85, /* RXDATA[7:0] */
	0x1f86, /* x x SDTDATA[13:8] */
	0x1f87, /* SDTDATA[7:0] */
	0x1f89, /* ANTSNR[23:16] */
	0x1f8a, /* ANTSNR[15:8] */
	0x1f8b, /* ANTSNR[7:0] */
	0x1f8c, /* x x x x ANTFEC[13:8] */
	0x1f8d, /* ANTFEC[7:0] */
	0x1f8e, /* MAXCNT[7:0] */
	0x1f8f, /* SCANCNT[7:0] */
	0x1f91, /* MAXPW[23:16] */
	0x1f92, /* MAXPW[15:8] */
	0x1f93, /* MAXPW[7:0] */
	0x1f95, /* CURPWMSE[23:16] */
	0x1f96, /* CURPWMSE[15:8] */
	0x1f97, /* CURPWMSE[7:0] */
2043
#endif /* SMART_ANT */
2044 2045
	0x211f, /* 1'b1 1'b1 1'b1 CIRQEN x x 1'b0 1'b0 1111xx00 */
	0x212a, /* EQAUTOST */
2046
	0x2122, /* CHFAST[7:0] 01100000 */
2047 2048 2049
	0x212b, /* FFFSTEP_V[3:0] x FBFSTEP_V[2:0] 0001x001 */
	0x212c, /* PHDEROTBWSEL[3:0] 1'b1 1'b1 1'b1 1'b0 10001110 */
	0x212d, /* 1'b1 1'b1 1'b1 1'b1 x x TPIFLOCKS */
2050 2051 2052 2053 2054
	0x2135, /* DYNTRACKFDEQ[3:0] x 1'b0 1'b0 1'b0 1010x000 */
	0x2141, /* TRMODE[1:0] 1'b1 1'b1 1'b0 1'b1 1'b1 1'b1 01110111 */
	0x2162, /* AICCCTRLE */
	0x2173, /* PHNCNFCNT[7:0] 00000100 */
	0x2179, /* 1'b0 1'b0 1'b0 1'b1 x BADSINGLEDYNTRACKFBF[2:0] 0001x001 */
2055 2056 2057
	0x217a, /* 1'b0 1'b0 1'b0 1'b1 x BADSLOWSINGLEDYNTRACKFBF[2:0] 0001x001 */
	0x217e, /* CNFCNTTPIF[7:0] 00001000 */
	0x217f, /* TPERRCNTTPIF[7:0] 00000001 */
2058 2059 2060 2061 2062
	0x2180, /* x x x x x x FBDLYCIR[9:8] */
	0x2181, /* FBDLYCIR[7:0] */
	0x2185, /* MAXPWRMAIN[7:0] */
	0x2191, /* NCOMBDET x x x x x x x */
	0x2199, /* x MAINSTRON */
2063 2064
	0x219a, /* FFFEQSTEPOUT_V[3:0] FBFSTEPOUT_V[2:0] */
	0x21a1, /* x x SNRREF[5:0] */
2065 2066 2067 2068
	0x2845, /* 1'b0 1'b1 x x FFFSTEP_CQS[1:0] FFFCENTERTAP[1:0] 01xx1110 */
	0x2846, /* 1'b0 x 1'b0 1'b1 FBFSTEP_CQS[1:0] 1'b1 1'b0 0x011110 */
	0x2847, /* ENNOSIGDE */
	0x2849, /* 1'b1 1'b1 NOUSENOSI */
2069
	0x284a, /* EQINITWAITTIME[7:0] 01100100 */
2070 2071 2072 2073
	0x3000, /* 1'b1 1'b1 1'b1 x x x 1'b0 RPTRSTM */
	0x3001, /* RPTRSTWAITTIME[7:0] (100msec) 00110010 */
	0x3031, /* FRAMELOC */
	0x3032, /* 1'b1 1'b0 1'b0 1'b0 x x FRAMELOCKMODE_CQS[1:0] 1000xx11 */
2074 2075
	0x30a9, /* VDLOCK_Q FRAMELOCK */
	0x30aa, /* MPEGLOCK */
2076 2077
};

2078
#define numDumpRegs (sizeof(regtab)/sizeof(regtab[0]))
2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091
static u8 regval1[numDumpRegs] = {0, };
static u8 regval2[numDumpRegs] = {0, };

static void lgdt3306a_DumpAllRegs(struct lgdt3306a_state *state)
{
		memset(regval2, 0xff, sizeof(regval2));
		lgdt3306a_DumpRegs(state);
}

static void lgdt3306a_DumpRegs(struct lgdt3306a_state *state)
{
	int i;
	int sav_debug = debug;
2092

2093 2094
	if ((debug & DBG_DUMP) == 0)
		return;
M
Michael Ira Krufky 已提交
2095
	debug &= ~DBG_REG; /* suppress DBG_REG during reg dump */
2096

2097
	lg_debug("\n");
2098

2099
	for (i = 0; i < numDumpRegs; i++) {
2100
		lgdt3306a_read_reg(state, regtab[i], &regval1[i]);
2101
		if (regval1[i] != regval2[i]) {
2102 2103
			lg_debug(" %04X = %02X\n", regtab[i], regval1[i]);
				 regval2[i] = regval1[i];
2104 2105 2106 2107
		}
	}
	debug = sav_debug;
}
2108
#endif /* DBG_DUMP */
2109 2110 2111 2112 2113 2114 2115



static struct dvb_frontend_ops lgdt3306a_ops = {
	.delsys = { SYS_ATSC, SYS_DVBC_ANNEX_B },
	.info = {
		.name = "LG Electronics LGDT3306A VSB/QAM Frontend",
2116 2117 2118
#if 0
		.type               = FE_ATSC,
#endif
2119
		.frequency_min      = 54000000,
2120
		.frequency_max      = 858000000,
2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146 2147 2148 2149 2150 2151 2152
		.frequency_stepsize = 62500,
		.caps = FE_CAN_QAM_64 | FE_CAN_QAM_256 | FE_CAN_8VSB
	},
	.i2c_gate_ctrl        = lgdt3306a_i2c_gate_ctrl,
	.init                 = lgdt3306a_init,
	.sleep                = lgdt3306a_fe_sleep,
	/* if this is set, it overrides the default swzigzag */
	.tune                 = lgdt3306a_tune,
	.set_frontend         = lgdt3306a_set_parameters,
	.get_frontend         = lgdt3306a_get_frontend,
	.get_frontend_algo    = lgdt3306a_get_frontend_algo,
	.get_tune_settings    = lgdt3306a_get_tune_settings,
	.read_status          = lgdt3306a_read_status,
	.read_ber             = lgdt3306a_read_ber,
	.read_signal_strength = lgdt3306a_read_signal_strength,
	.read_snr             = lgdt3306a_read_snr,
	.read_ucblocks        = lgdt3306a_read_ucblocks,
	.release              = lgdt3306a_release,
	.ts_bus_ctrl          = lgdt3306a_ts_bus_ctrl,
	.search               = lgdt3306a_search,
};

MODULE_DESCRIPTION("LG Electronics LGDT3306A ATSC/QAM-B Demodulator Driver");
MODULE_AUTHOR("Fred Richter <frichter@hauppauge.com>");
MODULE_LICENSE("GPL");
MODULE_VERSION("0.2");

/*
 * Local variables:
 * c-basic-offset: 8
 * End:
 */