346 lines
9.8 KiB
C
346 lines
9.8 KiB
C
|
// SPDX-License-Identifier: GPL-2.0-or-later
|
||
|
|
/*
|
||
|
|
Mantis VP-1041 driver
|
||
|
|
|
||
|
|
Copyright (C) Manu Abraham (abraham.manu@gmail.com)
|
||
|
|
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/signal.h>
|
||
|
|
#include <linux/sched.h>
|
||
|
|
#include <linux/interrupt.h>
|
||
|
|
|
||
|
|
#include <media/dmxdev.h>
|
||
|
|
#include <media/dvbdev.h>
|
||
|
|
#include <media/dvb_demux.h>
|
||
|
|
#include <media/dvb_frontend.h>
|
||
|
|
#include <media/dvb_net.h>
|
||
|
|
|
||
|
|
#include "mantis_common.h"
|
||
|
|
#include "mantis_ioc.h"
|
||
|
|
#include "mantis_dvb.h"
|
||
|
|
#include "mantis_vp1041.h"
|
||
|
|
#include "stb0899_reg.h"
|
||
|
|
#include "stb0899_drv.h"
|
||
|
|
#include "stb0899_cfg.h"
|
||
|
|
#include "stb6100_cfg.h"
|
||
|
|
#include "stb6100.h"
|
||
|
|
#include "lnbp21.h"
|
||
|
|
|
||
|
|
#define MANTIS_MODEL_NAME "VP-1041"
|
||
|
|
#define MANTIS_DEV_TYPE "DSS/DVB-S/DVB-S2"
|
||
|
|
|
||
|
|
static const struct stb0899_s1_reg vp1041_stb0899_s1_init_1[] = {
|
||
|
|
|
||
|
|
/* 0x0000000b, *//* SYSREG */
|
||
|
|
{ STB0899_DEV_ID , 0x30 },
|
||
|
|
{ STB0899_DISCNTRL1 , 0x32 },
|
||
|
|
{ STB0899_DISCNTRL2 , 0x80 },
|
||
|
|
{ STB0899_DISRX_ST0 , 0x04 },
|
||
|
|
{ STB0899_DISRX_ST1 , 0x00 },
|
||
|
|
{ STB0899_DISPARITY , 0x00 },
|
||
|
|
{ STB0899_DISSTATUS , 0x20 },
|
||
|
|
{ STB0899_DISF22 , 0x99 },
|
||
|
|
{ STB0899_DISF22RX , 0xa8 },
|
||
|
|
/* SYSREG ? */
|
||
|
|
{ STB0899_ACRPRESC , 0x11 },
|
||
|
|
{ STB0899_ACRDIV1 , 0x0a },
|
||
|
|
{ STB0899_ACRDIV2 , 0x05 },
|
||
|
|
{ STB0899_DACR1 , 0x00 },
|
||
|
|
{ STB0899_DACR2 , 0x00 },
|
||
|
|
{ STB0899_OUTCFG , 0x00 },
|
||
|
|
{ STB0899_MODECFG , 0x00 },
|
||
|
|
{ STB0899_IRQSTATUS_3 , 0xfe },
|
||
|
|
{ STB0899_IRQSTATUS_2 , 0x03 },
|
||
|
|
{ STB0899_IRQSTATUS_1 , 0x7c },
|
||
|
|
{ STB0899_IRQSTATUS_0 , 0xf4 },
|
||
|
|
{ STB0899_IRQMSK_3 , 0xf3 },
|
||
|
|
{ STB0899_IRQMSK_2 , 0xfc },
|
||
|
|
{ STB0899_IRQMSK_1 , 0xff },
|
||
|
|
{ STB0899_IRQMSK_0 , 0xff },
|
||
|
|
{ STB0899_IRQCFG , 0x00 },
|
||
|
|
{ STB0899_I2CCFG , 0x88 },
|
||
|
|
{ STB0899_I2CRPT , 0x58 },
|
||
|
|
{ STB0899_IOPVALUE5 , 0x00 },
|
||
|
|
{ STB0899_IOPVALUE4 , 0x33 },
|
||
|
|
{ STB0899_IOPVALUE3 , 0x6d },
|
||
|
|
{ STB0899_IOPVALUE2 , 0x90 },
|
||
|
|
{ STB0899_IOPVALUE1 , 0x60 },
|
||
|
|
{ STB0899_IOPVALUE0 , 0x00 },
|
||
|
|
{ STB0899_GPIO00CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO01CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO02CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO03CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO04CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO05CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO06CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO07CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO08CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO09CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO10CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO11CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO12CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO13CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO14CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO15CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO16CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO17CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO18CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO19CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO20CFG , 0x82 },
|
||
|
|
{ STB0899_SDATCFG , 0xb8 },
|
||
|
|
{ STB0899_SCLTCFG , 0xba },
|
||
|
|
{ STB0899_AGCRFCFG , 0x1c }, /* 0x11 */
|
||
|
|
{ STB0899_GPIO22 , 0x82 }, /* AGCBB2CFG */
|
||
|
|
{ STB0899_GPIO21 , 0x91 }, /* AGCBB1CFG */
|
||
|
|
{ STB0899_DIRCLKCFG , 0x82 },
|
||
|
|
{ STB0899_CLKOUT27CFG , 0x7e },
|
||
|
|
{ STB0899_STDBYCFG , 0x82 },
|
||
|
|
{ STB0899_CS0CFG , 0x82 },
|
||
|
|
{ STB0899_CS1CFG , 0x82 },
|
||
|
|
{ STB0899_DISEQCOCFG , 0x20 },
|
||
|
|
{ STB0899_GPIO32CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO33CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO34CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO35CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO36CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO37CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO38CFG , 0x82 },
|
||
|
|
{ STB0899_GPIO39CFG , 0x82 },
|
||
|
|
{ STB0899_NCOARSE , 0x17 }, /* 0x15 = 27 Mhz Clock, F/3 = 198MHz, F/6 = 99MHz */
|
||
|
|
{ STB0899_SYNTCTRL , 0x02 }, /* 0x00 = CLK from CLKI, 0x02 = CLK from XTALI */
|
||
|
|
{ STB0899_FILTCTRL , 0x00 },
|
||
|
|
{ STB0899_SYSCTRL , 0x01 },
|
||
|
|
{ STB0899_STOPCLK1 , 0x20 },
|
||
|
|
{ STB0899_STOPCLK2 , 0x00 },
|
||
|
|
{ STB0899_INTBUFSTATUS , 0x00 },
|
||
|
|
{ STB0899_INTBUFCTRL , 0x0a },
|
||
|
|
{ 0xffff , 0xff },
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct stb0899_s1_reg vp1041_stb0899_s1_init_3[] = {
|
||
|
|
{ STB0899_DEMOD , 0x00 },
|
||
|
|
{ STB0899_RCOMPC , 0xc9 },
|
||
|
|
{ STB0899_AGC1CN , 0x01 },
|
||
|
|
{ STB0899_AGC1REF , 0x10 },
|
||
|
|
{ STB0899_RTC , 0x23 },
|
||
|
|
{ STB0899_TMGCFG , 0x4e },
|
||
|
|
{ STB0899_AGC2REF , 0x34 },
|
||
|
|
{ STB0899_TLSR , 0x84 },
|
||
|
|
{ STB0899_CFD , 0xf7 },
|
||
|
|
{ STB0899_ACLC , 0x87 },
|
||
|
|
{ STB0899_BCLC , 0x94 },
|
||
|
|
{ STB0899_EQON , 0x41 },
|
||
|
|
{ STB0899_LDT , 0xf1 },
|
||
|
|
{ STB0899_LDT2 , 0xe3 },
|
||
|
|
{ STB0899_EQUALREF , 0xb4 },
|
||
|
|
{ STB0899_TMGRAMP , 0x10 },
|
||
|
|
{ STB0899_TMGTHD , 0x30 },
|
||
|
|
{ STB0899_IDCCOMP , 0xfd },
|
||
|
|
{ STB0899_QDCCOMP , 0xff },
|
||
|
|
{ STB0899_POWERI , 0x0c },
|
||
|
|
{ STB0899_POWERQ , 0x0f },
|
||
|
|
{ STB0899_RCOMP , 0x6c },
|
||
|
|
{ STB0899_AGCIQIN , 0x80 },
|
||
|
|
{ STB0899_AGC2I1 , 0x06 },
|
||
|
|
{ STB0899_AGC2I2 , 0x00 },
|
||
|
|
{ STB0899_TLIR , 0x30 },
|
||
|
|
{ STB0899_RTF , 0x7f },
|
||
|
|
{ STB0899_DSTATUS , 0x00 },
|
||
|
|
{ STB0899_LDI , 0xbc },
|
||
|
|
{ STB0899_CFRM , 0xea },
|
||
|
|
{ STB0899_CFRL , 0x31 },
|
||
|
|
{ STB0899_NIRM , 0x2b },
|
||
|
|
{ STB0899_NIRL , 0x80 },
|
||
|
|
{ STB0899_ISYMB , 0x1d },
|
||
|
|
{ STB0899_QSYMB , 0xa6 },
|
||
|
|
{ STB0899_SFRH , 0x2f },
|
||
|
|
{ STB0899_SFRM , 0x68 },
|
||
|
|
{ STB0899_SFRL , 0x40 },
|
||
|
|
{ STB0899_SFRUPH , 0x2f },
|
||
|
|
{ STB0899_SFRUPM , 0x68 },
|
||
|
|
{ STB0899_SFRUPL , 0x40 },
|
||
|
|
{ STB0899_EQUAI1 , 0x02 },
|
||
|
|
{ STB0899_EQUAQ1 , 0xff },
|
||
|
|
{ STB0899_EQUAI2 , 0x04 },
|
||
|
|
{ STB0899_EQUAQ2 , 0x05 },
|
||
|
|
{ STB0899_EQUAI3 , 0x02 },
|
||
|
|
{ STB0899_EQUAQ3 , 0xfd },
|
||
|
|
{ STB0899_EQUAI4 , 0x03 },
|
||
|
|
{ STB0899_EQUAQ4 , 0x07 },
|
||
|
|
{ STB0899_EQUAI5 , 0x08 },
|
||
|
|
{ STB0899_EQUAQ5 , 0xf5 },
|
||
|
|
{ STB0899_DSTATUS2 , 0x00 },
|
||
|
|
{ STB0899_VSTATUS , 0x00 },
|
||
|
|
{ STB0899_VERROR , 0x86 },
|
||
|
|
{ STB0899_IQSWAP , 0x2a },
|
||
|
|
{ STB0899_ECNT1M , 0x00 },
|
||
|
|
{ STB0899_ECNT1L , 0x00 },
|
||
|
|
{ STB0899_ECNT2M , 0x00 },
|
||
|
|
{ STB0899_ECNT2L , 0x00 },
|
||
|
|
{ STB0899_ECNT3M , 0x0a },
|
||
|
|
{ STB0899_ECNT3L , 0xad },
|
||
|
|
{ STB0899_FECAUTO1 , 0x06 },
|
||
|
|
{ STB0899_FECM , 0x01 },
|
||
|
|
{ STB0899_VTH12 , 0xb0 },
|
||
|
|
{ STB0899_VTH23 , 0x7a },
|
||
|
|
{ STB0899_VTH34 , 0x58 },
|
||
|
|
{ STB0899_VTH56 , 0x38 },
|
||
|
|
{ STB0899_VTH67 , 0x34 },
|
||
|
|
{ STB0899_VTH78 , 0x24 },
|
||
|
|
{ STB0899_PRVIT , 0xff },
|
||
|
|
{ STB0899_VITSYNC , 0x19 },
|
||
|
|
{ STB0899_RSULC , 0xb1 }, /* DVB = 0xb1, DSS = 0xa1 */
|
||
|
|
{ STB0899_TSULC , 0x42 },
|
||
|
|
{ STB0899_RSLLC , 0x41 },
|
||
|
|
{ STB0899_TSLPL , 0x12 },
|
||
|
|
{ STB0899_TSCFGH , 0x0c },
|
||
|
|
{ STB0899_TSCFGM , 0x00 },
|
||
|
|
{ STB0899_TSCFGL , 0x00 },
|
||
|
|
{ STB0899_TSOUT , 0x69 }, /* 0x0d for CAM */
|
||
|
|
{ STB0899_RSSYNCDEL , 0x00 },
|
||
|
|
{ STB0899_TSINHDELH , 0x02 },
|
||
|
|
{ STB0899_TSINHDELM , 0x00 },
|
||
|
|
{ STB0899_TSINHDELL , 0x00 },
|
||
|
|
{ STB0899_TSLLSTKM , 0x1b },
|
||
|
|
{ STB0899_TSLLSTKL , 0xb3 },
|
||
|
|
{ STB0899_TSULSTKM , 0x00 },
|
||
|
|
{ STB0899_TSULSTKL , 0x00 },
|
||
|
|
{ STB0899_PCKLENUL , 0xbc },
|
||
|
|
{ STB0899_PCKLENLL , 0xcc },
|
||
|
|
{ STB0899_RSPCKLEN , 0xbd },
|
||
|
|
{ STB0899_TSSTATUS , 0x90 },
|
||
|
|
{ STB0899_ERRCTRL1 , 0xb6 },
|
||
|
|
{ STB0899_ERRCTRL2 , 0x95 },
|
||
|
|
{ STB0899_ERRCTRL3 , 0x8d },
|
||
|
|
{ STB0899_DMONMSK1 , 0x27 },
|
||
|
|
{ STB0899_DMONMSK0 , 0x03 },
|
||
|
|
{ STB0899_DEMAPVIT , 0x5c },
|
||
|
|
{ STB0899_PLPARM , 0x19 },
|
||
|
|
{ STB0899_PDELCTRL , 0x48 },
|
||
|
|
{ STB0899_PDELCTRL2 , 0x00 },
|
||
|
|
{ STB0899_BBHCTRL1 , 0x00 },
|
||
|
|
{ STB0899_BBHCTRL2 , 0x00 },
|
||
|
|
{ STB0899_HYSTTHRESH , 0x77 },
|
||
|
|
{ STB0899_MATCSTM , 0x00 },
|
||
|
|
{ STB0899_MATCSTL , 0x00 },
|
||
|
|
{ STB0899_UPLCSTM , 0x00 },
|
||
|
|
{ STB0899_UPLCSTL , 0x00 },
|
||
|
|
{ STB0899_DFLCSTM , 0x00 },
|
||
|
|
{ STB0899_DFLCSTL , 0x00 },
|
||
|
|
{ STB0899_SYNCCST , 0x00 },
|
||
|
|
{ STB0899_SYNCDCSTM , 0x00 },
|
||
|
|
{ STB0899_SYNCDCSTL , 0x00 },
|
||
|
|
{ STB0899_ISI_ENTRY , 0x00 },
|
||
|
|
{ STB0899_ISI_BIT_EN , 0x00 },
|
||
|
|
{ STB0899_MATSTRM , 0xf0 },
|
||
|
|
{ STB0899_MATSTRL , 0x02 },
|
||
|
|
{ STB0899_UPLSTRM , 0x45 },
|
||
|
|
{ STB0899_UPLSTRL , 0x60 },
|
||
|
|
{ STB0899_DFLSTRM , 0xe3 },
|
||
|
|
{ STB0899_DFLSTRL , 0x00 },
|
||
|
|
{ STB0899_SYNCSTR , 0x47 },
|
||
|
|
{ STB0899_SYNCDSTRM , 0x05 },
|
||
|
|
{ STB0899_SYNCDSTRL , 0x18 },
|
||
|
|
{ STB0899_CFGPDELSTATUS1 , 0x19 },
|
||
|
|
{ STB0899_CFGPDELSTATUS2 , 0x2b },
|
||
|
|
{ STB0899_BBFERRORM , 0x00 },
|
||
|
|
{ STB0899_BBFERRORL , 0x01 },
|
||
|
|
{ STB0899_UPKTERRORM , 0x00 },
|
||
|
|
{ STB0899_UPKTERRORL , 0x00 },
|
||
|
|
{ 0xffff , 0xff },
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct stb0899_config vp1041_stb0899_config = {
|
||
|
|
.init_dev = vp1041_stb0899_s1_init_1,
|
||
|
|
.init_s2_demod = stb0899_s2_init_2,
|
||
|
|
.init_s1_demod = vp1041_stb0899_s1_init_3,
|
||
|
|
.init_s2_fec = stb0899_s2_init_4,
|
||
|
|
.init_tst = stb0899_s1_init_5,
|
||
|
|
|
||
|
|
.demod_address = 0x68, /* 0xd0 >> 1 */
|
||
|
|
|
||
|
|
.xtal_freq = 27000000,
|
||
|
|
.inversion = IQ_SWAP_ON,
|
||
|
|
|
||
|
|
.lo_clk = 76500000,
|
||
|
|
.hi_clk = 99000000,
|
||
|
|
|
||
|
|
.esno_ave = STB0899_DVBS2_ESNO_AVE,
|
||
|
|
.esno_quant = STB0899_DVBS2_ESNO_QUANT,
|
||
|
|
.avframes_coarse = STB0899_DVBS2_AVFRAMES_COARSE,
|
||
|
|
.avframes_fine = STB0899_DVBS2_AVFRAMES_FINE,
|
||
|
|
.miss_threshold = STB0899_DVBS2_MISS_THRESHOLD,
|
||
|
|
.uwp_threshold_acq = STB0899_DVBS2_UWP_THRESHOLD_ACQ,
|
||
|
|
.uwp_threshold_track = STB0899_DVBS2_UWP_THRESHOLD_TRACK,
|
||
|
|
.uwp_threshold_sof = STB0899_DVBS2_UWP_THRESHOLD_SOF,
|
||
|
|
.sof_search_timeout = STB0899_DVBS2_SOF_SEARCH_TIMEOUT,
|
||
|
|
|
||
|
|
.btr_nco_bits = STB0899_DVBS2_BTR_NCO_BITS,
|
||
|
|
.btr_gain_shift_offset = STB0899_DVBS2_BTR_GAIN_SHIFT_OFFSET,
|
||
|
|
.crl_nco_bits = STB0899_DVBS2_CRL_NCO_BITS,
|
||
|
|
.ldpc_max_iter = STB0899_DVBS2_LDPC_MAX_ITER,
|
||
|
|
|
||
|
|
.tuner_get_frequency = stb6100_get_frequency,
|
||
|
|
.tuner_set_frequency = stb6100_set_frequency,
|
||
|
|
.tuner_set_bandwidth = stb6100_set_bandwidth,
|
||
|
|
.tuner_get_bandwidth = stb6100_get_bandwidth,
|
||
|
|
.tuner_set_rfsiggain = NULL,
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct stb6100_config vp1041_stb6100_config = {
|
||
|
|
.tuner_address = 0x60,
|
||
|
|
.refclock = 27000000,
|
||
|
|
};
|
||
|
|
|
||
|
|
static int vp1041_frontend_init(struct mantis_pci *mantis, struct dvb_frontend *fe)
|
||
|
|
{
|
||
|
|
struct i2c_adapter *adapter = &mantis->adapter;
|
||
|
|
|
||
|
|
int err = 0;
|
||
|
|
|
||
|
|
err = mantis_frontend_power(mantis, POWER_ON);
|
||
|
|
if (err == 0) {
|
||
|
|
mantis_frontend_soft_reset(mantis);
|
||
|
|
msleep(250);
|
||
|
|
mantis->fe = dvb_attach(stb0899_attach, &vp1041_stb0899_config, adapter);
|
||
|
|
if (mantis->fe) {
|
||
|
|
dprintk(MANTIS_ERROR, 1,
|
||
|
|
"found STB0899 DVB-S/DVB-S2 frontend @0x%02x",
|
||
|
|
vp1041_stb0899_config.demod_address);
|
||
|
|
|
||
|
|
if (dvb_attach(stb6100_attach, mantis->fe, &vp1041_stb6100_config, adapter)) {
|
||
|
|
if (!dvb_attach(lnbp21_attach, mantis->fe, adapter, 0, 0))
|
||
|
|
dprintk(MANTIS_ERROR, 1, "No LNBP21 found!");
|
||
|
|
}
|
||
|
|
} else {
|
||
|
|
return -EREMOTEIO;
|
||
|
|
}
|
||
|
|
} else {
|
||
|
|
dprintk(MANTIS_ERROR, 1, "Frontend on <%s> POWER ON failed! <%d>",
|
||
|
|
adapter->name,
|
||
|
|
err);
|
||
|
|
|
||
|
|
return -EIO;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
dprintk(MANTIS_ERROR, 1, "Done!");
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
struct mantis_hwconfig vp1041_config = {
|
||
|
|
.model_name = MANTIS_MODEL_NAME,
|
||
|
|
.dev_type = MANTIS_DEV_TYPE,
|
||
|
|
.ts_size = MANTIS_TS_188,
|
||
|
|
|
||
|
|
.baud_rate = MANTIS_BAUD_9600,
|
||
|
|
.parity = MANTIS_PARITY_NONE,
|
||
|
|
.bytes = 0,
|
||
|
|
|
||
|
|
.frontend_init = vp1041_frontend_init,
|
||
|
|
.power = GPIF_A12,
|
||
|
|
.reset = GPIF_A13,
|
||
|
|
};
|