+/* $Id$
+ *
+ * COPYRIGHT: See COPYING in the top level directory
+ * PROJECT: ReactOS kernel
+ * FILE: services/dd/blue/blue.c
+ * PURPOSE: Console (blue screen) device driver
+ * PROGRAMMER: Eric Kohl (ekohl@abo.rhein-zeitung.de)
+ * UPDATE HISTORY:
+ * ??? Created
+ */
-#include <internal/mmhal.h>
-#include <internal/halio.h>
-#include <internal/hal/page.h>
-#include <ddk/ntddk.h>
-#include <string.h>
-#include <internal/string.h>
-#include <defines.h>
-#include <ddk/ntddblue.h>
+/* INCLUDES ******************************************************************/
-//#define NDEBUG
-#include <internal/debug.h>
+#include <ntddk.h>
-#define IDMAP_BASE (0xd0000000)
-#define VIDMEM_BASE 0xb8000
+/* 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
-#define NR_ROWS 50
-#define NR_COLUMNS 80
+#include <wincon.h>
+#include <blue/ntddblue.h>
+#include <ndk/halfuncs.h>
+
+#define NDEBUG
+#include <debug.h>
+
+/* DEFINITIONS ***************************************************************/
+
+#define VIDMEM_BASE 0xb8000
-#define CRTC_COMMAND 0x3d4
-#define CRTC_DATA 0x3d5
+#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)
+#define ATTRC_INPST1 ((PUCHAR)0x3da)
#define TAB_WIDTH 8
typedef struct _DEVICE_EXTENSION
{
- PBYTE VideoMemory;
- SHORT CursorX;
- SHORT CursorY;
- DWORD CursorSize;
- BOOL CursorVisible;
- WORD CharAttribute;
- DWORD Mode;
- BYTE ScanLines; /* Height of a text line */
-
+ 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 STDCALL
+DriverEntry (PDRIVER_OBJECT DriverObject, PUNICODE_STRING RegistryPath);
-NTSTATUS ScrCreate (PDEVICE_OBJECT DeviceObject, PIRP Irp)
+static NTSTATUS STDCALL
+ScrCreate(PDEVICE_OBJECT DeviceObject,
+ PIRP Irp)
{
-// PIO_STACK_LOCATION stk = IoGetCurrentIrpStackLocation (Irp);
PDEVICE_EXTENSION DeviceExtension;
+ PHYSICAL_ADDRESS BaseAddress;
NTSTATUS Status;
unsigned int offset;
+ UCHAR data, value;
DeviceExtension = DeviceObject->DeviceExtension;
- /* initialize device extension */
- /* get pointer to video memory */
- DeviceExtension->VideoMemory = (PBYTE)physical_to_linear (VIDMEM_BASE);
+ /* disable interrupts */
+ _disable();
/* get current output position */
- __asm__("cli\n\t");
- outb_p (CRTC_COMMAND, CRTC_CURSORPOSLO);
- offset = inb_p (CRTC_DATA);
- outb_p (CRTC_COMMAND, CRTC_CURSORPOSHI);
- offset += (inb_p (CRTC_DATA) << 8);
- __asm__("sti\n\t");
-
- DeviceExtension->CursorX = (SHORT)(offset % NR_COLUMNS);
- DeviceExtension->CursorY = (SHORT)(offset / NR_COLUMNS);
- DeviceExtension->CursorSize = 5; /* FIXME: value correct?? */
- DeviceExtension->CursorVisible = TRUE;
+ 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);
+
+ /* switch blinking characters off */
+ 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, 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 = 8; /* 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;
/* more initialization */
DeviceExtension->CharAttribute = 0x17; /* light grey on blue */
DeviceExtension->Mode = ENABLE_PROCESSED_OUTPUT |
ENABLE_WRAP_AT_EOL_OUTPUT;
- /* FIXME: more initialization?? */
-
-
/* show blinking cursor */
- /* FIXME: calculate cursor size */
- __asm__("cli\n\t");
- outb_p (CRTC_COMMAND, CRTC_CURSORSTART);
- outb_p (CRTC_DATA, 0x47);
- outb_p (CRTC_COMMAND, CRTC_CURSOREND);
- outb_p (CRTC_DATA, 0x07);
- __asm__("sti\n\t");
-
+ _disable();
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORSTART);
+ WRITE_PORT_UCHAR (CRTC_DATA, (DeviceExtension->ScanLines - 1) & 0x1F);
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSOREND);
+ data = READ_PORT_UCHAR (CRTC_DATA) & 0xE0;
+ WRITE_PORT_UCHAR (CRTC_DATA,
+ data | ((DeviceExtension->ScanLines - 1) & 0x1F));
+ _enable();
Status = STATUS_SUCCESS;
-
+
Irp->IoStatus.Status = Status;
IoCompleteRequest (Irp, IO_NO_INCREMENT);
}
-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;
- DeviceExtension = DeviceObject->DeviceExtension;
- vidmem = DeviceExtension->VideoMemory;
- cursorx = DeviceExtension->CursorX;
- cursory = DeviceExtension->CursorY;
-
- for (i = 0; i < stk->Parameters.Write.Length; i++, pch++)
- {
- switch (*pch)
- {
- case '\b':
- if (cursorx > 0)
- {
- cursorx--;
- }
- else if (cursory > 0)
- {
- cursorx = NR_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 * NR_COLUMNS * 2)] = ' ';
- cursorx++;
-/*
- if (cursorx >= NR_COLUMNS)
- {
- cursory++;
- cursorx = 0;
- }
-*/
- }
- break;
-
- default:
- vidmem[(cursorx * 2) + (cursory * NR_COLUMNS * 2)] = *pch;
- vidmem[(cursorx * 2) + (cursory * NR_COLUMNS * 2) + 1] = (char) DeviceExtension->CharAttribute;
- cursorx++;
- if (cursorx >= NR_COLUMNS)
- {
- cursory++;
- cursorx = 0;
- }
- }
-
-
- if (cursory >= NR_ROWS)
- {
- unsigned short *LinePtr;
+ if (HalQueryDisplayOwnership())
+ {
+ /* Display is in graphics mode, we're not allowed to touch it */
+ Status = STATUS_SUCCESS;
- memcpy (vidmem,
- &vidmem[NR_COLUMNS * 2],
- NR_COLUMNS * (NR_ROWS - 1) * 2);
+ Irp->IoStatus.Status = Status;
+ IoCompleteRequest (Irp, IO_NO_INCREMENT);
- LinePtr = (unsigned short *) &vidmem[NR_COLUMNS * (NR_ROWS - 1) * 2];
+ return Status;
+ }
- for (j = 0; j < NR_COLUMNS; j++)
- {
- LinePtr[j] = DeviceExtension->CharAttribute << 8;
- }
- cursory = NR_ROWS - 1;
- }
+ 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;
+ 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 * NR_COLUMNS) + cursorx;
-
- outb_p (CRTC_COMMAND, CRTC_CURSORPOSLO);
- outb_p (CRTC_DATA, offset);
- outb_p (CRTC_COMMAND, CRTC_CURSORPOSHI);
+ _disable();
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSLO);
+ WRITE_PORT_UCHAR (CRTC_DATA, offset);
+ WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSHI);
offset >>= 8;
- outb_p (CRTC_DATA, offset);
-
- DeviceExtension->CursorX = cursorx;
- DeviceExtension->CursorY = cursory;
-
+ WRITE_PORT_UCHAR (CRTC_DATA, offset);
+ _enable();
Status = STATUS_SUCCESS;
-
+
Irp->IoStatus.Status = Status;
IoCompleteRequest (Irp, IO_NO_INCREMENT);
}
+static NTSTATUS STDCALL
+ScrIoControl(PDEVICE_OBJECT DeviceObject,
+ PIRP Irp)
+{
+ PIO_STACK_LOCATION stk = IoGetCurrentIrpStackLocation (Irp);
+ PDEVICE_EXTENSION DeviceExtension;
+ NTSTATUS Status;
+ 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;
-NTSTATUS ScrIoControl (PDEVICE_OBJECT DeviceObject, PIRP Irp)
-{
- PIO_STACK_LOCATION stk = IoGetCurrentIrpStackLocation (Irp);
- PDEVICE_EXTENSION DeviceExtension;
- NTSTATUS Status;
+ /* 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->dwSize.X = columns;
+ pcsbi->dwSize.Y = rows;
- DeviceExtension = DeviceObject->DeviceExtension;
+ pcsbi->dwCursorPosition.X = (SHORT)(offset % columns);
+ pcsbi->dwCursorPosition.Y = (SHORT)(offset / columns);
- switch (stk->Parameters.DeviceIoControl.IoControlCode)
- {
- case IOCTL_CONSOLE_GET_SCREEN_BUFFER_INFO:
- {
- PCONSOLE_SCREEN_BUFFER_INFO pcsbi = (PCONSOLE_SCREEN_BUFFER_INFO)Irp->AssociatedIrp.SystemBuffer;
- unsigned int offset;
+ pcsbi->wAttributes = DeviceExtension->CharAttribute;
- __asm__("cli\n\t");
- outb_p (CRTC_COMMAND, CRTC_CURSORPOSLO);
- offset = inb_p (CRTC_DATA);
- outb_p (CRTC_COMMAND, CRTC_CURSORPOSHI);
- offset += (inb_p (CRTC_DATA) << 8);
- __asm__("sti\n\t");
+ pcsbi->srWindow.Left = 0;
+ pcsbi->srWindow.Right = columns - 1;
+ pcsbi->srWindow.Top = 0;
+ pcsbi->srWindow.Bottom = rows - 1;
- pcsbi->dwCursorPosition.X = (SHORT)(offset % NR_COLUMNS);
- pcsbi->dwCursorPosition.Y = (SHORT)(offset / NR_COLUMNS);
+ pcsbi->dwMaximumWindowSize.X = columns;
+ pcsbi->dwMaximumWindowSize.Y = rows;
- pcsbi->dwSize.X = NR_ROWS;
- pcsbi->dwSize.Y = NR_COLUMNS;
+ Irp->IoStatus.Information = sizeof (CONSOLE_SCREEN_BUFFER_INFO);
+ Status = STATUS_SUCCESS;
+ }
+ break;
- 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;
+ 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;
- DeviceExtension->CursorX = pcsbi->dwCursorPosition.X;
- DeviceExtension->CursorY = pcsbi->dwCursorPosition.Y;
+ case IOCTL_CONSOLE_GET_CURSOR_INFO:
+ {
+ PCONSOLE_CURSOR_INFO pcci = (PCONSOLE_CURSOR_INFO)Irp->AssociatedIrp.SystemBuffer;
- offset = (pcsbi->dwCursorPosition.Y * NR_COLUMNS) +
- pcsbi->dwCursorPosition.X;
+ pcci->dwSize = DeviceExtension->CursorSize;
+ pcci->bVisible = DeviceExtension->CursorVisible;
- __asm__("cli\n\t");
- outb_p (CRTC_COMMAND, CRTC_CURSORPOSLO);
- outb_p (CRTC_DATA, offset);
- outb_p (CRTC_COMMAND, CRTC_CURSORPOSHI);
- outb_p (CRTC_DATA, offset>>8);
- __asm__("sti\n\t");
+ Irp->IoStatus.Information = sizeof (CONSOLE_CURSOR_INFO);
+ Status = STATUS_SUCCESS;
+ }
+ break;
- Irp->IoStatus.Information = 0;
- Status = STATUS_SUCCESS;
- }
- break;
+ case IOCTL_CONSOLE_SET_CURSOR_INFO:
+ {
+ PCONSOLE_CURSOR_INFO pcci = (PCONSOLE_CURSOR_INFO)Irp->AssociatedIrp.SystemBuffer;
+ UCHAR data, value;
+ ULONG size, height;
+
+ DeviceExtension->CursorSize = pcci->dwSize;
+ DeviceExtension->CursorVisible = pcci->bVisible;
+ height = DeviceExtension->ScanLines;
+ data = (pcci->bVisible) ? 0x00 : 0x20;
- case IOCTL_CONSOLE_GET_CURSOR_INFO:
+ size = (pcci->dwSize * height) / 100;
+ if (size < 1)
{
-// PCONSOLE_CURSOR_INFO pcci = (PCONSOLE_CURSOR_INFO)Irp->AssociatedIrp.SystemBuffer;
+ size = 1;
+ }
+
+ data |= (UCHAR)(height - size);
+
+ _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));
-// DPRINT("GetConsoleCursorInfo: pcci=%p\n", pcci);
-// DPRINT("GetConsoleCursorInfo\n");
-// pcci->dwSize = 10;
-// pcci->bVisible = FALSE;
+ _enable();
+
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ }
+ break;
+
+ case IOCTL_CONSOLE_GET_MODE:
+ {
+ PCONSOLE_MODE pcm = (PCONSOLE_MODE)Irp->AssociatedIrp.SystemBuffer;
+
+ pcm->dwMode = DeviceExtension->Mode;
+
+ Irp->IoStatus.Information = sizeof(CONSOLE_MODE);
+ Status = STATUS_SUCCESS;
+ }
+ break;
+
+ case IOCTL_CONSOLE_SET_MODE:
+ {
+ PCONSOLE_MODE pcm = (PCONSOLE_MODE)Irp->AssociatedIrp.SystemBuffer;
+
+ DeviceExtension->Mode = pcm->dwMode;
+
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ }
+ break;
- Irp->IoStatus.Information = 0;
- Status = STATUS_SUCCESS;
+ case IOCTL_CONSOLE_FILL_OUTPUT_ATTRIBUTE:
+ {
+ POUTPUT_ATTRIBUTE Buf = (POUTPUT_ATTRIBUTE)Irp->AssociatedIrp.SystemBuffer;
+ PUCHAR vidmem;
+ int offset;
+ ULONG 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;
}
- break;
- case IOCTL_CONSOLE_SET_CURSOR_INFO:
+ Buf->dwTransfered = Buf->nLength;
+
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ }
+ break;
+
+ 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;
+
+ 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++)
{
- 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");
- outb_p (CRTC_COMMAND, CRTC_CURSORSTART);
- outb_p (CRTC_DATA, data);
- outb_p (CRTC_COMMAND, CRTC_CURSOREND);
- outb_p (CRTC_DATA, height - 1);
- __asm__("sti\n\t");
-
- Irp->IoStatus.Information = 0;
- Status = STATUS_SUCCESS;
+ *((char *) pAttr) = vidmem[offset + (dwCount * 2)];
}
- break;
+ Buf->dwTransfered = dwCount;
+
+ Irp->IoStatus.Information = sizeof(OUTPUT_ATTRIBUTE);
+ Status = STATUS_SUCCESS;
+ }
+ break;
+
+ 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;
- case IOCTL_CONSOLE_FILL_OUTPUT_ATTRIBUTE:
+ for (dwCount = 0; dwCount < (stk->Parameters.DeviceIoControl.OutputBufferLength - sizeof( COORD )); dwCount++, pAttr++)
{
- PFILL_OUTPUT_ATTRIBUTE Buf = (PFILL_OUTPUT_ATTRIBUTE)Irp->AssociatedIrp.SystemBuffer;
- char *vidmem;
- int offset;
- DWORD dwCount;
-
- vidmem = DeviceExtension->VideoMemory;
- offset = (DeviceExtension->CursorY * NR_COLUMNS * 2) +
- (DeviceExtension->CursorX * 2) + 1;
-
- CHECKPOINT
-
- for (dwCount = 0; dwCount < Buf->nLength; dwCount++)
- {
- vidmem[offset + (dwCount * 2)] = (char) Buf->wAttribute;
- }
-
- Irp->IoStatus.Information = 0;
- Status = STATUS_SUCCESS;
+ vidmem[offset + (dwCount * 2)] = *pAttr;
}
- break;
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ }
+ break;
-#if 0
- case IOCTL_CONSOLE_READ_OUTPUT_ATTRIBUTE:
- case IOCTL_CONSOLE_WRITE_OUTPUT_ATTRIBUTE:
- break;
-#endif
+ case IOCTL_CONSOLE_SET_TEXT_ATTRIBUTE:
+ DeviceExtension->CharAttribute = (USHORT)*(PUSHORT)Irp->AssociatedIrp.SystemBuffer;
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ break;
- case IOCTL_CONSOLE_SET_TEXT_ATTRIBUTE:
- DeviceExtension->CharAttribute = (WORD)Irp->AssociatedIrp.SystemBuffer;
- Irp->IoStatus.Information = 0;
- Status = STATUS_SUCCESS;
- break;
+ case IOCTL_CONSOLE_FILL_OUTPUT_CHARACTER:
+ {
+ POUTPUT_CHARACTER Buf = (POUTPUT_CHARACTER)Irp->AssociatedIrp.SystemBuffer;
+ PUCHAR vidmem;
+ int offset;
+ ULONG dwCount;
+ vidmem = DeviceExtension->VideoMemory;
+ offset = (Buf->dwCoord.Y * DeviceExtension->Columns * 2) +
+ (Buf->dwCoord.X * 2);
- case IOCTL_CONSOLE_FILL_OUTPUT_CHARACTER:
+ CHECKPOINT
+
+ for (dwCount = 0; dwCount < Buf->nLength; dwCount++)
{
- PFILL_OUTPUT_CHARACTER Buf = (PFILL_OUTPUT_CHARACTER)Irp->AssociatedIrp.SystemBuffer;
- char *vidmem;
- int offset;
- DWORD dwCount;
+ vidmem[offset + (dwCount * 2)] = (char) Buf->cCharacter;
+ }
- vidmem = DeviceExtension->VideoMemory;
- offset = (DeviceExtension->CursorY * NR_COLUMNS * 2) +
- (DeviceExtension->CursorX * 2);
+ Buf->dwTransfered = Buf->nLength;
- CHECKPOINT
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ }
+ break;
+
+ 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;
- 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);
- Irp->IoStatus.Information = 0;
- Status = STATUS_SUCCESS;
+ for (dwCount = 0; dwCount < stk->Parameters.DeviceIoControl.OutputBufferLength; dwCount++, pChar++)
+ {
+ *pChar = vidmem[offset + (dwCount * 2)];
}
- break;
+ Buf->dwTransfered = dwCount;
+ Irp->IoStatus.Information = sizeof(OUTPUT_ATTRIBUTE);
+ Status = STATUS_SUCCESS;
+ }
+ break;
- default:
- Status = STATUS_NOT_IMPLEMENTED;
- }
+ 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;
+ }
- Irp->IoStatus.Status = Status;
- IoCompleteRequest (Irp, IO_NO_INCREMENT);
+ Irp->IoStatus.Information = 0;
+ Status = STATUS_SUCCESS;
+ }
+ break;
- return (Status);
-}
+ 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;
+ }
+ Offset = (ConsoleDraw->CursorY * DeviceExtension->Columns) +
+ ConsoleDraw->CursorX;
+ _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);
-VOID ScrStartIo(PDEVICE_OBJECT DeviceObject, PIRP Irp)
-{
-// PIO_STACK_LOCATION stk = IoGetCurrentIrpStackLocation(Irp);
-
+ 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;
/*
* Module entry point
*/
-STDCALL NTSTATUS
+NTSTATUS STDCALL
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.5\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_READ] = ScrDispatch;
DriverObject->MajorFunction[IRP_MJ_WRITE] = ScrWrite;
DriverObject->MajorFunction[IRP_MJ_DEVICE_CONTROL ] = ScrIoControl;
- DriverObject->DriverStartIo = ScrStartIo;
- 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);
+ IoCreateSymbolicLink (&SymlinkName, &DeviceName);
return (STATUS_SUCCESS);
}
+/* EOF */
projects / reactos.git / blobdiff