cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

mantis_vp1041.c (10073B)


      1// SPDX-License-Identifier: GPL-2.0-or-later
      2/*
      3	Mantis VP-1041 driver
      4
      5	Copyright (C) Manu Abraham (abraham.manu@gmail.com)
      6
      7*/
      8
      9#include <linux/signal.h>
     10#include <linux/sched.h>
     11#include <linux/interrupt.h>
     12
     13#include <media/dmxdev.h>
     14#include <media/dvbdev.h>
     15#include <media/dvb_demux.h>
     16#include <media/dvb_frontend.h>
     17#include <media/dvb_net.h>
     18
     19#include "mantis_common.h"
     20#include "mantis_ioc.h"
     21#include "mantis_dvb.h"
     22#include "mantis_vp1041.h"
     23#include "stb0899_reg.h"
     24#include "stb0899_drv.h"
     25#include "stb0899_cfg.h"
     26#include "stb6100_cfg.h"
     27#include "stb6100.h"
     28#include "lnbp21.h"
     29
     30#define MANTIS_MODEL_NAME	"VP-1041"
     31#define MANTIS_DEV_TYPE		"DSS/DVB-S/DVB-S2"
     32
     33static const struct stb0899_s1_reg vp1041_stb0899_s1_init_1[] = {
     34
     35	/* 0x0000000b, *//* SYSREG */
     36	{ STB0899_DEV_ID		, 0x30 },
     37	{ STB0899_DISCNTRL1		, 0x32 },
     38	{ STB0899_DISCNTRL2		, 0x80 },
     39	{ STB0899_DISRX_ST0		, 0x04 },
     40	{ STB0899_DISRX_ST1		, 0x00 },
     41	{ STB0899_DISPARITY		, 0x00 },
     42	{ STB0899_DISSTATUS		, 0x20 },
     43	{ STB0899_DISF22		, 0x99 },
     44	{ STB0899_DISF22RX		, 0xa8 },
     45	/* SYSREG ? */
     46	{ STB0899_ACRPRESC		, 0x11 },
     47	{ STB0899_ACRDIV1		, 0x0a },
     48	{ STB0899_ACRDIV2		, 0x05 },
     49	{ STB0899_DACR1			, 0x00 },
     50	{ STB0899_DACR2			, 0x00 },
     51	{ STB0899_OUTCFG		, 0x00 },
     52	{ STB0899_MODECFG		, 0x00 },
     53	{ STB0899_IRQSTATUS_3		, 0xfe },
     54	{ STB0899_IRQSTATUS_2		, 0x03 },
     55	{ STB0899_IRQSTATUS_1		, 0x7c },
     56	{ STB0899_IRQSTATUS_0		, 0xf4 },
     57	{ STB0899_IRQMSK_3		, 0xf3 },
     58	{ STB0899_IRQMSK_2		, 0xfc },
     59	{ STB0899_IRQMSK_1		, 0xff },
     60	{ STB0899_IRQMSK_0		, 0xff },
     61	{ STB0899_IRQCFG		, 0x00 },
     62	{ STB0899_I2CCFG		, 0x88 },
     63	{ STB0899_I2CRPT		, 0x58 },
     64	{ STB0899_IOPVALUE5		, 0x00 },
     65	{ STB0899_IOPVALUE4		, 0x33 },
     66	{ STB0899_IOPVALUE3		, 0x6d },
     67	{ STB0899_IOPVALUE2		, 0x90 },
     68	{ STB0899_IOPVALUE1		, 0x60 },
     69	{ STB0899_IOPVALUE0		, 0x00 },
     70	{ STB0899_GPIO00CFG		, 0x82 },
     71	{ STB0899_GPIO01CFG		, 0x82 },
     72	{ STB0899_GPIO02CFG		, 0x82 },
     73	{ STB0899_GPIO03CFG		, 0x82 },
     74	{ STB0899_GPIO04CFG		, 0x82 },
     75	{ STB0899_GPIO05CFG		, 0x82 },
     76	{ STB0899_GPIO06CFG		, 0x82 },
     77	{ STB0899_GPIO07CFG		, 0x82 },
     78	{ STB0899_GPIO08CFG		, 0x82 },
     79	{ STB0899_GPIO09CFG		, 0x82 },
     80	{ STB0899_GPIO10CFG		, 0x82 },
     81	{ STB0899_GPIO11CFG		, 0x82 },
     82	{ STB0899_GPIO12CFG		, 0x82 },
     83	{ STB0899_GPIO13CFG		, 0x82 },
     84	{ STB0899_GPIO14CFG		, 0x82 },
     85	{ STB0899_GPIO15CFG		, 0x82 },
     86	{ STB0899_GPIO16CFG		, 0x82 },
     87	{ STB0899_GPIO17CFG		, 0x82 },
     88	{ STB0899_GPIO18CFG		, 0x82 },
     89	{ STB0899_GPIO19CFG		, 0x82 },
     90	{ STB0899_GPIO20CFG		, 0x82 },
     91	{ STB0899_SDATCFG		, 0xb8 },
     92	{ STB0899_SCLTCFG		, 0xba },
     93	{ STB0899_AGCRFCFG		, 0x1c }, /* 0x11 */
     94	{ STB0899_GPIO22		, 0x82 }, /* AGCBB2CFG */
     95	{ STB0899_GPIO21		, 0x91 }, /* AGCBB1CFG */
     96	{ STB0899_DIRCLKCFG		, 0x82 },
     97	{ STB0899_CLKOUT27CFG		, 0x7e },
     98	{ STB0899_STDBYCFG		, 0x82 },
     99	{ STB0899_CS0CFG		, 0x82 },
    100	{ STB0899_CS1CFG		, 0x82 },
    101	{ STB0899_DISEQCOCFG		, 0x20 },
    102	{ STB0899_GPIO32CFG		, 0x82 },
    103	{ STB0899_GPIO33CFG		, 0x82 },
    104	{ STB0899_GPIO34CFG		, 0x82 },
    105	{ STB0899_GPIO35CFG		, 0x82 },
    106	{ STB0899_GPIO36CFG		, 0x82 },
    107	{ STB0899_GPIO37CFG		, 0x82 },
    108	{ STB0899_GPIO38CFG		, 0x82 },
    109	{ STB0899_GPIO39CFG		, 0x82 },
    110	{ STB0899_NCOARSE		, 0x17 }, /* 0x15 = 27 Mhz Clock, F/3 = 198MHz, F/6 = 99MHz */
    111	{ STB0899_SYNTCTRL		, 0x02 }, /* 0x00 = CLK from CLKI, 0x02 = CLK from XTALI */
    112	{ STB0899_FILTCTRL		, 0x00 },
    113	{ STB0899_SYSCTRL		, 0x01 },
    114	{ STB0899_STOPCLK1		, 0x20 },
    115	{ STB0899_STOPCLK2		, 0x00 },
    116	{ STB0899_INTBUFSTATUS		, 0x00 },
    117	{ STB0899_INTBUFCTRL		, 0x0a },
    118	{ 0xffff			, 0xff },
    119};
    120
    121static const struct stb0899_s1_reg vp1041_stb0899_s1_init_3[] = {
    122	{ STB0899_DEMOD			, 0x00 },
    123	{ STB0899_RCOMPC		, 0xc9 },
    124	{ STB0899_AGC1CN		, 0x01 },
    125	{ STB0899_AGC1REF		, 0x10 },
    126	{ STB0899_RTC			, 0x23 },
    127	{ STB0899_TMGCFG		, 0x4e },
    128	{ STB0899_AGC2REF		, 0x34 },
    129	{ STB0899_TLSR			, 0x84 },
    130	{ STB0899_CFD			, 0xf7 },
    131	{ STB0899_ACLC			, 0x87 },
    132	{ STB0899_BCLC			, 0x94 },
    133	{ STB0899_EQON			, 0x41 },
    134	{ STB0899_LDT			, 0xf1 },
    135	{ STB0899_LDT2			, 0xe3 },
    136	{ STB0899_EQUALREF		, 0xb4 },
    137	{ STB0899_TMGRAMP		, 0x10 },
    138	{ STB0899_TMGTHD		, 0x30 },
    139	{ STB0899_IDCCOMP		, 0xfd },
    140	{ STB0899_QDCCOMP		, 0xff },
    141	{ STB0899_POWERI		, 0x0c },
    142	{ STB0899_POWERQ		, 0x0f },
    143	{ STB0899_RCOMP			, 0x6c },
    144	{ STB0899_AGCIQIN		, 0x80 },
    145	{ STB0899_AGC2I1		, 0x06 },
    146	{ STB0899_AGC2I2		, 0x00 },
    147	{ STB0899_TLIR			, 0x30 },
    148	{ STB0899_RTF			, 0x7f },
    149	{ STB0899_DSTATUS		, 0x00 },
    150	{ STB0899_LDI			, 0xbc },
    151	{ STB0899_CFRM			, 0xea },
    152	{ STB0899_CFRL			, 0x31 },
    153	{ STB0899_NIRM			, 0x2b },
    154	{ STB0899_NIRL			, 0x80 },
    155	{ STB0899_ISYMB			, 0x1d },
    156	{ STB0899_QSYMB			, 0xa6 },
    157	{ STB0899_SFRH			, 0x2f },
    158	{ STB0899_SFRM			, 0x68 },
    159	{ STB0899_SFRL			, 0x40 },
    160	{ STB0899_SFRUPH		, 0x2f },
    161	{ STB0899_SFRUPM		, 0x68 },
    162	{ STB0899_SFRUPL		, 0x40 },
    163	{ STB0899_EQUAI1		, 0x02 },
    164	{ STB0899_EQUAQ1		, 0xff },
    165	{ STB0899_EQUAI2		, 0x04 },
    166	{ STB0899_EQUAQ2		, 0x05 },
    167	{ STB0899_EQUAI3		, 0x02 },
    168	{ STB0899_EQUAQ3		, 0xfd },
    169	{ STB0899_EQUAI4		, 0x03 },
    170	{ STB0899_EQUAQ4		, 0x07 },
    171	{ STB0899_EQUAI5		, 0x08 },
    172	{ STB0899_EQUAQ5		, 0xf5 },
    173	{ STB0899_DSTATUS2		, 0x00 },
    174	{ STB0899_VSTATUS		, 0x00 },
    175	{ STB0899_VERROR		, 0x86 },
    176	{ STB0899_IQSWAP		, 0x2a },
    177	{ STB0899_ECNT1M		, 0x00 },
    178	{ STB0899_ECNT1L		, 0x00 },
    179	{ STB0899_ECNT2M		, 0x00 },
    180	{ STB0899_ECNT2L		, 0x00 },
    181	{ STB0899_ECNT3M		, 0x0a },
    182	{ STB0899_ECNT3L		, 0xad },
    183	{ STB0899_FECAUTO1		, 0x06 },
    184	{ STB0899_FECM			, 0x01 },
    185	{ STB0899_VTH12			, 0xb0 },
    186	{ STB0899_VTH23			, 0x7a },
    187	{ STB0899_VTH34			, 0x58 },
    188	{ STB0899_VTH56			, 0x38 },
    189	{ STB0899_VTH67			, 0x34 },
    190	{ STB0899_VTH78			, 0x24 },
    191	{ STB0899_PRVIT			, 0xff },
    192	{ STB0899_VITSYNC		, 0x19 },
    193	{ STB0899_RSULC			, 0xb1 }, /* DVB = 0xb1, DSS = 0xa1 */
    194	{ STB0899_TSULC			, 0x42 },
    195	{ STB0899_RSLLC			, 0x41 },
    196	{ STB0899_TSLPL			, 0x12 },
    197	{ STB0899_TSCFGH		, 0x0c },
    198	{ STB0899_TSCFGM		, 0x00 },
    199	{ STB0899_TSCFGL		, 0x00 },
    200	{ STB0899_TSOUT			, 0x69 }, /* 0x0d for CAM */
    201	{ STB0899_RSSYNCDEL		, 0x00 },
    202	{ STB0899_TSINHDELH		, 0x02 },
    203	{ STB0899_TSINHDELM		, 0x00 },
    204	{ STB0899_TSINHDELL		, 0x00 },
    205	{ STB0899_TSLLSTKM		, 0x1b },
    206	{ STB0899_TSLLSTKL		, 0xb3 },
    207	{ STB0899_TSULSTKM		, 0x00 },
    208	{ STB0899_TSULSTKL		, 0x00 },
    209	{ STB0899_PCKLENUL		, 0xbc },
    210	{ STB0899_PCKLENLL		, 0xcc },
    211	{ STB0899_RSPCKLEN		, 0xbd },
    212	{ STB0899_TSSTATUS		, 0x90 },
    213	{ STB0899_ERRCTRL1		, 0xb6 },
    214	{ STB0899_ERRCTRL2		, 0x95 },
    215	{ STB0899_ERRCTRL3		, 0x8d },
    216	{ STB0899_DMONMSK1		, 0x27 },
    217	{ STB0899_DMONMSK0		, 0x03 },
    218	{ STB0899_DEMAPVIT		, 0x5c },
    219	{ STB0899_PLPARM		, 0x19 },
    220	{ STB0899_PDELCTRL		, 0x48 },
    221	{ STB0899_PDELCTRL2		, 0x00 },
    222	{ STB0899_BBHCTRL1		, 0x00 },
    223	{ STB0899_BBHCTRL2		, 0x00 },
    224	{ STB0899_HYSTTHRESH		, 0x77 },
    225	{ STB0899_MATCSTM		, 0x00 },
    226	{ STB0899_MATCSTL		, 0x00 },
    227	{ STB0899_UPLCSTM		, 0x00 },
    228	{ STB0899_UPLCSTL		, 0x00 },
    229	{ STB0899_DFLCSTM		, 0x00 },
    230	{ STB0899_DFLCSTL		, 0x00 },
    231	{ STB0899_SYNCCST		, 0x00 },
    232	{ STB0899_SYNCDCSTM		, 0x00 },
    233	{ STB0899_SYNCDCSTL		, 0x00 },
    234	{ STB0899_ISI_ENTRY		, 0x00 },
    235	{ STB0899_ISI_BIT_EN		, 0x00 },
    236	{ STB0899_MATSTRM		, 0xf0 },
    237	{ STB0899_MATSTRL		, 0x02 },
    238	{ STB0899_UPLSTRM		, 0x45 },
    239	{ STB0899_UPLSTRL		, 0x60 },
    240	{ STB0899_DFLSTRM		, 0xe3 },
    241	{ STB0899_DFLSTRL		, 0x00 },
    242	{ STB0899_SYNCSTR		, 0x47 },
    243	{ STB0899_SYNCDSTRM		, 0x05 },
    244	{ STB0899_SYNCDSTRL		, 0x18 },
    245	{ STB0899_CFGPDELSTATUS1	, 0x19 },
    246	{ STB0899_CFGPDELSTATUS2	, 0x2b },
    247	{ STB0899_BBFERRORM		, 0x00 },
    248	{ STB0899_BBFERRORL		, 0x01 },
    249	{ STB0899_UPKTERRORM		, 0x00 },
    250	{ STB0899_UPKTERRORL		, 0x00 },
    251	{ 0xffff			, 0xff },
    252};
    253
    254static struct stb0899_config vp1041_stb0899_config = {
    255	.init_dev		= vp1041_stb0899_s1_init_1,
    256	.init_s2_demod		= stb0899_s2_init_2,
    257	.init_s1_demod		= vp1041_stb0899_s1_init_3,
    258	.init_s2_fec		= stb0899_s2_init_4,
    259	.init_tst		= stb0899_s1_init_5,
    260
    261	.demod_address		= 0x68, /*  0xd0 >> 1 */
    262
    263	.xtal_freq		= 27000000,
    264	.inversion		= IQ_SWAP_ON,
    265
    266	.lo_clk			= 76500000,
    267	.hi_clk			= 99000000,
    268
    269	.esno_ave		= STB0899_DVBS2_ESNO_AVE,
    270	.esno_quant		= STB0899_DVBS2_ESNO_QUANT,
    271	.avframes_coarse	= STB0899_DVBS2_AVFRAMES_COARSE,
    272	.avframes_fine		= STB0899_DVBS2_AVFRAMES_FINE,
    273	.miss_threshold		= STB0899_DVBS2_MISS_THRESHOLD,
    274	.uwp_threshold_acq	= STB0899_DVBS2_UWP_THRESHOLD_ACQ,
    275	.uwp_threshold_track	= STB0899_DVBS2_UWP_THRESHOLD_TRACK,
    276	.uwp_threshold_sof	= STB0899_DVBS2_UWP_THRESHOLD_SOF,
    277	.sof_search_timeout	= STB0899_DVBS2_SOF_SEARCH_TIMEOUT,
    278
    279	.btr_nco_bits		= STB0899_DVBS2_BTR_NCO_BITS,
    280	.btr_gain_shift_offset	= STB0899_DVBS2_BTR_GAIN_SHIFT_OFFSET,
    281	.crl_nco_bits		= STB0899_DVBS2_CRL_NCO_BITS,
    282	.ldpc_max_iter		= STB0899_DVBS2_LDPC_MAX_ITER,
    283
    284	.tuner_get_frequency	= stb6100_get_frequency,
    285	.tuner_set_frequency	= stb6100_set_frequency,
    286	.tuner_set_bandwidth	= stb6100_set_bandwidth,
    287	.tuner_get_bandwidth	= stb6100_get_bandwidth,
    288	.tuner_set_rfsiggain	= NULL,
    289};
    290
    291static struct stb6100_config vp1041_stb6100_config = {
    292	.tuner_address	= 0x60,
    293	.refclock	= 27000000,
    294};
    295
    296static int vp1041_frontend_init(struct mantis_pci *mantis, struct dvb_frontend *fe)
    297{
    298	struct i2c_adapter *adapter	= &mantis->adapter;
    299
    300	int err = 0;
    301
    302	err = mantis_frontend_power(mantis, POWER_ON);
    303	if (err == 0) {
    304		mantis_frontend_soft_reset(mantis);
    305		msleep(250);
    306		mantis->fe = dvb_attach(stb0899_attach, &vp1041_stb0899_config, adapter);
    307		if (mantis->fe) {
    308			dprintk(MANTIS_ERROR, 1,
    309				"found STB0899 DVB-S/DVB-S2 frontend @0x%02x",
    310				vp1041_stb0899_config.demod_address);
    311
    312			if (dvb_attach(stb6100_attach, mantis->fe, &vp1041_stb6100_config, adapter)) {
    313				if (!dvb_attach(lnbp21_attach, mantis->fe, adapter, 0, 0))
    314					dprintk(MANTIS_ERROR, 1, "No LNBP21 found!");
    315			}
    316		} else {
    317			return -EREMOTEIO;
    318		}
    319	} else {
    320		dprintk(MANTIS_ERROR, 1, "Frontend on <%s> POWER ON failed! <%d>",
    321			adapter->name,
    322			err);
    323
    324		return -EIO;
    325	}
    326
    327
    328	dprintk(MANTIS_ERROR, 1, "Done!");
    329
    330	return 0;
    331}
    332
    333struct mantis_hwconfig vp1041_config = {
    334	.model_name	= MANTIS_MODEL_NAME,
    335	.dev_type	= MANTIS_DEV_TYPE,
    336	.ts_size	= MANTIS_TS_188,
    337
    338	.baud_rate	= MANTIS_BAUD_9600,
    339	.parity		= MANTIS_PARITY_NONE,
    340	.bytes		= 0,
    341
    342	.frontend_init	= vp1041_frontend_init,
    343	.power		= GPIF_A12,
    344	.reset		= GPIF_A13,
    345};