DSL_DRV_STATIC DSL_uint_t DSL_DRV_Poll(DSL_DRV_DevHeader_t *pDrvHdr)
{
DSL_int_t nRet = 0;
DSL_OpenContext_t *pOpenCtx = pDrvHdr->pOpenCtx;
DSL_DEBUG(DSL_DBG_MSG, (DSL_NULL, "IN - DSL_DRV_Poll" DSL_DRV_CRLF));
if (pOpenCtx == DSL_NULL)
{
/* This should never happen */
DSL_DEBUG(DSL_DBG_ERR, (DSL_NULL, "!!! Ioctl call for file which "
"was not opened" DSL_DRV_CRLF));
return -EFAULT;
}
#if 0
poll_wait(pFile, &pOpenCtx->eventWaitQueue, wait);
if(DSL_DRV_MUTEX_LOCK(pOpenCtx->eventMutex))
{
DSL_DEBUG( DSL_DBG_ERR, (DSL_NULL, "Couldn't lock event mutex"DSL_DRV_CRLF));
return DSL_ERROR;
}
if (pOpenCtx->eventFifo == DSL_NULL
|| pOpenCtx->eventFifoBuf == DSL_NULL
|| pOpenCtx->bEventActivation == DSL_FALSE)
{
DSL_DEBUG(DSL_DBG_WRN,
(DSL_NULL, "!!! Ioctl call for file which was not configured"
" for event handling!!!" DSL_DRV_CRLF));
}
else
{
if ( DSL_Fifo_isEmpty( pOpenCtx->eventFifo ) == DSL_FALSE )
{
nRet |= POLLIN | POLLRDNORM; /* an event available */
}
}
DSL_DRV_MUTEX_UNLOCK(pOpenCtx->eventMutex);
DSL_DEBUG(DSL_DBG_MSG, (DSL_NULL, "OUT - DSL_DRV_Poll" DSL_DRV_CRLF));
#endif
return nRet;
}
/*
IO controls for user space accessing
\param ino Pointer to the stucture of inode.
\param fil Pointer to the stucture of file.
\param command The ioctl command.
\param lon The address of data.
\return Success or failure.
\ingroup Internal
*/
DSL_int_t DSL_DRV_Ioctls(DSL_DRV_DevHeader_t *pDrvHdr, DSL_uint_t nCommand, DSL_uint32_t nArg)
{
DSL_int_t nErr=0;
DSL_boolean_t bIsInKernel;
DSL_uint32_t nRetCode = 0;
DSL_Context_t *pContext;
DSL_devCtx_t *pDevCtx;
DSL_OpenContext_t *pOpenCtx = pDrvHdr->pOpenCtx;
DSL_DEBUG(DSL_DBG_MSG, (DSL_NULL, "Device will be controled..."DSL_DRV_CRLF));
DSL_DEBUG(DSL_DBG_MSG, (DSL_NULL, "IN - DSL_DRV_Ioctls: The ioctl "
"command(0x%X) is called" DSL_DRV_CRLF, nCommand));
if ((pOpenCtx = gv_drv_dsl_pOpenCtx) == DSL_NULL)
// SchS: orig: if (pOpenCtx == DSL_NULL)
{
/* This should never happen */
DSL_DEBUG(DSL_DBG_ERR, (DSL_NULL, "!!! Ioctl call for file which "
"was not opened" DSL_DRV_CRLF));
return -1;
}
else
{
if ((pDevCtx = pOpenCtx->pDevCtx) == DSL_NULL)
{
/* This should never happen */
DSL_DEBUG(DSL_DBG_ERR, (DSL_NULL, "DSL_DRV_Poll: !!! Ioctl call "
"for file which was not opened correctly" DSL_DRV_CRLF));
return -1;
}
else
{
if ((pContext = pDevCtx->pContext) == DSL_NULL)
{
/* This should never happen */
DSL_DEBUG(DSL_DBG_ERR, (DSL_NULL, "!!! Ioctl call to device "
"which was not ready" DSL_DRV_CRLF));
return -1;
}
}
}
bIsInKernel = DSL_TRUE;
switch(nCommand)
{
#if 0
//SchS
case FIOSELECT:
if ( DSL_Fifo_isEmpty( pOpenCtx->eventFifo ) == DSL_FALSE )
{
selWakeup((SEL_WAKEUP_NODE*) nArg);
}
return 0;
case FIOUNSELECT:
selNodeDelete(&pOpenCtx->eventWaitQueue, (SEL_WAKEUP_NODE*) nArg);
return 0;
#endif
}
if ( (_IOC_TYPE(nCommand) == DSL_IOC_MAGIC_CPE_API) ||
(_IOC_TYPE(nCommand) == DSL_IOC_MAGIC_CPE_API_G997) ||
(_IOC_TYPE(nCommand) == DSL_IOC_MAGIC_CPE_API_PM) ||
(_IOC_TYPE(nCommand) == DSL_IOC_MAGIC_CPE_API_SAR) ||
(_IOC_TYPE(nCommand) == DSL_IOC_MAGIC_CPE_API_DEP) )
{
nRetCode = DSL_DRV_IoctlHandle(pOpenCtx, pContext, bIsInKernel, nCommand, nArg);
if (nRetCode < DSL_SUCCESS)
{
nErr = DSL_DRV_ErrorToOS(nRetCode);
}
}
#if defined(INCLUDE_DSL_ADSL_MIB)
else if (_IOC_TYPE(nCommand) == DSL_IOC_MAGIC_MIB)
{
nRetCode = DSL_DRV_MIB_IoctlHandle(pContext, bIsInKernel, nCommand, nArg);
nErr = nRetCode;
}
#endif
else
{
DSL_DEBUG(DSL_DBG_ERR, (DSL_NULL, "The ioctl command(0x%X) is not "
"supported!" DSL_DRV_CRLF, nCommand));
nErr = -1;
return nErr;
}
DSL_DEBUG(DSL_DBG_MSG, (DSL_NULL, "OUT - DSL_DRV_Ioctls(), retCode=%d"
DSL_DRV_CRLF, nErr));
return nErr;
}
static DSL_Error_t DSL_CEOC_FifoSnmpMessageRead(
DSL_OpenContext_t *pOpenCtx,
DSL_Context_t *pContext,
DSL_CEOC_Message_t *pMsg)
{
DSL_Error_t nErrCode = DSL_SUCCESS;
DSL_uint8_t *pElmnt = DSL_NULL;
DSL_CHECK_POINTER(pContext, pMsg);
DSL_CHECK_ERR_CODE();
DSL_DEBUG(DSL_DBG_MSG, (pContext,
SYS_DBG_MSG"DSL[%02d]: IN - DSL_CEOC_FifoSnmpMessageRead" DSL_DRV_CRLF,
DSL_DEV_NUM(pContext)));
if (DSL_DRV_MUTEX_LOCK(pOpenCtx->rxSnmpFifoMutex))
{
DSL_DEBUG( DSL_DBG_ERR,
(pContext, SYS_DBG_ERR"DSL[%02d]: ERROR - CEOC mutex lock failed!"
DSL_DRV_CRLF, DSL_DEV_NUM(pContext)));
return DSL_ERR_SEMAPHORE_GET;
}
if ((pOpenCtx->rxSnmpFifo != DSL_NULL) &&
(pOpenCtx->rxSnmpFifoBuf != DSL_NULL) &&
((pOpenCtx->nResourceActivationMask & DSL_RESOURCE_ACTIVATION_SNMP) == DSL_RESOURCE_ACTIVATION_CLEANED))
{
if (DSL_Fifo_isEmpty(pOpenCtx->rxSnmpFifo))
{
DSL_DEBUG( DSL_DBG_WRN,
(pContext, SYS_DBG_WRN"DSL[%02d]: WARNING - CEOC Rx SNMP fifo is empty!"
DSL_DRV_CRLF, DSL_DEV_NUM(pContext)));
nErrCode = DSL_WRN_SNMP_NO_DATA;
}
else
{
pElmnt = DSL_Fifo_readElement(pOpenCtx->rxSnmpFifo);
if( pElmnt == DSL_NULL )
{
DSL_DEBUG( DSL_DBG_ERR,
(pContext, SYS_DBG_ERR"DSL[%02d]: ERROR - received NULL pointer to the CEOC SNMP fifo!"
DSL_DRV_CRLF, DSL_DEV_NUM(pContext)));
nErrCode = DSL_ERROR;
}
else
{
/* copy an element */
memcpy(pMsg, pElmnt, sizeof(DSL_G997_SnmpData_t));
}
}
}
else
{
nErrCode = DSL_WRN_SNMP_NO_DATA;
}
DSL_DRV_MUTEX_UNLOCK(pOpenCtx->rxSnmpFifoMutex);
DSL_DEBUG(DSL_DBG_MSG, (pContext,
SYS_DBG_MSG"DSL[%02d]: OUT - DSL_CEOC_FifoSnmpMessageRead, retCode=%d"
DSL_DRV_CRLF, DSL_DEV_NUM(pContext), nErrCode));
return nErrCode;
}
