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

static void BrpMiscInit(void *pDataBuf, BrpMiscCfgStruct *cfg )
{
    BrpMiscCfgStruct*   pCfg =(BrpMiscCfgStruct *)(pDataBuf);
    memmove(pCfg,cfg,sizeof(*cfg));
}

static int BrpMiscCntrl(void *pDataBuf, int cmd, void *pParam, int maxlen)
{
    int i,ret,index,len;
    BrpMiscCfgStruct*  pCfg =(BrpMiscCfgStruct *)(pDataBuf);
    switch(cmd)
    {
        case SDC_REINIT:
            BrpMiscInit(pDataBuf,pCfg);
            break;

        case SDC_GET_ALARMS:
            i=0; 
            len=maxlen/4;
    
            if( GET_PC_BIT(8)==0 )
		    {
                ((ULONG*)pParam)[0]=SDA_BRP_LOST_8M;
            }
            else
    	    {	
    		    ((ULONG*)pParam)[0]=0;
      		}
        
           if( GET_PC_BIT(7)==0 )
           {
                ((ULONG*)pParam)[1]=SDA_BRP_LOST_8K;
           }
    	   else
    	   {	
                ((ULONG*)pParam)[1]=0;
           }
           
           return i;
        default: 
            return SDE_UNKNOW_CMD;

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

char *BrpMiscBspInit(int DEV, char *FreeMemPtr, BrpMiscCfgStruct *cfg)
{
    InstallSD(DEV,NULL,NULL,BrpMiscCntrl,FreeMemPtr);
    BrpMiscInit(FreeMemPtr, cfg); 
    FreeMemPtr += sizeof(BrpMiscCfgStruct);
    memcpy(FreeMemPtr,"*BrpMisc",8);
    FreeMemPtr += 8;
    return FreeMemPtr;
}