|
@@ -83,88 +83,71 @@ static int tda8261_get_status(struct dvb_frontend *fe, u32 *status)
|
|
|
static const u32 div_tab[] = { 2000, 1000, 500, 250, 125 }; /* kHz */
|
|
|
static const u8 ref_div[] = { 0x00, 0x01, 0x02, 0x05, 0x07 };
|
|
|
|
|
|
-static int tda8261_get_state(struct dvb_frontend *fe,
|
|
|
- enum tuner_param param,
|
|
|
- struct tuner_state *tstate)
|
|
|
+static int tda8261_get_frequency(struct dvb_frontend *fe, u32 *frequency)
|
|
|
{
|
|
|
struct tda8261_state *state = fe->tuner_priv;
|
|
|
- int err = 0;
|
|
|
|
|
|
- switch (param) {
|
|
|
- case DVBFE_TUNER_FREQUENCY:
|
|
|
- tstate->frequency = state->frequency;
|
|
|
- break;
|
|
|
- case DVBFE_TUNER_BANDWIDTH:
|
|
|
- tstate->bandwidth = 40000000; /* FIXME! need to calculate Bandwidth */
|
|
|
- break;
|
|
|
- default:
|
|
|
- pr_err("%s: Unknown parameter (param=%d)\n", __func__, param);
|
|
|
- err = -EINVAL;
|
|
|
- break;
|
|
|
- }
|
|
|
+ *frequency = state->frequency;
|
|
|
|
|
|
- return err;
|
|
|
+ return 0;
|
|
|
}
|
|
|
|
|
|
-static int tda8261_set_state(struct dvb_frontend *fe,
|
|
|
- enum tuner_param param,
|
|
|
- struct tuner_state *tstate)
|
|
|
+static int tda8261_set_params(struct dvb_frontend *fe)
|
|
|
{
|
|
|
+ struct dtv_frontend_properties *c = &fe->dtv_property_cache;
|
|
|
struct tda8261_state *state = fe->tuner_priv;
|
|
|
const struct tda8261_config *config = state->config;
|
|
|
u32 frequency, N, status = 0;
|
|
|
u8 buf[4];
|
|
|
int err = 0;
|
|
|
|
|
|
- if (param & DVBFE_TUNER_FREQUENCY) {
|
|
|
- /**
|
|
|
- * N = Max VCO Frequency / Channel Spacing
|
|
|
- * Max VCO Frequency = VCO frequency + (channel spacing - 1)
|
|
|
- * (to account for half channel spacing on either side)
|
|
|
- */
|
|
|
- frequency = tstate->frequency;
|
|
|
- if ((frequency < 950000) || (frequency > 2150000)) {
|
|
|
- pr_warn("%s: Frequency beyond limits, frequency=%d\n", __func__, frequency);
|
|
|
- return -EINVAL;
|
|
|
- }
|
|
|
- N = (frequency + (div_tab[config->step_size] - 1)) / div_tab[config->step_size];
|
|
|
- pr_debug("%s: Step size=%d, Divider=%d, PG=0x%02x (%d)\n",
|
|
|
- __func__, config->step_size, div_tab[config->step_size], N, N);
|
|
|
-
|
|
|
- buf[0] = (N >> 8) & 0xff;
|
|
|
- buf[1] = N & 0xff;
|
|
|
- buf[2] = (0x01 << 7) | ((ref_div[config->step_size] & 0x07) << 1);
|
|
|
-
|
|
|
- if (frequency < 1450000)
|
|
|
- buf[3] = 0x00;
|
|
|
- else if (frequency < 2000000)
|
|
|
- buf[3] = 0x40;
|
|
|
- else if (frequency < 2150000)
|
|
|
- buf[3] = 0x80;
|
|
|
-
|
|
|
- /* Set params */
|
|
|
- if ((err = tda8261_write(state, buf)) < 0) {
|
|
|
- pr_err("%s: I/O Error\n", __func__);
|
|
|
- return err;
|
|
|
- }
|
|
|
- /* sleep for some time */
|
|
|
- pr_debug("%s: Waiting to Phase LOCK\n", __func__);
|
|
|
- msleep(20);
|
|
|
- /* check status */
|
|
|
- if ((err = tda8261_get_status(fe, &status)) < 0) {
|
|
|
- pr_err("%s: I/O Error\n", __func__);
|
|
|
- return err;
|
|
|
- }
|
|
|
- if (status == 1) {
|
|
|
- pr_debug("%s: Tuner Phase locked: status=%d\n", __func__, status);
|
|
|
- state->frequency = frequency; /* cache successful state */
|
|
|
- } else {
|
|
|
- pr_debug("%s: No Phase lock: status=%d\n", __func__, status);
|
|
|
- }
|
|
|
- } else {
|
|
|
- pr_err("%s: Unknown parameter (param=%d)\n", __func__, param);
|
|
|
+ /*
|
|
|
+ * N = Max VCO Frequency / Channel Spacing
|
|
|
+ * Max VCO Frequency = VCO frequency + (channel spacing - 1)
|
|
|
+ * (to account for half channel spacing on either side)
|
|
|
+ */
|
|
|
+ frequency = c->frequency;
|
|
|
+ if ((frequency < 950000) || (frequency > 2150000)) {
|
|
|
+ pr_warn("%s: Frequency beyond limits, frequency=%d\n",
|
|
|
+ __func__, frequency);
|
|
|
return -EINVAL;
|
|
|
}
|
|
|
+ N = (frequency + (div_tab[config->step_size] - 1)) / div_tab[config->step_size];
|
|
|
+ pr_debug("%s: Step size=%d, Divider=%d, PG=0x%02x (%d)\n",
|
|
|
+ __func__, config->step_size, div_tab[config->step_size], N, N);
|
|
|
+
|
|
|
+ buf[0] = (N >> 8) & 0xff;
|
|
|
+ buf[1] = N & 0xff;
|
|
|
+ buf[2] = (0x01 << 7) | ((ref_div[config->step_size] & 0x07) << 1);
|
|
|
+
|
|
|
+ if (frequency < 1450000)
|
|
|
+ buf[3] = 0x00;
|
|
|
+ else if (frequency < 2000000)
|
|
|
+ buf[3] = 0x40;
|
|
|
+ else if (frequency < 2150000)
|
|
|
+ buf[3] = 0x80;
|
|
|
+
|
|
|
+ /* Set params */
|
|
|
+ err = tda8261_write(state, buf);
|
|
|
+ if (err < 0) {
|
|
|
+ pr_err("%s: I/O Error\n", __func__);
|
|
|
+ return err;
|
|
|
+ }
|
|
|
+ /* sleep for some time */
|
|
|
+ pr_debug("%s: Waiting to Phase LOCK\n", __func__);
|
|
|
+ msleep(20);
|
|
|
+ /* check status */
|
|
|
+ if ((err = tda8261_get_status(fe, &status)) < 0) {
|
|
|
+ pr_err("%s: I/O Error\n", __func__);
|
|
|
+ return err;
|
|
|
+ }
|
|
|
+ if (status == 1) {
|
|
|
+ pr_debug("%s: Tuner Phase locked: status=%d\n", __func__,
|
|
|
+ status);
|
|
|
+ state->frequency = frequency; /* cache successful state */
|
|
|
+ } else {
|
|
|
+ pr_debug("%s: No Phase lock: status=%d\n", __func__, status);
|
|
|
+ }
|
|
|
|
|
|
return 0;
|
|
|
}
|
|
@@ -182,14 +165,13 @@ static struct dvb_tuner_ops tda8261_ops = {
|
|
|
|
|
|
.info = {
|
|
|
.name = "TDA8261",
|
|
|
-// .tuner_name = NULL,
|
|
|
.frequency_min = 950000,
|
|
|
.frequency_max = 2150000,
|
|
|
.frequency_step = 0
|
|
|
},
|
|
|
|
|
|
- .set_state = tda8261_set_state,
|
|
|
- .get_state = tda8261_get_state,
|
|
|
+ .set_params = tda8261_set_params,
|
|
|
+ .get_frequency = tda8261_get_frequency,
|
|
|
.get_status = tda8261_get_status,
|
|
|
.release = tda8261_release
|
|
|
};
|
|
@@ -210,10 +192,7 @@ struct dvb_frontend *tda8261_attach(struct dvb_frontend *fe,
|
|
|
fe->ops.tuner_ops = tda8261_ops;
|
|
|
|
|
|
fe->ops.tuner_ops.info.frequency_step = div_tab[config->step_size];
|
|
|
-// fe->ops.tuner_ops.tuner_name = &config->buf;
|
|
|
|
|
|
-// printk("%s: Attaching %s TDA8261 8PSK/QPSK tuner\n",
|
|
|
-// __func__, fe->ops.tuner_ops.tuner_name);
|
|
|
pr_info("%s: Attaching TDA8261 8PSK/QPSK tuner\n", __func__);
|
|
|
|
|
|
return fe;
|