mfcpwrmgmt.cpp

SAMSUNG S3C6410 CPU BSP for winmobile6

//MfcPwrMgmt.cpp

#include <windows.h>
//#include <nkintr.h>
//#include <oal_intr.h>


#include <s3c6410.h>
#include <DrvLib.h>
#include "pmplatform.h"


// Reference count indicating how many handles are using the MFC
static LONG _ref_count = 0;


static BOOL mfc_power_on_off(int on_off)
{
    DWORD    dwIPIndex = PWR_IP_MFC;
    DWORD    dwIOCTL;

    HANDLE   hPwrControl;

    hPwrControl = CreateFile( L"PWC0:",
                              GENERIC_READ|GENERIC_WRITE,
                              FILE_SHARE_READ|FILE_SHARE_WRITE,
                              NULL,
                              OPEN_EXISTING,
                              0, 0);
    if (INVALID_HANDLE_VALUE == hPwrControl )
    {
        RETAILMSG(1, (L"[MFC] PWC0 Open Device Failed.\r\n"));
        return FALSE;
    }

    if (on_off == 0)
        dwIOCTL = IOCTL_PWRCON_SET_POWER_OFF;
    else
        dwIOCTL = IOCTL_PWRCON_SET_POWER_ON;

    if ( !DeviceIoControl(hPwrControl, dwIOCTL, &dwIPIndex, sizeof(DWORD), NULL, 0, NULL, NULL) )
    {
        RETAILMSG(1,(TEXT("[MFC] MFC Power(%d) : MFC Power On/Off Failed\r\n")));
        CloseHandle(hPwrControl);
        return FALSE;
    }

    CloseHandle(hPwrControl);

    return TRUE;
}


static BOOL mfc_clock_on_off(int on_off)
{
    static volatile S3C6410_SYSCON_REG * pSysConReg = NULL;

    // SYSCON_REG register address mapping
    //   Once it is mapped, it keeps the mapping until the OS is rebooted.
    if (pSysConReg == NULL) {
        pSysConReg = (S3C6410_SYSCON_REG *)DrvLib_MapIoSpace(S3C6410_BASE_REG_PA_SYSCON, sizeof(S3C6410_SYSCON_REG), FALSE);
        if (pSysConReg == NULL)
        {
            RETAILMSG(1, (L"[[MFC Driver] MFC_Init() : g_pSysConReg DrvLib_MapIoSpace() Failed\n\r"));
            return FALSE;
        }
    }

    if (on_off == 0) {
//        pSysConReg->HCLK_GATE &= ~(1<<0);    // MFC (Turning off the H_CLK will cause the SW reset and sleep/wakeup not to work.)
        pSysConReg->PCLK_GATE &= ~(1<<0);    // MFC
        pSysConReg->SCLK_GATE &= ~(1<<3);    // MFC
    }
    else {
        pSysConReg->HCLK_GATE |= (1<<0);    // MFC
        pSysConReg->PCLK_GATE |= (1<<0);    // MFC
        pSysConReg->SCLK_GATE |= (1<<3);    // MFC
    }

    return TRUE;
}



BOOL Mfc_Pwr_On()
{
    RETAILMSG(0, (L"\n[MFC POWER] MFC_POWER_ON."));

    if (InterlockedIncrement(&_ref_count) == 1) {

        if (mfc_power_on_off(1) == FALSE)
            return FALSE;

        RETAILMSG(1, (L"\n[MFC POWER] Power is up."));
    }

    return TRUE;
}



BOOL Mfc_Pwr_Off()
{
    if (_ref_count == 0)
        return TRUE;

    RETAILMSG(0, (L"\n[MFC POWER] MFC_POWER_OFF."));

    if (InterlockedDecrement(&_ref_count) == 0) {

        if (mfc_power_on_off(0) == FALSE)
            return FALSE;

        RETAILMSG(1, (L"\n[MFC POWER] Power is down"));

    }

    return TRUE;
}

#if 0
BOOL Mfc_Is_Pwr_On()
{
    RETAILMSG(1, (L"\n[MFC POWER]Mfc_Is_Pwr_On. _ref_count=%d\r\n"), _ref_count);

        
    BOOL bIsPwrOn = (BOOL)_ref_count;
    BOOL bIsClockOn = FALSE;
    
    // check clock of Mfc
    {
        DWORD dwTmp;
        volatile S3C6410_SYSCON_REG * pSysConReg = NULL;

        pSysConReg = (S3C6410_SYSCON_REG *)DrvLib_MapIoSpace(S3C6410_BASE_REG_PA_SYSCON, sizeof(S3C6410_SYSCON_REG), FALSE);
        if (pSysConReg == NULL)
        {
            return FALSE;
        }
        dwTmp = pSysConReg->HCLK_GATE;

        if( dwTmp & (1<<0) )
            bIsClockOn = TRUE;

        DrvLib_UnmapIoSpace((PVOID)pSysConReg);
        pSysConReg = NULL;
    }

    if( bIsClockOn && bIsPwrOn )
        return TRUE;

    return FALSE;
    
}
#endif


BOOL Mfc_Clk_On()
{
    return mfc_clock_on_off(1);
}



BOOL Mfc_Clk_Off()
{
    return mfc_clock_on_off(0);
}