mfcsetclk.cpp

来自「Samsung公司S3C6400芯片的BSP源码包」· C++ 代码 · 共 47 行

//MfcSetClk.cpp

#include <windows.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_set_MFC_CLKDIV0(int mfc_ratio)
{
	volatile S3C6400_SYSCON_REG * 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;
	}

	pSysConReg->CLK_DIV0 = (pSysConReg->CLK_DIV0 & ~(0xF << 28)) | (mfc_ratio << 28);

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


	return TRUE;
}

BOOL Mfc_Set_ClkDiv(int divider)
{
	if ((divider < 1) || (divider > 16)) {
		RETAILMSG(1, (L"[[MFC Driver] Mfc_Set_ClkDiv() : MFC clock divider must be 1 ~ 16.\n\r"));
		return FALSE;
	}


	mfc_set_MFC_CLKDIV0(divider - 1);

	return TRUE;
}