Re: [PATCH 09/12] [media] tsin: c8sectpfe: Add support for various ST NIM cards.

Mauro Carvalho Chehab
2015-07-22T21:53:51Z

Em Wed, 24 Jun 2015 16:11:07 +0100
Peter Griffin <peter.griffin@linaro.org> escreveu:

> This patch adds support for the following 3 NIM cards: -
> 1) STV0367-NIM (stv0367 demod with Thompson PLL)
> 2) B2100A (2x stv0367 demods & 2x NXP tda18212 tuners)
> 3) STV0903-6110NIM (stv0903 demod + 6110 tuner, lnb24)
>
> Signed-off-by: Peter Griffin <peter.griffin@linaro.org>
> ---
> drivers/media/tsin/c8sectpfe/c8sectpfe-dvb.c | 296 +++++++++++++++++++++++++++
> drivers/media/tsin/c8sectpfe/c8sectpfe-dvb.h | 20 ++
> 2 files changed, 316 insertions(+)
> create mode 100644 drivers/media/tsin/c8sectpfe/c8sectpfe-dvb.c
> create mode 100644 drivers/media/tsin/c8sectpfe/c8sectpfe-dvb.h
>
> diff --git a/drivers/media/tsin/c8sectpfe/c8sectpfe-dvb.c b/drivers/media/tsin/c8sectpfe/c8sectpfe-dvb.c
> new file mode 100644
> index 0000000..5c4ecb4
> --- /dev/null
> +++ b/drivers/media/tsin/c8sectpfe/c8sectpfe-dvb.c
> @@ -0,0 +1,296 @@
> +/*
> + * c8sectpfe-dvb.c - C8SECTPFE STi DVB driver
> + *
> + * Copyright (c) STMicroelectronics 2015
> + *
> + * Author Peter Griffin <peter.griffin@linaro.org>
> + *
> + * This program is free software; you can redistribute it and/or modify
> + * it under the terms of the GNU General Public License as published by
> + * the Free Software Foundation; either version 2 of the License, or
> + * (at your option) any later version.
> + *
> + * This program is distributed in the hope that it will be useful,
> + * but WITHOUT ANY WARRANTY; without even the implied warranty of
> + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
> + *
> + * GNU General Public License for more details.
> + */
> +#include <linux/completion.h>
> +#include <linux/delay.h>
> +#include <linux/i2c.h>
> +#include <linux/interrupt.h>
> +#include <linux/version.h>
> +
> +#include <dt-bindings/media/c8sectpfe.h>
> +
> +#include "c8sectpfe-common.h"
> +#include "c8sectpfe-core.h"
> +#include "c8sectpfe-dvb.h"
> +
> +#include "dvb-pll.h"
> +#include "lnbh24.h"
> +#include "stv0367.h"
> +#include "stv0367_priv.h"
> +#include "stv6110x.h"
> +#include "stv090x.h"
> +#include "tda18212.h"
> +
> +static inline const char *dvb_card_str(unsigned int c)
> +{
> + switch (c) {
> + case STV0367_PLL_BOARD_NIMA: return "STV0367_PLL_BOARD_NIMA";
> + case STV0367_PLL_BOARD_NIMB: return "STV0367_PLL_BOARD_NIMB";
> + case STV0367_TDA18212_NIMA_1: return "STV0367_TDA18212_NIMA_1";
> + case STV0367_TDA18212_NIMA_2: return "STV0367_TDA18212_NIMA_2";
> + case STV0367_TDA18212_NIMB_1: return "STV0367_TDA18212_NIMB_1";
> + case STV0367_TDA18212_NIMB_2: return "STV0367_TDA18212_NIMB_2";
> + case STV0903_6110_LNB24_NIMA: return "STV0903_6110_LNB24_NIMA";
> + case STV0903_6110_LNB24_NIMB: return "STV0903_6110_LNB24_NIMB";
> + default: return "unknown dvb frontend card";
> + }
> +}
> +
> +static struct stv090x_config stv090x_config = {
> + .device = STV0903,
> + .demod_mode = STV090x_SINGLE,
> + .clk_mode = STV090x_CLK_EXT,
> + .xtal = 16000000,
> + .address = 0x69,
> +
> + .ts1_mode = STV090x_TSMODE_SERIAL_CONTINUOUS,
> + .ts2_mode = STV090x_TSMODE_SERIAL_CONTINUOUS,
> +
> + .repeater_level = STV090x_RPTLEVEL_64,
> +
> + .tuner_init = NULL,
> + .tuner_set_mode = NULL,
> + .tuner_set_frequency = NULL,
> + .tuner_get_frequency = NULL,
> + .tuner_set_bandwidth = NULL,
> + .tuner_get_bandwidth = NULL,
> + .tuner_set_bbgain = NULL,
> + .tuner_get_bbgain = NULL,
> + .tuner_set_refclk = NULL,
> + .tuner_get_status = NULL,
> +};
> +
> +static struct stv6110x_config stv6110x_config = {
> + .addr = 0x60,
> + .refclk = 16000000,
> +};
> +
> +#define NIMA 0
> +#define NIMB 1
> +
> +static struct stv0367_config stv0367_pll_config[] = {
> + {
> + .demod_address = 0x1c,
> + .xtal = 27000000,
> + .if_khz = 36166,
> + .if_iq_mode = FE_TER_NORMAL_IF_TUNER,
> + .ts_mode = STV0367_SERIAL_PUNCT_CLOCK,
> + .clk_pol = STV0367_CLOCKPOLARITY_DEFAULT,
> + }, {
> + .demod_address = 0x1d,
> + .xtal = 27000000,
> + .if_khz = 36166,
> + .if_iq_mode = FE_TER_NORMAL_IF_TUNER,
> + .ts_mode = STV0367_SERIAL_PUNCT_CLOCK,
> + .clk_pol = STV0367_CLOCKPOLARITY_DEFAULT,
> + },
> +};
> +
> +static struct stv0367_config stv0367_tda18212_config[] = {
> + {
> + .demod_address = 0x1c,
> + .xtal = 16000000,
> + .if_khz = 4500,
> + .if_iq_mode = FE_TER_NORMAL_IF_TUNER,
> + .ts_mode = STV0367_SERIAL_PUNCT_CLOCK,
> + .clk_pol = STV0367_CLOCKPOLARITY_DEFAULT,
> + }, {
> + .demod_address = 0x1d,
> + .xtal = 16000000,
> + .if_khz = 4500,
> + .if_iq_mode = FE_TER_NORMAL_IF_TUNER,
> + .ts_mode = STV0367_SERIAL_PUNCT_CLOCK,
> + .clk_pol = STV0367_CLOCKPOLARITY_DEFAULT,
> + }, {
> + .demod_address = 0x1e,
> + .xtal = 16000000,
> + .if_khz = 4500,
> + .if_iq_mode = FE_TER_NORMAL_IF_TUNER,
> + .ts_mode = STV0367_SERIAL_PUNCT_CLOCK,
> + .clk_pol = STV0367_CLOCKPOLARITY_DEFAULT,
> + },
> +};
> +
> +static struct tda18212_config tda18212_conf = {
> + .if_dvbt_6 = 4150,
> + .if_dvbt_7 = 4150,
> + .if_dvbt_8 = 4500,
> + .if_dvbc = 5000,
> +};
> +
> +int c8sectpfe_frontend_attach(struct dvb_frontend **fe,
> + struct c8sectpfe *c8sectpfe,
> + struct channel_info *tsin, int chan_num)
> +{
> + struct tda18212_config *tda18212;
> + struct stv6110x_devctl *fe2;
> + struct i2c_client *client;
> + struct i2c_board_info tda18212_info = {
> + .type = "tda18212",
> + .addr = 0x60,
> + };
> +
> + BUG_ON(!tsin);

Just return an error if !tsin.

> +
> + switch (tsin->dvb_card) {
> +
> + case STV0367_PLL_BOARD_NIMA:
> + case STV0367_PLL_BOARD_NIMB:
> + if (tsin->dvb_card == STV0367_PLL_BOARD_NIMA)
> + *fe = dvb_attach(stv0367ter_attach,
> + &stv0367_pll_config[NIMA], tsin->i2c_adapter);
> + else
> + *fe = dvb_attach(stv0367ter_attach,
> + &stv0367_pll_config[NIMB], tsin->i2c_adapter);
> +
> + if (!*fe) {
> + dev_err(c8sectpfe->device,
> + "%s: stv0367ter_attach failed for NIM card %s\n"
> + , __func__, dvb_card_str(tsin->dvb_card));
> + return -ENODEV;
> + };
> +
> + /*
> + * init the demod so that i2c gate_ctrl
> + * to the tuner works correctly
> + */
> + (*fe)->ops.init(*fe);
> +
> + if (!dvb_attach(dvb_pll_attach, *fe, 0x60,
> + tsin->i2c_adapter, DVB_PLL_THOMSON_DTT7546X)) {
> +
> + dev_err(c8sectpfe->device,
> + "%s: DVB_PLL_THOMSON_DTT7546X attach failed\n\t"
> + "for NIM card %s\n",
> + __func__, dvb_card_str(tsin->dvb_card));
> + return -ENODEV;
> + }
> + break;
> +
> + case STV0367_TDA18212_NIMA_1:
> + case STV0367_TDA18212_NIMA_2:
> + case STV0367_TDA18212_NIMB_1:
> + case STV0367_TDA18212_NIMB_2:
> + if (tsin->dvb_card == STV0367_TDA18212_NIMA_1)
> + *fe = dvb_attach(stv0367ter_attach,
> + &stv0367_tda18212_config[0],
> + tsin->i2c_adapter);
> + else if (tsin->dvb_card == STV0367_TDA18212_NIMB_1)
> + *fe = dvb_attach(stv0367ter_attach,
> + &stv0367_tda18212_config[1],
> + tsin->i2c_adapter);
> + else
> + *fe = dvb_attach(stv0367ter_attach,
> + &stv0367_tda18212_config[2],
> + tsin->i2c_adapter);
> +
> + if (!*fe) {
> + dev_err(c8sectpfe->device,
> + "%s: stv0367ter_attach failed for NIM card %s\n"
> + , __func__, dvb_card_str(tsin->dvb_card));
> + return -ENODEV;
> + };
> +
> + /*
> + * init the demod so that i2c gate_ctrl
> + * to the tuner works correctly
> + */
> + (*fe)->ops.init(*fe);
> +
> + /* Allocate the tda18212 structure */
> + tda18212 = devm_kzalloc(c8sectpfe->device,
> + sizeof(struct tda18212_config),
> + GFP_KERNEL);
> + if (!tda18212) {
> + dev_err(c8sectpfe->device,
> + "%s: devm_kzalloc failed\n", __func__);
> + return -ENOMEM;
> + }
> +
> + memcpy(tda18212, &tda18212_conf,
> + sizeof(struct tda18212_config));
> +
> + tda18212->fe = (*fe);
> +
> + tda18212_info.platform_data = tda18212;
> +
> + /* attach tuner */
> + request_module("tda18212");
> + client = i2c_new_device(tsin->i2c_adapter, &tda18212_info);
> + if (!client || !client->dev.driver) {
> + dvb_frontend_detach(*fe);
> + return -ENODEV;
> + }
> +
> + if (!try_module_get(client->dev.driver->owner)) {
> + i2c_unregister_device(client);
> + dvb_frontend_detach(*fe);
> + return -ENODEV;
> + }
> +
> + tsin->i2c_client = client;
> +
> + break;
> +
> + case STV0903_6110_LNB24_NIMA:
> + *fe = dvb_attach(stv090x_attach, &stv090x_config,
> + tsin->i2c_adapter, STV090x_DEMODULATOR_0);
> + if (!*fe) {
> + dev_err(c8sectpfe->device, "%s: stv090x_attach failed\n"
> + "\tfor NIM card %s\n",
> + __func__, dvb_card_str(tsin->dvb_card));
> + return -ENODEV;
> + }
> +
> + fe2 = dvb_attach(stv6110x_attach, *fe,
> + &stv6110x_config, tsin->i2c_adapter);
> + if (!fe2) {
> + dev_err(c8sectpfe->device,
> + "%s: stv6110x_attach failed for NIM card %s\n"
> + , __func__, dvb_card_str(tsin->dvb_card));
> + return -ENODEV;
> + };
> +
> + stv090x_config.tuner_init = fe2->tuner_init;
> + stv090x_config.tuner_set_mode = fe2->tuner_set_mode;
> + stv090x_config.tuner_set_frequency = fe2->tuner_set_frequency;
> + stv090x_config.tuner_get_frequency = fe2->tuner_get_frequency;
> + stv090x_config.tuner_set_bandwidth = fe2->tuner_set_bandwidth;
> + stv090x_config.tuner_get_bandwidth = fe2->tuner_get_bandwidth;
> + stv090x_config.tuner_set_bbgain = fe2->tuner_set_bbgain;
> + stv090x_config.tuner_get_bbgain = fe2->tuner_get_bbgain;
> + stv090x_config.tuner_set_refclk = fe2->tuner_set_refclk;
> + stv090x_config.tuner_get_status = fe2->tuner_get_status;
> +
> + dvb_attach(lnbh24_attach, *fe, tsin->i2c_adapter, 0, 0, 0x9);
> + break;
> +
> + default:
> + dev_err(c8sectpfe->device,
> + "%s: DVB frontend card %s not yet supported\n",
> + __func__, dvb_card_str(tsin->dvb_card));
> + return -ENODEV;
> + }
> +
> + (*fe)->id = chan_num;
> +
> + dev_info(c8sectpfe->device,
> + "DVB frontend card %s successfully attached",
> + dvb_card_str(tsin->dvb_card));
> + return 0;
> +}
> diff --git a/drivers/media/tsin/c8sectpfe/c8sectpfe-dvb.h b/drivers/media/tsin/c8sectpfe/c8sectpfe-dvb.h
> new file mode 100644
> index 0000000..bd366db
> --- /dev/null
> +++ b/drivers/media/tsin/c8sectpfe/c8sectpfe-dvb.h
> @@ -0,0 +1,20 @@
> +/*
> + * c8sectpfe-common.h - C8SECTPFE STi DVB driver
> + *
> + * Copyright (c) STMicroelectronics 2015
> + *
> + * Author: Peter Griffin <peter.griffin@linaro.org>
> + *
> + * This program is free software; you can redistribute it and/or
> + * modify it under the terms of the GNU General Public License as
> + * published by the Free Software Foundation; either version 2 of
> + * the License, or (at your option) any later version.
> + */
> +#ifndef _C8SECTPFE_DVB_H_
> +#define _C8SECTPFE_DVB_H_
> +
> +int c8sectpfe_frontend_attach(struct dvb_frontend **fe,
> + struct c8sectpfe *c8sectpfe, struct channel_info *tsin,
> + int chan_num);
> +
> +#endif