|
@@ -724,19 +724,15 @@ static inline int check_mode(struct tuner *t, enum v4l2_tuner_type mode)
|
|
|
}
|
|
|
|
|
|
/**
|
|
|
- * set_mode_freq - Switch tuner to other mode.
|
|
|
- * @client: struct i2c_client pointer
|
|
|
+ * set_mode - Switch tuner to other mode.
|
|
|
* @t: a pointer to the module's internal struct_tuner
|
|
|
* @mode: enum v4l2_type (radio or TV)
|
|
|
- * @freq: frequency to set (0 means to use the previous one)
|
|
|
*
|
|
|
* If tuner doesn't support the needed mode (radio or TV), prints a
|
|
|
* debug message and returns -EINVAL, changing its state to standby.
|
|
|
- * Otherwise, changes the state and sets frequency to the last value, if
|
|
|
- * the tuner can sleep or if it supports both Radio and TV.
|
|
|
+ * Otherwise, changes the mode and returns 0.
|
|
|
*/
|
|
|
-static int set_mode_freq(struct i2c_client *client, struct tuner *t,
|
|
|
- enum v4l2_tuner_type mode, unsigned int freq)
|
|
|
+static int set_mode(struct tuner *t, enum v4l2_tuner_type mode)
|
|
|
{
|
|
|
struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops;
|
|
|
|
|
@@ -752,17 +748,27 @@ static int set_mode_freq(struct i2c_client *client, struct tuner *t,
|
|
|
t->mode = mode;
|
|
|
tuner_dbg("Changing to mode %d\n", mode);
|
|
|
}
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * set_freq - Set the tuner to the desired frequency.
|
|
|
+ * @t: a pointer to the module's internal struct_tuner
|
|
|
+ * @freq: frequency to set (0 means to use the current frequency)
|
|
|
+ */
|
|
|
+static void set_freq(struct tuner *t, unsigned int freq)
|
|
|
+{
|
|
|
+ struct i2c_client *client = v4l2_get_subdevdata(&t->sd);
|
|
|
+
|
|
|
if (t->mode == V4L2_TUNER_RADIO) {
|
|
|
- if (freq)
|
|
|
- t->radio_freq = freq;
|
|
|
- set_radio_freq(client, t->radio_freq);
|
|
|
+ if (!freq)
|
|
|
+ freq = t->radio_freq;
|
|
|
+ set_radio_freq(client, freq);
|
|
|
} else {
|
|
|
- if (freq)
|
|
|
- t->tv_freq = freq;
|
|
|
- set_tv_freq(client, t->tv_freq);
|
|
|
+ if (!freq)
|
|
|
+ freq = t->tv_freq;
|
|
|
+ set_tv_freq(client, freq);
|
|
|
}
|
|
|
-
|
|
|
- return 0;
|
|
|
}
|
|
|
|
|
|
/*
|
|
@@ -817,7 +823,8 @@ static void set_tv_freq(struct i2c_client *c, unsigned int freq)
|
|
|
/**
|
|
|
* tuner_fixup_std - force a given video standard variant
|
|
|
*
|
|
|
- * @t: tuner internal struct
|
|
|
+ * @t: tuner internal struct
|
|
|
+ * @std: TV standard
|
|
|
*
|
|
|
* A few devices or drivers have problem to detect some standard variations.
|
|
|
* On other operational systems, the drivers generally have a per-country
|
|
@@ -827,57 +834,39 @@ static void set_tv_freq(struct i2c_client *c, unsigned int freq)
|
|
|
* to distinguish all video standard variations, a modprobe parameter can
|
|
|
* be used to force a video standard match.
|
|
|
*/
|
|
|
-static int tuner_fixup_std(struct tuner *t)
|
|
|
+static v4l2_std_id tuner_fixup_std(struct tuner *t, v4l2_std_id std)
|
|
|
{
|
|
|
- if ((t->std & V4L2_STD_PAL) == V4L2_STD_PAL) {
|
|
|
+ if (pal[0] != '-' && (std & V4L2_STD_PAL) == V4L2_STD_PAL) {
|
|
|
switch (pal[0]) {
|
|
|
case '6':
|
|
|
- tuner_dbg("insmod fixup: PAL => PAL-60\n");
|
|
|
- t->std = V4L2_STD_PAL_60;
|
|
|
- break;
|
|
|
+ return V4L2_STD_PAL_60;
|
|
|
case 'b':
|
|
|
case 'B':
|
|
|
case 'g':
|
|
|
case 'G':
|
|
|
- tuner_dbg("insmod fixup: PAL => PAL-BG\n");
|
|
|
- t->std = V4L2_STD_PAL_BG;
|
|
|
- break;
|
|
|
+ return V4L2_STD_PAL_BG;
|
|
|
case 'i':
|
|
|
case 'I':
|
|
|
- tuner_dbg("insmod fixup: PAL => PAL-I\n");
|
|
|
- t->std = V4L2_STD_PAL_I;
|
|
|
- break;
|
|
|
+ return V4L2_STD_PAL_I;
|
|
|
case 'd':
|
|
|
case 'D':
|
|
|
case 'k':
|
|
|
case 'K':
|
|
|
- tuner_dbg("insmod fixup: PAL => PAL-DK\n");
|
|
|
- t->std = V4L2_STD_PAL_DK;
|
|
|
- break;
|
|
|
+ return V4L2_STD_PAL_DK;
|
|
|
case 'M':
|
|
|
case 'm':
|
|
|
- tuner_dbg("insmod fixup: PAL => PAL-M\n");
|
|
|
- t->std = V4L2_STD_PAL_M;
|
|
|
- break;
|
|
|
+ return V4L2_STD_PAL_M;
|
|
|
case 'N':
|
|
|
case 'n':
|
|
|
- if (pal[1] == 'c' || pal[1] == 'C') {
|
|
|
- tuner_dbg("insmod fixup: PAL => PAL-Nc\n");
|
|
|
- t->std = V4L2_STD_PAL_Nc;
|
|
|
- } else {
|
|
|
- tuner_dbg("insmod fixup: PAL => PAL-N\n");
|
|
|
- t->std = V4L2_STD_PAL_N;
|
|
|
- }
|
|
|
- break;
|
|
|
- case '-':
|
|
|
- /* default parameter, do nothing */
|
|
|
- break;
|
|
|
+ if (pal[1] == 'c' || pal[1] == 'C')
|
|
|
+ return V4L2_STD_PAL_Nc;
|
|
|
+ return V4L2_STD_PAL_N;
|
|
|
default:
|
|
|
tuner_warn("pal= argument not recognised\n");
|
|
|
break;
|
|
|
}
|
|
|
}
|
|
|
- if ((t->std & V4L2_STD_SECAM) == V4L2_STD_SECAM) {
|
|
|
+ if (secam[0] != '-' && (std & V4L2_STD_SECAM) == V4L2_STD_SECAM) {
|
|
|
switch (secam[0]) {
|
|
|
case 'b':
|
|
|
case 'B':
|
|
@@ -885,63 +874,42 @@ static int tuner_fixup_std(struct tuner *t)
|
|
|
case 'G':
|
|
|
case 'h':
|
|
|
case 'H':
|
|
|
- tuner_dbg("insmod fixup: SECAM => SECAM-BGH\n");
|
|
|
- t->std = V4L2_STD_SECAM_B |
|
|
|
- V4L2_STD_SECAM_G |
|
|
|
- V4L2_STD_SECAM_H;
|
|
|
- break;
|
|
|
+ return V4L2_STD_SECAM_B |
|
|
|
+ V4L2_STD_SECAM_G |
|
|
|
+ V4L2_STD_SECAM_H;
|
|
|
case 'd':
|
|
|
case 'D':
|
|
|
case 'k':
|
|
|
case 'K':
|
|
|
- tuner_dbg("insmod fixup: SECAM => SECAM-DK\n");
|
|
|
- t->std = V4L2_STD_SECAM_DK;
|
|
|
- break;
|
|
|
+ return V4L2_STD_SECAM_DK;
|
|
|
case 'l':
|
|
|
case 'L':
|
|
|
- if ((secam[1] == 'C') || (secam[1] == 'c')) {
|
|
|
- tuner_dbg("insmod fixup: SECAM => SECAM-L'\n");
|
|
|
- t->std = V4L2_STD_SECAM_LC;
|
|
|
- } else {
|
|
|
- tuner_dbg("insmod fixup: SECAM => SECAM-L\n");
|
|
|
- t->std = V4L2_STD_SECAM_L;
|
|
|
- }
|
|
|
- break;
|
|
|
- case '-':
|
|
|
- /* default parameter, do nothing */
|
|
|
- break;
|
|
|
+ if ((secam[1] == 'C') || (secam[1] == 'c'))
|
|
|
+ return V4L2_STD_SECAM_LC;
|
|
|
+ return V4L2_STD_SECAM_L;
|
|
|
default:
|
|
|
tuner_warn("secam= argument not recognised\n");
|
|
|
break;
|
|
|
}
|
|
|
}
|
|
|
|
|
|
- if ((t->std & V4L2_STD_NTSC) == V4L2_STD_NTSC) {
|
|
|
+ if (ntsc[0] != '-' && (std & V4L2_STD_NTSC) == V4L2_STD_NTSC) {
|
|
|
switch (ntsc[0]) {
|
|
|
case 'm':
|
|
|
case 'M':
|
|
|
- tuner_dbg("insmod fixup: NTSC => NTSC-M\n");
|
|
|
- t->std = V4L2_STD_NTSC_M;
|
|
|
- break;
|
|
|
+ return V4L2_STD_NTSC_M;
|
|
|
case 'j':
|
|
|
case 'J':
|
|
|
- tuner_dbg("insmod fixup: NTSC => NTSC_M_JP\n");
|
|
|
- t->std = V4L2_STD_NTSC_M_JP;
|
|
|
- break;
|
|
|
+ return V4L2_STD_NTSC_M_JP;
|
|
|
case 'k':
|
|
|
case 'K':
|
|
|
- tuner_dbg("insmod fixup: NTSC => NTSC_M_KR\n");
|
|
|
- t->std = V4L2_STD_NTSC_M_KR;
|
|
|
- break;
|
|
|
- case '-':
|
|
|
- /* default parameter, do nothing */
|
|
|
- break;
|
|
|
+ return V4L2_STD_NTSC_M_KR;
|
|
|
default:
|
|
|
tuner_info("ntsc= argument not recognised\n");
|
|
|
break;
|
|
|
}
|
|
|
}
|
|
|
- return 0;
|
|
|
+ return std;
|
|
|
}
|
|
|
|
|
|
/*
|
|
@@ -1058,10 +1026,9 @@ static void tuner_status(struct dvb_frontend *fe)
|
|
|
static int tuner_s_radio(struct v4l2_subdev *sd)
|
|
|
{
|
|
|
struct tuner *t = to_tuner(sd);
|
|
|
- struct i2c_client *client = v4l2_get_subdevdata(sd);
|
|
|
|
|
|
- if (set_mode_freq(client, t, V4L2_TUNER_RADIO, 0) == -EINVAL)
|
|
|
- return 0;
|
|
|
+ if (set_mode(t, V4L2_TUNER_RADIO) == 0)
|
|
|
+ set_freq(t, 0);
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
@@ -1072,16 +1039,20 @@ static int tuner_s_radio(struct v4l2_subdev *sd)
|
|
|
/**
|
|
|
* tuner_s_power - controls the power state of the tuner
|
|
|
* @sd: pointer to struct v4l2_subdev
|
|
|
- * @on: a zero value puts the tuner to sleep
|
|
|
+ * @on: a zero value puts the tuner to sleep, non-zero wakes it up
|
|
|
*/
|
|
|
static int tuner_s_power(struct v4l2_subdev *sd, int on)
|
|
|
{
|
|
|
struct tuner *t = to_tuner(sd);
|
|
|
struct analog_demod_ops *analog_ops = &t->fe.ops.analog_ops;
|
|
|
|
|
|
- /* FIXME: Why this function don't wake the tuner if on != 0 ? */
|
|
|
- if (on)
|
|
|
+ if (on) {
|
|
|
+ if (t->standby && set_mode(t, t->mode) == 0) {
|
|
|
+ tuner_dbg("Waking up tuner\n");
|
|
|
+ set_freq(t, 0);
|
|
|
+ }
|
|
|
return 0;
|
|
|
+ }
|
|
|
|
|
|
tuner_dbg("Putting tuner to sleep\n");
|
|
|
t->standby = true;
|
|
@@ -1093,28 +1064,36 @@ static int tuner_s_power(struct v4l2_subdev *sd, int on)
|
|
|
static int tuner_s_std(struct v4l2_subdev *sd, v4l2_std_id std)
|
|
|
{
|
|
|
struct tuner *t = to_tuner(sd);
|
|
|
- struct i2c_client *client = v4l2_get_subdevdata(sd);
|
|
|
|
|
|
- if (set_mode_freq(client, t, V4L2_TUNER_ANALOG_TV, 0) == -EINVAL)
|
|
|
+ if (set_mode(t, V4L2_TUNER_ANALOG_TV))
|
|
|
return 0;
|
|
|
|
|
|
- t->std = std;
|
|
|
- tuner_fixup_std(t);
|
|
|
-
|
|
|
+ t->std = tuner_fixup_std(t, std);
|
|
|
+ if (t->std != std)
|
|
|
+ tuner_dbg("Fixup standard %llx to %llx\n", std, t->std);
|
|
|
+ set_freq(t, 0);
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
static int tuner_s_frequency(struct v4l2_subdev *sd, struct v4l2_frequency *f)
|
|
|
{
|
|
|
struct tuner *t = to_tuner(sd);
|
|
|
- struct i2c_client *client = v4l2_get_subdevdata(sd);
|
|
|
-
|
|
|
- if (set_mode_freq(client, t, f->type, f->frequency) == -EINVAL)
|
|
|
- return 0;
|
|
|
|
|
|
+ if (set_mode(t, f->type) == 0)
|
|
|
+ set_freq(t, f->frequency);
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
+/**
|
|
|
+ * tuner_g_frequency - Get the tuned frequency for the tuner
|
|
|
+ * @sd: pointer to struct v4l2_subdev
|
|
|
+ * @f: pointer to struct v4l2_frequency
|
|
|
+ *
|
|
|
+ * At return, the structure f will be filled with tuner frequency
|
|
|
+ * if the tuner matches the f->type.
|
|
|
+ * Note: f->type should be initialized before calling it.
|
|
|
+ * This is done by either video_ioctl2 or by the bridge driver.
|
|
|
+ */
|
|
|
static int tuner_g_frequency(struct v4l2_subdev *sd, struct v4l2_frequency *f)
|
|
|
{
|
|
|
struct tuner *t = to_tuner(sd);
|
|
@@ -1122,8 +1101,7 @@ static int tuner_g_frequency(struct v4l2_subdev *sd, struct v4l2_frequency *f)
|
|
|
|
|
|
if (check_mode(t, f->type) == -EINVAL)
|
|
|
return 0;
|
|
|
- f->type = t->mode;
|
|
|
- if (fe_tuner_ops->get_frequency && !t->standby) {
|
|
|
+ if (f->type == t->mode && fe_tuner_ops->get_frequency && !t->standby) {
|
|
|
u32 abs_freq;
|
|
|
|
|
|
fe_tuner_ops->get_frequency(&t->fe, &abs_freq);
|
|
@@ -1131,12 +1109,22 @@ static int tuner_g_frequency(struct v4l2_subdev *sd, struct v4l2_frequency *f)
|
|
|
DIV_ROUND_CLOSEST(abs_freq * 2, 125) :
|
|
|
DIV_ROUND_CLOSEST(abs_freq, 62500);
|
|
|
} else {
|
|
|
- f->frequency = (V4L2_TUNER_RADIO == t->mode) ?
|
|
|
+ f->frequency = (V4L2_TUNER_RADIO == f->type) ?
|
|
|
t->radio_freq : t->tv_freq;
|
|
|
}
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
+/**
|
|
|
+ * tuner_g_tuner - Fill in tuner information
|
|
|
+ * @sd: pointer to struct v4l2_subdev
|
|
|
+ * @vt: pointer to struct v4l2_tuner
|
|
|
+ *
|
|
|
+ * At return, the structure vt will be filled with tuner information
|
|
|
+ * if the tuner matches vt->type.
|
|
|
+ * Note: vt->type should be initialized before calling it.
|
|
|
+ * This is done by either video_ioctl2 or by the bridge driver.
|
|
|
+ */
|
|
|
static int tuner_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
|
|
|
{
|
|
|
struct tuner *t = to_tuner(sd);
|
|
@@ -1145,48 +1133,58 @@ static int tuner_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
|
|
|
|
|
|
if (check_mode(t, vt->type) == -EINVAL)
|
|
|
return 0;
|
|
|
- vt->type = t->mode;
|
|
|
- if (analog_ops->get_afc)
|
|
|
+ if (vt->type == t->mode && analog_ops->get_afc)
|
|
|
vt->afc = analog_ops->get_afc(&t->fe);
|
|
|
- if (t->mode == V4L2_TUNER_ANALOG_TV)
|
|
|
+ if (vt->type == V4L2_TUNER_ANALOG_TV)
|
|
|
vt->capability |= V4L2_TUNER_CAP_NORM;
|
|
|
- if (t->mode != V4L2_TUNER_RADIO) {
|
|
|
+ if (vt->type != V4L2_TUNER_RADIO) {
|
|
|
vt->rangelow = tv_range[0] * 16;
|
|
|
vt->rangehigh = tv_range[1] * 16;
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
/* radio mode */
|
|
|
- vt->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
|
|
|
- if (fe_tuner_ops->get_status) {
|
|
|
- u32 tuner_status;
|
|
|
-
|
|
|
- fe_tuner_ops->get_status(&t->fe, &tuner_status);
|
|
|
- vt->rxsubchans =
|
|
|
- (tuner_status & TUNER_STATUS_STEREO) ?
|
|
|
- V4L2_TUNER_SUB_STEREO :
|
|
|
- V4L2_TUNER_SUB_MONO;
|
|
|
+ if (vt->type == t->mode) {
|
|
|
+ vt->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
|
|
|
+ if (fe_tuner_ops->get_status) {
|
|
|
+ u32 tuner_status;
|
|
|
+
|
|
|
+ fe_tuner_ops->get_status(&t->fe, &tuner_status);
|
|
|
+ vt->rxsubchans =
|
|
|
+ (tuner_status & TUNER_STATUS_STEREO) ?
|
|
|
+ V4L2_TUNER_SUB_STEREO :
|
|
|
+ V4L2_TUNER_SUB_MONO;
|
|
|
+ }
|
|
|
+ if (analog_ops->has_signal)
|
|
|
+ vt->signal = analog_ops->has_signal(&t->fe);
|
|
|
+ vt->audmode = t->audmode;
|
|
|
}
|
|
|
- if (analog_ops->has_signal)
|
|
|
- vt->signal = analog_ops->has_signal(&t->fe);
|
|
|
vt->capability |= V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO;
|
|
|
- vt->audmode = t->audmode;
|
|
|
vt->rangelow = radio_range[0] * 16000;
|
|
|
vt->rangehigh = radio_range[1] * 16000;
|
|
|
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
+/**
|
|
|
+ * tuner_s_tuner - Set the tuner's audio mode
|
|
|
+ * @sd: pointer to struct v4l2_subdev
|
|
|
+ * @vt: pointer to struct v4l2_tuner
|
|
|
+ *
|
|
|
+ * Sets the audio mode if the tuner matches vt->type.
|
|
|
+ * Note: vt->type should be initialized before calling it.
|
|
|
+ * This is done by either video_ioctl2 or by the bridge driver.
|
|
|
+ */
|
|
|
static int tuner_s_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
|
|
|
{
|
|
|
struct tuner *t = to_tuner(sd);
|
|
|
- struct i2c_client *client = v4l2_get_subdevdata(sd);
|
|
|
|
|
|
- if (set_mode_freq(client, t, vt->type, 0) == -EINVAL)
|
|
|
+ if (set_mode(t, vt->type))
|
|
|
return 0;
|
|
|
|
|
|
if (t->mode == V4L2_TUNER_RADIO)
|
|
|
t->audmode = vt->audmode;
|
|
|
+ set_freq(t, 0);
|
|
|
|
|
|
return 0;
|
|
|
}
|
|
@@ -1221,7 +1219,8 @@ static int tuner_resume(struct i2c_client *c)
|
|
|
tuner_dbg("resume\n");
|
|
|
|
|
|
if (!t->standby)
|
|
|
- set_mode_freq(c, t, t->type, 0);
|
|
|
+ if (set_mode(t, t->mode) == 0)
|
|
|
+ set_freq(t, 0);
|
|
|
|
|
|
return 0;
|
|
|
}
|