port.c

Go to the documentation of this file.

/*++

Copyright (c) 1992  Microsoft Corporation

Module Name:

    port.c

Abstract:

    This is the console fullscreen driver for the VGA card.

Environment:

    kernel mode only

Notes:

Revision History:

--*/

#include "stdarg.h"
#include "stdio.h"
#include "ntddk.h"
#include "fsvga.h"
#include "fsvgalog.h"


VOID
GetHardwareScrollReg(
    PDEVICE_EXTENSION deviceExtension
    )

/*++

Routine Description:

    This routine gets the hardware scrolls register value.

Arguments:

Return Value:

--*/

{
    UCHAR low;
    UCHAR high;
    UCHAR mid;

    WRITE_PORT_UCHAR(deviceExtension->DeviceRegisters[CRTCAddressPortColor],
                      IND_START_ADRS_L);
    low = READ_PORT_UCHAR(deviceExtension->DeviceRegisters[CRTCDataPortColor]);

    WRITE_PORT_UCHAR(deviceExtension->DeviceRegisters[CRTCAddressPortColor],
                      IND_START_ADRS_H);
    high = READ_PORT_UCHAR(deviceExtension->DeviceRegisters[CRTCDataPortColor]);

    deviceExtension->EmulateInfo.StartAddress = MAKEWORD(low, high);

    WRITE_PORT_UCHAR(deviceExtension->DeviceRegisters[CRTCAddressPortColor],
                      IND_LINE_COMPARE);
    low = READ_PORT_UCHAR(deviceExtension->DeviceRegisters[CRTCDataPortColor]);

    WRITE_PORT_UCHAR(deviceExtension->DeviceRegisters[CRTCAddressPortColor],
                      IND_LINE_COMPARE8);
    mid = READ_PORT_UCHAR(deviceExtension->DeviceRegisters[CRTCDataPortColor]);
    mid = (mid >> 4) & 1;

    WRITE_PORT_UCHAR(deviceExtension->DeviceRegisters[CRTCAddressPortColor],
                      IND_LINE_COMPARE9);
    high = READ_PORT_UCHAR(deviceExtension->DeviceRegisters[CRTCDataPortColor]);
    high = (high >> 5) & 2;

    high |= mid;
    deviceExtension->EmulateInfo.LineCompare = MAKEWORD(low, high);
}

VOID
SetGRAMWriteMode(
    PDEVICE_EXTENSION deviceExtension
    )

/*++

Routine Description:

    This routine sets the write mode of graphics register.

Arguments:

Return Value:

--*/

{
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_GRAPH_MODE, M_PROC_WRITE+M_DATA_READ));

    //
    // Set up to write data without interacting with the latches.
    //
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_DATA_ROTATE, DR_SET));

    //
    // Enable all the available EGA planes.
    //
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[SEQUAddressPort],
                      MAKEWORD(IND_MAP_MASK, GRAPH_ADDR_MASK));
    //
    // Use all pixel positions.
    //
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_BIT_MASK, BIT_MASK_DEFAULT));

}

VOID
SetGRAMCopyMode(
    PDEVICE_EXTENSION deviceExtension
    )

/*++

Routine Description:

    This routine sets the copy mode of graphics register.

Arguments:

Return Value:

--*/

{
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_GRAPH_MODE, M_LATCH_WRITE+M_COLOR_READ));

    //
    // Set up to write data without interacting with the latches.
    //
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_DATA_ROTATE, DR_SET));

    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_COLOR_DONT_CARE, 0));
}

VOID
SetGRAMInvertMode(
    PDEVICE_EXTENSION deviceExtension
    )

/*++

Routine Description:

    This routine sets the invert mode of graphics register.

Arguments:

Return Value:

--*/

{
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_GRAPH_MODE, M_AND_WRITE+M_COLOR_READ));

    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_DATA_ROTATE, DR_XOR));

    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_BIT_MASK, BIT_MASK_DEFAULT));

    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_COLOR_DONT_CARE, 0));

    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_SET_RESET, 0xff));
}

VOID
set_opaque_bkgnd_proc(
    PDEVICE_EXTENSION deviceExtension,
    PUCHAR FrameBuffer,
    WORD Attributes
    )

/*++

set_opaque_bkgnd

  Set the VGA registers for drawing a full screen byte with opaque
  font and opaque background.

Created.

--*/

{
    BYTE ColorFg = LOBYTE(Attributes) & 0x0f;
    BYTE ColorBg = (LOBYTE(Attributes) & 0xf0) >> 4;

    if (Attributes & COMMON_LVB_REVERSE_VIDEO)
    {
        Attributes = ColorBg;
        ColorBg = ColorFg;
        ColorFg = (BYTE)Attributes;
    }

    if (deviceExtension->EmulateInfo.ColorFg == ColorFg &&
        deviceExtension->EmulateInfo.ColorBg == ColorBg)
        return;

    deviceExtension->EmulateInfo.ColorFg = ColorFg;
    deviceExtension->EmulateInfo.ColorBg = ColorBg;

    ColorSetDirect(deviceExtension, FrameBuffer, ColorFg, ColorBg);
}

VOID
ColorSetGridMask(
    PDEVICE_EXTENSION deviceExtension,
    BYTE BitMask
    )
{

    //
    // That color is used for all planes.
    //
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_SET_RESET_ENABLE, GRAPH_ADDR_MASK));

    //
    // Change the Set/Reset register to be all set.
    //
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_SET_RESET, 0x07));

    //
    // Use specified pixel positions.
    //
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_BIT_MASK, BitMask));

    //
    // Set up to write data without interacting with the latches.
    //
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_DATA_ROTATE, DR_SET));
}

VOID
ColorSetDirect(
    PDEVICE_EXTENSION deviceExtension,
    PUCHAR FrameBuffer,
    BYTE ColorFg,
    BYTE ColorBg
    )

/*++

ColorSetDirect

  Set the VGA registers for drawing a full screen byte with opaque
  font and opaque background.

Created.

--*/

{
    //
    // Set up to write data without interacting with the latches.
    //
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_DATA_ROTATE, DR_SET));

    //
    // Put the background color in the Set/Reset register.
    //
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_SET_RESET, ColorBg));

    //
    // That color is used for all planes.
    //
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_SET_RESET_ENABLE, GRAPH_ADDR_MASK));

    //
    // This gets our background color into the latches.
    //
    AccessGRAM_WR(FrameBuffer, GRAPH_ADDR_MASK);

    //
    // Change the Set/Reset register to be all zeroes.
    //
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_SET_RESET, 0));

    //
    // The Set/Reset enable register now flags where the foreground/background colors are the same.
    //
    ColorFg = ~(ColorFg ^ ColorBg);
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_SET_RESET_ENABLE, ColorFg));

    //
    // Color differences will be xor'd with the latches.
    //
    WRITE_PORT_USHORT(deviceExtension->DeviceRegisters[GRAPHAddressPort],
                      MAKEWORD(IND_DATA_ROTATE, DR_XOR));


}

---