mfcpwrmgmt.cpp

Samsung公司S3C6400芯片的BSP源码包

//MfcPwrMgmt.cpp

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


#include <s3c6400.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 S3C6400_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 = (S3C6400_SYSCON_REG *)DrvLib_MapIoSpace(S3C6400_BASE_REG_PA_SYSCON, sizeof(S3C6400_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 |= (0<<0);	// MFC
		pSysConReg->PCLK_GATE |= (0<<0);	// MFC
		pSysConReg->SCLK_GATE |= (0<<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(1, (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(1, (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;
}




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



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