tpumisc.c

来自「这是单板上DPRAM的驱动程序」· C语言 代码 · 共 52 行

#include <psos.h>
#include "board.h"
#include "tpumisc.h"
#include "bspcomm.h"
#include "bspspec.h"

static void TPUMiscInit(void *pDataBuf, TPUMiscCfgStruct *cfg )
{
    USHORT temp_ushort;
    TPUMiscCfgStruct*   pCfg =(TPUMiscCfgStruct *)(pDataBuf);

/*-------------------------<< Initial data >>-------------------------------*/
    memmove(pCfg,cfg,sizeof(*cfg));
}

/* Changed */
static int TPUMiscCntrl(void *pDataBuf, int cmd, void *pParam, int maxlen)
{
    int ret,i;
    ULONG *buf;
    TPUMiscCfgStruct*  pCfg =(TPUMiscCfgStruct *)(pDataBuf);
    switch(cmd)
    {
        case SDC_REINIT:
            TPUMiscInit(pDataBuf,pCfg);
            break;

        case SDC_GET_ALARMS:
            buf=(ULONG *)pParam;i=0; maxlen/=4;
            if(GET_PC_BIT(15)==0)
            { 
                if(i>=maxlen)   return SDE_SHORTER_BUF;
                buf[i++]=SDA_LOST_CLOCK;
            }                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                          
            return i;
        default: 
            return SDE_UNKNOW_CMD;

    }/* end of switch(cmd) */
    return SDE_OK;
}

char *TPUMiscBspInit(int DEV, char *FreeMemPtr, TPUMiscCfgStruct *cfg)
{
    InstallSD(DEV,NULL,NULL,TPUMiscCntrl,FreeMemPtr);
    TPUMiscInit(FreeMemPtr, cfg); 
    FreeMemPtr += sizeof(TPUMiscCfgStruct);
    memcpy(FreeMemPtr,"*TPUMisc",8);
    FreeMemPtr += 8;
    return FreeMemPtr;
}