PageRenderTime 62ms CodeModel.GetById 18ms app.highlight 36ms RepoModel.GetById 1ms app.codeStats 0ms

/drivers/media/common/tuners/tuner-simple.c

https://bitbucket.org/ndreys/linux-sunxi
C | 1131 lines | 845 code | 184 blank | 102 comment | 171 complexity | 8d058670a296dea1ce98aa6af4998b4f MD5 | raw file
Possible License(s): GPL-2.0, LGPL-2.0, AGPL-1.0
   1/*
   2 * i2c tv tuner chip device driver
   3 * controls all those simple 4-control-bytes style tuners.
   4 *
   5 * This "tuner-simple" module was split apart from the original "tuner" module.
   6 */
   7#include <linux/delay.h>
   8#include <linux/i2c.h>
   9#include <linux/videodev2.h>
  10#include <media/tuner.h>
  11#include <media/v4l2-common.h>
  12#include <media/tuner-types.h>
  13#include "tuner-i2c.h"
  14#include "tuner-simple.h"
  15
  16static int debug;
  17module_param(debug, int, 0644);
  18MODULE_PARM_DESC(debug, "enable verbose debug messages");
  19
  20#define TUNER_SIMPLE_MAX 64
  21static unsigned int simple_devcount;
  22
  23static int offset;
  24module_param(offset, int, 0664);
  25MODULE_PARM_DESC(offset, "Allows to specify an offset for tuner");
  26
  27static unsigned int atv_input[TUNER_SIMPLE_MAX] = \
  28			{ [0 ... (TUNER_SIMPLE_MAX-1)] = 0 };
  29static unsigned int dtv_input[TUNER_SIMPLE_MAX] = \
  30			{ [0 ... (TUNER_SIMPLE_MAX-1)] = 0 };
  31module_param_array(atv_input, int, NULL, 0644);
  32module_param_array(dtv_input, int, NULL, 0644);
  33MODULE_PARM_DESC(atv_input, "specify atv rf input, 0 for autoselect");
  34MODULE_PARM_DESC(dtv_input, "specify dtv rf input, 0 for autoselect");
  35
  36/* ---------------------------------------------------------------------- */
  37
  38/* tv standard selection for Temic 4046 FM5
  39   this value takes the low bits of control byte 2
  40   from datasheet Rev.01, Feb.00
  41     standard     BG      I       L       L2      D
  42     picture IF   38.9    38.9    38.9    33.95   38.9
  43     sound 1      33.4    32.9    32.4    40.45   32.4
  44     sound 2      33.16
  45     NICAM        33.05   32.348  33.05           33.05
  46 */
  47#define TEMIC_SET_PAL_I         0x05
  48#define TEMIC_SET_PAL_DK        0x09
  49#define TEMIC_SET_PAL_L         0x0a /* SECAM ? */
  50#define TEMIC_SET_PAL_L2        0x0b /* change IF ! */
  51#define TEMIC_SET_PAL_BG        0x0c
  52
  53/* tv tuner system standard selection for Philips FQ1216ME
  54   this value takes the low bits of control byte 2
  55   from datasheet "1999 Nov 16" (supersedes "1999 Mar 23")
  56     standard 		BG	DK	I	L	L`
  57     picture carrier	38.90	38.90	38.90	38.90	33.95
  58     colour		34.47	34.47	34.47	34.47	38.38
  59     sound 1		33.40	32.40	32.90	32.40	40.45
  60     sound 2		33.16	-	-	-	-
  61     NICAM		33.05	33.05	32.35	33.05	39.80
  62 */
  63#define PHILIPS_SET_PAL_I	0x01 /* Bit 2 always zero !*/
  64#define PHILIPS_SET_PAL_BGDK	0x09
  65#define PHILIPS_SET_PAL_L2	0x0a
  66#define PHILIPS_SET_PAL_L	0x0b
  67
  68/* system switching for Philips FI1216MF MK2
  69   from datasheet "1996 Jul 09",
  70    standard         BG     L      L'
  71    picture carrier  38.90  38.90  33.95
  72    colour	     34.47  34.37  38.38
  73    sound 1          33.40  32.40  40.45
  74    sound 2          33.16  -      -
  75    NICAM            33.05  33.05  39.80
  76 */
  77#define PHILIPS_MF_SET_STD_BG	0x01 /* Bit 2 must be zero, Bit 3 is system output */
  78#define PHILIPS_MF_SET_STD_L	0x03 /* Used on Secam France */
  79#define PHILIPS_MF_SET_STD_LC	0x02 /* Used on SECAM L' */
  80
  81/* Control byte */
  82
  83#define TUNER_RATIO_MASK        0x06 /* Bit cb1:cb2 */
  84#define TUNER_RATIO_SELECT_50   0x00
  85#define TUNER_RATIO_SELECT_32   0x02
  86#define TUNER_RATIO_SELECT_166  0x04
  87#define TUNER_RATIO_SELECT_62   0x06
  88
  89#define TUNER_CHARGE_PUMP       0x40  /* Bit cb6 */
  90
  91/* Status byte */
  92
  93#define TUNER_POR	  0x80
  94#define TUNER_FL          0x40
  95#define TUNER_MODE        0x38
  96#define TUNER_AFC         0x07
  97#define TUNER_SIGNAL      0x07
  98#define TUNER_STEREO      0x10
  99
 100#define TUNER_PLL_LOCKED   0x40
 101#define TUNER_STEREO_MK3   0x04
 102
 103static DEFINE_MUTEX(tuner_simple_list_mutex);
 104static LIST_HEAD(hybrid_tuner_instance_list);
 105
 106struct tuner_simple_priv {
 107	unsigned int nr;
 108	u16 last_div;
 109
 110	struct tuner_i2c_props i2c_props;
 111	struct list_head hybrid_tuner_instance_list;
 112
 113	unsigned int type;
 114	struct tunertype *tun;
 115
 116	u32 frequency;
 117	u32 bandwidth;
 118};
 119
 120/* ---------------------------------------------------------------------- */
 121
 122static int tuner_read_status(struct dvb_frontend *fe)
 123{
 124	struct tuner_simple_priv *priv = fe->tuner_priv;
 125	unsigned char byte;
 126
 127	if (1 != tuner_i2c_xfer_recv(&priv->i2c_props, &byte, 1))
 128		return 0;
 129
 130	return byte;
 131}
 132
 133static inline int tuner_signal(const int status)
 134{
 135	return (status & TUNER_SIGNAL) << 13;
 136}
 137
 138static inline int tuner_stereo(const int type, const int status)
 139{
 140	switch (type) {
 141	case TUNER_PHILIPS_FM1216ME_MK3:
 142	case TUNER_PHILIPS_FM1236_MK3:
 143	case TUNER_PHILIPS_FM1256_IH3:
 144	case TUNER_LG_NTSC_TAPE:
 145	case TUNER_TCL_MF02GIP_5N:
 146		return ((status & TUNER_SIGNAL) == TUNER_STEREO_MK3);
 147	case TUNER_PHILIPS_FM1216MK5:
 148		return status | TUNER_STEREO;
 149	default:
 150		return status & TUNER_STEREO;
 151	}
 152}
 153
 154static inline int tuner_islocked(const int status)
 155{
 156	return (status & TUNER_FL);
 157}
 158
 159static inline int tuner_afcstatus(const int status)
 160{
 161	return (status & TUNER_AFC) - 2;
 162}
 163
 164
 165static int simple_get_status(struct dvb_frontend *fe, u32 *status)
 166{
 167	struct tuner_simple_priv *priv = fe->tuner_priv;
 168	int tuner_status;
 169
 170	if (priv->i2c_props.adap == NULL)
 171		return -EINVAL;
 172
 173	tuner_status = tuner_read_status(fe);
 174
 175	*status = 0;
 176
 177	if (tuner_islocked(tuner_status))
 178		*status = TUNER_STATUS_LOCKED;
 179	if (tuner_stereo(priv->type, tuner_status))
 180		*status |= TUNER_STATUS_STEREO;
 181
 182	tuner_dbg("AFC Status: %d\n", tuner_afcstatus(tuner_status));
 183
 184	return 0;
 185}
 186
 187static int simple_get_rf_strength(struct dvb_frontend *fe, u16 *strength)
 188{
 189	struct tuner_simple_priv *priv = fe->tuner_priv;
 190	int signal;
 191
 192	if (priv->i2c_props.adap == NULL)
 193		return -EINVAL;
 194
 195	signal = tuner_signal(tuner_read_status(fe));
 196
 197	*strength = signal;
 198
 199	tuner_dbg("Signal strength: %d\n", signal);
 200
 201	return 0;
 202}
 203
 204/* ---------------------------------------------------------------------- */
 205
 206static inline char *tuner_param_name(enum param_type type)
 207{
 208	char *name;
 209
 210	switch (type) {
 211	case TUNER_PARAM_TYPE_RADIO:
 212		name = "radio";
 213		break;
 214	case TUNER_PARAM_TYPE_PAL:
 215		name = "pal";
 216		break;
 217	case TUNER_PARAM_TYPE_SECAM:
 218		name = "secam";
 219		break;
 220	case TUNER_PARAM_TYPE_NTSC:
 221		name = "ntsc";
 222		break;
 223	case TUNER_PARAM_TYPE_DIGITAL:
 224		name = "digital";
 225		break;
 226	default:
 227		name = "unknown";
 228		break;
 229	}
 230	return name;
 231}
 232
 233static struct tuner_params *simple_tuner_params(struct dvb_frontend *fe,
 234						enum param_type desired_type)
 235{
 236	struct tuner_simple_priv *priv = fe->tuner_priv;
 237	struct tunertype *tun = priv->tun;
 238	int i;
 239
 240	for (i = 0; i < tun->count; i++)
 241		if (desired_type == tun->params[i].type)
 242			break;
 243
 244	/* use default tuner params if desired_type not available */
 245	if (i == tun->count) {
 246		tuner_dbg("desired params (%s) undefined for tuner %d\n",
 247			  tuner_param_name(desired_type), priv->type);
 248		i = 0;
 249	}
 250
 251	tuner_dbg("using tuner params #%d (%s)\n", i,
 252		  tuner_param_name(tun->params[i].type));
 253
 254	return &tun->params[i];
 255}
 256
 257static int simple_config_lookup(struct dvb_frontend *fe,
 258				struct tuner_params *t_params,
 259				unsigned *frequency, u8 *config, u8 *cb)
 260{
 261	struct tuner_simple_priv *priv = fe->tuner_priv;
 262	int i;
 263
 264	for (i = 0; i < t_params->count; i++) {
 265		if (*frequency > t_params->ranges[i].limit)
 266			continue;
 267		break;
 268	}
 269	if (i == t_params->count) {
 270		tuner_dbg("frequency out of range (%d > %d)\n",
 271			  *frequency, t_params->ranges[i - 1].limit);
 272		*frequency = t_params->ranges[--i].limit;
 273	}
 274	*config = t_params->ranges[i].config;
 275	*cb     = t_params->ranges[i].cb;
 276
 277	tuner_dbg("freq = %d.%02d (%d), range = %d, "
 278		  "config = 0x%02x, cb = 0x%02x\n",
 279		  *frequency / 16, *frequency % 16 * 100 / 16, *frequency,
 280		  i, *config, *cb);
 281
 282	return i;
 283}
 284
 285/* ---------------------------------------------------------------------- */
 286
 287static void simple_set_rf_input(struct dvb_frontend *fe,
 288				u8 *config, u8 *cb, unsigned int rf)
 289{
 290	struct tuner_simple_priv *priv = fe->tuner_priv;
 291
 292	switch (priv->type) {
 293	case TUNER_PHILIPS_TUV1236D:
 294		switch (rf) {
 295		case 1:
 296			*cb |= 0x08;
 297			break;
 298		default:
 299			*cb &= ~0x08;
 300			break;
 301		}
 302		break;
 303	case TUNER_PHILIPS_FCV1236D:
 304		switch (rf) {
 305		case 1:
 306			*cb |= 0x01;
 307			break;
 308		default:
 309			*cb &= ~0x01;
 310			break;
 311		}
 312		break;
 313	default:
 314		break;
 315	}
 316}
 317
 318static int simple_std_setup(struct dvb_frontend *fe,
 319			    struct analog_parameters *params,
 320			    u8 *config, u8 *cb)
 321{
 322	struct tuner_simple_priv *priv = fe->tuner_priv;
 323	int rc;
 324
 325	/* tv norm specific stuff for multi-norm tuners */
 326	switch (priv->type) {
 327	case TUNER_PHILIPS_SECAM: /* FI1216MF */
 328		/* 0x01 -> ??? no change ??? */
 329		/* 0x02 -> PAL BDGHI / SECAM L */
 330		/* 0x04 -> ??? PAL others / SECAM others ??? */
 331		*cb &= ~0x03;
 332		if (params->std & V4L2_STD_SECAM_L)
 333			/* also valid for V4L2_STD_SECAM */
 334			*cb |= PHILIPS_MF_SET_STD_L;
 335		else if (params->std & V4L2_STD_SECAM_LC)
 336			*cb |= PHILIPS_MF_SET_STD_LC;
 337		else /* V4L2_STD_B|V4L2_STD_GH */
 338			*cb |= PHILIPS_MF_SET_STD_BG;
 339		break;
 340
 341	case TUNER_TEMIC_4046FM5:
 342		*cb &= ~0x0f;
 343
 344		if (params->std & V4L2_STD_PAL_BG) {
 345			*cb |= TEMIC_SET_PAL_BG;
 346
 347		} else if (params->std & V4L2_STD_PAL_I) {
 348			*cb |= TEMIC_SET_PAL_I;
 349
 350		} else if (params->std & V4L2_STD_PAL_DK) {
 351			*cb |= TEMIC_SET_PAL_DK;
 352
 353		} else if (params->std & V4L2_STD_SECAM_L) {
 354			*cb |= TEMIC_SET_PAL_L;
 355
 356		}
 357		break;
 358
 359	case TUNER_PHILIPS_FQ1216ME:
 360		*cb &= ~0x0f;
 361
 362		if (params->std & (V4L2_STD_PAL_BG|V4L2_STD_PAL_DK)) {
 363			*cb |= PHILIPS_SET_PAL_BGDK;
 364
 365		} else if (params->std & V4L2_STD_PAL_I) {
 366			*cb |= PHILIPS_SET_PAL_I;
 367
 368		} else if (params->std & V4L2_STD_SECAM_L) {
 369			*cb |= PHILIPS_SET_PAL_L;
 370
 371		}
 372		break;
 373
 374	case TUNER_PHILIPS_FCV1236D:
 375		/* 0x00 -> ATSC antenna input 1 */
 376		/* 0x01 -> ATSC antenna input 2 */
 377		/* 0x02 -> NTSC antenna input 1 */
 378		/* 0x03 -> NTSC antenna input 2 */
 379		*cb &= ~0x03;
 380		if (!(params->std & V4L2_STD_ATSC))
 381			*cb |= 2;
 382		break;
 383
 384	case TUNER_MICROTUNE_4042FI5:
 385		/* Set the charge pump for fast tuning */
 386		*config |= TUNER_CHARGE_PUMP;
 387		break;
 388
 389	case TUNER_PHILIPS_TUV1236D:
 390	{
 391		struct tuner_i2c_props i2c = priv->i2c_props;
 392		/* 0x40 -> ATSC antenna input 1 */
 393		/* 0x48 -> ATSC antenna input 2 */
 394		/* 0x00 -> NTSC antenna input 1 */
 395		/* 0x08 -> NTSC antenna input 2 */
 396		u8 buffer[4] = { 0x14, 0x00, 0x17, 0x00};
 397		*cb &= ~0x40;
 398		if (params->std & V4L2_STD_ATSC) {
 399			*cb |= 0x40;
 400			buffer[1] = 0x04;
 401		}
 402		/* set to the correct mode (analog or digital) */
 403		i2c.addr = 0x0a;
 404		rc = tuner_i2c_xfer_send(&i2c, &buffer[0], 2);
 405		if (2 != rc)
 406			tuner_warn("i2c i/o error: rc == %d "
 407				   "(should be 2)\n", rc);
 408		rc = tuner_i2c_xfer_send(&i2c, &buffer[2], 2);
 409		if (2 != rc)
 410			tuner_warn("i2c i/o error: rc == %d "
 411				   "(should be 2)\n", rc);
 412		break;
 413	}
 414	}
 415	if (atv_input[priv->nr])
 416		simple_set_rf_input(fe, config, cb, atv_input[priv->nr]);
 417
 418	return 0;
 419}
 420
 421static int simple_set_aux_byte(struct dvb_frontend *fe, u8 config, u8 aux)
 422{
 423	struct tuner_simple_priv *priv = fe->tuner_priv;
 424	int rc;
 425	u8 buffer[2];
 426
 427	buffer[0] = (config & ~0x38) | 0x18;
 428	buffer[1] = aux;
 429
 430	tuner_dbg("setting aux byte: 0x%02x 0x%02x\n", buffer[0], buffer[1]);
 431
 432	rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 2);
 433	if (2 != rc)
 434		tuner_warn("i2c i/o error: rc == %d (should be 2)\n", rc);
 435
 436	return rc == 2 ? 0 : rc;
 437}
 438
 439static int simple_post_tune(struct dvb_frontend *fe, u8 *buffer,
 440			    u16 div, u8 config, u8 cb)
 441{
 442	struct tuner_simple_priv *priv = fe->tuner_priv;
 443	int rc;
 444
 445	switch (priv->type) {
 446	case TUNER_LG_TDVS_H06XF:
 447		simple_set_aux_byte(fe, config, 0x20);
 448		break;
 449	case TUNER_PHILIPS_FQ1216LME_MK3:
 450		simple_set_aux_byte(fe, config, 0x60); /* External AGC */
 451		break;
 452	case TUNER_MICROTUNE_4042FI5:
 453	{
 454		/* FIXME - this may also work for other tuners */
 455		unsigned long timeout = jiffies + msecs_to_jiffies(1);
 456		u8 status_byte = 0;
 457
 458		/* Wait until the PLL locks */
 459		for (;;) {
 460			if (time_after(jiffies, timeout))
 461				return 0;
 462			rc = tuner_i2c_xfer_recv(&priv->i2c_props,
 463						 &status_byte, 1);
 464			if (1 != rc) {
 465				tuner_warn("i2c i/o read error: rc == %d "
 466					   "(should be 1)\n", rc);
 467				break;
 468			}
 469			if (status_byte & TUNER_PLL_LOCKED)
 470				break;
 471			udelay(10);
 472		}
 473
 474		/* Set the charge pump for optimized phase noise figure */
 475		config &= ~TUNER_CHARGE_PUMP;
 476		buffer[0] = (div>>8) & 0x7f;
 477		buffer[1] = div      & 0xff;
 478		buffer[2] = config;
 479		buffer[3] = cb;
 480		tuner_dbg("tv 0x%02x 0x%02x 0x%02x 0x%02x\n",
 481			  buffer[0], buffer[1], buffer[2], buffer[3]);
 482
 483		rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
 484		if (4 != rc)
 485			tuner_warn("i2c i/o error: rc == %d "
 486				   "(should be 4)\n", rc);
 487		break;
 488	}
 489	}
 490
 491	return 0;
 492}
 493
 494static int simple_radio_bandswitch(struct dvb_frontend *fe, u8 *buffer)
 495{
 496	struct tuner_simple_priv *priv = fe->tuner_priv;
 497
 498	switch (priv->type) {
 499	case TUNER_TENA_9533_DI:
 500	case TUNER_YMEC_TVF_5533MF:
 501		tuner_dbg("This tuner doesn't have FM. "
 502			  "Most cards have a TEA5767 for FM\n");
 503		return 0;
 504	case TUNER_PHILIPS_FM1216ME_MK3:
 505	case TUNER_PHILIPS_FM1236_MK3:
 506	case TUNER_PHILIPS_FMD1216ME_MK3:
 507	case TUNER_PHILIPS_FMD1216MEX_MK3:
 508	case TUNER_LG_NTSC_TAPE:
 509	case TUNER_PHILIPS_FM1256_IH3:
 510	case TUNER_TCL_MF02GIP_5N:
 511		buffer[3] = 0x19;
 512		break;
 513	case TUNER_PHILIPS_FM1216MK5:
 514		buffer[2] = 0x88;
 515		buffer[3] = 0x09;
 516		break;
 517	case TUNER_TNF_5335MF:
 518		buffer[3] = 0x11;
 519		break;
 520	case TUNER_LG_PAL_FM:
 521		buffer[3] = 0xa5;
 522		break;
 523	case TUNER_THOMSON_DTT761X:
 524		buffer[3] = 0x39;
 525		break;
 526	case TUNER_PHILIPS_FQ1216LME_MK3:
 527	case TUNER_PHILIPS_FQ1236_MK5:
 528		tuner_err("This tuner doesn't have FM\n");
 529		/* Set the low band for sanity, since it covers 88-108 MHz */
 530		buffer[3] = 0x01;
 531		break;
 532	case TUNER_MICROTUNE_4049FM5:
 533	default:
 534		buffer[3] = 0xa4;
 535		break;
 536	}
 537
 538	return 0;
 539}
 540
 541/* ---------------------------------------------------------------------- */
 542
 543static int simple_set_tv_freq(struct dvb_frontend *fe,
 544			      struct analog_parameters *params)
 545{
 546	struct tuner_simple_priv *priv = fe->tuner_priv;
 547	u8 config, cb;
 548	u16 div;
 549	u8 buffer[4];
 550	int rc, IFPCoff, i;
 551	enum param_type desired_type;
 552	struct tuner_params *t_params;
 553
 554	/* IFPCoff = Video Intermediate Frequency - Vif:
 555		940  =16*58.75  NTSC/J (Japan)
 556		732  =16*45.75  M/N STD
 557		704  =16*44     ATSC (at DVB code)
 558		632  =16*39.50  I U.K.
 559		622.4=16*38.90  B/G D/K I, L STD
 560		592  =16*37.00  D China
 561		590  =16.36.875 B Australia
 562		543.2=16*33.95  L' STD
 563		171.2=16*10.70  FM Radio (at set_radio_freq)
 564	*/
 565
 566	if (params->std == V4L2_STD_NTSC_M_JP) {
 567		IFPCoff      = 940;
 568		desired_type = TUNER_PARAM_TYPE_NTSC;
 569	} else if ((params->std & V4L2_STD_MN) &&
 570		  !(params->std & ~V4L2_STD_MN)) {
 571		IFPCoff      = 732;
 572		desired_type = TUNER_PARAM_TYPE_NTSC;
 573	} else if (params->std == V4L2_STD_SECAM_LC) {
 574		IFPCoff      = 543;
 575		desired_type = TUNER_PARAM_TYPE_SECAM;
 576	} else {
 577		IFPCoff      = 623;
 578		desired_type = TUNER_PARAM_TYPE_PAL;
 579	}
 580
 581	t_params = simple_tuner_params(fe, desired_type);
 582
 583	i = simple_config_lookup(fe, t_params, &params->frequency,
 584				 &config, &cb);
 585
 586	div = params->frequency + IFPCoff + offset;
 587
 588	tuner_dbg("Freq= %d.%02d MHz, V_IF=%d.%02d MHz, "
 589		  "Offset=%d.%02d MHz, div=%0d\n",
 590		  params->frequency / 16, params->frequency % 16 * 100 / 16,
 591		  IFPCoff / 16, IFPCoff % 16 * 100 / 16,
 592		  offset / 16, offset % 16 * 100 / 16, div);
 593
 594	/* tv norm specific stuff for multi-norm tuners */
 595	simple_std_setup(fe, params, &config, &cb);
 596
 597	if (t_params->cb_first_if_lower_freq && div < priv->last_div) {
 598		buffer[0] = config;
 599		buffer[1] = cb;
 600		buffer[2] = (div>>8) & 0x7f;
 601		buffer[3] = div      & 0xff;
 602	} else {
 603		buffer[0] = (div>>8) & 0x7f;
 604		buffer[1] = div      & 0xff;
 605		buffer[2] = config;
 606		buffer[3] = cb;
 607	}
 608	priv->last_div = div;
 609	if (t_params->has_tda9887) {
 610		struct v4l2_priv_tun_config tda9887_cfg;
 611		int tda_config = 0;
 612		int is_secam_l = (params->std & (V4L2_STD_SECAM_L |
 613						 V4L2_STD_SECAM_LC)) &&
 614			!(params->std & ~(V4L2_STD_SECAM_L |
 615					  V4L2_STD_SECAM_LC));
 616
 617		tda9887_cfg.tuner = TUNER_TDA9887;
 618		tda9887_cfg.priv  = &tda_config;
 619
 620		if (params->std == V4L2_STD_SECAM_LC) {
 621			if (t_params->port1_active ^ t_params->port1_invert_for_secam_lc)
 622				tda_config |= TDA9887_PORT1_ACTIVE;
 623			if (t_params->port2_active ^ t_params->port2_invert_for_secam_lc)
 624				tda_config |= TDA9887_PORT2_ACTIVE;
 625		} else {
 626			if (t_params->port1_active)
 627				tda_config |= TDA9887_PORT1_ACTIVE;
 628			if (t_params->port2_active)
 629				tda_config |= TDA9887_PORT2_ACTIVE;
 630		}
 631		if (t_params->intercarrier_mode)
 632			tda_config |= TDA9887_INTERCARRIER;
 633		if (is_secam_l) {
 634			if (i == 0 && t_params->default_top_secam_low)
 635				tda_config |= TDA9887_TOP(t_params->default_top_secam_low);
 636			else if (i == 1 && t_params->default_top_secam_mid)
 637				tda_config |= TDA9887_TOP(t_params->default_top_secam_mid);
 638			else if (t_params->default_top_secam_high)
 639				tda_config |= TDA9887_TOP(t_params->default_top_secam_high);
 640		} else {
 641			if (i == 0 && t_params->default_top_low)
 642				tda_config |= TDA9887_TOP(t_params->default_top_low);
 643			else if (i == 1 && t_params->default_top_mid)
 644				tda_config |= TDA9887_TOP(t_params->default_top_mid);
 645			else if (t_params->default_top_high)
 646				tda_config |= TDA9887_TOP(t_params->default_top_high);
 647		}
 648		if (t_params->default_pll_gating_18)
 649			tda_config |= TDA9887_GATING_18;
 650		i2c_clients_command(priv->i2c_props.adap, TUNER_SET_CONFIG,
 651				    &tda9887_cfg);
 652	}
 653	tuner_dbg("tv 0x%02x 0x%02x 0x%02x 0x%02x\n",
 654		  buffer[0], buffer[1], buffer[2], buffer[3]);
 655
 656	rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
 657	if (4 != rc)
 658		tuner_warn("i2c i/o error: rc == %d (should be 4)\n", rc);
 659
 660	simple_post_tune(fe, &buffer[0], div, config, cb);
 661
 662	return 0;
 663}
 664
 665static int simple_set_radio_freq(struct dvb_frontend *fe,
 666				 struct analog_parameters *params)
 667{
 668	struct tunertype *tun;
 669	struct tuner_simple_priv *priv = fe->tuner_priv;
 670	u8 buffer[4];
 671	u16 div;
 672	int rc, j;
 673	struct tuner_params *t_params;
 674	unsigned int freq = params->frequency;
 675
 676	tun = priv->tun;
 677
 678	for (j = tun->count-1; j > 0; j--)
 679		if (tun->params[j].type == TUNER_PARAM_TYPE_RADIO)
 680			break;
 681	/* default t_params (j=0) will be used if desired type wasn't found */
 682	t_params = &tun->params[j];
 683
 684	/* Select Radio 1st IF used */
 685	switch (t_params->radio_if) {
 686	case 0: /* 10.7 MHz */
 687		freq += (unsigned int)(10.7*16000);
 688		break;
 689	case 1: /* 33.3 MHz */
 690		freq += (unsigned int)(33.3*16000);
 691		break;
 692	case 2: /* 41.3 MHz */
 693		freq += (unsigned int)(41.3*16000);
 694		break;
 695	default:
 696		tuner_warn("Unsupported radio_if value %d\n",
 697			   t_params->radio_if);
 698		return 0;
 699	}
 700
 701	buffer[2] = (t_params->ranges[0].config & ~TUNER_RATIO_MASK) |
 702		    TUNER_RATIO_SELECT_50; /* 50 kHz step */
 703
 704	/* Bandswitch byte */
 705	simple_radio_bandswitch(fe, &buffer[0]);
 706
 707	/* Convert from 1/16 kHz V4L steps to 1/20 MHz (=50 kHz) PLL steps
 708	   freq * (1 Mhz / 16000 V4L steps) * (20 PLL steps / 1 MHz) =
 709	   freq * (1/800) */
 710	div = (freq + 400) / 800;
 711
 712	if (t_params->cb_first_if_lower_freq && div < priv->last_div) {
 713		buffer[0] = buffer[2];
 714		buffer[1] = buffer[3];
 715		buffer[2] = (div>>8) & 0x7f;
 716		buffer[3] = div      & 0xff;
 717	} else {
 718		buffer[0] = (div>>8) & 0x7f;
 719		buffer[1] = div      & 0xff;
 720	}
 721
 722	tuner_dbg("radio 0x%02x 0x%02x 0x%02x 0x%02x\n",
 723	       buffer[0], buffer[1], buffer[2], buffer[3]);
 724	priv->last_div = div;
 725
 726	if (t_params->has_tda9887) {
 727		int config = 0;
 728		struct v4l2_priv_tun_config tda9887_cfg;
 729
 730		tda9887_cfg.tuner = TUNER_TDA9887;
 731		tda9887_cfg.priv = &config;
 732
 733		if (t_params->port1_active &&
 734		    !t_params->port1_fm_high_sensitivity)
 735			config |= TDA9887_PORT1_ACTIVE;
 736		if (t_params->port2_active &&
 737		    !t_params->port2_fm_high_sensitivity)
 738			config |= TDA9887_PORT2_ACTIVE;
 739		if (t_params->intercarrier_mode)
 740			config |= TDA9887_INTERCARRIER;
 741/*		if (t_params->port1_set_for_fm_mono)
 742			config &= ~TDA9887_PORT1_ACTIVE;*/
 743		if (t_params->fm_gain_normal)
 744			config |= TDA9887_GAIN_NORMAL;
 745		if (t_params->radio_if == 2)
 746			config |= TDA9887_RIF_41_3;
 747		i2c_clients_command(priv->i2c_props.adap, TUNER_SET_CONFIG,
 748				    &tda9887_cfg);
 749	}
 750	rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
 751	if (4 != rc)
 752		tuner_warn("i2c i/o error: rc == %d (should be 4)\n", rc);
 753
 754	return 0;
 755}
 756
 757static int simple_set_params(struct dvb_frontend *fe,
 758			     struct analog_parameters *params)
 759{
 760	struct tuner_simple_priv *priv = fe->tuner_priv;
 761	int ret = -EINVAL;
 762
 763	if (priv->i2c_props.adap == NULL)
 764		return -EINVAL;
 765
 766	switch (params->mode) {
 767	case V4L2_TUNER_RADIO:
 768		ret = simple_set_radio_freq(fe, params);
 769		priv->frequency = params->frequency * 125 / 2;
 770		break;
 771	case V4L2_TUNER_ANALOG_TV:
 772	case V4L2_TUNER_DIGITAL_TV:
 773		ret = simple_set_tv_freq(fe, params);
 774		priv->frequency = params->frequency * 62500;
 775		break;
 776	}
 777	priv->bandwidth = 0;
 778
 779	return ret;
 780}
 781
 782static void simple_set_dvb(struct dvb_frontend *fe, u8 *buf,
 783			   const struct dvb_frontend_parameters *params)
 784{
 785	struct tuner_simple_priv *priv = fe->tuner_priv;
 786
 787	switch (priv->type) {
 788	case TUNER_PHILIPS_FMD1216ME_MK3:
 789	case TUNER_PHILIPS_FMD1216MEX_MK3:
 790		if (params->u.ofdm.bandwidth == BANDWIDTH_8_MHZ &&
 791		    params->frequency >= 158870000)
 792			buf[3] |= 0x08;
 793		break;
 794	case TUNER_PHILIPS_TD1316:
 795		/* determine band */
 796		buf[3] |= (params->frequency < 161000000) ? 1 :
 797			  (params->frequency < 444000000) ? 2 : 4;
 798
 799		/* setup PLL filter */
 800		if (params->u.ofdm.bandwidth == BANDWIDTH_8_MHZ)
 801			buf[3] |= 1 << 3;
 802		break;
 803	case TUNER_PHILIPS_TUV1236D:
 804	case TUNER_PHILIPS_FCV1236D:
 805	{
 806		unsigned int new_rf;
 807
 808		if (dtv_input[priv->nr])
 809			new_rf = dtv_input[priv->nr];
 810		else
 811			switch (params->u.vsb.modulation) {
 812			case QAM_64:
 813			case QAM_256:
 814				new_rf = 1;
 815				break;
 816			case VSB_8:
 817			default:
 818				new_rf = 0;
 819				break;
 820			}
 821		simple_set_rf_input(fe, &buf[2], &buf[3], new_rf);
 822		break;
 823	}
 824	default:
 825		break;
 826	}
 827}
 828
 829static u32 simple_dvb_configure(struct dvb_frontend *fe, u8 *buf,
 830				const struct dvb_frontend_parameters *params)
 831{
 832	/* This function returns the tuned frequency on success, 0 on error */
 833	struct tuner_simple_priv *priv = fe->tuner_priv;
 834	struct tunertype *tun = priv->tun;
 835	static struct tuner_params *t_params;
 836	u8 config, cb;
 837	u32 div;
 838	int ret;
 839	unsigned frequency = params->frequency / 62500;
 840
 841	if (!tun->stepsize) {
 842		/* tuner-core was loaded before the digital tuner was
 843		 * configured and somehow picked the wrong tuner type */
 844		tuner_err("attempt to treat tuner %d (%s) as digital tuner "
 845			  "without stepsize defined.\n",
 846			  priv->type, priv->tun->name);
 847		return 0; /* failure */
 848	}
 849
 850	t_params = simple_tuner_params(fe, TUNER_PARAM_TYPE_DIGITAL);
 851	ret = simple_config_lookup(fe, t_params, &frequency, &config, &cb);
 852	if (ret < 0)
 853		return 0; /* failure */
 854
 855	div = ((frequency + t_params->iffreq) * 62500 + offset +
 856	       tun->stepsize/2) / tun->stepsize;
 857
 858	buf[0] = div >> 8;
 859	buf[1] = div & 0xff;
 860	buf[2] = config;
 861	buf[3] = cb;
 862
 863	simple_set_dvb(fe, buf, params);
 864
 865	tuner_dbg("%s: div=%d | buf=0x%02x,0x%02x,0x%02x,0x%02x\n",
 866		  tun->name, div, buf[0], buf[1], buf[2], buf[3]);
 867
 868	/* calculate the frequency we set it to */
 869	return (div * tun->stepsize) - t_params->iffreq;
 870}
 871
 872static int simple_dvb_calc_regs(struct dvb_frontend *fe,
 873				struct dvb_frontend_parameters *params,
 874				u8 *buf, int buf_len)
 875{
 876	struct tuner_simple_priv *priv = fe->tuner_priv;
 877	u32 frequency;
 878
 879	if (buf_len < 5)
 880		return -EINVAL;
 881
 882	frequency = simple_dvb_configure(fe, buf+1, params);
 883	if (frequency == 0)
 884		return -EINVAL;
 885
 886	buf[0] = priv->i2c_props.addr;
 887
 888	priv->frequency = frequency;
 889	priv->bandwidth = (fe->ops.info.type == FE_OFDM) ?
 890		params->u.ofdm.bandwidth : 0;
 891
 892	return 5;
 893}
 894
 895static int simple_dvb_set_params(struct dvb_frontend *fe,
 896				 struct dvb_frontend_parameters *params)
 897{
 898	struct tuner_simple_priv *priv = fe->tuner_priv;
 899	u32 prev_freq, prev_bw;
 900	int ret;
 901	u8 buf[5];
 902
 903	if (priv->i2c_props.adap == NULL)
 904		return -EINVAL;
 905
 906	prev_freq = priv->frequency;
 907	prev_bw   = priv->bandwidth;
 908
 909	ret = simple_dvb_calc_regs(fe, params, buf, 5);
 910	if (ret != 5)
 911		goto fail;
 912
 913	/* put analog demod in standby when tuning digital */
 914	if (fe->ops.analog_ops.standby)
 915		fe->ops.analog_ops.standby(fe);
 916
 917	if (fe->ops.i2c_gate_ctrl)
 918		fe->ops.i2c_gate_ctrl(fe, 1);
 919
 920	/* buf[0] contains the i2c address, but *
 921	 * we already have it in i2c_props.addr */
 922	ret = tuner_i2c_xfer_send(&priv->i2c_props, buf+1, 4);
 923	if (ret != 4)
 924		goto fail;
 925
 926	return 0;
 927fail:
 928	/* calc_regs sets frequency and bandwidth. if we failed, unset them */
 929	priv->frequency = prev_freq;
 930	priv->bandwidth = prev_bw;
 931
 932	return ret;
 933}
 934
 935static int simple_init(struct dvb_frontend *fe)
 936{
 937	struct tuner_simple_priv *priv = fe->tuner_priv;
 938
 939	if (priv->i2c_props.adap == NULL)
 940		return -EINVAL;
 941
 942	if (priv->tun->initdata) {
 943		int ret;
 944
 945		if (fe->ops.i2c_gate_ctrl)
 946			fe->ops.i2c_gate_ctrl(fe, 1);
 947
 948		ret = tuner_i2c_xfer_send(&priv->i2c_props,
 949					  priv->tun->initdata + 1,
 950					  priv->tun->initdata[0]);
 951		if (ret != priv->tun->initdata[0])
 952			return ret;
 953	}
 954
 955	return 0;
 956}
 957
 958static int simple_sleep(struct dvb_frontend *fe)
 959{
 960	struct tuner_simple_priv *priv = fe->tuner_priv;
 961
 962	if (priv->i2c_props.adap == NULL)
 963		return -EINVAL;
 964
 965	if (priv->tun->sleepdata) {
 966		int ret;
 967
 968		if (fe->ops.i2c_gate_ctrl)
 969			fe->ops.i2c_gate_ctrl(fe, 1);
 970
 971		ret = tuner_i2c_xfer_send(&priv->i2c_props,
 972					  priv->tun->sleepdata + 1,
 973					  priv->tun->sleepdata[0]);
 974		if (ret != priv->tun->sleepdata[0])
 975			return ret;
 976	}
 977
 978	return 0;
 979}
 980
 981static int simple_release(struct dvb_frontend *fe)
 982{
 983	struct tuner_simple_priv *priv = fe->tuner_priv;
 984
 985	mutex_lock(&tuner_simple_list_mutex);
 986
 987	if (priv)
 988		hybrid_tuner_release_state(priv);
 989
 990	mutex_unlock(&tuner_simple_list_mutex);
 991
 992	fe->tuner_priv = NULL;
 993
 994	return 0;
 995}
 996
 997static int simple_get_frequency(struct dvb_frontend *fe, u32 *frequency)
 998{
 999	struct tuner_simple_priv *priv = fe->tuner_priv;
1000	*frequency = priv->frequency;
1001	return 0;
1002}
1003
1004static int simple_get_bandwidth(struct dvb_frontend *fe, u32 *bandwidth)
1005{
1006	struct tuner_simple_priv *priv = fe->tuner_priv;
1007	*bandwidth = priv->bandwidth;
1008	return 0;
1009}
1010
1011static struct dvb_tuner_ops simple_tuner_ops = {
1012	.init              = simple_init,
1013	.sleep             = simple_sleep,
1014	.set_analog_params = simple_set_params,
1015	.set_params        = simple_dvb_set_params,
1016	.calc_regs         = simple_dvb_calc_regs,
1017	.release           = simple_release,
1018	.get_frequency     = simple_get_frequency,
1019	.get_bandwidth     = simple_get_bandwidth,
1020	.get_status        = simple_get_status,
1021	.get_rf_strength   = simple_get_rf_strength,
1022};
1023
1024struct dvb_frontend *simple_tuner_attach(struct dvb_frontend *fe,
1025					 struct i2c_adapter *i2c_adap,
1026					 u8 i2c_addr,
1027					 unsigned int type)
1028{
1029	struct tuner_simple_priv *priv = NULL;
1030	int instance;
1031
1032	if (type >= tuner_count) {
1033		printk(KERN_WARNING "%s: invalid tuner type: %d (max: %d)\n",
1034		       __func__, type, tuner_count-1);
1035		return NULL;
1036	}
1037
1038	/* If i2c_adap is set, check that the tuner is at the correct address.
1039	 * Otherwise, if i2c_adap is NULL, the tuner will be programmed directly
1040	 * by the digital demod via calc_regs.
1041	 */
1042	if (i2c_adap != NULL) {
1043		u8 b[1];
1044		struct i2c_msg msg = {
1045			.addr = i2c_addr, .flags = I2C_M_RD,
1046			.buf = b, .len = 1,
1047		};
1048
1049		if (fe->ops.i2c_gate_ctrl)
1050			fe->ops.i2c_gate_ctrl(fe, 1);
1051
1052		if (1 != i2c_transfer(i2c_adap, &msg, 1))
1053			printk(KERN_WARNING "tuner-simple %d-%04x: "
1054			       "unable to probe %s, proceeding anyway.",
1055			       i2c_adapter_id(i2c_adap), i2c_addr,
1056			       tuners[type].name);
1057
1058		if (fe->ops.i2c_gate_ctrl)
1059			fe->ops.i2c_gate_ctrl(fe, 0);
1060	}
1061
1062	mutex_lock(&tuner_simple_list_mutex);
1063
1064	instance = hybrid_tuner_request_state(struct tuner_simple_priv, priv,
1065					      hybrid_tuner_instance_list,
1066					      i2c_adap, i2c_addr,
1067					      "tuner-simple");
1068	switch (instance) {
1069	case 0:
1070		mutex_unlock(&tuner_simple_list_mutex);
1071		return NULL;
1072	case 1:
1073		fe->tuner_priv = priv;
1074
1075		priv->type = type;
1076		priv->tun  = &tuners[type];
1077		priv->nr   = simple_devcount++;
1078		break;
1079	default:
1080		fe->tuner_priv = priv;
1081		break;
1082	}
1083
1084	mutex_unlock(&tuner_simple_list_mutex);
1085
1086	memcpy(&fe->ops.tuner_ops, &simple_tuner_ops,
1087	       sizeof(struct dvb_tuner_ops));
1088
1089	if (type != priv->type)
1090		tuner_warn("couldn't set type to %d. Using %d (%s) instead\n",
1091			    type, priv->type, priv->tun->name);
1092	else
1093		tuner_info("type set to %d (%s)\n",
1094			   priv->type, priv->tun->name);
1095
1096	if ((debug) || ((atv_input[priv->nr] > 0) ||
1097			(dtv_input[priv->nr] > 0))) {
1098		if (0 == atv_input[priv->nr])
1099			tuner_info("tuner %d atv rf input will be "
1100				   "autoselected\n", priv->nr);
1101		else
1102			tuner_info("tuner %d atv rf input will be "
1103				   "set to input %d (insmod option)\n",
1104				   priv->nr, atv_input[priv->nr]);
1105		if (0 == dtv_input[priv->nr])
1106			tuner_info("tuner %d dtv rf input will be "
1107				   "autoselected\n", priv->nr);
1108		else
1109			tuner_info("tuner %d dtv rf input will be "
1110				   "set to input %d (insmod option)\n",
1111				   priv->nr, dtv_input[priv->nr]);
1112	}
1113
1114	strlcpy(fe->ops.tuner_ops.info.name, priv->tun->name,
1115		sizeof(fe->ops.tuner_ops.info.name));
1116
1117	return fe;
1118}
1119EXPORT_SYMBOL_GPL(simple_tuner_attach);
1120
1121MODULE_DESCRIPTION("Simple 4-control-bytes style tuner driver");
1122MODULE_AUTHOR("Ralph Metzler, Gerd Knorr, Gunther Mayer");
1123MODULE_LICENSE("GPL");
1124
1125/*
1126 * Overrides for Emacs so that we follow Linus's tabbing style.
1127 * ---------------------------------------------------------------------------
1128 * Local variables:
1129 * c-basic-offset: 8
1130 * End:
1131 */