//*************************************************************************
//*************************************************************************
//**                                                                     **
//**        (C)Copyright 1985-2008, American Megatrends, Inc.            **
//**                                                                     **
//**                       All Rights Reserved.                          **
//**                                                                     **
//**      5555 Oakbrook Parkway, Suite 200, Norcross, GA 30093           **
//**                                                                     **
//**                       Phone: (770)-246-8600                         **
//**                                                                     **
//*************************************************************************
//*************************************************************************
//
//*************************************************************************
// $Header: /Alaska/BIN/IO/Fintek/F81866/F81866 Board/F81866SmartFan.c 1     7/20/11 4:23a Kasalinyi $Revision: 
//
// $Date:
//*************************************************************************
// Revision History
// ----------------
// 
//*************************************************************************
//<AMI_FHDR_START>
//
// Name:  <F81866SmartFan.c>
//
// Description: This is related to individual Smart Fan functions.
//
//<AMI_FHDR_END>
//*************************************************************************
#include <Efi.h>
#include <Token.h>
#include <AmiLib.h>
#include <Setup.h>
#include <AmiDxeLib.h>
#include <Protocol\BootScriptSave.h>
#define HWM_CONFIG_INDEX        F81866_HWM_BASE_ADDRESS+5
#define HWM_CONFIG_DATA         F81866_HWM_BASE_ADDRESS+6
SETUP_DATA                      SetupData;
static EFI_EVENT                gEvtReadyToBoot = NULL;
static EFI_GUID                 gEfiBootScriptSaveGuid = EFI_BOOT_SCRIPT_SAVE_GUID;

typedef	struct _DXE_SMF_INIT_DATA{
	UINT8 			Reg8;
	UINT8 			AndData8;
	UINT8 			OrData8;    
} DXE_SMF_INIT_DATA;

typedef	struct _S3_SAVE_DATA{
	UINT8 			Bank;
	UINT8 			Reg8;  
} S3_SAVE_DATA;
//----------------------------------------------------------------------------------------------
// smart system fan registers need init AfterActivate. !!!AfterActivate
//----------------------------------------------------------------------------------------------
DXE_SMF_INIT_DATA   DXE_FAN1_INIT_TABLE[] = {
	{0x96, 0xFC, 0x00},
	{0xA2, 0xFF, 0x00},
	{0xA3, 0xFF, 0x00},
	{0xA6, 0xFF, 0x00},
	{0xA7, 0xFF, 0x00},
	{0xA8, 0xFF, 0x00},
	{0xA9, 0XFF, 0x00},
	{0xAB, 0xFF, 0x00},
	{0xAC, 0xFF, 0x00},
	{0xAD, 0xFF, 0x00},
	{0xAE, 0xFF, 0x00},
};

DXE_SMF_INIT_DATA   DXE_FAN2_INIT_TABLE[] = {
	{0x96, 0xF3, 0x00},
	{0xB2, 0xFF, 0x00},
	{0xB3, 0xFF, 0x00},
	{0xB6, 0xFF, 0x00},
	{0xB7, 0xFF, 0x00},
	{0xB8, 0xFF, 0x00},
	{0xB9, 0XFF, 0x00},
	{0xBB, 0xFF, 0x00},
	{0xBC, 0xFF, 0x00},
	{0xBD, 0xFF, 0x00},
	{0xBE, 0xFF, 0x00},
};

DXE_SMF_INIT_DATA   DXE_FAN3_INIT_TABLE[] = {
	{0x96, 0xCF, 0x00},
	{0xC2, 0xFF, 0x00},
	{0xC3, 0xFF, 0x00},
	{0xC6, 0xFF, 0x00},
	{0xC7, 0xFF, 0x00},
	{0xC8, 0xFF, 0x00},
	{0xC9, 0XFF, 0x00},
	{0xCB, 0xFF, 0x00},
	{0xCC, 0xFF, 0x00},
	{0xCD, 0xFF, 0x00},
	{0xCE, 0xFF, 0x00},
};

S3_SAVE_DATA HwmS3SaveRegisterTbl[] = {
// ----------------------
//| Bank | Reg8 | 
// ----------------------
    {0x00,0x94},
    {0x00,0x96},
    {0x00,0xA2},
    {0x00,0xA3},
    {0x00,0xA6},
    {0x00,0xA7},
    {0x00,0xA8},
    {0x00,0xA9},
    {0x00,0xAB},
    {0x00,0xAC},
    {0x00,0xAD},
    {0x00,0xAE},
    {0x00,0xB2},
    {0x00,0xB3},
    {0x00,0xB6},
    {0x00,0xB7},
    {0x00,0xB8},
    {0x00,0xB9},
    {0x00,0xBB},
    {0x00,0xBC},
    {0x00,0xBD},
    {0x00,0xBE},
    {0x00,0xC2},
    {0x00,0xC3},
    {0x00,0xC6},
    {0x00,0xC7},
    {0x00,0xC8},
    {0x00,0xC9},
    {0x00,0xCB},
    {0x00,0xCC},
    {0x00,0xCD},
    {0x00,0xCE},
};
//--------------------------------------------------------------------------
// Definition of smart fan functions
//--------------------------------------------------------------------------
VOID F81866SmartFunction (VOID);
static VOID SmartFanFuncStart(VOID);
static VOID F81866_SMF1_INIT(void);
static VOID F81866_SMF2_INIT(void);
static VOID F81866_SMF3_INIT(void);
static void F81866_SMF_WRITE_CFG(DXE_SMF_INIT_DATA DXE_SMF_MODEx_Table);
static EFI_STATUS HwmCallbackReadyToBoot(
    IN  EFI_EVENT Event,
    IN  VOID    *Context);
//<AMI_PHDR_START>
//---------------------------------------------------------------------------
// Procedure:    F81866SmartFunction
//
// Description:    This function initializes the IT8783 in BDS phase
//
// Input:        
//      IN      EFI_HANDLE              ImageHandle
//      IN      EFI_SYSTEM_TABLE        SystemTable
//
// Output:      Status
//
//---------------------------------------------------------------------------
//<AMI_PHDR_END>

VOID F81866SmartFunction (VOID)
{
    EFI_STATUS      Status = EFI_SUCCESS;
    UINTN           Size = sizeof(SETUP_DATA);
    EFI_GUID        SetupGuid = SETUP_GUID;

    //Get Setup variable
    Status=pRS->GetVariable( L"Setup", &SetupGuid, NULL, &Size, &SetupData);
    if(Status != EFI_SUCCESS) return;

    //Init the smart fan function
    if(SetupData.SmartFanEnable)  
        SmartFanFuncStart();
}

//<AMI_PHDR_START>
//---------------------------------------------------------------------------
// Procedure:    SmartFanFuncStart
//
// Description:    This function start to initialize the smart fan function
//
// Input:        NULL
//
//
// Output:      NULL
//
//---------------------------------------------------------------------------
//<AMI_PHDR_END>
static VOID SmartFanFuncStart(VOID)
{
    EFI_STATUS      Status;
    //--------------------------------------------------------------------------
    // Before speed control, program neccessary registers if needed.
    //--------------------------------------------------------------------------
   
    //--------------------------------------------------------------------------
    // Start to program the smart fan mode
    //--------------------------------------------------------------------------
    F81866_SMF1_INIT();
    F81866_SMF2_INIT();
    F81866_SMF3_INIT();
    //Create event for boot script
    Status = CreateReadyToBootEvent(
        TPL_NOTIFY,
         HwmCallbackReadyToBoot,
        NULL,
        &gEvtReadyToBoot
    );
    ASSERT_EFI_ERROR(Status);
}

//<AMI_PHDR_START>
//---------------------------------------------------------------------------
// Procedure:    F81866_SMF1_INIT
//
// Description:    This function do smart fan1 config
//
// Input:        NULL
//
//
// Output:      NULL
//
//---------------------------------------------------------------------------
//<AMI_PHDR_END>
void  F81866_SMF1_INIT(VOID)
{
    UINT8   i, temp;
	switch (SetupData.Fan1SmartFanMode) {
		case 0:
            DXE_FAN1_INIT_TABLE[0].OrData8 = 0x02;//mode
            DXE_FAN1_INIT_TABLE[1].OrData8 = (UINT8)(1500000/SetupData.Fan1Mode0FixedSpeed >> 8);//mode
            DXE_FAN1_INIT_TABLE[2].OrData8 = (UINT8)(1500000/SetupData.Fan1Mode0FixedSpeed & 0xFF);//mode
		break;
		case 1:
            DXE_FAN1_INIT_TABLE[0].OrData8 = 0x03;//mode
            DXE_FAN1_INIT_TABLE[2].OrData8 = (UINT8)SetupData.Fan1Mode1FixedDuty*0xFF/100;//mode
		break;
		case 2:
            DXE_FAN1_INIT_TABLE[0].OrData8 = 0x00;//mode
            DXE_FAN1_INIT_TABLE[3].OrData8 = SetupData.Fan1Mode2AutoRpmT1;
            DXE_FAN1_INIT_TABLE[4].OrData8 = SetupData.Fan1Mode2AutoRpmT2;
            DXE_FAN1_INIT_TABLE[5].OrData8 = SetupData.Fan1Mode2AutoRpmT3;
            DXE_FAN1_INIT_TABLE[6].OrData8 = SetupData.Fan1Mode2AutoRpmT4;   
            DXE_FAN1_INIT_TABLE[7].OrData8 = (UINT8)((100-SetupData.Fan1Mode2AutoRpmF1)*32/60); 
            DXE_FAN1_INIT_TABLE[8].OrData8 = (UINT8)((100-SetupData.Fan1Mode2AutoRpmF2)*32/60);
            DXE_FAN1_INIT_TABLE[9].OrData8 = (UINT8)((100-SetupData.Fan1Mode2AutoRpmF3)*32/60);       
            DXE_FAN1_INIT_TABLE[10].OrData8 = (UINT8)((100-SetupData.Fan1Mode2AutoRpmF4)*32/60);  
		break;
		case 3:
            DXE_FAN1_INIT_TABLE[0].OrData8 = 0x01;//mode
            DXE_FAN1_INIT_TABLE[3].OrData8 = SetupData.Fan1Mode3AutoDutyT1;
            DXE_FAN1_INIT_TABLE[4].OrData8 = SetupData.Fan1Mode3AutoDutyT2;
            DXE_FAN1_INIT_TABLE[5].OrData8 = SetupData.Fan1Mode3AutoDutyT3;    
            DXE_FAN1_INIT_TABLE[6].OrData8 = SetupData.Fan1Mode3AutoDutyT4;   
            DXE_FAN1_INIT_TABLE[7].OrData8 = (UINT8)(SetupData.Fan1Mode3AutoDutyF1*0xFF/100); 
            DXE_FAN1_INIT_TABLE[8].OrData8 = (UINT8)(SetupData.Fan1Mode3AutoDutyF2*0xFF/100);
            DXE_FAN1_INIT_TABLE[9].OrData8 = (UINT8)(SetupData.Fan1Mode3AutoDutyF3*0xFF/100);       
            DXE_FAN1_INIT_TABLE[10].OrData8 = (UINT8)(SetupData.Fan1Mode3AutoDutyF4*0xFF/100);             
		break;
		default:
		break;
    }
    for(i=0; i<( (sizeof(DXE_FAN1_INIT_TABLE))/(sizeof(DXE_SMF_INIT_DATA)) ); i++) {
        IoWrite8(HWM_CONFIG_INDEX, DXE_FAN1_INIT_TABLE[i].Reg8 ); 
        if(DXE_FAN1_INIT_TABLE[i].AndData8 == 0xFF) {
            temp = DXE_FAN1_INIT_TABLE[i].OrData8;
            } else {
            temp = IoRead8(HWM_CONFIG_DATA);
            temp &= DXE_FAN1_INIT_TABLE[i].AndData8;
            temp |= DXE_FAN1_INIT_TABLE[i].OrData8;
        }
        IoWrite8(HWM_CONFIG_DATA, temp); 
    }
}

//<AMI_PHDR_START>
//---------------------------------------------------------------------------
// Procedure:    F81866_SMF2_INIT
//
// Description:    This function do smart fan2 config
//
// Input:        NULL
//
//
// Output:      NULL
//
//---------------------------------------------------------------------------
//<AMI_PHDR_END>
void    F81866_SMF2_INIT(VOID)
{
    UINT8   i, temp;
	switch (SetupData.Fan2SmartFanMode) {
		case 0:
            DXE_FAN2_INIT_TABLE[0].OrData8 = 0x02 << 2;//mode
            DXE_FAN2_INIT_TABLE[1].OrData8 = (UINT8)(1500000/SetupData.Fan2Mode0FixedSpeed >> 8);//mode
            DXE_FAN2_INIT_TABLE[2].OrData8 = (UINT8)(1500000/SetupData.Fan2Mode0FixedSpeed & 0xFF);//mode
		break;
		case 1:
            DXE_FAN2_INIT_TABLE[0].OrData8 = 0x03 << 2;//mode
            DXE_FAN2_INIT_TABLE[2].OrData8 = (UINT8)(SetupData.Fan2Mode1FixedDuty*0xFF/100);//mode
		break;
		case 2:
            DXE_FAN2_INIT_TABLE[0].OrData8 = 0x00 << 2;//mode
            DXE_FAN2_INIT_TABLE[3].OrData8 = SetupData.Fan2Mode2AutoRpmT1;
            DXE_FAN2_INIT_TABLE[4].OrData8 = SetupData.Fan2Mode2AutoRpmT2;
            DXE_FAN2_INIT_TABLE[5].OrData8 = SetupData.Fan2Mode2AutoRpmT3;    
            DXE_FAN2_INIT_TABLE[6].OrData8 = SetupData.Fan2Mode2AutoRpmT4;   
            DXE_FAN2_INIT_TABLE[7].OrData8 = (UINT8)((100-SetupData.Fan2Mode2AutoRpmF1)*32/60); 
            DXE_FAN2_INIT_TABLE[8].OrData8 = (UINT8)((100-SetupData.Fan2Mode2AutoRpmF2)*32/60);
            DXE_FAN2_INIT_TABLE[9].OrData8 = (UINT8)((100-SetupData.Fan2Mode2AutoRpmF3)*32/60);       
            DXE_FAN2_INIT_TABLE[10].OrData8 = (UINT8)((100-SetupData.Fan2Mode2AutoRpmF4)*32/60);  
		break;
		case 3:
            DXE_FAN2_INIT_TABLE[0].OrData8 = 0x01 << 2;//mode
            DXE_FAN2_INIT_TABLE[3].OrData8 = SetupData.Fan2Mode3AutoDutyT1;
            DXE_FAN2_INIT_TABLE[4].OrData8 = SetupData.Fan2Mode3AutoDutyT2;
            DXE_FAN2_INIT_TABLE[5].OrData8 = SetupData.Fan2Mode3AutoDutyT3;    
            DXE_FAN2_INIT_TABLE[6].OrData8 = SetupData.Fan2Mode3AutoDutyT4;   
            DXE_FAN2_INIT_TABLE[7].OrData8 = (UINT8)(SetupData.Fan2Mode3AutoDutyF1*0xFF/100); 
            DXE_FAN2_INIT_TABLE[8].OrData8 = (UINT8)(SetupData.Fan2Mode3AutoDutyF2*0xFF/100);
            DXE_FAN2_INIT_TABLE[9].OrData8 = (UINT8)(SetupData.Fan2Mode3AutoDutyF3*0xFF/100);       
            DXE_FAN2_INIT_TABLE[10].OrData8 = (UINT8)(SetupData.Fan2Mode3AutoDutyF4*0xFF/100);             
		break;
		default:
		break;
    }
    for(i=0; i<( (sizeof(DXE_FAN2_INIT_TABLE))/(sizeof(DXE_SMF_INIT_DATA)) ); i++) {
        IoWrite8(HWM_CONFIG_INDEX, DXE_FAN2_INIT_TABLE[i].Reg8 ); 
        if(DXE_FAN2_INIT_TABLE[i].AndData8 == 0xFF) {
            temp = DXE_FAN2_INIT_TABLE[i].OrData8;
            } else {
            temp = IoRead8(HWM_CONFIG_DATA);
            temp &= DXE_FAN2_INIT_TABLE[i].AndData8;
            temp |= DXE_FAN2_INIT_TABLE[i].OrData8;
        }
        IoWrite8(HWM_CONFIG_DATA, temp); 
    }
}

//<AMI_PHDR_START>
//---------------------------------------------------------------------------
// Procedure:    F81866_SMF3_INIT
//
// Description:    This function do smart fan3 config
//
// Input:        NULL
//
//
// Output:      NULL
//
//---------------------------------------------------------------------------
//<AMI_PHDR_END>
void    F81866_SMF3_INIT(VOID)
{
    UINT8   i, temp;
	switch (SetupData.Fan3SmartFanMode) {
		case 0:
            DXE_FAN3_INIT_TABLE[0].OrData8 = 0x02 << 4;//mode
            DXE_FAN3_INIT_TABLE[1].OrData8 = (UINT8)(1500000/SetupData.Fan3Mode0FixedSpeed >> 8);//mode
            DXE_FAN3_INIT_TABLE[2].OrData8 = (UINT8)(1500000/SetupData.Fan3Mode0FixedSpeed & 0xFF);//mode
		break;
		case 1:
            DXE_FAN3_INIT_TABLE[0].OrData8 = 0x03 << 4;//mode
            DXE_FAN3_INIT_TABLE[2].OrData8 = (UINT8)(SetupData.Fan3Mode1FixedDuty*0xFF/100);//mode
		break;
		case 2:
            DXE_FAN3_INIT_TABLE[0].OrData8 = 0x00 << 4;//mode
            DXE_FAN3_INIT_TABLE[3].OrData8 = SetupData.Fan3Mode2AutoRpmT1;
            DXE_FAN3_INIT_TABLE[4].OrData8 = SetupData.Fan3Mode2AutoRpmT2;
            DXE_FAN3_INIT_TABLE[5].OrData8 = SetupData.Fan3Mode2AutoRpmT3;    
            DXE_FAN3_INIT_TABLE[6].OrData8 = SetupData.Fan3Mode2AutoRpmT4;   
            DXE_FAN3_INIT_TABLE[7].OrData8 = (UINT8)((100-SetupData.Fan3Mode2AutoRpmF1)*32/60); 
            DXE_FAN3_INIT_TABLE[8].OrData8 = (UINT8)((100-SetupData.Fan3Mode2AutoRpmF2)*32/60);
            DXE_FAN3_INIT_TABLE[9].OrData8 = (UINT8)((100-SetupData.Fan3Mode2AutoRpmF3)*32/60);       
            DXE_FAN3_INIT_TABLE[10].OrData8 = (UINT8)((100-SetupData.Fan3Mode2AutoRpmF4)*32/60);  
		break;
		case 3:
            DXE_FAN3_INIT_TABLE[0].OrData8 = 0x01 << 4;//mode
            DXE_FAN3_INIT_TABLE[3].OrData8 = SetupData.Fan3Mode3AutoDutyT1;
            DXE_FAN3_INIT_TABLE[4].OrData8 = SetupData.Fan3Mode3AutoDutyT2;
            DXE_FAN3_INIT_TABLE[5].OrData8 = SetupData.Fan3Mode3AutoDutyT3;    
            DXE_FAN3_INIT_TABLE[6].OrData8 = SetupData.Fan3Mode3AutoDutyT4;   
            DXE_FAN3_INIT_TABLE[7].OrData8 = (UINT8)(SetupData.Fan3Mode3AutoDutyF1*0xFF/100); 
            DXE_FAN3_INIT_TABLE[8].OrData8 = (UINT8)(SetupData.Fan3Mode3AutoDutyF2*0xFF/100);
            DXE_FAN3_INIT_TABLE[9].OrData8 = (UINT8)(SetupData.Fan3Mode3AutoDutyF3*0xFF/100);       
            DXE_FAN3_INIT_TABLE[10].OrData8 = (UINT8)(SetupData.Fan3Mode3AutoDutyF4*0xFF/100);             
		break;
		default:
		break;
    }
    for(i=0; i<( (sizeof(DXE_FAN3_INIT_TABLE))/(sizeof(DXE_SMF_INIT_DATA)) ); i++) {
        IoWrite8(HWM_CONFIG_INDEX, DXE_FAN3_INIT_TABLE[i].Reg8 ); 
        if(DXE_FAN3_INIT_TABLE[i].AndData8 == 0xFF) {
            temp = DXE_FAN3_INIT_TABLE[i].OrData8;
            } else {
            temp = IoRead8(HWM_CONFIG_DATA);
            temp &= DXE_FAN3_INIT_TABLE[i].AndData8;
            temp |= DXE_FAN3_INIT_TABLE[i].OrData8;
        }
        IoWrite8(HWM_CONFIG_DATA, temp); 
    }
}

//<AMI_PHDR_START>
//---------------------------------------------------------------------------
// Procedure:    HwmCallbackReadyToBoot
//
// Description:    This function save registers for S3
//
// Input:        NULL
//
//
// Output:      NULL
//
//---------------------------------------------------------------------------
//<AMI_PHDR_END>
static EFI_STATUS HwmCallbackReadyToBoot(
    IN  EFI_EVENT Event,
    IN  VOID    *Context)
{
    EFI_BOOT_SCRIPT_SAVE_PROTOCOL *bss;
    EFI_STATUS      Status;
    UINT8           bank_reg,bank,r,v,i;

    Status = pBS->LocateProtocol(&gEfiBootScriptSaveGuid,NULL,&bss);
    if(EFI_ERROR(Status)) return Status;

    // record the register from table into boot script 
    for (i=0; i < ((sizeof(HwmS3SaveRegisterTbl))/(sizeof(S3_SAVE_DATA))); i++) {
        bank = HwmS3SaveRegisterTbl[i].Bank;
        bank_reg = 0x4e;
        r = HwmS3SaveRegisterTbl[i].Reg8;

        //select bank
        IoWrite8(HWM_CONFIG_INDEX, bank_reg);
        IoWrite8(HWM_CONFIG_DATA, bank);
        //select register to read actual data
        IoWrite8(HWM_CONFIG_INDEX, r);
        v = IoRead8(HWM_CONFIG_DATA);
        //save to s3 bootscrip table
        BOOT_SCRIPT_S3_IO_WRITE_MACRO(bss,EfiBootScriptWidthUint8,HWM_CONFIG_INDEX, 1, &bank_reg);
        BOOT_SCRIPT_S3_IO_WRITE_MACRO(bss,EfiBootScriptWidthUint8,HWM_CONFIG_DATA, 1, &bank);

        BOOT_SCRIPT_S3_IO_WRITE_MACRO(bss,EfiBootScriptWidthUint8,HWM_CONFIG_INDEX, 1, &r);
        BOOT_SCRIPT_S3_IO_WRITE_MACRO(bss,EfiBootScriptWidthUint8,HWM_CONFIG_DATA, 1, &v);
    }

    return Status;
}


//*************************************************************************
//*************************************************************************
//**                                                                     **
//**        (C)Copyright 1985-2008, American Megatrends, Inc.            **
//**                                                                     **
//**                       All Rights Reserved.                          **
//**                                                                     **
//**      5555 Oakbrook Parkway, Suite 200, Norcross, GA 30093           **
//**                                                                     **
//**                       Phone: (770)-246-8600                         **
//**                                                                     **
//*************************************************************************
//*************************************************************************