cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

tuner-simple.c (29390B)


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