📄 scrdrv.c
字号:
/* ----------------------------------------------------------------------------
File Name: scrdrv.c
Description:
stv0299 demod driver.
Copyright (C) 2003-2004 STMicroelectronics
History:
date: 25-March-2004
version: 1.0.0
author: SD
comment: write for multi-instance.
date: 07-April-2004
version:
author: SD
comment: remove commented code.
date: 22-July-2004
version:
author: SD
comment: Tone Detection Algorithm Added.
Reference:
ST API Definition "TUNER Driver API" DVD-API-06
---------------------------------------------------------------------------- */
/* Includes ---------------------------------------------------------------- */
#ifdef ST_OSLINUX
#include "stos.h"
#else
/* C libs */
#include <string.h>
#include "stlite.h" /* Standard includes */
/* STAPI */
#include "sttbx.h"
#endif
#include "stevt.h"
#include "sttuner.h"
/* local to sttuner */
#include "util.h" /* generic utility functions for sttuner */
#include "dbtypes.h" /* data types for databases */
#include "sysdbase.h" /* functions to accesss system data */
#include "ioarch.h" /* I/O for this driver */
#include "ioreg.h" /* I/O for this driver */
#include "d0299.h"
#include "sioctl.h"
#include "scr.h" /* data structure typedefs for all the the sat ioctl functions */
#ifdef STTUNER_MINIDRIVER
#include "l0299.h"
#include "lnb21.h"
#include "lnbh21.h"
#include "d0399.h"
#include "d0299.h"
#endif
#if defined(ST_OS21) || defined(ST_OSLINUX)
static semaphore_t *Lock_InitTermOpenClose, *DiSEqC_Semaphore; /* guard calls to the functions */
#else
static semaphore_t Lock_InitTermOpenClose, DiSEqC_Semaphore; /* guard calls to the functions */
#endif
#ifndef STTUNER_MINIDRIVER
static BOOL Installed = FALSE;
/* ---------- per instance of driver ---------- */
typedef struct
{
ST_DeviceName_t *DeviceName; /* unique name for opening under */
STTUNER_Handle_t TopLevelHandle; /* access tuner, lnb etc. using this */
IOARCH_Handle_t IOHandle; /* instance access to I/O driver */
ST_Partition_t *MemoryPartition; /* which partition this data block belongs to */
void *InstanceChainPrev; /* previous data block in chain or NULL if not */
void *InstanceChainNext; /* next data block in chain or NULL if last */
STTUNER_DiSEqCConfig_t DiSEqCConfig; /** Added DiSEqC configuration structure to get the trace of current state**/
STTUNER_SCRLNB_Index_t LNBIndex ; /* From which LNB to get RF signal*/
STTUNER_SCRBPF_t SCRBPF ;
STTUNER_SCR_Mode_t SCR_Mode;
STTUNER_ScrType_t Scr_App_Type;
U8 NbLnb;
U16 SCRLNB_LO_Frequencies[8]; /* In MHz*/
U8 NbScr;
U16 SCRBPFFrequencies[8]; /* In MHz*/
BOOL SCREnable ; /*IFA new feature*/
}
SCR_InstanceData_t;
#endif
#ifdef STTUNER_MINIDRIVER
typedef struct
{
STTUNER_Handle_t TopLevelHandle; /* access tuner, lnb etc. using this */
IOARCH_Handle_t IOHandle; /* instance access to I/O driver */
ST_Partition_t *MemoryPartition; /* which partition this data block belongs to */
STTUNER_DiSEqCConfig_t DiSEqCConfig; /** Added DiSEqC configuration structure to get the trace of current state**/
STTUNER_SCRLNB_Index_t LNBIndex ; /* From which LNB to get RF signal*/
STTUNER_SCRBPF_t SCRBPF ;
STTUNER_SCR_Mode_t SCR_Mode;
STTUNER_ScrType_t Scr_App_Type;
U8 NbLnb;
U16 SCRLNB_LO_Frequencies[8]; /* In MHz*/
U8 NbScr;
U16 SCRBPFFrequencies[8]; /* In MHz*/
BOOL SCREnable;
}
SCR_InstanceData_t;
#endif
#ifndef STTUNER_MINIDRIVER
/* instance chain, the default boot value is invalid, to catch errors */
static SCR_InstanceData_t *InstanceChainTop = (SCR_InstanceData_t *)0x7fffffff;
#endif
#ifdef STTUNER_MINIDRIVER
static SCR_InstanceData_t *SCRInstance;
#endif
#ifndef STTUNER_MINIDRIVER
static U16 LO_LUT[13] =
{
0000,/* Not used*/
0xfff,/* not used */
9750,
10000,
10600,
10750,
11000,
11250,
11475,
20250,
5150,
1585,
13850
};
#endif
/* functions --------------------------------------------------------------- */
#ifndef STTUNER_MINIDRIVER
/* API */
ST_ErrorCode_t scr_scrdrv_Init(ST_DeviceName_t *DeviceName, SCR_InitParams_t *InitParams);
ST_ErrorCode_t scr_scrdrv_Term(ST_DeviceName_t *DeviceName, SCR_TermParams_t *TermParams);
ST_ErrorCode_t scr_scrdrv_Open (ST_DeviceName_t *DeviceName, SCR_OpenParams_t *OpenParams, SCR_Handle_t *Handle, DEMOD_Handle_t DemodHandle, SCR_Capability_t *Capability);
ST_ErrorCode_t scr_scrdrv_Close(SCR_Handle_t Handle, SCR_CloseParams_t *CloseParams);
ST_ErrorCode_t scr_scrdrv_IsLocked(SCR_Handle_t Handle, DEMOD_Handle_t DemodHandle, BOOL *IsLocked);
ST_ErrorCode_t scr_scrdrv_SetFrequency (STTUNER_Handle_t Handle, DEMOD_Handle_t DemodHandle, ST_DeviceName_t *DeviceName, U32 InitialFrequency, U8 LNBIndex, U8 SCRBPF );
ST_ErrorCode_t scr_scrdrv_Off (SCR_OpenParams_t *OpenParams, DEMOD_Handle_t DemodHandle, U8 SCRBPF);
ST_ErrorCode_t scr_auto_detect(SCR_OpenParams_t *OpenParams, DEMOD_Handle_t DemodHandle, U32 StartFreq, U32 StopFreq, U8 *NbTones, U32 *ToneList,int* power_detection_level);
ST_ErrorCode_t scr_tone_enable(SCR_OpenParams_t *OpenParams, DEMOD_Handle_t DemodHandle);
U8 scr_get_application_number(SCR_OpenParams_t *OpenParams, DEMOD_Handle_t DemodHandle, U8 SCRBPF, U16 SCRCenterFrequency,int* power_detection_level);
U8 scr_get_LO_frequency(SCR_OpenParams_t *OpenParams, DEMOD_Handle_t DemodHandle, U8 SCRBPF, U16 SCRCenterFrequency, U16 *SCRLNB_Frequency,int* power_detection_level);
/* local functions --------------------------------------------------------- */
ST_ErrorCode_t scr_tone_enable_x(SCR_OpenParams_t *OpenParams, DEMOD_Handle_t DemodHandle, U32 ScrIndex,U32 ScrNb);
SCR_InstanceData_t *SCR_GetInstFromHandle(SCR_Handle_t Handle);
extern ST_ErrorCode_t (* demod_tonedetection)(DEMOD_Handle_t Handle,U32 StartFreq, U32 StopFreq, U8 *NbTones,U32 *ToneListm, U8 mode);
#endif
#ifdef STTUNER_MINIDRIVER
#ifdef STTUNER_DRV_SAT_STV0399
extern ST_ErrorCode_t demod_d0399_tonedetection(DEMOD_Handle_t Handle,U32 StartFreq, U32 StopFreq, U8 *NbTones,U32 *ToneList);
#endif
#ifdef STTUNER_DRV_SAT_STV0399E
extern ST_ErrorCode_t demod_d0399_tonedetection(DEMOD_Handle_t Handle,U32 StartFreq, U32 StopFreq, U8 *NbTones,U32 *ToneList);
#endif
#endif
/* ----------------------------------------------------------------------------
Name: STTUNER_DRV_DEMOD_STV0299_Install()
Description:
install a satellite device driver into the scr database.
Parameters:
Return Value:
---------------------------------------------------------------------------- */
#ifndef STTUNER_MINIDRIVER
ST_ErrorCode_t STTUNER_DRV_SCR_APPLICATION_Install(STTUNER_scr_dbase_t *Scr)
{
ST_ErrorCode_t Error = ST_NO_ERROR;
if(Installed == TRUE)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
STTBX_Print(("%s fail driver already installed\n", identity));
#endif
return(STTUNER_ERROR_INITSTATE);
}
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
STTBX_Print(("%s installing sat:scr:application3...", identity));
#endif
/* mark ID in database */
Scr->ID = STTUNER_SCR_APPLICATION;
/* map API */
Scr->scr_Init = scr_scrdrv_Init;
Scr->scr_Term = scr_scrdrv_Term;
Scr->scr_Open = scr_scrdrv_Open;
Scr->scr_Close = scr_scrdrv_Close;
/*Scr->scr_IsLocked = scr_scrdrv_IsLocked ; */
Scr->scr_SetFrequency = scr_scrdrv_SetFrequency;
Scr->scr_Off = scr_scrdrv_Off;
InstanceChainTop = NULL;
#if defined(ST_OS21) || defined(ST_OSLINUX)
Lock_InitTermOpenClose = semaphore_create_fifo(1);
DiSEqC_Semaphore = semaphore_create_fifo(1);
#else
semaphore_init_fifo(&Lock_InitTermOpenClose, 1);
semaphore_init_fifo(&DiSEqC_Semaphore, 1);
#endif
Installed = TRUE;
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
STTBX_Print(("ok\n"));
#endif
return(Error);
}
/* ----------------------------------------------------------------------------
Name: STTUNER_SCR_APPLICATION_3_unInstall()
Description:
uninstall satellite device driver into the scr database.
Parameters:
Return Value:
---------------------------------------------------------------------------- */
ST_ErrorCode_t STTUNER_DRV_SCR_APPLICATION_UnInstall(STTUNER_scr_dbase_t *Scr)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
const char *identity = "STTUNER scr STTUNER_SCR_APPLICATION_3_UnInstall()";
#endif
ST_ErrorCode_t Error = ST_NO_ERROR;
if(Installed == FALSE)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
STTBX_Print(("%s fail driver not installed\n", identity));
#endif
return(STTUNER_ERROR_INITSTATE);
}
if(Scr->ID != STTUNER_SCR_APPLICATION)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
STTBX_Print(("%s fail incorrect driver type\n", identity));
#endif
return(STTUNER_ERROR_ID);
}
/* has all memory been freed, by Term() */
if(InstanceChainTop != NULL)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
STTBX_Print(("%s fail at least one instance not terminated\n", identity));
#endif
return(ST_ERROR_OPEN_HANDLE);
}
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
STTBX_Print(("%s uninstalling sat:scr...", identity));
#endif
/* mark ID in database */
Scr->ID = STTUNER_NO_DRIVER;
/* unmap API */
Scr->scr_Init = NULL;
Scr->scr_Term = NULL;
Scr->scr_Open = NULL;
Scr->scr_Close = NULL;
Scr->scr_IsLocked = NULL;
Scr->scr_SetFrequency = NULL;
Scr->scr_Off = NULL;
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
STTBX_Print(("<"));
#endif
#if defined(ST_OS21) || defined(ST_OSLINUX)
semaphore_delete(Lock_InitTermOpenClose);
semaphore_delete(DiSEqC_Semaphore);
#else
semaphore_delete(&Lock_InitTermOpenClose);
semaphore_delete(&DiSEqC_Semaphore);
#endif
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
STTBX_Print((">"));
#endif
InstanceChainTop = (SCR_InstanceData_t *)0x7ffffffe;
Installed = FALSE;
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
STTBX_Print(("ok\n"));
#endif
return(Error);
}
#endif
/* ----------------------------------------------------------------------------
Name: scr_scrdrv_Init()
Description:
Parameters:
Return Value:
---------------------------------------------------------------------------- */
ST_ErrorCode_t scr_scrdrv_Init(ST_DeviceName_t *DeviceName, SCR_InitParams_t *InitParams)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
const char *identity = "STTUNER scr scr_scrdrv_Init()";
#endif
ST_ErrorCode_t Error = ST_NO_ERROR;
U8 i;
#ifndef STTUNER_MINIDRIVER
SCR_InstanceData_t *InstanceNew, *Instance;
if(Installed == FALSE)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
STTBX_Print(("%s fail driver not installed\n", identity));
#endif
return(STTUNER_ERROR_INITSTATE);
}
/* now safe to lock semaphore */
SEM_LOCK(Lock_InitTermOpenClose);
/* ---------- check params ---------- */
Error = STTUNER_Util_CheckPtrNull(InitParams->MemoryPartition);
if( Error != ST_NO_ERROR)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
STTBX_Print(("%s fail MemoryPartition not valid\n", identity));
#endif
SEM_UNLOCK(Lock_InitTermOpenClose);
return(Error);
}
Error = STTUNER_Util_CheckPtrNull(DeviceName);
if( Error != ST_NO_ERROR)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
STTBX_Print(("%s fail DeviceName not valid\n", identity));
#endif
SEM_UNLOCK(Lock_InitTermOpenClose);
return(Error);
}
InstanceNew = memory_allocate_clear(InitParams->MemoryPartition, 1, sizeof( SCR_InstanceData_t ));
if (InstanceNew == NULL)
{
#ifdef STTUNER_DEBUG_MODULE_SATDRV_SCR
STTBX_Print(("%s fail memory allocation InstanceNew\n", identity));
#endif
SEM_UNLOCK(Lock_InitTermOpenClose);
return(ST_ERROR_NO_MEMORY);
}
/* slot into chain */
if (InstanceChainTop == NULL)
{
InstanceNew->InstanceChainPrev = NULL; /* no previous instance */
InstanceChainTop = InstanceNew;
}
else /* tag onto last data block in chain */
{
Instance = InstanceChainTop;
while(Instance->InstanceChainNext != NULL)
{
Instance = Instance->InstanceChainNext; /* next block */
}
Instance->InstanceChainNext = (void *)InstanceNew;
InstanceNew->InstanceChainPrev = (void *)Instance;
}
InstanceNew->DeviceName = DeviceName;
InstanceNew->TopLevelHandle = STTUNER_MAX_HANDLES;
InstanceNew->IOHandle = InitParams->IOHandle;
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -