📄 d0399e.c
字号:
/* if instance to delete is first in chain */
if (Instance->InstanceChainPrev == NULL)
{
InstanceChainTop = InstanceNext; /* which would be NULL if last block to be term'd */
if (InstanceNext != NULL)
{
InstanceNext->InstanceChainPrev = NULL; /* now top of chain, no previous instance */
}
}
else
{ /* safe to set value for prev instaance (because there IS one) */
InstancePrev->InstanceChainNext = InstanceNext;
}
/* if there is a next block in the chain */
if (InstanceNext != NULL)
{
InstanceNext->InstanceChainPrev = InstancePrev;
}
memory_deallocate(Instance->MemoryPartition, Instance);
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print(("%s freed block at 0x%08x\n", identity, (U32)Instance ));
#endif
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print(("%s terminated ok\n", identity));
#endif
SEM_UNLOCK(Lock_InitTermOpenClose);
return(Error);
}
else if(Instance->InstanceChainNext == NULL)
{ /* error we should have found a matching name before the end of the list */
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print(("\n%s fail no free handle before end of list\n", identity));
#endif
SEM_UNLOCK(Lock_InitTermOpenClose);
return(STTUNER_ERROR_INITSTATE);
}
else
{
Instance = Instance->InstanceChainNext; /* next block */
}
}
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print(("%s FAIL! this point should NEVER be reached\n", identity));
#endif
SEM_UNLOCK(Lock_InitTermOpenClose);
#endif
/****************************MINIDRIVER*********************
*************************************************************
**************************************************************/
#ifdef STTUNER_MINIDRIVER
/* now safe to lock semaphore */
SEM_LOCK(Lock_InitTermOpenClose);
memory_deallocate(DEMODInstance->MemoryPartition, DEMODInstance);
SEM_UNLOCK(Lock_InitTermOpenClose);
#ifdef ST_OS21
semaphore_delete(Lock_InitTermOpenClose);
#else
semaphore_delete(&Lock_InitTermOpenClose);
#endif
#endif
return(Error);
}
/* ----------------------------------------------------------------------------
Name: demod_d0399_Open()
Description:
Parameters:
Return Value:
---------------------------------------------------------------------------- */
ST_ErrorCode_t demod_d0399_Open(ST_DeviceName_t *DeviceName, DEMOD_OpenParams_t *OpenParams, DEMOD_Capability_t *Capability, DEMOD_Handle_t *Handle)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
const char *identity = "STTUNER d0399.c demod_d0399_Open()";
#endif
#ifdef STTUNER_BLOCK_SYNC_MODE_SELECT
int ENA8_LevelValue;
#endif
ST_ErrorCode_t Error = ST_NO_ERROR;
#ifndef STTUNER_MINIDRIVER
D0399_InstanceData_t *Instance;
U32 ChipID;
STTUNER_InstanceDbase_t *Inst;
if(Installed == FALSE)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print(("%s fail driver not installed\n", identity));
#endif
return(STTUNER_ERROR_INITSTATE);
}
/* now safe to lock semaphore */
SEM_LOCK(Lock_InitTermOpenClose);
/* ---------- check that at least one init has taken place ---------- */
if(InstanceChainTop == NULL)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print(("%s fail nothing initalized\n", identity));
#endif
SEM_UNLOCK(Lock_InitTermOpenClose);
return(STTUNER_ERROR_INITSTATE);
}
/* find handle from name */
Instance = InstanceChainTop;
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print(("%s looking (%s)", identity, Instance->DeviceName));
#endif
while(strcmp((char *)Instance->DeviceName, (char *)DeviceName) != 0)
{
/* error, should have found matching DeviceName before end of list */
if(Instance->InstanceChainNext == NULL)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print(("\n%s fail no block named '%s' before end of list\n", identity, DeviceName));
#endif
SEM_UNLOCK(Lock_InitTermOpenClose);
return(STTUNER_ERROR_INITSTATE);
}
Instance = Instance->InstanceChainNext; /* next block */
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print(("(%s)", Instance->DeviceName));
#endif
}
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print((" found ok\n"));
#endif
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print(("%s using block at 0x%08x\n", identity, (U32)Instance));
#endif
/* check handle IS actually free */
if (Instance->TopLevelHandle != STTUNER_MAX_HANDLES)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print(("%s fail driver instance already open\n", identity));
#endif
SEM_UNLOCK(Lock_InitTermOpenClose);
return(ST_ERROR_OPEN_HANDLE);
}
/* else now got pointer to free (and valid) data block */
ChipID = STTUNER_IOREG_GetRegister( &(Instance->DeviceMap), Instance->IOHandle, R399_ID);
if ((ChipID & 0xF0) != 0xB0) /* 399 ID code 0xB? */
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print(("%s fail device not found (0x%02x)\n", identity, ChipID));
#endif
/* Term LLA */
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print(("%s FE_399_Term()\n", identity));
#endif
SEM_UNLOCK(Lock_InitTermOpenClose);
return(ST_ERROR_UNKNOWN_DEVICE);
}
else
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print(("%s device found, release/revision=%u\n", identity, ChipID & 0x0F));
#endif
}
Error = STTUNER_IOREG_Reset(&Instance->DeviceMap, Instance->IOHandle, Def399Val, addressarray);
if (Error != ST_NO_ERROR)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0299
STTBX_Print(("%s fail reset device\n", identity));
#endif
SEM_UNLOCK(Lock_InitTermOpenClose);
return(Error);
}
/* Set serial data mode */
if (Instance->TSOutputMode == STTUNER_TS_MODE_SERIAL)
{
Error |= STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_OUTRS_PS, 1);
}
else
{
Error |= STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_OUTRS_PS, 0);
}
if (Instance->ClockPolarity == STTUNER_DATA_CLOCK_POLARITY_FALLING) /* Rising Edge */
{
Error |= STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_CLK_POL, 1);
}
else
{
Error |= STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_CLK_POL, 0);
}
/* standard used : DVB, DSS ... */
switch(Instance->FECMode)
{
case STTUNER_FEC_MODE_DVB:
case STTUNER_FEC_MODE_DEFAULT:
STTUNER_IOREG_SetField(&Instance->DeviceMap, Instance->IOHandle, F399_FECMODE, 0);
break;
case STTUNER_FEC_MODE_DIRECTV:
STTUNER_IOREG_SetField(&Instance->DeviceMap, Instance->IOHandle, F399_FECMODE, 4);
STTUNER_IOREG_SetField(&Instance->DeviceMap, Instance->IOHandle, F399_MODE_COEF, 1);
STTUNER_IOREG_SetField(&Instance->DeviceMap, Instance->IOHandle, F399_DESCRAM, 0);
break;
default:
STTUNER_IOREG_SetField(&Instance->DeviceMap, Instance->IOHandle, F399_FECMODE, 0);
break;
}
if (Instance->DataClockAtParityBytes == STTUNER_DATACLOCK_NULL_AT_PARITYBYTES) /* Parity enable changes done for 5528 live decode issue*/
{
Error |= STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_CLK_CFG, 1);
}
else
{
Error |= STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_CLK_CFG, 0);
}
if(Instance->BlockSyncMode == STTUNER_SYNC_FORCED)
{
Error |= STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_MPEG, 1);
}
else
{
Error |= STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_MPEG, 0);
}
/* Set Block Sync control for bug GNBvd27452. Block Sync bit will set sync byte 0x47 or 0xb8 after every 8th packet */
#ifdef STTUNER_BLOCK_SYNC_MODE_SELECT
if((Instance->BlockSyncMode == STTUNER_SYNC_NORMAL) || (Instance->BlockSyncMode == STTUNER_SYNC_DEFAULT))
STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_MPEG, 0);
else
STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_MPEG, 1);
if(Instance->DataFIFOMode == STTUNER_DATAFIFO_ENABLED)
{
if(Instance->OutputFIFOConfig.OutputRateCompensationMode == STTUNER_COMPENSATE_DATACLOCK)
{
STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_EN_STBACKEND, 1);
}
else if(Instance->OutputFIFOConfig.OutputRateCompensationMode == STTUNER_COMPENSATE_DATAVALID)
{
STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_EN_STBACKEND, 0);
}
if (Instance->TSOutputMode == STTUNER_TS_MODE_SERIAL)
{
ENA8_LevelValue = 0x01;/* use only ENA8_LEVEL[3:2] in serial mode*/
ENA8_LevelValue |= ((Instance->OutputFIFOConfig.CLOCKPERIOD - 1)<<2);
STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_ENA8_LEVEL,ENA8_LevelValue);
}
else if (Instance->TSOutputMode == STTUNER_TS_MODE_PARALLEL)
{
ENA8_LevelValue = (Instance->OutputFIFOConfig.CLOCKPERIOD) / 4;
STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_ENA8_LEVEL,ENA8_LevelValue);
}
}
#endif
/* ERRCNTL #1: Set default error count mode i.e., QPSK bit error rate */
STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_ERRMODE, 0); /* error rate */
STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_ERR_SOURCE, 0); /* source: QPSK */
STTUNER_IOREG_SetField(&(Instance->DeviceMap), Instance->IOHandle, F399_NOE, 3); /* 2^18 bytes */
/* Set capabilties */
Capability->FECAvail = STTUNER_FEC_1_2 | STTUNER_FEC_2_3 | STTUNER_FEC_3_4 |
STTUNER_FEC_5_6 | STTUNER_FEC_6_7 | STTUNER_FEC_7_8; /* direct mapping to STTUNER_FECRate_t */
Capability->ModulationAvail = STTUNER_MOD_ALL; /* direct mapping to STTUNER_Modulation_t */
Capability->AGCControl = FALSE;
Capability->SymbolMin = STV0399E_SYMBOL_RATE_MIN; /* 1 MegaSymbols/sec */
Capability->SymbolMax = STV0399E_SYMBOL_RATE_MAX; /* 45 MegaSymbols/sec */
Capability->FreqMin = STV0399E_FREQ_MIN; /* 950000 */
Capability->FreqMax = STV0399E_FREQ_MAX; /* 2150000 */
Capability->BerMax = MAX399_BER;
Capability->SignalQualityMax = MAX399_SIGNAL_QUALITY;
Capability->AgcMax = MAX399_AGC;
/* change tuner step size to best fixed value for STV0399 */
Inst = STTUNER_GetDrvInst();
Inst[OpenParams->TopLevelHandle].Sat.Ioctl.TunerStepSize = STV0399_TUNER_SCAN_STEP;
#ifdef STTUNER_LNB_POWER_THRU_DEMODIO
Inst[OpenParams->TopLevelHandle].Sat.Demod.DeviceMap = &Instance->DeviceMap;
Inst[OpenParams->TopLevelHandle].Sat.Demod.TEN_FieldIndex = F399_OP0_1;
Inst[OpenParams->TopLevelHandle].Sat.Demod.VEN_FieldIndex = F399_OP1_1;
Inst[OpenParams->TopLevelHandle].Sat.Demod.VSEL_FieldIndex = F399_LOCK_CONF;
#endif
/* finally (as nor more errors to check for, allocate handle */
Instance->TopLevelHandle = OpenParams->TopLevelHandle;
/* in loopthriugh mode the second demod which is connected by loopthrough of first cannot send disecq-st
command because of a DC block in the loop-through path. Presently it depends upon toplevelhandle but when tone detection
LLA of SatCR will be written "DISECQ_ST_ENABLE" will be initalized automatically depending upon the tone sent*/
#ifdef STTUNER_DRV_SAT_SCR
#ifdef STTUNER_DRV_SAT_SCR_LOOPTHROUGH
if(OpenParams->TopLevelHandle == 0)
Instance->DISECQ_ST_ENABLE = TRUE;
if(OpenParams->TopLevelHandle == 1)
Instance->DISECQ_ST_ENABLE = FALSE;
#endif
#endif
*Handle = (U32)Instance;
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0399
STTBX_Print(("%s opened ok\n", identity));
#endif
SEM_UNLOCK(Lock_InitTermOpenClose);
#endif
/********************************MINIDRIVER********************************
***************************************************************************
*****************************************************************************/
#ifdef STTUNER_MINIDRIVER
U8 Data;
#ifdef STTUNER_BLOCK_SYNC_MODE_SELECT
int ENA8_LevelValue;
#endif
/* now safe to lock semaphore */
SEM_LOCK(Lock_InitTermOpenClose);
/* check handle IS actually free */
if (DEMODInstance->TopLevelHandle != STTUNER_MAX_HANDLES)
{
SEM_UNLOCK(Lock_InitTermOpenClose);
return(ST_ERROR_OPEN_HANDLE);
}
/* reset all chip registers */
Error = STTUNER_IOREG_Reset(&Instance->DeviceMap, Instance->IOHandle, DefVal, addressarray);
if (Error != ST_NO_ERROR)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_D0299
STTBX_Print(("%s fail reset device\n", identity));
#endif
SEM_UNLOCK(Lock_InitTermOpenClose);
return(Error);
}
/*Set OUTRSPS, CLKCFG,FEC settings */
switch(DEMODInstance->FECMode)
{
case STTUNER_FEC_MODE_DVB:
case STTUNER_FEC_MODE_DEFAULT:
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -