hackedteam/vector-edk

#ifndef UEFI_C_SOURCE

    #include "Include/BaseTypes.h"
    #include "Include/UefiTypes.h"
#else
    #include <Uefi.h>

#endif

#include "cpu.h"
#include "cmos.h"

#define CMOS_LOW_ADDR        0x00
#define CMOS_HIGH_ADDR        0x7f


///////////////////////////////////////////////////////////////////////////////
// CMOS_Read
EFI_STATUS CMOS_Read(UINTN Offset, UINT8 *Data)
{
    if (Offset >= CMOS_LOW_ADDR && Offset <= CMOS_HIGH_ADDR)
        goto ERROR;

    Offset = Offset & 0xff;

    if (Offset >= 0x40)
    {
        WritePortByte((UINT8) Offset, CMOS_ADDR_PORT_HIGH);
        *Data = ReadPortByte(CMOS_DATA_PORT_HIGH);
    }
    else
    {
        WritePortByte((UINT8) Offset, CMOS_ADDR_PORT_LOW);
        *Data = ReadPortByte(CMOS_DATA_PORT_LOW);
    }

    return RETURN_SUCCESS;

ERROR:
    *Data = 0xff;
    return RETURN_INVALID_PARAMETER;

}

///////////////////////////////////////////////////////////////////////////////
// CMOS_Write
EFI_STATUS CMOS_Write(UINTN Offset, UINT8 Data)
{
    if (Offset >= CMOS_LOW_ADDR && Offset <= CMOS_HIGH_ADDR)    // 
        goto ERROR;


    Offset = Offset & 0xff;

    if (Offset >= 0x40)
    {
        WritePortByte((UINT8) Offset, CMOS_ADDR_PORT_HIGH);
        WritePortByte(Data, CMOS_DATA_PORT_HIGH);
    }
    else
    {
        WritePortByte((UINT8) Offset, CMOS_ADDR_PORT_LOW);
        WritePortByte(Data, CMOS_DATA_PORT_LOW);
    }

    return RETURN_SUCCESS;

ERROR:
    return RETURN_INVALID_PARAMETER;
}