cxd2820r_core.c 17.1 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45
/*
 * Sony CXD2820R demodulator driver
 *
 * Copyright (C) 2010 Antti Palosaari <crope@iki.fi>
 *
 *    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.
 *
 *    You should have received a copy of the GNU General Public License along
 *    with this program; if not, write to the Free Software Foundation, Inc.,
 *    51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
 */


#include "cxd2820r_priv.h"

/* write multiple registers */
static int cxd2820r_wr_regs_i2c(struct cxd2820r_priv *priv, u8 i2c, u8 reg,
	u8 *val, int len)
{
	int ret;
	u8 buf[len+1];
	struct i2c_msg msg[1] = {
		{
			.addr = i2c,
			.flags = 0,
			.len = sizeof(buf),
			.buf = buf,
		}
	};

	buf[0] = reg;
	memcpy(&buf[1], val, len);

	ret = i2c_transfer(priv->i2c, msg, 1);
	if (ret == 1) {
		ret = 0;
	} else {
46 47
		dev_warn(&priv->i2c->dev, "%s: i2c wr failed=%d reg=%02x " \
				"len=%d\n", KBUILD_MODNAME, ret, reg, len);
48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77
		ret = -EREMOTEIO;
	}
	return ret;
}

/* read multiple registers */
static int cxd2820r_rd_regs_i2c(struct cxd2820r_priv *priv, u8 i2c, u8 reg,
	u8 *val, int len)
{
	int ret;
	u8 buf[len];
	struct i2c_msg msg[2] = {
		{
			.addr = i2c,
			.flags = 0,
			.len = 1,
			.buf = &reg,
		}, {
			.addr = i2c,
			.flags = I2C_M_RD,
			.len = sizeof(buf),
			.buf = buf,
		}
	};

	ret = i2c_transfer(priv->i2c, msg, 2);
	if (ret == 2) {
		memcpy(val, buf, len);
		ret = 0;
	} else {
78 79
		dev_warn(&priv->i2c->dev, "%s: i2c rd failed=%d reg=%02x " \
				"len=%d\n", KBUILD_MODNAME, ret, reg, len);
80 81 82 83 84 85 86
		ret = -EREMOTEIO;
	}

	return ret;
}

/* write multiple registers */
87
int cxd2820r_wr_regs(struct cxd2820r_priv *priv, u32 reginfo, u8 *val,
88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112
	int len)
{
	int ret;
	u8 i2c_addr;
	u8 reg = (reginfo >> 0) & 0xff;
	u8 bank = (reginfo >> 8) & 0xff;
	u8 i2c = (reginfo >> 16) & 0x01;

	/* select I2C */
	if (i2c)
		i2c_addr = priv->cfg.i2c_address | (1 << 1); /* DVB-C */
	else
		i2c_addr = priv->cfg.i2c_address; /* DVB-T/T2 */

	/* switch bank if needed */
	if (bank != priv->bank[i2c]) {
		ret = cxd2820r_wr_regs_i2c(priv, i2c_addr, 0x00, &bank, 1);
		if (ret)
			return ret;
		priv->bank[i2c] = bank;
	}
	return cxd2820r_wr_regs_i2c(priv, i2c_addr, reg, val, len);
}

/* read multiple registers */
113
int cxd2820r_rd_regs(struct cxd2820r_priv *priv, u32 reginfo, u8 *val,
114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138
	int len)
{
	int ret;
	u8 i2c_addr;
	u8 reg = (reginfo >> 0) & 0xff;
	u8 bank = (reginfo >> 8) & 0xff;
	u8 i2c = (reginfo >> 16) & 0x01;

	/* select I2C */
	if (i2c)
		i2c_addr = priv->cfg.i2c_address | (1 << 1); /* DVB-C */
	else
		i2c_addr = priv->cfg.i2c_address; /* DVB-T/T2 */

	/* switch bank if needed */
	if (bank != priv->bank[i2c]) {
		ret = cxd2820r_wr_regs_i2c(priv, i2c_addr, 0x00, &bank, 1);
		if (ret)
			return ret;
		priv->bank[i2c] = bank;
	}
	return cxd2820r_rd_regs_i2c(priv, i2c_addr, reg, val, len);
}

/* write single register */
139
int cxd2820r_wr_reg(struct cxd2820r_priv *priv, u32 reg, u8 val)
140 141 142 143 144
{
	return cxd2820r_wr_regs(priv, reg, &val, 1);
}

/* read single register */
145
int cxd2820r_rd_reg(struct cxd2820r_priv *priv, u32 reg, u8 *val)
146 147 148 149 150
{
	return cxd2820r_rd_regs(priv, reg, val, 1);
}

/* write single register with mask */
151
int cxd2820r_wr_reg_mask(struct cxd2820r_priv *priv, u32 reg, u8 val,
152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170
	u8 mask)
{
	int ret;
	u8 tmp;

	/* no need for read if whole reg is written */
	if (mask != 0xff) {
		ret = cxd2820r_rd_reg(priv, reg, &tmp);
		if (ret)
			return ret;

		val &= mask;
		tmp &= ~mask;
		val |= tmp;
	}

	return cxd2820r_wr_reg(priv, reg, val);
}

171
int cxd2820r_gpio(struct dvb_frontend *fe, u8 *gpio)
172 173 174
{
	struct cxd2820r_priv *priv = fe->demodulator_priv;
	int ret, i;
175
	u8 tmp0, tmp1;
176 177 178

	dev_dbg(&priv->i2c->dev, "%s: delsys=%d\n", __func__,
			fe->dtv_property_cache.delivery_system);
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 204

	/* update GPIOs only when needed */
	if (!memcmp(gpio, priv->gpio, sizeof(priv->gpio)))
		return 0;

	tmp0 = 0x00;
	tmp1 = 0x00;
	for (i = 0; i < sizeof(priv->gpio); i++) {
		/* enable / disable */
		if (gpio[i] & CXD2820R_GPIO_E)
			tmp0 |= (2 << 6) >> (2 * i);
		else
			tmp0 |= (1 << 6) >> (2 * i);

		/* input / output */
		if (gpio[i] & CXD2820R_GPIO_I)
			tmp1 |= (1 << (3 + i));
		else
			tmp1 |= (0 << (3 + i));

		/* high / low */
		if (gpio[i] & CXD2820R_GPIO_H)
			tmp1 |= (1 << (0 + i));
		else
			tmp1 |= (0 << (0 + i));

205 206
		dev_dbg(&priv->i2c->dev, "%s: gpio i=%d %02x %02x\n", __func__,
				i, tmp0, tmp1);
207 208
	}

209 210
	dev_dbg(&priv->i2c->dev, "%s: wr gpio=%02x %02x\n", __func__, tmp0,
			tmp1);
211 212 213 214 215 216 217 218 219 220 221 222 223 224 225

	/* write bits [7:2] */
	ret = cxd2820r_wr_reg_mask(priv, 0x00089, tmp0, 0xfc);
	if (ret)
		goto error;

	/* write bits [5:0] */
	ret = cxd2820r_wr_reg_mask(priv, 0x0008e, tmp1, 0x3f);
	if (ret)
		goto error;

	memcpy(priv->gpio, gpio, sizeof(priv->gpio));

	return ret;
error:
226
	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
227 228 229 230
	return ret;
}

/* 64 bit div with round closest, like DIV_ROUND_CLOSEST but 64 bit */
231
u32 cxd2820r_div_u64_round_closest(u64 dividend, u32 divisor)
232 233 234 235
{
	return div_u64(dividend + (divisor / 2), divisor);
}

236
static int cxd2820r_set_frontend(struct dvb_frontend *fe)
237
{
238
	struct cxd2820r_priv *priv = fe->demodulator_priv;
239 240 241
	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
	int ret;

242 243 244
	dev_dbg(&priv->i2c->dev, "%s: delsys=%d\n", __func__,
			fe->dtv_property_cache.delivery_system);

245 246 247 248 249
	switch (c->delivery_system) {
	case SYS_DVBT:
		ret = cxd2820r_init_t(fe);
		if (ret < 0)
			goto err;
250
		ret = cxd2820r_set_frontend_t(fe);
251 252 253 254 255 256 257
		if (ret < 0)
			goto err;
		break;
	case SYS_DVBT2:
		ret = cxd2820r_init_t(fe);
		if (ret < 0)
			goto err;
258
		ret = cxd2820r_set_frontend_t2(fe);
259 260 261
		if (ret < 0)
			goto err;
		break;
262
	case SYS_DVBC_ANNEX_A:
263 264 265
		ret = cxd2820r_init_c(fe);
		if (ret < 0)
			goto err;
266
		ret = cxd2820r_set_frontend_c(fe);
267 268 269 270
		if (ret < 0)
			goto err;
		break;
	default:
271 272
		dev_dbg(&priv->i2c->dev, "%s: error state=%d\n", __func__,
				fe->dtv_property_cache.delivery_system);
273 274
		ret = -EINVAL;
		break;
275
	}
276
err:
277 278 279 280
	return ret;
}
static int cxd2820r_read_status(struct dvb_frontend *fe, fe_status_t *status)
{
281
	struct cxd2820r_priv *priv = fe->demodulator_priv;
282 283
	int ret;

284 285 286
	dev_dbg(&priv->i2c->dev, "%s: delsys=%d\n", __func__,
			fe->dtv_property_cache.delivery_system);

287 288 289 290 291 292 293
	switch (fe->dtv_property_cache.delivery_system) {
	case SYS_DVBT:
		ret = cxd2820r_read_status_t(fe, status);
		break;
	case SYS_DVBT2:
		ret = cxd2820r_read_status_t2(fe, status);
		break;
294
	case SYS_DVBC_ANNEX_A:
295
		ret = cxd2820r_read_status_c(fe, status);
296 297 298 299
		break;
	default:
		ret = -EINVAL;
		break;
300 301 302 303
	}
	return ret;
}

304
static int cxd2820r_get_frontend(struct dvb_frontend *fe)
305
{
306
	struct cxd2820r_priv *priv = fe->demodulator_priv;
307 308
	int ret;

309 310
	dev_dbg(&priv->i2c->dev, "%s: delsys=%d\n", __func__,
			fe->dtv_property_cache.delivery_system);
311 312 313 314

	if (priv->delivery_system == SYS_UNDEFINED)
		return 0;

315 316
	switch (fe->dtv_property_cache.delivery_system) {
	case SYS_DVBT:
317
		ret = cxd2820r_get_frontend_t(fe);
318 319
		break;
	case SYS_DVBT2:
320
		ret = cxd2820r_get_frontend_t2(fe);
321
		break;
322 323
	case SYS_DVBC_ANNEX_A:
		ret = cxd2820r_get_frontend_c(fe);
324 325 326 327
		break;
	default:
		ret = -EINVAL;
		break;
328 329 330 331 332 333
	}
	return ret;
}

static int cxd2820r_read_ber(struct dvb_frontend *fe, u32 *ber)
{
334
	struct cxd2820r_priv *priv = fe->demodulator_priv;
335 336
	int ret;

337 338 339
	dev_dbg(&priv->i2c->dev, "%s: delsys=%d\n", __func__,
			fe->dtv_property_cache.delivery_system);

340 341 342 343 344 345 346
	switch (fe->dtv_property_cache.delivery_system) {
	case SYS_DVBT:
		ret = cxd2820r_read_ber_t(fe, ber);
		break;
	case SYS_DVBT2:
		ret = cxd2820r_read_ber_t2(fe, ber);
		break;
347
	case SYS_DVBC_ANNEX_A:
348
		ret = cxd2820r_read_ber_c(fe, ber);
349 350 351 352
		break;
	default:
		ret = -EINVAL;
		break;
353 354 355 356 357 358
	}
	return ret;
}

static int cxd2820r_read_signal_strength(struct dvb_frontend *fe, u16 *strength)
{
359
	struct cxd2820r_priv *priv = fe->demodulator_priv;
360 361
	int ret;

362 363 364
	dev_dbg(&priv->i2c->dev, "%s: delsys=%d\n", __func__,
			fe->dtv_property_cache.delivery_system);

365 366 367 368 369 370 371
	switch (fe->dtv_property_cache.delivery_system) {
	case SYS_DVBT:
		ret = cxd2820r_read_signal_strength_t(fe, strength);
		break;
	case SYS_DVBT2:
		ret = cxd2820r_read_signal_strength_t2(fe, strength);
		break;
372
	case SYS_DVBC_ANNEX_A:
373
		ret = cxd2820r_read_signal_strength_c(fe, strength);
374 375 376 377
		break;
	default:
		ret = -EINVAL;
		break;
378 379 380 381 382 383
	}
	return ret;
}

static int cxd2820r_read_snr(struct dvb_frontend *fe, u16 *snr)
{
384
	struct cxd2820r_priv *priv = fe->demodulator_priv;
385 386
	int ret;

387 388 389
	dev_dbg(&priv->i2c->dev, "%s: delsys=%d\n", __func__,
			fe->dtv_property_cache.delivery_system);

390 391 392 393 394 395 396
	switch (fe->dtv_property_cache.delivery_system) {
	case SYS_DVBT:
		ret = cxd2820r_read_snr_t(fe, snr);
		break;
	case SYS_DVBT2:
		ret = cxd2820r_read_snr_t2(fe, snr);
		break;
397
	case SYS_DVBC_ANNEX_A:
398
		ret = cxd2820r_read_snr_c(fe, snr);
399 400 401 402
		break;
	default:
		ret = -EINVAL;
		break;
403 404 405 406 407 408
	}
	return ret;
}

static int cxd2820r_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
{
409
	struct cxd2820r_priv *priv = fe->demodulator_priv;
410 411
	int ret;

412 413 414
	dev_dbg(&priv->i2c->dev, "%s: delsys=%d\n", __func__,
			fe->dtv_property_cache.delivery_system);

415 416 417 418 419 420 421
	switch (fe->dtv_property_cache.delivery_system) {
	case SYS_DVBT:
		ret = cxd2820r_read_ucblocks_t(fe, ucblocks);
		break;
	case SYS_DVBT2:
		ret = cxd2820r_read_ucblocks_t2(fe, ucblocks);
		break;
422
	case SYS_DVBC_ANNEX_A:
423
		ret = cxd2820r_read_ucblocks_c(fe, ucblocks);
424 425 426 427
		break;
	default:
		ret = -EINVAL;
		break;
428 429 430 431 432 433
	}
	return ret;
}

static int cxd2820r_init(struct dvb_frontend *fe)
{
434
	return 0;
435 436 437 438
}

static int cxd2820r_sleep(struct dvb_frontend *fe)
{
439
	struct cxd2820r_priv *priv = fe->demodulator_priv;
440 441
	int ret;

442 443 444
	dev_dbg(&priv->i2c->dev, "%s: delsys=%d\n", __func__,
			fe->dtv_property_cache.delivery_system);

445 446 447 448 449 450 451
	switch (fe->dtv_property_cache.delivery_system) {
	case SYS_DVBT:
		ret = cxd2820r_sleep_t(fe);
		break;
	case SYS_DVBT2:
		ret = cxd2820r_sleep_t2(fe);
		break;
452
	case SYS_DVBC_ANNEX_A:
453
		ret = cxd2820r_sleep_c(fe);
454 455 456 457
		break;
	default:
		ret = -EINVAL;
		break;
458 459 460 461 462
	}
	return ret;
}

static int cxd2820r_get_tune_settings(struct dvb_frontend *fe,
463
				      struct dvb_frontend_tune_settings *s)
464
{
465
	struct cxd2820r_priv *priv = fe->demodulator_priv;
466
	int ret;
467

468 469 470
	dev_dbg(&priv->i2c->dev, "%s: delsys=%d\n", __func__,
			fe->dtv_property_cache.delivery_system);

471 472 473 474 475 476 477
	switch (fe->dtv_property_cache.delivery_system) {
	case SYS_DVBT:
		ret = cxd2820r_get_tune_settings_t(fe, s);
		break;
	case SYS_DVBT2:
		ret = cxd2820r_get_tune_settings_t2(fe, s);
		break;
478
	case SYS_DVBC_ANNEX_A:
479
		ret = cxd2820r_get_tune_settings_c(fe, s);
480 481 482 483
		break;
	default:
		ret = -EINVAL;
		break;
484 485 486 487
	}
	return ret;
}

488
static enum dvbfe_search cxd2820r_search(struct dvb_frontend *fe)
489 490 491 492 493
{
	struct cxd2820r_priv *priv = fe->demodulator_priv;
	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
	int ret, i;
	fe_status_t status = 0;
494 495 496

	dev_dbg(&priv->i2c->dev, "%s: delsys=%d\n", __func__,
			fe->dtv_property_cache.delivery_system);
497 498

	/* switch between DVB-T and DVB-T2 when tune fails */
499
	if (priv->last_tune_failed) {
500 501 502 503 504
		if (priv->delivery_system == SYS_DVBT) {
			ret = cxd2820r_sleep_t(fe);
			if (ret)
				goto error;

505
			c->delivery_system = SYS_DVBT2;
506 507 508 509 510
		} else if (priv->delivery_system == SYS_DVBT2) {
			ret = cxd2820r_sleep_t2(fe);
			if (ret)
				goto error;

511
			c->delivery_system = SYS_DVBT;
512
		}
513 514 515
	}

	/* set frontend */
516
	ret = cxd2820r_set_frontend(fe);
517 518 519 520 521 522 523
	if (ret)
		goto error;


	/* frontend lock wait loop count */
	switch (priv->delivery_system) {
	case SYS_DVBT:
524
	case SYS_DVBC_ANNEX_A:
525 526 527 528 529 530 531 532 533 534 535 536 537
		i = 20;
		break;
	case SYS_DVBT2:
		i = 40;
		break;
	case SYS_UNDEFINED:
	default:
		i = 0;
		break;
	}

	/* wait frontend lock */
	for (; i > 0; i--) {
538
		dev_dbg(&priv->i2c->dev, "%s: loop=%d\n", __func__, i);
539 540 541 542 543
		msleep(50);
		ret = cxd2820r_read_status(fe, &status);
		if (ret)
			goto error;

544
		if (status & FE_HAS_LOCK)
545 546 547 548
			break;
	}

	/* check if we have a valid signal */
549
	if (status & FE_HAS_LOCK) {
550 551 552 553 554 555 556 557
		priv->last_tune_failed = 0;
		return DVBFE_ALGO_SEARCH_SUCCESS;
	} else {
		priv->last_tune_failed = 1;
		return DVBFE_ALGO_SEARCH_AGAIN;
	}

error:
558
	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
559 560 561 562 563 564 565 566
	return DVBFE_ALGO_SEARCH_ERROR;
}

static int cxd2820r_get_frontend_algo(struct dvb_frontend *fe)
{
	return DVBFE_ALGO_CUSTOM;
}

567 568 569
static void cxd2820r_release(struct dvb_frontend *fe)
{
	struct cxd2820r_priv *priv = fe->demodulator_priv;
570
	int uninitialized_var(ret); /* silence compiler warning */
571 572

	dev_dbg(&priv->i2c->dev, "%s\n", __func__);
573

574 575 576 577 578 579 580 581 582
#ifdef CONFIG_GPIOLIB
	/* remove GPIOs */
	if (priv->gpio_chip.label) {
		ret = gpiochip_remove(&priv->gpio_chip);
		if (ret)
			dev_err(&priv->i2c->dev, "%s: gpiochip_remove() " \
					"failed=%d\n", KBUILD_MODNAME, ret);
	}
#endif
583
	kfree(priv);
584 585 586
	return;
}

587
static int cxd2820r_i2c_gate_ctrl(struct dvb_frontend *fe, int enable)
588 589
{
	struct cxd2820r_priv *priv = fe->demodulator_priv;
590 591

	dev_dbg(&priv->i2c->dev, "%s: %d\n", __func__, enable);
592 593 594

	/* Bit 0 of reg 0xdb in bank 0x00 controls I2C repeater */
	return cxd2820r_wr_reg_mask(priv, 0xdb, enable ? 1 : 0, 0x1);
595 596
}

597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 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
#ifdef CONFIG_GPIOLIB
static int cxd2820r_gpio_direction_output(struct gpio_chip *chip, unsigned nr,
		int val)
{
	struct cxd2820r_priv *priv =
			container_of(chip, struct cxd2820r_priv, gpio_chip);
	u8 gpio[GPIO_COUNT];

	dev_dbg(&priv->i2c->dev, "%s: nr=%d val=%d\n", __func__, nr, val);

	memcpy(gpio, priv->gpio, sizeof(gpio));
	gpio[nr] = CXD2820R_GPIO_E | CXD2820R_GPIO_O | (val << 2);

	return cxd2820r_gpio(&priv->fe, gpio);
}

static void cxd2820r_gpio_set(struct gpio_chip *chip, unsigned nr, int val)
{
	struct cxd2820r_priv *priv =
			container_of(chip, struct cxd2820r_priv, gpio_chip);
	u8 gpio[GPIO_COUNT];

	dev_dbg(&priv->i2c->dev, "%s: nr=%d val=%d\n", __func__, nr, val);

	memcpy(gpio, priv->gpio, sizeof(gpio));
	gpio[nr] = CXD2820R_GPIO_E | CXD2820R_GPIO_O | (val << 2);

	(void) cxd2820r_gpio(&priv->fe, gpio);

	return;
}

static int cxd2820r_gpio_get(struct gpio_chip *chip, unsigned nr)
{
	struct cxd2820r_priv *priv =
			container_of(chip, struct cxd2820r_priv, gpio_chip);

	dev_dbg(&priv->i2c->dev, "%s: nr=%d\n", __func__, nr);

	return (priv->gpio[nr] >> 2) & 0x01;
}
#endif

640
static const struct dvb_frontend_ops cxd2820r_ops = {
641
	.delsys = { SYS_DVBT, SYS_DVBT2, SYS_DVBC_ANNEX_A },
642 643
	/* default: DVB-T/T2 */
	.info = {
644
		.name = "Sony CXD2820R",
645 646 647 648 649 650 651 652 653

		.caps =	FE_CAN_FEC_1_2			|
			FE_CAN_FEC_2_3			|
			FE_CAN_FEC_3_4			|
			FE_CAN_FEC_5_6			|
			FE_CAN_FEC_7_8			|
			FE_CAN_FEC_AUTO			|
			FE_CAN_QPSK			|
			FE_CAN_QAM_16			|
654
			FE_CAN_QAM_32			|
655
			FE_CAN_QAM_64			|
656
			FE_CAN_QAM_128			|
657 658 659 660 661 662
			FE_CAN_QAM_256			|
			FE_CAN_QAM_AUTO			|
			FE_CAN_TRANSMISSION_MODE_AUTO	|
			FE_CAN_GUARD_INTERVAL_AUTO	|
			FE_CAN_HIERARCHY_AUTO		|
			FE_CAN_MUTE_TS			|
663 664
			FE_CAN_2G_MODULATION		|
			FE_CAN_MULTISTREAM
665
		},
666

667 668 669
	.release		= cxd2820r_release,
	.init			= cxd2820r_init,
	.sleep			= cxd2820r_sleep,
670

671 672
	.get_tune_settings	= cxd2820r_get_tune_settings,
	.i2c_gate_ctrl		= cxd2820r_i2c_gate_ctrl,
673

674
	.get_frontend		= cxd2820r_get_frontend,
675

676 677
	.get_frontend_algo	= cxd2820r_get_frontend_algo,
	.search			= cxd2820r_search,
678

679 680 681 682 683 684
	.read_status		= cxd2820r_read_status,
	.read_snr		= cxd2820r_read_snr,
	.read_ber		= cxd2820r_read_ber,
	.read_ucblocks		= cxd2820r_read_ucblocks,
	.read_signal_strength	= cxd2820r_read_signal_strength,
};
685

686
struct dvb_frontend *cxd2820r_attach(const struct cxd2820r_config *cfg,
687 688
		struct i2c_adapter *i2c, int *gpio_chip_base
)
689
{
690
	struct cxd2820r_priv *priv;
691
	int ret;
692
	u8 tmp;
693

694
	priv = kzalloc(sizeof(struct cxd2820r_priv), GFP_KERNEL);
695 696 697 698
	if (!priv) {
		ret = -ENOMEM;
		dev_err(&i2c->dev, "%s: kzalloc() failed\n",
				KBUILD_MODNAME);
699
		goto error;
700
	}
701

702
	priv->i2c = i2c;
703 704 705
	memcpy(&priv->cfg, cfg, sizeof(struct cxd2820r_config));
	memcpy(&priv->fe.ops, &cxd2820r_ops, sizeof(struct dvb_frontend_ops));
	priv->fe.demodulator_priv = priv;
706 707 708

	priv->bank[0] = priv->bank[1] = 0xff;
	ret = cxd2820r_rd_reg(priv, 0x000fd, &tmp);
709
	dev_dbg(&priv->i2c->dev, "%s: chip id=%02x\n", __func__, tmp);
710 711 712
	if (ret || tmp != 0xe1)
		goto error;

713
	if (gpio_chip_base) {
714 715
#ifdef CONFIG_GPIOLIB
		/* add GPIOs */
716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733
		priv->gpio_chip.label = KBUILD_MODNAME;
		priv->gpio_chip.dev = &priv->i2c->dev;
		priv->gpio_chip.owner = THIS_MODULE;
		priv->gpio_chip.direction_output =
				cxd2820r_gpio_direction_output;
		priv->gpio_chip.set = cxd2820r_gpio_set;
		priv->gpio_chip.get = cxd2820r_gpio_get;
		priv->gpio_chip.base = -1; /* dynamic allocation */
		priv->gpio_chip.ngpio = GPIO_COUNT;
		priv->gpio_chip.can_sleep = 1;
		ret = gpiochip_add(&priv->gpio_chip);
		if (ret)
			goto error;

		dev_dbg(&priv->i2c->dev, "%s: gpio_chip.base=%d\n", __func__,
				priv->gpio_chip.base);

		*gpio_chip_base = priv->gpio_chip.base;
734 735 736 737 738
#else
		/*
		 * Use static GPIO configuration if GPIOLIB is undefined.
		 * This is fallback condition.
		 */
739
		u8 gpio[GPIO_COUNT];
740 741 742 743 744 745
		gpio[0] = (*gpio_chip_base >> 0) & 0x07;
		gpio[1] = (*gpio_chip_base >> 3) & 0x07;
		gpio[2] = 0;
		ret = cxd2820r_gpio(&priv->fe, gpio);
		if (ret)
			goto error;
746
#endif
747
	}
748

749
	return &priv->fe;
750
error:
751
	dev_dbg(&i2c->dev, "%s: failed=%d\n", __func__, ret);
752 753 754 755 756 757 758 759
	kfree(priv);
	return NULL;
}
EXPORT_SYMBOL(cxd2820r_attach);

MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
MODULE_DESCRIPTION("Sony CXD2820R demodulator driver");
MODULE_LICENSE("GPL");