Skip to content

K
Kernel

openeuler / Kernel
1 年多 前同步成功

通知 8
Star 0
Fork 0
K
Kernel
提交 c7a9f3aa 编写于 作者: M Michael Krufky 提交者： Mauro Carvalho Chehab
浏览文件
操作

V4L/DVB (7129): tuner-simple: move device-specific code into three separate functions 

Move the switch..case blocks with device-specific code from functions
simple_set_tv_freq and simple_set_radio_freq

...into three new functions:
simple_std_setup, simple_post_tune and simple_radio_bandswitch
Signed-off-by: NMichael Krufky <mkrufky@linuxtv.org>
Signed-off-by: NMauro Carvalho Chehab <mchehab@infradead.org>
上级 b65aa260
隐藏空白更改
内联 并排
Showing with 184 addition and 147 deletion
drivers/media/video/tuner-simple.c
浏览文件 @ c7a9f3aa
...@@ -251,59 +251,13 @@ static int simple_config_lookup(struct dvb_frontend *fe, ...@@ -251,59 +251,13 @@ static int simple_config_lookup(struct dvb_frontend *fe,
/* ---------------------------------------------------------------------- */ /* ---------------------------------------------------------------------- */
static int simple_set_tv_freq(struct dvb_frontend *fe, static int simple_std_setup(struct dvb_frontend *fe,
struct analog_parameters *params) struct analog_parameters *params,
u8 *buffer, u8 *config, u8 *cb)
{ {
struct tuner_simple_priv *priv = fe->tuner_priv; struct tuner_simple_priv *priv = fe->tuner_priv;
u8 config, cb, tuneraddr; u8 tuneraddr;
u16 div; int rc;
struct tunertype *tun;
u8 buffer[4];
int rc, IFPCoff, i;
enum param_type desired_type;
struct tuner_params *t_params;
tun = priv->tun;
/* IFPCoff = Video Intermediate Frequency - Vif:
940 =16*58.75 NTSC/J (Japan)
732 =16*45.75 M/N STD
704 =16*44 ATSC (at DVB code)
632 =16*39.50 I U.K.
622.4=16*38.90 B/G D/K I, L STD
592 =16*37.00 D China
590 =16.36.875 B Australia
543.2=16*33.95 L' STD
171.2=16*10.70 FM Radio (at set_radio_freq)
*/
if (params->std == V4L2_STD_NTSC_M_JP) {
IFPCoff = 940;
desired_type = TUNER_PARAM_TYPE_NTSC;
} else if ((params->std & V4L2_STD_MN) &&
!(params->std & ~V4L2_STD_MN)) {
IFPCoff = 732;
desired_type = TUNER_PARAM_TYPE_NTSC;
} else if (params->std == V4L2_STD_SECAM_LC) {
IFPCoff = 543;
desired_type = TUNER_PARAM_TYPE_SECAM;
} else {
IFPCoff = 623;
desired_type = TUNER_PARAM_TYPE_PAL;
}
t_params = simple_tuner_params(fe, desired_type);
i = simple_config_lookup(fe, t_params, &params->frequency,
&config, &cb);
div = params->frequency + IFPCoff + offset;
tuner_dbg("Freq= %d.%02d MHz, V_IF=%d.%02d MHz, "
"Offset=%d.%02d MHz, div=%0d\n",
params->frequency / 16, params->frequency % 16 * 100 / 16,
IFPCoff / 16, IFPCoff % 16 * 100 / 16,
offset / 16, offset % 16 * 100 / 16, div);
/* tv norm specific stuff for multi-norm tuners */ /* tv norm specific stuff for multi-norm tuners */
switch (priv->type) { switch (priv->type) {
...@@ -311,45 +265,45 @@ static int simple_set_tv_freq(struct dvb_frontend *fe, ...@@ -311,45 +265,45 @@ static int simple_set_tv_freq(struct dvb_frontend *fe,
/* 0x01 -> ??? no change ??? */ /* 0x01 -> ??? no change ??? */
/* 0x02 -> PAL BDGHI / SECAM L */ /* 0x02 -> PAL BDGHI / SECAM L */
/* 0x04 -> ??? PAL others / SECAM others ??? */ /* 0x04 -> ??? PAL others / SECAM others ??? */
cb &= ~0x03; *cb &= ~0x03;
if (params->std & V4L2_STD_SECAM_L) if (params->std & V4L2_STD_SECAM_L)
/* also valid for V4L2_STD_SECAM */ /* also valid for V4L2_STD_SECAM */
cb |= PHILIPS_MF_SET_STD_L; *cb |= PHILIPS_MF_SET_STD_L;
else if (params->std & V4L2_STD_SECAM_LC) else if (params->std & V4L2_STD_SECAM_LC)
cb |= PHILIPS_MF_SET_STD_LC; *cb |= PHILIPS_MF_SET_STD_LC;
else /* V4L2_STD_B|V4L2_STD_GH */ else /* V4L2_STD_B|V4L2_STD_GH */
cb |= PHILIPS_MF_SET_STD_BG; *cb |= PHILIPS_MF_SET_STD_BG;
break; break;
case TUNER_TEMIC_4046FM5: case TUNER_TEMIC_4046FM5:
cb &= ~0x0f; *cb &= ~0x0f;
if (params->std & V4L2_STD_PAL_BG) { if (params->std & V4L2_STD_PAL_BG) {
cb |= TEMIC_SET_PAL_BG; *cb |= TEMIC_SET_PAL_BG;
} else if (params->std & V4L2_STD_PAL_I) { } else if (params->std & V4L2_STD_PAL_I) {
cb |= TEMIC_SET_PAL_I; *cb |= TEMIC_SET_PAL_I;
} else if (params->std & V4L2_STD_PAL_DK) { } else if (params->std & V4L2_STD_PAL_DK) {
cb |= TEMIC_SET_PAL_DK; *cb |= TEMIC_SET_PAL_DK;
} else if (params->std & V4L2_STD_SECAM_L) { } else if (params->std & V4L2_STD_SECAM_L) {
cb |= TEMIC_SET_PAL_L; *cb |= TEMIC_SET_PAL_L;
} }
break; break;
case TUNER_PHILIPS_FQ1216ME: case TUNER_PHILIPS_FQ1216ME:
cb &= ~0x0f; *cb &= ~0x0f;
if (params->std & (V4L2_STD_PAL_BG|V4L2_STD_PAL_DK)) { if (params->std & (V4L2_STD_PAL_BG|V4L2_STD_PAL_DK)) {
cb |= PHILIPS_SET_PAL_BGDK; *cb |= PHILIPS_SET_PAL_BGDK;
} else if (params->std & V4L2_STD_PAL_I) { } else if (params->std & V4L2_STD_PAL_I) {
cb |= PHILIPS_SET_PAL_I; *cb |= PHILIPS_SET_PAL_I;
} else if (params->std & V4L2_STD_SECAM_L) { } else if (params->std & V4L2_STD_SECAM_L) {
cb |= PHILIPS_SET_PAL_L; *cb |= PHILIPS_SET_PAL_L;
} }
break; break;
...@@ -359,15 +313,15 @@ static int simple_set_tv_freq(struct dvb_frontend *fe, ...@@ -359,15 +313,15 @@ static int simple_set_tv_freq(struct dvb_frontend *fe,
/* 0x01 -> ATSC antenna input 2 */ /* 0x01 -> ATSC antenna input 2 */
/* 0x02 -> NTSC antenna input 1 */ /* 0x02 -> NTSC antenna input 1 */
/* 0x03 -> NTSC antenna input 2 */ /* 0x03 -> NTSC antenna input 2 */
cb &= ~0x03; *cb &= ~0x03;
if (!(params->std & V4L2_STD_ATSC)) if (!(params->std & V4L2_STD_ATSC))
cb |= 2; *cb |= 2;
/* FIXME: input */ /* FIXME: input */
break; break;
case TUNER_MICROTUNE_4042FI5: case TUNER_MICROTUNE_4042FI5:
/* Set the charge pump for fast tuning */ /* Set the charge pump for fast tuning */
config |= TUNER_CHARGE_PUMP; *config |= TUNER_CHARGE_PUMP;
break; break;
case TUNER_PHILIPS_TUV1236D: case TUNER_PHILIPS_TUV1236D:
...@@ -379,9 +333,9 @@ static int simple_set_tv_freq(struct dvb_frontend *fe, ...@@ -379,9 +333,9 @@ static int simple_set_tv_freq(struct dvb_frontend *fe,
buffer[1] = 0x00; buffer[1] = 0x00;
buffer[2] = 0x17; buffer[2] = 0x17;
buffer[3] = 0x00; buffer[3] = 0x00;
cb &= ~0x40; *cb &= ~0x40;
if (params->std & V4L2_STD_ATSC) { if (params->std & V4L2_STD_ATSC) {
cb |= 0x40; *cb |= 0x40;
buffer[1] = 0x04; buffer[1] = 0x04;
} }
/* set to the correct mode (analog or digital) */ /* set to the correct mode (analog or digital) */
...@@ -400,6 +354,165 @@ static int simple_set_tv_freq(struct dvb_frontend *fe, ...@@ -400,6 +354,165 @@ static int simple_set_tv_freq(struct dvb_frontend *fe,
break; break;
} }
return 0;
}
static int simple_post_tune(struct dvb_frontend *fe, u8 *buffer,
u16 div, u8 config, u8 cb)
{
struct tuner_simple_priv *priv = fe->tuner_priv;
int rc;
switch (priv->type) {
case TUNER_LG_TDVS_H06XF:
/* Set the Auxiliary Byte. */
buffer[0] = buffer[2];
buffer[0] &= ~0x20;
buffer[0] |= 0x18;
buffer[1] = 0x20;
tuner_dbg("tv 0x%02x 0x%02x\n", buffer[0], buffer[1]);
rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 2);
if (2 != rc)
tuner_warn("i2c i/o error: rc == %d "
"(should be 2)\n", rc);
break;
case TUNER_MICROTUNE_4042FI5:
{
/* FIXME - this may also work for other tuners */
unsigned long timeout = jiffies + msecs_to_jiffies(1);
u8 status_byte = 0;
/* Wait until the PLL locks */
for (;;) {
if (time_after(jiffies, timeout))
return 0;
rc = tuner_i2c_xfer_recv(&priv->i2c_props,
&status_byte, 1);
if (1 != rc) {
tuner_warn("i2c i/o read error: rc == %d "
"(should be 1)\n", rc);
break;
}
if (status_byte & TUNER_PLL_LOCKED)
break;
udelay(10);
}
/* Set the charge pump for optimized phase noise figure */
config &= ~TUNER_CHARGE_PUMP;
buffer[0] = (div>>8) & 0x7f;
buffer[1] = div & 0xff;
buffer[2] = config;
buffer[3] = cb;
tuner_dbg("tv 0x%02x 0x%02x 0x%02x 0x%02x\n",
buffer[0], buffer[1], buffer[2], buffer[3]);
rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
if (4 != rc)
tuner_warn("i2c i/o error: rc == %d "
"(should be 4)\n", rc);
break;
}
}
return 0;
}
static int simple_radio_bandswitch(struct dvb_frontend *fe, u8 *buffer)
{
struct tuner_simple_priv *priv = fe->tuner_priv;
switch (priv->type) {
case TUNER_TENA_9533_DI:
case TUNER_YMEC_TVF_5533MF:
tuner_dbg("This tuner doesn't have FM. "
"Most cards have a TEA5767 for FM\n");
return 0;
case TUNER_PHILIPS_FM1216ME_MK3:
case TUNER_PHILIPS_FM1236_MK3:
case TUNER_PHILIPS_FMD1216ME_MK3:
case TUNER_LG_NTSC_TAPE:
case TUNER_PHILIPS_FM1256_IH3:
buffer[3] = 0x19;
break;
case TUNER_TNF_5335MF:
buffer[3] = 0x11;
break;
case TUNER_LG_PAL_FM:
buffer[3] = 0xa5;
break;
case TUNER_THOMSON_DTT761X:
buffer[3] = 0x39;
break;
case TUNER_MICROTUNE_4049FM5:
default:
buffer[3] = 0xa4;
break;
}
return 0;
}
/* ---------------------------------------------------------------------- */
static int simple_set_tv_freq(struct dvb_frontend *fe,
struct analog_parameters *params)
{
struct tuner_simple_priv *priv = fe->tuner_priv;
u8 config, cb;
u16 div;
struct tunertype *tun;
u8 buffer[4];
int rc, IFPCoff, i;
enum param_type desired_type;
struct tuner_params *t_params;
tun = priv->tun;
/* IFPCoff = Video Intermediate Frequency - Vif:
940 =16*58.75 NTSC/J (Japan)
732 =16*45.75 M/N STD
704 =16*44 ATSC (at DVB code)
632 =16*39.50 I U.K.
622.4=16*38.90 B/G D/K I, L STD
592 =16*37.00 D China
590 =16.36.875 B Australia
543.2=16*33.95 L' STD
171.2=16*10.70 FM Radio (at set_radio_freq)
*/
if (params->std == V4L2_STD_NTSC_M_JP) {
IFPCoff = 940;
desired_type = TUNER_PARAM_TYPE_NTSC;
} else if ((params->std & V4L2_STD_MN) &&
!(params->std & ~V4L2_STD_MN)) {
IFPCoff = 732;
desired_type = TUNER_PARAM_TYPE_NTSC;
} else if (params->std == V4L2_STD_SECAM_LC) {
IFPCoff = 543;
desired_type = TUNER_PARAM_TYPE_SECAM;
} else {
IFPCoff = 623;
desired_type = TUNER_PARAM_TYPE_PAL;
}
t_params = simple_tuner_params(fe, desired_type);
i = simple_config_lookup(fe, t_params, &params->frequency,
&config, &cb);
div = params->frequency + IFPCoff + offset;
tuner_dbg("Freq= %d.%02d MHz, V_IF=%d.%02d MHz, "
"Offset=%d.%02d MHz, div=%0d\n",
params->frequency / 16, params->frequency % 16 * 100 / 16,
IFPCoff / 16, IFPCoff % 16 * 100 / 16,
offset / 16, offset % 16 * 100 / 16, div);
/* tv norm specific stuff for multi-norm tuners */
simple_std_setup(fe, params, &buffer[1], &config, &cb);
if (t_params->cb_first_if_lower_freq && div < priv->last_div) { if (t_params->cb_first_if_lower_freq && div < priv->last_div) {
buffer[0] = config; buffer[0] = config;
buffer[1] = cb; buffer[1] = cb;
...@@ -463,58 +576,8 @@ static int simple_set_tv_freq(struct dvb_frontend *fe, ...@@ -463,58 +576,8 @@ static int simple_set_tv_freq(struct dvb_frontend *fe,
if (4 != rc) if (4 != rc)
tuner_warn("i2c i/o error: rc == %d (should be 4)\n", rc); tuner_warn("i2c i/o error: rc == %d (should be 4)\n", rc);
switch (priv->type) { simple_post_tune(fe, &buffer[0], div, config, cb);
case TUNER_LG_TDVS_H06XF:
/* Set the Auxiliary Byte. */
buffer[0] = buffer[2];
buffer[0] &= ~0x20;
buffer[0] |= 0x18;
buffer[1] = 0x20;
tuner_dbg("tv 0x%02x 0x%02x\n", buffer[0], buffer[1]);
rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 2);
if (2 != rc)
tuner_warn("i2c i/o error: rc == %d "
"(should be 2)\n", rc);
break;
case TUNER_MICROTUNE_4042FI5:
{
/* FIXME - this may also work for other tuners */
unsigned long timeout = jiffies + msecs_to_jiffies(1);
u8 status_byte = 0;
/* Wait until the PLL locks */
for (;;) {
if (time_after(jiffies, timeout))
return 0;
rc = tuner_i2c_xfer_recv(&priv->i2c_props,
&status_byte, 1);
if (1 != rc) {
tuner_warn("i2c i/o read error: rc == %d "
"(should be 1)\n", rc);
break;
}
if (status_byte & TUNER_PLL_LOCKED)
break;
udelay(10);
}
/* Set the charge pump for optimized phase noise figure */
config &= ~TUNER_CHARGE_PUMP;
buffer[0] = (div>>8) & 0x7f;
buffer[1] = div & 0xff;
buffer[2] = config;
buffer[3] = cb;
tuner_dbg("tv 0x%02x 0x%02x 0x%02x 0x%02x\n",
buffer[0], buffer[1], buffer[2], buffer[3]);
rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
if (4 != rc)
tuner_warn("i2c i/o error: rc == %d "
"(should be 4)\n", rc);
break;
}
}
return 0; return 0;
} }
...@@ -555,33 +618,7 @@ static int simple_set_radio_freq(struct dvb_frontend *fe, ...@@ -555,33 +618,7 @@ static int simple_set_radio_freq(struct dvb_frontend *fe,
} }
/* Bandswitch byte */ /* Bandswitch byte */
switch (priv->type) { simple_radio_bandswitch(fe, &buffer[0]);
case TUNER_TENA_9533_DI:
case TUNER_YMEC_TVF_5533MF:
tuner_dbg("This tuner doesn't have FM. "
"Most cards have a TEA5767 for FM\n");
return 0;
case TUNER_PHILIPS_FM1216ME_MK3:
case TUNER_PHILIPS_FM1236_MK3:
case TUNER_PHILIPS_FMD1216ME_MK3:
case TUNER_LG_NTSC_TAPE:
case TUNER_PHILIPS_FM1256_IH3:
buffer[3] = 0x19;
break;
case TUNER_TNF_5335MF:
buffer[3] = 0x11;
break;
case TUNER_LG_PAL_FM:
buffer[3] = 0xa5;
break;
case TUNER_THOMSON_DTT761X:
buffer[3] = 0x39;
break;
case TUNER_MICROTUNE_4049FM5:
default:
buffer[3] = 0xa4;
break;
}
buffer[2] = (t_params->ranges[0].config & ~TUNER_RATIO_MASK) | buffer[2] = (t_params->ranges[0].config & ~TUNER_RATIO_MASK) |
TUNER_RATIO_SELECT_50; /* 50 kHz step */ TUNER_RATIO_SELECT_50; /* 50 kHz step */
......
Markdown is supported
0% 或 .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑！
想要评论请 注册 或