-/* $Id: blue.c,v 1.15 1999/12/10 17:04:37 dwelch Exp $
+/* $Id: blue.c,v 1.30 2001/07/30 11:49:38 ea Exp $
*
* COPYRIGHT: See COPYING in the top level directory
* PROJECT: ReactOS kernel
#include <defines.h>
#define NDEBUG
-#include <internal/debug.h>
+#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 VIDMEM_SIZE 0x2000
#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)
WORD CharAttribute;
DWORD Mode;
BYTE ScanLines; /* Height of a text line */
- BYTE Rows; /* Number of rows */
- BYTE Columns; /* Number of columns */
+ WORD Rows; /* Number of rows */
+ WORD Columns; /* Number of columns */
} DEVICE_EXTENSION, *PDEVICE_EXTENSION;
/* FUNCTIONS **************************************************************/
NTSTATUS
-ScrCreate (PDEVICE_OBJECT DeviceObject, PIRP Irp)
+STDCALL ScrCreate (PDEVICE_OBJECT DeviceObject, PIRP Irp)
{
PDEVICE_EXTENSION DeviceExtension;
+ PHYSICAL_ADDRESS BaseAddress;
NTSTATUS Status;
unsigned int offset;
BYTE data, value;
DeviceExtension = DeviceObject->DeviceExtension;
- /* initialize device extension */
-
/* get pointer to video memory */
- /* FIXME : use MmMapIoSpace() */
- DeviceExtension->VideoMemory = (PBYTE)(IDMAP_BASE + VIDMEM_BASE);
+ BaseAddress.QuadPart = VIDMEM_BASE;
+ DeviceExtension->VideoMemory =
+ (PBYTE)MmMapIoSpace (BaseAddress, VIDMEM_SIZE, FALSE);
+ /* disable interrupts */
__asm__("cli\n\t");
/* get current output position */
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*/);
+ 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 */
__asm__("sti\n\t");
- 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 */
+ /* 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->CursorSize = 5; /* FIXME: value correct?? */
DeviceExtension->CursorVisible = TRUE;
ENABLE_WRAP_AT_EOL_OUTPUT;
/* show blinking cursor */
- /* FIXME: calculate cursor size */
__asm__("cli\n\t");
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);
+ data = READ_PORT_UCHAR (CRTC_DATA) & 0xE0;
+ WRITE_PORT_UCHAR (CRTC_DATA,
+ data | ((DeviceExtension->ScanLines - 1) & 0x1F));
__asm__("sti\n\t");
Status = STATUS_SUCCESS;
NTSTATUS
-ScrWrite (PDEVICE_OBJECT DeviceObject, PIRP Irp)
+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;
int cursorx, cursory;
int rows, columns;
+ int processed = DeviceExtension->Mode & ENABLE_PROCESSED_OUTPUT;
- DeviceExtension = DeviceObject->DeviceExtension;
vidmem = DeviceExtension->VideoMemory;
rows = DeviceExtension->Rows;
columns = DeviceExtension->Columns;
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;
-
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);
Status = STATUS_SUCCESS;
-
+
Irp->IoStatus.Status = Status;
IoCompleteRequest (Irp, IO_NO_INCREMENT);
NTSTATUS
-ScrIoControl (PDEVICE_OBJECT DeviceObject, PIRP Irp)
+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:
int columns = DeviceExtension->Columns;
unsigned int offset;
+ /* read cursor position from crtc */
__asm__("cli\n\t");
WRITE_PORT_UCHAR (CRTC_COMMAND, CRTC_CURSORPOSLO);
offset = READ_PORT_UCHAR (CRTC_DATA);
offset += (READ_PORT_UCHAR (CRTC_DATA) << 8);
__asm__("sti\n\t");
- pcsbi->dwSize.X = rows;
- pcsbi->dwSize.Y = columns;
+ pcsbi->dwSize.X = columns;
+ pcsbi->dwSize.Y = rows;
pcsbi->dwCursorPosition.X = (SHORT)(offset % columns);
pcsbi->dwCursorPosition.Y = (SHORT)(offset / columns);
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;
DeviceExtension->CharAttribute = pcsbi->wAttributes;
-
offset = (pcsbi->dwCursorPosition.Y * DeviceExtension->Columns) +
pcsbi->dwCursorPosition.X;
case IOCTL_CONSOLE_SET_CURSOR_INFO:
{
PCONSOLE_CURSOR_INFO pcci = (PCONSOLE_CURSOR_INFO)Irp->AssociatedIrp.SystemBuffer;
- BYTE data;
+ BYTE data, value;
DWORD size, height;
DeviceExtension->CursorSize = pcci->dwSize;
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);
+ value = READ_PORT_UCHAR (CRTC_DATA) & 0xE0;
+ WRITE_PORT_UCHAR (CRTC_DATA, value | (height - 1));
+
__asm__("sti\n\t");
Irp->IoStatus.Information = 0;
case IOCTL_CONSOLE_READ_OUTPUT_ATTRIBUTE:
{
POUTPUT_ATTRIBUTE Buf = (POUTPUT_ATTRIBUTE)Irp->AssociatedIrp.SystemBuffer;
- LPWORD pAttr = (LPWORD)MmGetSystemAddressForMdl(Irp->MdlAddress);
+ PWORD pAttr = (PWORD)MmGetSystemAddressForMdl(Irp->MdlAddress);
char *vidmem;
int offset;
DWORD dwCount;
case IOCTL_CONSOLE_WRITE_OUTPUT_ATTRIBUTE:
{
- POUTPUT_ATTRIBUTE Buf = (POUTPUT_ATTRIBUTE)Irp->AssociatedIrp.SystemBuffer;
- LPWORD pAttr = (LPWORD)MmGetSystemAddressForMdl(Irp->MdlAddress);
+ COORD *pCoord = (COORD *)MmGetSystemAddressForMdl(Irp->MdlAddress);
+ CHAR *pAttr = (CHAR *)(pCoord + 1);
char *vidmem;
int offset;
DWORD dwCount;
vidmem = DeviceExtension->VideoMemory;
- offset = (Buf->dwCoord.Y * DeviceExtension->Columns * 2) +
- (Buf->dwCoord.X * 2) + 1;
+ offset = (pCoord->Y * DeviceExtension->Columns * 2) +
+ (pCoord->X * 2) + 1;
- for (dwCount = 0; dwCount < stk->Parameters.Write.Length; dwCount++, pAttr++)
+ for (dwCount = 0; dwCount < (stk->Parameters.Write.Length - sizeof( COORD )); dwCount++, pAttr++)
{
- vidmem[offset + (dwCount * 2)] = (char) *pAttr;
+ vidmem[offset + (dwCount * 2)] = *pAttr;
}
-
- Buf->dwTransfered = dwCount;
-
- Irp->IoStatus.Information = sizeof(OUTPUT_ATTRIBUTE);
+ Irp->IoStatus.Information = 0;
Status = STATUS_SUCCESS;
}
break;
case IOCTL_CONSOLE_SET_TEXT_ATTRIBUTE:
- DeviceExtension->CharAttribute = (WORD)*(LPWORD)Irp->AssociatedIrp.SystemBuffer;
+ DeviceExtension->CharAttribute = (WORD)*(PWORD)Irp->AssociatedIrp.SystemBuffer;
Irp->IoStatus.Information = 0;
Status = STATUS_SUCCESS;
break;
case IOCTL_CONSOLE_WRITE_OUTPUT_CHARACTER:
{
- POUTPUT_CHARACTER Buf = (POUTPUT_CHARACTER)Irp->AssociatedIrp.SystemBuffer;
- LPSTR pChar = (LPSTR)MmGetSystemAddressForMdl(Irp->MdlAddress);
+ COORD *pCoord;
+ LPSTR pChar;
char *vidmem;
int offset;
DWORD dwCount;
-
+ pCoord = (COORD *)MmGetSystemAddressForMdl(Irp->MdlAddress);
+ pChar = (CHAR *)(pCoord + 1);
vidmem = DeviceExtension->VideoMemory;
- offset = (Buf->dwCoord.Y * DeviceExtension->Columns * 2) +
- (Buf->dwCoord.X * 2) + 1;
+ offset = (pCoord->Y * DeviceExtension->Columns * 2) +
+ (pCoord->X * 2);
- for (dwCount = 0; dwCount < stk->Parameters.Write.Length; dwCount++, pChar++)
+ for (dwCount = 0; dwCount < (stk->Parameters.Write.Length - sizeof( COORD )); dwCount++, pChar++)
{
- vidmem[offset + (dwCount * 2)] = (char) *pChar;
+ vidmem[offset + (dwCount * 2)] = *pChar;
}
- Buf->dwTransfered = dwCount;
-
- Irp->IoStatus.Information = sizeof(OUTPUT_ATTRIBUTE);
+ Irp->IoStatus.Information = 0;
Status = STATUS_SUCCESS;
}
break;
NTSTATUS
-ScrDispatch (PDEVICE_OBJECT DeviceObject, PIRP Irp)
+STDCALL ScrDispatch (PDEVICE_OBJECT DeviceObject, PIRP Irp)
{
PIO_STACK_LOCATION stk = IoGetCurrentIrpStackLocation(Irp);
NTSTATUS Status;
/*
* Module entry point
*/
-NTSTATUS STDCALL
+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;
-
+ UNICODE_STRING DeviceName;
+ UNICODE_STRING SymlinkName;
+
DbgPrint ("Screen Driver 0.0.6\n");
DriverObject->MajorFunction[IRP_MJ_CREATE] = ScrCreate;
DriverObject->MajorFunction[IRP_MJ_WRITE] = ScrWrite;
DriverObject->MajorFunction[IRP_MJ_DEVICE_CONTROL ] = ScrIoControl;
- RtlInitAnsiString (&adevice_name, "\\Device\\BlueScreen");
- RtlAnsiStringToUnicodeString (&device_name, &adevice_name, TRUE);
+ RtlInitUnicodeString (&DeviceName, L"\\Device\\BlueScreen");
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);
+ RtlInitUnicodeString (&SymlinkName, L"\\??\\BlueScreen");
+ IoCreateSymbolicLink (&SymlinkName, &DeviceName);
return (STATUS_SUCCESS);
}
projects / reactos.git / blobdiff