-/* $Id: blue.c,v 1.15 1999/12/10 17:04:37 dwelch Exp $
+/* $Id$
*
* COPYRIGHT: See COPYING in the top level directory
* PROJECT: ReactOS kernel
/* INCLUDES ******************************************************************/
-#include <ddk/ntddk.h>
-#include <ddk/ntddblue.h>
-#include <string.h>
-#include <defines.h>
+#include <ntddk.h>
-#define NDEBUG
-#include <internal/debug.h>
+/* FIXME: W32API NEEDS TO BE FIXED */
+#ifdef _MSC_VER
+/*
+ * Wincon.h can't be included due to missing user-mode types,
+ * so we'll define them here
+ */
+typedef ULONG DWORD, *LPDWORD;
+typedef USHORT UINT, *LPWORD;
+typedef USHORT WORD;
+typedef UCHAR BYTE;
+typedef INT BOOL;
+typedef PVOID HWND;
+typedef PVOID LPVOID;
+#define WINAPI NTAPI
+#define APIENTRY WINAPI
+#define WINBASEAPI
+typedef struct _SECURITY_ATTRIBUTES SECURITY_ATTRIBUTES, *PSECURITY_ATTRIBUTES;
+#endif
+
+#include <wincon.h>
+#include <blue/ntddblue.h>
+#include <ndk/halfuncs.h>
+#define NDEBUG
+#include <debug.h>
/* DEFINITIONS ***************************************************************/
-#define IDMAP_BASE 0xd0000000
#define VIDMEM_BASE 0xb8000
-#define NR_ROWS 50
-#define NR_COLUMNS 80
-#define NR_SCANLINES 8
-
#define CRTC_COMMAND ((PUCHAR)0x3d4)
#define CRTC_DATA ((PUCHAR)0x3d5)
#define CRTC_COLUMNS 0x01
+#define CRTC_OVERFLOW 0x07
#define CRTC_ROWS 0x12
#define CRTC_SCANLINES 0x09
#define CRTC_CURSORSTART 0x0a
#define CRTC_CURSOREND 0x0b
-#define CRTC_CURSORPOSLO 0x0f
#define CRTC_CURSORPOSHI 0x0e
+#define CRTC_CURSORPOSLO 0x0f
#define ATTRC_WRITEREG ((PUCHAR)0x3c0)
#define ATTRC_READREG ((PUCHAR)0x3c1)
typedef struct _DEVICE_EXTENSION
{
- PBYTE VideoMemory; /* Pointer to video memory */
- DWORD CursorSize;
- BOOL CursorVisible;
- WORD CharAttribute;
- DWORD Mode;
- BYTE ScanLines; /* Height of a text line */
- BYTE Rows; /* Number of rows */
- BYTE Columns; /* Number of columns */
+ PUCHAR VideoMemory; /* Pointer to video memory */
+ ULONG CursorSize;
+ INT CursorVisible;
+ USHORT CharAttribute;
+ ULONG Mode;
+ UCHAR ScanLines; /* Height of a text line */
+ USHORT Rows; /* Number of rows */
+ USHORT Columns; /* Number of columns */
} DEVICE_EXTENSION, *PDEVICE_EXTENSION;
/* FUNCTIONS **************************************************************/
-NTSTATUS
-ScrCreate (PDEVICE_OBJECT DeviceObject, PIRP Irp)
+NTSTATUS STDCALL
+DriverEntry (PDRIVER_OBJECT DriverObject, PUNICODE_STRING RegistryPath);
+
+static NTSTATUS STDCALL
+ScrCreate(PDEVICE_OBJECT DeviceObject,
+ PIRP Irp)
{
PDEVICE_EXTENSION DeviceExtension;
+ PHYSICAL_ADDRESS BaseAddress;
NTSTATUS Status;
unsigned int offset;
- BYTE data, value;
+ UCHAR data, value;
DeviceExtension = DeviceObject->DeviceExtension;
- /* initialize device extension */
-
- /* get pointer to video memory */
- /* FIXME : use MmMapIoSpace() */
- DeviceExtension->VideoMemory = (PBYTE)(IDMAP_BASE + VIDMEM_BASE);
-
- __asm__("cli\n\t");
+ /* disable interrupts */
+ _disable();
/* get current output position */
WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSLO);
offset += (READ_PORT_UCHAR (CRTC_DATA) << 8);
/* switch blinking characters off */
- READ_PORT_UCHAR (ATTRC_INPST1 /*0x3da*/);
- value = READ_PORT_UCHAR (ATTRC_WRITEREG/*0x3c0*/);
- WRITE_PORT_UCHAR (ATTRC_WRITEREG /*0x3c0*/, 0x10);
- data = READ_PORT_UCHAR (ATTRC_READREG /*0x3c1*/);
+ READ_PORT_UCHAR (ATTRC_INPST1);
+ value = READ_PORT_UCHAR (ATTRC_WRITEREG);
+ WRITE_PORT_UCHAR (ATTRC_WRITEREG, 0x10);
+ data = READ_PORT_UCHAR (ATTRC_READREG);
data = data & ~0x08;
- WRITE_PORT_UCHAR (ATTRC_WRITEREG /*0x3c0*/, data);
- WRITE_PORT_UCHAR (ATTRC_WRITEREG /*0x3c0*/, value);
- READ_PORT_UCHAR (ATTRC_INPST1 /*0x3da*/);
- __asm__("sti\n\t");
+ WRITE_PORT_UCHAR (ATTRC_WRITEREG, data);
+ WRITE_PORT_UCHAR (ATTRC_WRITEREG, value);
+ READ_PORT_UCHAR (ATTRC_INPST1);
+
+ /* read screen information from crt controller */
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_COLUMNS);
+ DeviceExtension->Columns = READ_PORT_UCHAR (CRTC_DATA) + 1;
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_ROWS);
+ DeviceExtension->Rows = READ_PORT_UCHAR (CRTC_DATA);
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_OVERFLOW);
+ data = READ_PORT_UCHAR (CRTC_DATA);
+ DeviceExtension->Rows |= (((data & 0x02) << 7) | ((data & 0x40) << 3));
+ DeviceExtension->Rows++;
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_SCANLINES);
+ DeviceExtension->ScanLines = (READ_PORT_UCHAR (CRTC_DATA) & 0x1F) + 1;
+
+ /* enable interrupts */
+ _enable();
+
+ /* calculate number of text rows */
+ DeviceExtension->Rows =
+ DeviceExtension->Rows / DeviceExtension->ScanLines;
+#ifdef BOCHS_30ROWS
+ DeviceExtension->Rows = 30;
+#endif
+
+ DPRINT ("%d Columns %d Rows %d Scanlines\n",
+ DeviceExtension->Columns,
+ DeviceExtension->Rows,
+ DeviceExtension->ScanLines);
- DeviceExtension->ScanLines = NR_SCANLINES; /* FIXME: read it from CRTC */
- DeviceExtension->Rows = NR_ROWS; /* FIXME: read it from CRTC */
- DeviceExtension->Columns = NR_COLUMNS; /* FIXME: read it from CRTC */
+ /* get pointer to video memory */
+ BaseAddress.QuadPart = VIDMEM_BASE;
+ DeviceExtension->VideoMemory =
+ (PUCHAR)MmMapIoSpace (BaseAddress, DeviceExtension->Rows * DeviceExtension->Columns * 2, MmNonCached);
DeviceExtension->CursorSize = 5; /* FIXME: value correct?? */
DeviceExtension->CursorVisible = TRUE;
ENABLE_WRAP_AT_EOL_OUTPUT;
/* show blinking cursor */
- /* FIXME: calculate cursor size */
- __asm__("cli\n\t");
+ _disable();
WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORSTART);
- WRITE_PORT_UCHAR (CRTC_DATA, 0x47);
+ WRITE_PORT_UCHAR (CRTC_DATA, (DeviceExtension->ScanLines - 1) & 0x1F);
WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSOREND);
- WRITE_PORT_UCHAR (CRTC_DATA, 0x07);
- __asm__("sti\n\t");
+ data = READ_PORT_UCHAR (CRTC_DATA) & 0xE0;
+ WRITE_PORT_UCHAR (CRTC_DATA,
+ data | ((DeviceExtension->ScanLines - 1) & 0x1F));
+ _enable();
Status = STATUS_SUCCESS;
}
-NTSTATUS
-ScrWrite (PDEVICE_OBJECT DeviceObject, PIRP Irp)
+static NTSTATUS STDCALL
+ScrWrite(PDEVICE_OBJECT DeviceObject,
+ PIRP Irp)
{
PIO_STACK_LOCATION stk = IoGetCurrentIrpStackLocation (Irp);
- PDEVICE_EXTENSION DeviceExtension;
+ PDEVICE_EXTENSION DeviceExtension = DeviceObject->DeviceExtension;
NTSTATUS Status;
char *pch = Irp->UserBuffer;
- char *vidmem;
- int i, j, offset;
+ PUCHAR vidmem;
+ unsigned int i;
+ int j, offset;
int cursorx, cursory;
int rows, columns;
+ int processed = DeviceExtension->Mode & ENABLE_PROCESSED_OUTPUT;
+
+ if (HalQueryDisplayOwnership())
+ {
+ /* Display is in graphics mode, we're not allowed to touch it */
+ Status = STATUS_SUCCESS;
+
+ Irp->IoStatus.Status = Status;
+ IoCompleteRequest (Irp, IO_NO_INCREMENT);
+
+ return Status;
+ }
- DeviceExtension = DeviceObject->DeviceExtension;
vidmem = DeviceExtension->VideoMemory;
rows = DeviceExtension->Rows;
columns = DeviceExtension->Columns;
+ _disable();
WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSHI);
offset = READ_PORT_UCHAR (CRTC_DATA)<<8;
WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSLO);
offset += READ_PORT_UCHAR (CRTC_DATA);
+ _enable();
cursory = offset / columns;
cursorx = offset % columns;
-
- for (i = 0; i < stk->Parameters.Write.Length; i++, pch++)
- {
- switch (*pch)
- {
- case '\b':
- if (cursorx > 0)
- {
- cursorx--;
- }
- else if (cursory > 0)
- {
- cursorx = columns - 1;
- cursory--;
- }
- break;
-
- case '\n':
- cursory++;
- cursorx = 0;
- break;
-
- case '\r':
- break;
-
- case '\t':
- offset = TAB_WIDTH - (cursorx % TAB_WIDTH);
- for (j = 0; j < offset; j++)
- {
- vidmem[(cursorx * 2) + (cursory * columns * 2)] = ' ';
- cursorx++;
-
- if (cursorx >= columns)
- {
- cursory++;
- cursorx = 0;
- }
- }
- break;
-
- default:
- vidmem[(cursorx * 2) + (cursory * columns * 2)] = *pch;
- vidmem[(cursorx * 2) + (cursory * columns * 2) + 1] = (char) DeviceExtension->CharAttribute;
- cursorx++;
- if (cursorx >= columns)
- {
- cursory++;
- cursorx = 0;
- }
- break;
- }
-
-
- if (cursory >= rows)
- {
- unsigned short *LinePtr;
-
- memcpy (vidmem,
- &vidmem[columns * 2],
- columns * (rows - 1) * 2);
-
- LinePtr = (unsigned short *) &vidmem[columns * (rows - 1) * 2];
-
- for (j = 0; j < columns; j++)
- {
- LinePtr[j] = DeviceExtension->CharAttribute << 8;
- }
- cursory = rows - 1;
- for (j = 0; j < columns; j++)
- {
- vidmem[(j * 2) + (cursory * columns * 2)] = ' ';
- vidmem[(j * 2) + (cursory * columns * 2) + 1] = (char) DeviceExtension->CharAttribute;
- }
- }
+ if( processed == 0 )
+ {
+ /* raw output mode */
+ memcpy( &vidmem[(cursorx * 2) + (cursory * columns * 2)], pch, stk->Parameters.Write.Length );
+ offset += (stk->Parameters.Write.Length / 2);
+ }
+ else {
+ for (i = 0; i < stk->Parameters.Write.Length; i++, pch++)
+ {
+ switch (*pch)
+ {
+ case '\b':
+ if (cursorx > 0)
+ {
+ cursorx--;
+ }
+ else if (cursory > 0)
+ {
+ cursorx = columns - 1;
+ cursory--;
+ }
+ vidmem[(cursorx * 2) + (cursory * columns * 2)] = ' ';
+ vidmem[(cursorx * 2) + (cursory * columns * 2) + 1] = (char) DeviceExtension->CharAttribute;
+ break;
+
+ case '\n':
+ cursory++;
+ cursorx = 0;
+ break;
+
+ case '\r':
+ cursorx = 0;
+ break;
+
+ case '\t':
+ offset = TAB_WIDTH - (cursorx % TAB_WIDTH);
+ for (j = 0; j < offset; j++)
+ {
+ vidmem[(cursorx * 2) + (cursory * columns * 2)] = ' ';
+ cursorx++;
+
+ if (cursorx >= columns)
+ {
+ cursory++;
+ cursorx = 0;
+ }
+ }
+ break;
+
+ default:
+ vidmem[(cursorx * 2) + (cursory * columns * 2)] = *pch;
+ vidmem[(cursorx * 2) + (cursory * columns * 2) + 1] = (char) DeviceExtension->CharAttribute;
+ cursorx++;
+ if (cursorx >= columns)
+ {
+ cursory++;
+ cursorx = 0;
+ }
+ break;
+ }
+ if (cursory >= rows)
+ {
+ unsigned short *LinePtr;
+
+ memcpy (vidmem,
+ &vidmem[columns * 2],
+ columns * (rows - 1) * 2);
+
+ LinePtr = (unsigned short *) &vidmem[columns * (rows - 1) * 2];
+
+ for (j = 0; j < columns; j++)
+ {
+ LinePtr[j] = DeviceExtension->CharAttribute << 8;
+ }
+ cursory = rows - 1;
+ for (j = 0; j < columns; j++)
+ {
+ vidmem[(j * 2) + (cursory * columns * 2)] = ' ';
+ vidmem[(j * 2) + (cursory * columns * 2) + 1] = (char)DeviceExtension->CharAttribute;
+ }
+ }
+ }
+
+ /* Set the cursor position */
+ offset = (cursory * columns) + cursorx;
}
-
-
- /* Set the cursor position */
- offset = (cursory * columns) + cursorx;
-
+ _disable();
WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSLO);
WRITE_PORT_UCHAR (CRTC_DATA, offset);
WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSHI);
offset >>= 8;
WRITE_PORT_UCHAR (CRTC_DATA, offset);
+ _enable();
Status = STATUS_SUCCESS;
-
+
Irp->IoStatus.Status = Status;
IoCompleteRequest (Irp, IO_NO_INCREMENT);
}
-NTSTATUS
-ScrIoControl (PDEVICE_OBJECT DeviceObject, PIRP Irp)
+static NTSTATUS STDCALL
+ScrIoControl(PDEVICE_OBJECT DeviceObject,
+ PIRP Irp)
{
- PIO_STACK_LOCATION stk = IoGetCurrentIrpStackLocation (Irp);
- PDEVICE_EXTENSION DeviceExtension;
- NTSTATUS Status;
+ PIO_STACK_LOCATION stk = IoGetCurrentIrpStackLocation (Irp);
+ PDEVICE_EXTENSION DeviceExtension;
+ NTSTATUS Status;
- DeviceExtension = DeviceObject->DeviceExtension;
-
- switch (stk->Parameters.DeviceIoControl.IoControlCode)
+ DeviceExtension = DeviceObject->DeviceExtension;
+ switch (stk->Parameters.DeviceIoControl.IoControlCode)
{
- case IOCTL_CONSOLE_GET_SCREEN_BUFFER_INFO:
- {
- PCONSOLE_SCREEN_BUFFER_INFO pcsbi = (PCONSOLE_SCREEN_BUFFER_INFO)Irp->AssociatedIrp.SystemBuffer;
- int rows = DeviceExtension->Rows;
- int columns = DeviceExtension->Columns;
- unsigned int offset;
-
- __asm__("cli\n\t");
- WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSLO);
- offset = READ_PORT_UCHAR (CRTC_DATA);
- WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSHI);
- offset += (READ_PORT_UCHAR (CRTC_DATA) << 8);
- __asm__("sti\n\t");
+ case IOCTL_CONSOLE_GET_SCREEN_BUFFER_INFO:
+ {
+ PCONSOLE_SCREEN_BUFFER_INFO pcsbi = (PCONSOLE_SCREEN_BUFFER_INFO)Irp->AssociatedIrp.SystemBuffer;
+ int rows = DeviceExtension->Rows;
+ int columns = DeviceExtension->Columns;
+ unsigned int offset;
- pcsbi->dwSize.X = rows;
- pcsbi->dwSize.Y = columns;
+ /* read cursor position from crtc */
+ _disable();
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSLO);
+ offset = READ_PORT_UCHAR (CRTC_DATA);
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSHI);
+ offset += (READ_PORT_UCHAR (CRTC_DATA) << 8);
+ _enable();
- pcsbi->dwCursorPosition.X = (SHORT)(offset % columns);
- pcsbi->dwCursorPosition.Y = (SHORT)(offset / columns);
+ pcsbi->dwSize.X = columns;
+ pcsbi->dwSize.Y = rows;
- pcsbi->wAttributes = DeviceExtension->CharAttribute;
+ pcsbi->dwCursorPosition.X = (SHORT)(offset % columns);
+ pcsbi->dwCursorPosition.Y = (SHORT)(offset / columns);
- pcsbi->srWindow.Left = 0;
- pcsbi->srWindow.Right = columns - 1;
- pcsbi->srWindow.Top = 0;
- pcsbi->srWindow.Bottom = rows - 1;
+ pcsbi->wAttributes = DeviceExtension->CharAttribute;
- pcsbi->dwMaximumWindowSize.X = columns;
- pcsbi->dwMaximumWindowSize.Y = rows;
+ pcsbi->srWindow.Left = 0;
+ pcsbi->srWindow.Right = columns - 1;
+ pcsbi->srWindow.Top = 0;
+ pcsbi->srWindow.Bottom = rows - 1;
- Irp->IoStatus.Information = sizeof (CONSOLE_SCREEN_BUFFER_INFO);
- Status = STATUS_SUCCESS;
- }
- break;
-
- case IOCTL_CONSOLE_SET_SCREEN_BUFFER_INFO:
- {
- PCONSOLE_SCREEN_BUFFER_INFO pcsbi = (PCONSOLE_SCREEN_BUFFER_INFO)Irp->AssociatedIrp.SystemBuffer;
- unsigned int offset;
+ pcsbi->dwMaximumWindowSize.X = columns;
+ pcsbi->dwMaximumWindowSize.Y = rows;
- DeviceExtension->CharAttribute = pcsbi->wAttributes;
+ Irp->IoStatus.Information = sizeof (CONSOLE_SCREEN_BUFFER_INFO);
+ Status = STATUS_SUCCESS;
+ }
+ break;
- offset = (pcsbi->dwCursorPosition.Y * DeviceExtension->Columns) +
- pcsbi->dwCursorPosition.X;
+ case IOCTL_CONSOLE_SET_SCREEN_BUFFER_INFO:
+ {
+ PCONSOLE_SCREEN_BUFFER_INFO pcsbi = (PCONSOLE_SCREEN_BUFFER_INFO)Irp->AssociatedIrp.SystemBuffer;
+ unsigned int offset;
+
+ DeviceExtension->CharAttribute = pcsbi->wAttributes;
+ offset = (pcsbi->dwCursorPosition.Y * DeviceExtension->Columns) +
+ pcsbi->dwCursorPosition.X;
+
+ _disable();
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSLO);
+ WRITE_PORT_UCHAR (CRTC_DATA, offset);
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSHI);
+ WRITE_PORT_UCHAR (CRTC_DATA, offset>>8);
+ _enable();
+
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ }
+ break;
- __asm__("cli\n\t");
- WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSLO);
- WRITE_PORT_UCHAR (CRTC_DATA, offset);
- WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSHI);
- WRITE_PORT_UCHAR (CRTC_DATA, offset>>8);
- __asm__("sti\n\t");
+ case IOCTL_CONSOLE_GET_CURSOR_INFO:
+ {
+ PCONSOLE_CURSOR_INFO pcci = (PCONSOLE_CURSOR_INFO)Irp->AssociatedIrp.SystemBuffer;
- Irp->IoStatus.Information = 0;
- Status = STATUS_SUCCESS;
- }
- break;
+ pcci->dwSize = DeviceExtension->CursorSize;
+ pcci->bVisible = DeviceExtension->CursorVisible;
- case IOCTL_CONSOLE_GET_CURSOR_INFO:
- {
- PCONSOLE_CURSOR_INFO pcci = (PCONSOLE_CURSOR_INFO)Irp->AssociatedIrp.SystemBuffer;
+ Irp->IoStatus.Information = sizeof (CONSOLE_CURSOR_INFO);
+ Status = STATUS_SUCCESS;
+ }
+ break;
- pcci->dwSize = DeviceExtension->CursorSize;
- pcci->bVisible = DeviceExtension->CursorVisible;
+ case IOCTL_CONSOLE_SET_CURSOR_INFO:
+ {
+ PCONSOLE_CURSOR_INFO pcci = (PCONSOLE_CURSOR_INFO)Irp->AssociatedIrp.SystemBuffer;
+ UCHAR data, value;
+ ULONG size, height;
- Irp->IoStatus.Information = sizeof (CONSOLE_CURSOR_INFO);
- Status = STATUS_SUCCESS;
- }
- break;
+ DeviceExtension->CursorSize = pcci->dwSize;
+ DeviceExtension->CursorVisible = pcci->bVisible;
+ height = DeviceExtension->ScanLines;
+ data = (pcci->bVisible) ? 0x00 : 0x20;
- case IOCTL_CONSOLE_SET_CURSOR_INFO:
+ size = (pcci->dwSize * height) / 100;
+ if (size < 1)
{
- PCONSOLE_CURSOR_INFO pcci = (PCONSOLE_CURSOR_INFO)Irp->AssociatedIrp.SystemBuffer;
- BYTE data;
- DWORD size, height;
-
- DeviceExtension->CursorSize = pcci->dwSize;
- DeviceExtension->CursorVisible = pcci->bVisible;
- height = DeviceExtension->ScanLines;
- data = (pcci->bVisible) ? 0x40 : 0x20;
-
- size = (pcci->dwSize * height) / 100;
- if (size < 1)
- size = 1;
-
- data |= (BYTE)(height - size);
-
- __asm__("cli\n\t");
- WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORSTART);
- WRITE_PORT_UCHAR (CRTC_DATA, data);
- WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSOREND);
- WRITE_PORT_UCHAR (CRTC_DATA, height - 1);
- __asm__("sti\n\t");
-
- Irp->IoStatus.Information = 0;
- Status = STATUS_SUCCESS;
+ size = 1;
}
- break;
- case IOCTL_CONSOLE_GET_MODE:
- {
- PCONSOLE_MODE pcm = (PCONSOLE_MODE)Irp->AssociatedIrp.SystemBuffer;
+ data |= (UCHAR)(height - size);
- pcm->dwMode = DeviceExtension->Mode;
+ _disable();
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORSTART);
+ WRITE_PORT_UCHAR (CRTC_DATA, data);
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSOREND);
+ value = READ_PORT_UCHAR (CRTC_DATA) & 0xE0;
+ WRITE_PORT_UCHAR (CRTC_DATA, value | (height - 1));
- Irp->IoStatus.Information = sizeof(CONSOLE_MODE);
- Status = STATUS_SUCCESS;
- }
- break;
+ _enable();
- case IOCTL_CONSOLE_SET_MODE:
- {
- PCONSOLE_MODE pcm = (PCONSOLE_MODE)Irp->AssociatedIrp.SystemBuffer;
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ }
+ break;
- DeviceExtension->Mode = pcm->dwMode;
+ case IOCTL_CONSOLE_GET_MODE:
+ {
+ PCONSOLE_MODE pcm = (PCONSOLE_MODE)Irp->AssociatedIrp.SystemBuffer;
- Irp->IoStatus.Information = 0;
- Status = STATUS_SUCCESS;
- }
- break;
+ pcm->dwMode = DeviceExtension->Mode;
- case IOCTL_CONSOLE_FILL_OUTPUT_ATTRIBUTE:
- {
- POUTPUT_ATTRIBUTE Buf = (POUTPUT_ATTRIBUTE)Irp->AssociatedIrp.SystemBuffer;
- char *vidmem;
- int offset;
- DWORD dwCount;
-
- vidmem = DeviceExtension->VideoMemory;
- offset = (Buf->dwCoord.Y * DeviceExtension->Columns * 2) +
- (Buf->dwCoord.X * 2) + 1;
-
- for (dwCount = 0; dwCount < Buf->nLength; dwCount++)
- {
- vidmem[offset + (dwCount * 2)] = (char) Buf->wAttribute;
- }
-
- Buf->dwTransfered = Buf->nLength;
-
- Irp->IoStatus.Information = 0;
- Status = STATUS_SUCCESS;
- }
- break;
+ Irp->IoStatus.Information = sizeof(CONSOLE_MODE);
+ Status = STATUS_SUCCESS;
+ }
+ break;
- case IOCTL_CONSOLE_READ_OUTPUT_ATTRIBUTE:
- {
- POUTPUT_ATTRIBUTE Buf = (POUTPUT_ATTRIBUTE)Irp->AssociatedIrp.SystemBuffer;
- LPWORD pAttr = (LPWORD)MmGetSystemAddressForMdl(Irp->MdlAddress);
- char *vidmem;
- int offset;
- DWORD dwCount;
+ case IOCTL_CONSOLE_SET_MODE:
+ {
+ PCONSOLE_MODE pcm = (PCONSOLE_MODE)Irp->AssociatedIrp.SystemBuffer;
- vidmem = DeviceExtension->VideoMemory;
- offset = (Buf->dwCoord.Y * DeviceExtension->Columns * 2) +
- (Buf->dwCoord.X * 2) + 1;
+ DeviceExtension->Mode = pcm->dwMode;
- for (dwCount = 0; dwCount < stk->Parameters.Write.Length; dwCount++, pAttr++)
- {
- (char) *pAttr = vidmem[offset + (dwCount * 2)];
- }
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ }
+ break;
- Buf->dwTransfered = dwCount;
+ case IOCTL_CONSOLE_FILL_OUTPUT_ATTRIBUTE:
+ {
+ POUTPUT_ATTRIBUTE Buf = (POUTPUT_ATTRIBUTE)Irp->AssociatedIrp.SystemBuffer;
+ PUCHAR vidmem;
+ int offset;
+ ULONG dwCount;
- Irp->IoStatus.Information = sizeof(OUTPUT_ATTRIBUTE);
- Status = STATUS_SUCCESS;
- }
- break;
+ vidmem = DeviceExtension->VideoMemory;
+ offset = (Buf->dwCoord.Y * DeviceExtension->Columns * 2) +
+ (Buf->dwCoord.X * 2) + 1;
- case IOCTL_CONSOLE_WRITE_OUTPUT_ATTRIBUTE:
+ for (dwCount = 0; dwCount < Buf->nLength; dwCount++)
{
- POUTPUT_ATTRIBUTE Buf = (POUTPUT_ATTRIBUTE)Irp->AssociatedIrp.SystemBuffer;
- LPWORD pAttr = (LPWORD)MmGetSystemAddressForMdl(Irp->MdlAddress);
- char *vidmem;
- int offset;
- DWORD dwCount;
+ vidmem[offset + (dwCount * 2)] = (char) Buf->wAttribute;
+ }
- vidmem = DeviceExtension->VideoMemory;
- offset = (Buf->dwCoord.Y * DeviceExtension->Columns * 2) +
- (Buf->dwCoord.X * 2) + 1;
+ Buf->dwTransfered = Buf->nLength;
- for (dwCount = 0; dwCount < stk->Parameters.Write.Length; dwCount++, pAttr++)
- {
- vidmem[offset + (dwCount * 2)] = (char) *pAttr;
- }
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ }
+ break;
- Buf->dwTransfered = dwCount;
+ case IOCTL_CONSOLE_READ_OUTPUT_ATTRIBUTE:
+ {
+ POUTPUT_ATTRIBUTE Buf = (POUTPUT_ATTRIBUTE)Irp->AssociatedIrp.SystemBuffer;
+ PUSHORT pAttr = (PUSHORT)MmGetSystemAddressForMdl(Irp->MdlAddress);
+ PUCHAR vidmem;
+ int offset;
+ ULONG dwCount;
- Irp->IoStatus.Information = sizeof(OUTPUT_ATTRIBUTE);
- Status = STATUS_SUCCESS;
+ vidmem = DeviceExtension->VideoMemory;
+ offset = (Buf->dwCoord.Y * DeviceExtension->Columns * 2) +
+ (Buf->dwCoord.X * 2) + 1;
+
+ for (dwCount = 0; dwCount < stk->Parameters.DeviceIoControl.OutputBufferLength; dwCount++, pAttr++)
+ {
+ *((char *) pAttr) = vidmem[offset + (dwCount * 2)];
}
- break;
- case IOCTL_CONSOLE_SET_TEXT_ATTRIBUTE:
- DeviceExtension->CharAttribute = (WORD)*(LPWORD)Irp->AssociatedIrp.SystemBuffer;
- Irp->IoStatus.Information = 0;
- Status = STATUS_SUCCESS;
- break;
+ Buf->dwTransfered = dwCount;
+ Irp->IoStatus.Information = sizeof(OUTPUT_ATTRIBUTE);
+ Status = STATUS_SUCCESS;
+ }
+ break;
- case IOCTL_CONSOLE_FILL_OUTPUT_CHARACTER:
+ case IOCTL_CONSOLE_WRITE_OUTPUT_ATTRIBUTE:
+ {
+ COORD *pCoord = (COORD *)MmGetSystemAddressForMdl(Irp->MdlAddress);
+ CHAR *pAttr = (CHAR *)(pCoord + 1);
+ PUCHAR vidmem;
+ int offset;
+ ULONG dwCount;
+
+ vidmem = DeviceExtension->VideoMemory;
+ offset = (pCoord->Y * DeviceExtension->Columns * 2) +
+ (pCoord->X * 2) + 1;
+
+ for (dwCount = 0; dwCount < (stk->Parameters.DeviceIoControl.OutputBufferLength - sizeof( COORD )); dwCount++, pAttr++)
{
- POUTPUT_CHARACTER Buf = (POUTPUT_CHARACTER)Irp->AssociatedIrp.SystemBuffer;
- char *vidmem;
- int offset;
- DWORD dwCount;
+ vidmem[offset + (dwCount * 2)] = *pAttr;
+ }
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ }
+ break;
- vidmem = DeviceExtension->VideoMemory;
- offset = (Buf->dwCoord.Y * DeviceExtension->Columns * 2) +
- (Buf->dwCoord.X * 2);
+ case IOCTL_CONSOLE_SET_TEXT_ATTRIBUTE:
+ DeviceExtension->CharAttribute = (USHORT)*(PUSHORT)Irp->AssociatedIrp.SystemBuffer;
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ break;
- CHECKPOINT
+ case IOCTL_CONSOLE_FILL_OUTPUT_CHARACTER:
+ {
+ POUTPUT_CHARACTER Buf = (POUTPUT_CHARACTER)Irp->AssociatedIrp.SystemBuffer;
+ PUCHAR vidmem;
+ int offset;
+ ULONG dwCount;
- for (dwCount = 0; dwCount < Buf->nLength; dwCount++)
- {
- vidmem[offset + (dwCount * 2)] = (char) Buf->cCharacter;
- }
+ vidmem = DeviceExtension->VideoMemory;
+ offset = (Buf->dwCoord.Y * DeviceExtension->Columns * 2) +
+ (Buf->dwCoord.X * 2);
- Buf->dwTransfered = Buf->nLength;
+ CHECKPOINT
- Irp->IoStatus.Information = 0;
- Status = STATUS_SUCCESS;
+ for (dwCount = 0; dwCount < Buf->nLength; dwCount++)
+ {
+ vidmem[offset + (dwCount * 2)] = (char) Buf->cCharacter;
}
- break;
- case IOCTL_CONSOLE_READ_OUTPUT_CHARACTER:
- {
- POUTPUT_CHARACTER Buf = (POUTPUT_CHARACTER)Irp->AssociatedIrp.SystemBuffer;
- LPSTR pChar = (LPSTR)MmGetSystemAddressForMdl(Irp->MdlAddress);
- char *vidmem;
- int offset;
- DWORD dwCount;
+ Buf->dwTransfered = Buf->nLength;
- vidmem = DeviceExtension->VideoMemory;
- offset = (Buf->dwCoord.Y * DeviceExtension->Columns * 2) +
- (Buf->dwCoord.X * 2);
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ }
+ break;
- for (dwCount = 0; dwCount < stk->Parameters.Write.Length; dwCount++, pChar++)
- {
- *pChar = vidmem[offset + (dwCount * 2)];
- }
+ case IOCTL_CONSOLE_READ_OUTPUT_CHARACTER:
+ {
+ POUTPUT_CHARACTER Buf = (POUTPUT_CHARACTER)Irp->AssociatedIrp.SystemBuffer;
+ LPSTR pChar = (LPSTR)MmGetSystemAddressForMdl(Irp->MdlAddress);
+ PUCHAR vidmem;
+ int offset;
+ ULONG dwCount;
- Buf->dwTransfered = dwCount;
+ vidmem = DeviceExtension->VideoMemory;
+ offset = (Buf->dwCoord.Y * DeviceExtension->Columns * 2) +
+ (Buf->dwCoord.X * 2);
- Irp->IoStatus.Information = sizeof(OUTPUT_ATTRIBUTE);
- Status = STATUS_SUCCESS;
+ for (dwCount = 0; dwCount < stk->Parameters.DeviceIoControl.OutputBufferLength; dwCount++, pChar++)
+ {
+ *pChar = vidmem[offset + (dwCount * 2)];
}
- break;
- case IOCTL_CONSOLE_WRITE_OUTPUT_CHARACTER:
- {
- POUTPUT_CHARACTER Buf = (POUTPUT_CHARACTER)Irp->AssociatedIrp.SystemBuffer;
- LPSTR pChar = (LPSTR)MmGetSystemAddressForMdl(Irp->MdlAddress);
- char *vidmem;
- int offset;
- DWORD dwCount;
+ Buf->dwTransfered = dwCount;
- vidmem = DeviceExtension->VideoMemory;
- offset = (Buf->dwCoord.Y * DeviceExtension->Columns * 2) +
- (Buf->dwCoord.X * 2) + 1;
+ Irp->IoStatus.Information = sizeof(OUTPUT_ATTRIBUTE);
+ Status = STATUS_SUCCESS;
+ }
+ break;
- for (dwCount = 0; dwCount < stk->Parameters.Write.Length; dwCount++, pChar++)
- {
- vidmem[offset + (dwCount * 2)] = (char) *pChar;
- }
+ case IOCTL_CONSOLE_WRITE_OUTPUT_CHARACTER:
+ {
+ COORD *pCoord;
+ LPSTR pChar;
+ PUCHAR vidmem;
+ int offset;
+ ULONG dwCount;
+
+ pCoord = (COORD *)MmGetSystemAddressForMdl(Irp->MdlAddress);
+ pChar = (CHAR *)(pCoord + 1);
+ vidmem = DeviceExtension->VideoMemory;
+ offset = (pCoord->Y * DeviceExtension->Columns * 2) +
+ (pCoord->X * 2);
+
+ for (dwCount = 0; dwCount < (stk->Parameters.DeviceIoControl.OutputBufferLength - sizeof( COORD )); dwCount++, pChar++)
+ {
+ vidmem[offset + (dwCount * 2)] = *pChar;
+ }
- Buf->dwTransfered = dwCount;
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ }
+ break;
- Irp->IoStatus.Information = sizeof(OUTPUT_ATTRIBUTE);
- Status = STATUS_SUCCESS;
+ case IOCTL_CONSOLE_DRAW:
+ {
+ PCONSOLE_DRAW ConsoleDraw;
+ PUCHAR Src, Dest;
+ UINT SrcDelta, DestDelta, i, Offset;
+
+ ConsoleDraw = (PCONSOLE_DRAW) MmGetSystemAddressForMdl(Irp->MdlAddress);
+ Src = (PUCHAR) (ConsoleDraw + 1);
+ SrcDelta = ConsoleDraw->SizeX * 2;
+ Dest = DeviceExtension->VideoMemory +
+ (ConsoleDraw->Y * DeviceExtension->Columns + ConsoleDraw->X) * 2;
+ DestDelta = DeviceExtension->Columns * 2;
+
+ for (i = 0; i < ConsoleDraw->SizeY; i++)
+ {
+ RtlCopyMemory(Dest, Src, SrcDelta);
+ Src += SrcDelta;
+ Dest += DestDelta;
}
- break;
+ Offset = (ConsoleDraw->CursorY * DeviceExtension->Columns) +
+ ConsoleDraw->CursorX;
- default:
- Status = STATUS_NOT_IMPLEMENTED;
+ _disable();
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSLO);
+ WRITE_PORT_UCHAR (CRTC_DATA, Offset);
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSHI);
+ WRITE_PORT_UCHAR (CRTC_DATA, Offset >> 8);
+ _enable();
+
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ }
+ break;
+
+ default:
+ Status = STATUS_NOT_IMPLEMENTED;
}
- Irp->IoStatus.Status = Status;
- IoCompleteRequest (Irp, IO_NO_INCREMENT);
+ Irp->IoStatus.Status = Status;
+ IoCompleteRequest (Irp, IO_NO_INCREMENT);
- return (Status);
+ return Status;
}
-NTSTATUS
-ScrDispatch (PDEVICE_OBJECT DeviceObject, PIRP Irp)
+static NTSTATUS STDCALL
+ScrDispatch(PDEVICE_OBJECT DeviceObject,
+ PIRP Irp)
{
PIO_STACK_LOCATION stk = IoGetCurrentIrpStackLocation(Irp);
NTSTATUS Status;
DriverEntry (PDRIVER_OBJECT DriverObject, PUNICODE_STRING RegistryPath)
{
PDEVICE_OBJECT DeviceObject;
- ANSI_STRING adevice_name;
- UNICODE_STRING device_name;
- ANSI_STRING asymlink_name;
- UNICODE_STRING symlink_name;
-
- DbgPrint ("Screen Driver 0.0.6\n");
+ UNICODE_STRING DeviceName = RTL_CONSTANT_STRING(L"\\Device\\BlueScreen");
+ UNICODE_STRING SymlinkName = RTL_CONSTANT_STRING(L"\\??\\BlueScreen");
+
+ DPRINT ("Screen Driver 0.0.6\n");
DriverObject->MajorFunction[IRP_MJ_CREATE] = ScrCreate;
DriverObject->MajorFunction[IRP_MJ_CLOSE] = ScrDispatch;
DriverObject->MajorFunction[IRP_MJ_WRITE] = ScrWrite;
DriverObject->MajorFunction[IRP_MJ_DEVICE_CONTROL ] = ScrIoControl;
- RtlInitAnsiString (&adevice_name, "\\Device\\BlueScreen");
- RtlAnsiStringToUnicodeString (&device_name, &adevice_name, TRUE);
IoCreateDevice (DriverObject,
sizeof(DEVICE_EXTENSION),
- &device_name,
+ &DeviceName,
FILE_DEVICE_SCREEN,
0,
TRUE,
&DeviceObject);
- RtlInitAnsiString (&asymlink_name, "\\??\\BlueScreen");
- RtlAnsiStringToUnicodeString (&symlink_name, &asymlink_name, TRUE);
- IoCreateSymbolicLink (&symlink_name, &device_name);
-
- RtlFreeUnicodeString (&device_name);
- RtlFreeUnicodeString (&symlink_name);
+ IoCreateSymbolicLink (&SymlinkName, &DeviceName);
return (STATUS_SUCCESS);
}
projects / reactos.git / blobdiff