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

static void EdrtMiscInit(void *pDataBuf, EdrtMiscCfgStruct *cfg )
{
    EdrtMiscCfgStruct*   pCfg =(EdrtMiscCfgStruct *)(pDataBuf);
    memmove(pCfg,cfg,sizeof(*cfg));
}

static int EdrtMiscCntrl(void *pDataBuf, int cmd, void *pParam, int maxlen)
{
    int i,len; 
    EdrtMiscCfgStruct*  pCfg =(EdrtMiscCfgStruct *)(pDataBuf);
    switch(cmd)
    {
        case SDC_REINIT:
            EdrtMiscInit(pDataBuf,pCfg);
            break;

        case SDC_GET_ALARMS:
            i=0; len=maxlen/4;
            if( GET_PB_BIT(16)==1){
                if(i>=len)return SDE_SHORTER_BUF;
                ((ULONG*)pParam)[i++]=SDA_CLK_LOST;
                 SET_PD_BIT(7,0);
                 SET_PD_BIT(7,1);
                }
            return i;
        default: 
            return SDE_UNKNOW_CMD;

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

UCHAR *EdrtMiscBspInit(int DEV, UCHAR *FreeMemPtr, EdrtMiscCfgStruct *cfg)
{
    InstallSD(DEV,NULL,NULL,EdrtMiscCntrl,FreeMemPtr);
    EdrtMiscInit(FreeMemPtr, cfg); 
    FreeMemPtr += sizeof(EdrtMiscCfgStruct);
    memcpy(FreeMemPtr,"*edrtMisc",8);
    FreeMemPtr += 8;
    return FreeMemPtr;
}