1 /* $Id: blue.c,v 1.28 2000/09/29 15:03:21 jean Exp $
3 * COPYRIGHT: See COPYING in the top level directory
4 * PROJECT: ReactOS kernel
5 * FILE: services/dd/blue/blue.c
6 * PURPOSE: Console (blue screen) device driver
7 * PROGRAMMER: Eric Kohl (ekohl@abo.rhein-zeitung.de)
12 /* INCLUDES ******************************************************************/
14 #include <ddk/ntddk.h>
15 #include <ddk/ntddblue.h>
23 /* DEFINITIONS ***************************************************************/
25 #define VIDMEM_BASE 0xb8000
26 #define VIDMEM_SIZE 0x2000
28 #define CRTC_COMMAND ((PUCHAR)0x3d4)
29 #define CRTC_DATA ((PUCHAR)0x3d5)
31 #define CRTC_COLUMNS 0x01
32 #define CRTC_OVERFLOW 0x07
33 #define CRTC_ROWS 0x12
34 #define CRTC_SCANLINES 0x09
35 #define CRTC_CURSORSTART 0x0a
36 #define CRTC_CURSOREND 0x0b
37 #define CRTC_CURSORPOSHI 0x0e
38 #define CRTC_CURSORPOSLO 0x0f
40 #define ATTRC_WRITEREG ((PUCHAR)0x3c0)
41 #define ATTRC_READREG ((PUCHAR)0x3c1)
42 #define ATTRC_INPST1 ((PUCHAR)0x3da)
47 /* NOTES ******************************************************************/
49 * [[character][attribute]][[character][attribute]]....
53 /* TYPEDEFS ***************************************************************/
55 typedef struct _DEVICE_EXTENSION
57 PBYTE VideoMemory
; /* Pointer to video memory */
62 BYTE ScanLines
; /* Height of a text line */
63 WORD Rows
; /* Number of rows */
64 WORD Columns
; /* Number of columns */
65 } DEVICE_EXTENSION
, *PDEVICE_EXTENSION
;
68 /* FUNCTIONS **************************************************************/
71 STDCALL
ScrCreate (PDEVICE_OBJECT DeviceObject
, PIRP Irp
)
73 PDEVICE_EXTENSION DeviceExtension
;
74 PHYSICAL_ADDRESS BaseAddress
;
79 DeviceExtension
= DeviceObject
->DeviceExtension
;
81 /* get pointer to video memory */
82 BaseAddress
.QuadPart
= VIDMEM_BASE
;
83 DeviceExtension
->VideoMemory
=
84 (PBYTE
)MmMapIoSpace (BaseAddress
, VIDMEM_SIZE
, FALSE
);
86 /* disable interrupts */
89 /* get current output position */
90 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_CURSORPOSLO
);
91 offset
= READ_PORT_UCHAR (CRTC_DATA
);
92 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_CURSORPOSHI
);
93 offset
+= (READ_PORT_UCHAR (CRTC_DATA
) << 8);
95 /* switch blinking characters off */
96 READ_PORT_UCHAR (ATTRC_INPST1
);
97 value
= READ_PORT_UCHAR (ATTRC_WRITEREG
);
98 WRITE_PORT_UCHAR (ATTRC_WRITEREG
, 0x10);
99 data
= READ_PORT_UCHAR (ATTRC_READREG
);
101 WRITE_PORT_UCHAR (ATTRC_WRITEREG
, data
);
102 WRITE_PORT_UCHAR (ATTRC_WRITEREG
, value
);
103 READ_PORT_UCHAR (ATTRC_INPST1
);
105 /* read screen information from crt controller */
106 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_COLUMNS
);
107 DeviceExtension
->Columns
= READ_PORT_UCHAR (CRTC_DATA
) + 1;
108 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_ROWS
);
109 DeviceExtension
->Rows
= READ_PORT_UCHAR (CRTC_DATA
);
110 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_OVERFLOW
);
111 data
= READ_PORT_UCHAR (CRTC_DATA
);
112 DeviceExtension
->Rows
|= (((data
& 0x02) << 7) | ((data
& 0x40) << 3));
113 DeviceExtension
->Rows
++;
114 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_SCANLINES
);
115 DeviceExtension
->ScanLines
= (READ_PORT_UCHAR (CRTC_DATA
) & 0x1F) + 1;
117 /* enable interrupts */
120 /* calculate number of text rows */
121 DeviceExtension
->Rows
=
122 DeviceExtension
->Rows
/ DeviceExtension
->ScanLines
;
124 DeviceExtension
->Rows
= 30;
127 DPRINT ("%d Columns %d Rows %d Scanlines\n",
128 DeviceExtension
->Columns
,
129 DeviceExtension
->Rows
,
130 DeviceExtension
->ScanLines
);
132 DeviceExtension
->CursorSize
= 5; /* FIXME: value correct?? */
133 DeviceExtension
->CursorVisible
= TRUE
;
135 /* more initialization */
136 DeviceExtension
->CharAttribute
= 0x17; /* light grey on blue */
137 DeviceExtension
->Mode
= ENABLE_PROCESSED_OUTPUT
|
138 ENABLE_WRAP_AT_EOL_OUTPUT
;
140 /* show blinking cursor */
142 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_CURSORSTART
);
143 WRITE_PORT_UCHAR (CRTC_DATA
, (DeviceExtension
->ScanLines
- 1) & 0x1F);
144 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_CURSOREND
);
145 data
= READ_PORT_UCHAR (CRTC_DATA
) & 0xE0;
146 WRITE_PORT_UCHAR (CRTC_DATA
,
147 data
| ((DeviceExtension
->ScanLines
- 1) & 0x1F));
150 Status
= STATUS_SUCCESS
;
152 Irp
->IoStatus
.Status
= Status
;
153 IoCompleteRequest (Irp
, IO_NO_INCREMENT
);
160 STDCALL
ScrWrite (PDEVICE_OBJECT DeviceObject
, PIRP Irp
)
162 PIO_STACK_LOCATION stk
= IoGetCurrentIrpStackLocation (Irp
);
163 PDEVICE_EXTENSION DeviceExtension
= DeviceObject
->DeviceExtension
;
165 char *pch
= Irp
->UserBuffer
;
168 int cursorx
, cursory
;
170 int processed
= DeviceExtension
->Mode
& ENABLE_PROCESSED_OUTPUT
;
172 vidmem
= DeviceExtension
->VideoMemory
;
173 rows
= DeviceExtension
->Rows
;
174 columns
= DeviceExtension
->Columns
;
176 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_CURSORPOSHI
);
177 offset
= READ_PORT_UCHAR (CRTC_DATA
)<<8;
178 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_CURSORPOSLO
);
179 offset
+= READ_PORT_UCHAR (CRTC_DATA
);
181 cursory
= offset
/ columns
;
182 cursorx
= offset
% columns
;
185 /* raw output mode */
186 memcpy( &vidmem
[(cursorx
* 2) + (cursory
* columns
* 2)], pch
, stk
->Parameters
.Write
.Length
);
187 offset
+= (stk
->Parameters
.Write
.Length
/ 2);
190 for (i
= 0; i
< stk
->Parameters
.Write
.Length
; i
++, pch
++)
199 else if (cursory
> 0)
201 cursorx
= columns
- 1;
204 vidmem
[(cursorx
* 2) + (cursory
* columns
* 2)] = ' ';
205 vidmem
[(cursorx
* 2) + (cursory
* columns
* 2) + 1] = (char) DeviceExtension
->CharAttribute
;
217 offset
= TAB_WIDTH
- (cursorx
% TAB_WIDTH
);
218 for (j
= 0; j
< offset
; j
++)
220 vidmem
[(cursorx
* 2) + (cursory
* columns
* 2)] = ' ';
223 if (cursorx
>= columns
)
232 vidmem
[(cursorx
* 2) + (cursory
* columns
* 2)] = *pch
;
233 vidmem
[(cursorx
* 2) + (cursory
* columns
* 2) + 1] = (char) DeviceExtension
->CharAttribute
;
235 if (cursorx
>= columns
)
244 unsigned short *LinePtr
;
247 &vidmem
[columns
* 2],
248 columns
* (rows
- 1) * 2);
250 LinePtr
= (unsigned short *) &vidmem
[columns
* (rows
- 1) * 2];
252 for (j
= 0; j
< columns
; j
++)
254 LinePtr
[j
] = DeviceExtension
->CharAttribute
<< 8;
257 for (j
= 0; j
< columns
; j
++)
259 vidmem
[(j
* 2) + (cursory
* columns
* 2)] = ' ';
260 vidmem
[(j
* 2) + (cursory
* columns
* 2) + 1] = (char)DeviceExtension
->CharAttribute
;
265 /* Set the cursor position */
266 offset
= (cursory
* columns
) + cursorx
;
268 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_CURSORPOSLO
);
269 WRITE_PORT_UCHAR (CRTC_DATA
, offset
);
270 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_CURSORPOSHI
);
272 WRITE_PORT_UCHAR (CRTC_DATA
, offset
);
274 Status
= STATUS_SUCCESS
;
276 Irp
->IoStatus
.Status
= Status
;
277 IoCompleteRequest (Irp
, IO_NO_INCREMENT
);
284 STDCALL
ScrIoControl (PDEVICE_OBJECT DeviceObject
, PIRP Irp
)
286 PIO_STACK_LOCATION stk
= IoGetCurrentIrpStackLocation (Irp
);
287 PDEVICE_EXTENSION DeviceExtension
;
290 DeviceExtension
= DeviceObject
->DeviceExtension
;
292 switch (stk
->Parameters
.DeviceIoControl
.IoControlCode
)
294 case IOCTL_CONSOLE_GET_SCREEN_BUFFER_INFO
:
296 PCONSOLE_SCREEN_BUFFER_INFO pcsbi
= (PCONSOLE_SCREEN_BUFFER_INFO
)Irp
->AssociatedIrp
.SystemBuffer
;
297 int rows
= DeviceExtension
->Rows
;
298 int columns
= DeviceExtension
->Columns
;
301 /* read cursor position from crtc */
303 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_CURSORPOSLO
);
304 offset
= READ_PORT_UCHAR (CRTC_DATA
);
305 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_CURSORPOSHI
);
306 offset
+= (READ_PORT_UCHAR (CRTC_DATA
) << 8);
309 pcsbi
->dwSize
.X
= columns
;
310 pcsbi
->dwSize
.Y
= rows
;
312 pcsbi
->dwCursorPosition
.X
= (SHORT
)(offset
% columns
);
313 pcsbi
->dwCursorPosition
.Y
= (SHORT
)(offset
/ columns
);
315 pcsbi
->wAttributes
= DeviceExtension
->CharAttribute
;
317 pcsbi
->srWindow
.Left
= 0;
318 pcsbi
->srWindow
.Right
= columns
- 1;
319 pcsbi
->srWindow
.Top
= 0;
320 pcsbi
->srWindow
.Bottom
= rows
- 1;
322 pcsbi
->dwMaximumWindowSize
.X
= columns
;
323 pcsbi
->dwMaximumWindowSize
.Y
= rows
;
325 Irp
->IoStatus
.Information
= sizeof (CONSOLE_SCREEN_BUFFER_INFO
);
326 Status
= STATUS_SUCCESS
;
330 case IOCTL_CONSOLE_SET_SCREEN_BUFFER_INFO
:
332 PCONSOLE_SCREEN_BUFFER_INFO pcsbi
= (PCONSOLE_SCREEN_BUFFER_INFO
)Irp
->AssociatedIrp
.SystemBuffer
;
335 DeviceExtension
->CharAttribute
= pcsbi
->wAttributes
;
336 offset
= (pcsbi
->dwCursorPosition
.Y
* DeviceExtension
->Columns
) +
337 pcsbi
->dwCursorPosition
.X
;
340 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_CURSORPOSLO
);
341 WRITE_PORT_UCHAR (CRTC_DATA
, offset
);
342 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_CURSORPOSHI
);
343 WRITE_PORT_UCHAR (CRTC_DATA
, offset
>>8);
346 Irp
->IoStatus
.Information
= 0;
347 Status
= STATUS_SUCCESS
;
351 case IOCTL_CONSOLE_GET_CURSOR_INFO
:
353 PCONSOLE_CURSOR_INFO pcci
= (PCONSOLE_CURSOR_INFO
)Irp
->AssociatedIrp
.SystemBuffer
;
355 pcci
->dwSize
= DeviceExtension
->CursorSize
;
356 pcci
->bVisible
= DeviceExtension
->CursorVisible
;
358 Irp
->IoStatus
.Information
= sizeof (CONSOLE_CURSOR_INFO
);
359 Status
= STATUS_SUCCESS
;
363 case IOCTL_CONSOLE_SET_CURSOR_INFO
:
365 PCONSOLE_CURSOR_INFO pcci
= (PCONSOLE_CURSOR_INFO
)Irp
->AssociatedIrp
.SystemBuffer
;
369 DeviceExtension
->CursorSize
= pcci
->dwSize
;
370 DeviceExtension
->CursorVisible
= pcci
->bVisible
;
371 height
= DeviceExtension
->ScanLines
;
372 data
= (pcci
->bVisible
) ? 0x40 : 0x20;
374 size
= (pcci
->dwSize
* height
) / 100;
378 data
|= (BYTE
)(height
- size
);
381 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_CURSORSTART
);
382 WRITE_PORT_UCHAR (CRTC_DATA
, data
);
383 WRITE_PORT_UCHAR (CRTC_COMMAND
, CRTC_CURSOREND
);
384 value
= READ_PORT_UCHAR (CRTC_DATA
) & 0xE0;
385 WRITE_PORT_UCHAR (CRTC_DATA
, value
| (height
- 1));
389 Irp
->IoStatus
.Information
= 0;
390 Status
= STATUS_SUCCESS
;
394 case IOCTL_CONSOLE_GET_MODE
:
396 PCONSOLE_MODE pcm
= (PCONSOLE_MODE
)Irp
->AssociatedIrp
.SystemBuffer
;
398 pcm
->dwMode
= DeviceExtension
->Mode
;
400 Irp
->IoStatus
.Information
= sizeof(CONSOLE_MODE
);
401 Status
= STATUS_SUCCESS
;
405 case IOCTL_CONSOLE_SET_MODE
:
407 PCONSOLE_MODE pcm
= (PCONSOLE_MODE
)Irp
->AssociatedIrp
.SystemBuffer
;
409 DeviceExtension
->Mode
= pcm
->dwMode
;
411 Irp
->IoStatus
.Information
= 0;
412 Status
= STATUS_SUCCESS
;
416 case IOCTL_CONSOLE_FILL_OUTPUT_ATTRIBUTE
:
418 POUTPUT_ATTRIBUTE Buf
= (POUTPUT_ATTRIBUTE
)Irp
->AssociatedIrp
.SystemBuffer
;
423 vidmem
= DeviceExtension
->VideoMemory
;
424 offset
= (Buf
->dwCoord
.Y
* DeviceExtension
->Columns
* 2) +
425 (Buf
->dwCoord
.X
* 2) + 1;
427 for (dwCount
= 0; dwCount
< Buf
->nLength
; dwCount
++)
429 vidmem
[offset
+ (dwCount
* 2)] = (char) Buf
->wAttribute
;
432 Buf
->dwTransfered
= Buf
->nLength
;
434 Irp
->IoStatus
.Information
= 0;
435 Status
= STATUS_SUCCESS
;
439 case IOCTL_CONSOLE_READ_OUTPUT_ATTRIBUTE
:
441 POUTPUT_ATTRIBUTE Buf
= (POUTPUT_ATTRIBUTE
)Irp
->AssociatedIrp
.SystemBuffer
;
442 PWORD pAttr
= (PWORD
)MmGetSystemAddressForMdl(Irp
->MdlAddress
);
447 vidmem
= DeviceExtension
->VideoMemory
;
448 offset
= (Buf
->dwCoord
.Y
* DeviceExtension
->Columns
* 2) +
449 (Buf
->dwCoord
.X
* 2) + 1;
451 for (dwCount
= 0; dwCount
< stk
->Parameters
.Write
.Length
; dwCount
++, pAttr
++)
453 (char) *pAttr
= vidmem
[offset
+ (dwCount
* 2)];
456 Buf
->dwTransfered
= dwCount
;
458 Irp
->IoStatus
.Information
= sizeof(OUTPUT_ATTRIBUTE
);
459 Status
= STATUS_SUCCESS
;
463 case IOCTL_CONSOLE_WRITE_OUTPUT_ATTRIBUTE
:
465 POUTPUT_ATTRIBUTE Buf
= (POUTPUT_ATTRIBUTE
)Irp
->AssociatedIrp
.SystemBuffer
;
466 PWORD pAttr
= (PWORD
)MmGetSystemAddressForMdl(Irp
->MdlAddress
);
471 vidmem
= DeviceExtension
->VideoMemory
;
472 offset
= (Buf
->dwCoord
.Y
* DeviceExtension
->Columns
* 2) +
473 (Buf
->dwCoord
.X
* 2) + 1;
475 for (dwCount
= 0; dwCount
< stk
->Parameters
.Write
.Length
; dwCount
++, pAttr
++)
477 vidmem
[offset
+ (dwCount
* 2)] = (char) *pAttr
;
480 Buf
->dwTransfered
= dwCount
;
482 Irp
->IoStatus
.Information
= sizeof(OUTPUT_ATTRIBUTE
);
483 Status
= STATUS_SUCCESS
;
487 case IOCTL_CONSOLE_SET_TEXT_ATTRIBUTE
:
488 DeviceExtension
->CharAttribute
= (WORD
)*(PWORD
)Irp
->AssociatedIrp
.SystemBuffer
;
489 Irp
->IoStatus
.Information
= 0;
490 Status
= STATUS_SUCCESS
;
494 case IOCTL_CONSOLE_FILL_OUTPUT_CHARACTER
:
496 POUTPUT_CHARACTER Buf
= (POUTPUT_CHARACTER
)Irp
->AssociatedIrp
.SystemBuffer
;
501 vidmem
= DeviceExtension
->VideoMemory
;
502 offset
= (Buf
->dwCoord
.Y
* DeviceExtension
->Columns
* 2) +
503 (Buf
->dwCoord
.X
* 2);
507 for (dwCount
= 0; dwCount
< Buf
->nLength
; dwCount
++)
509 vidmem
[offset
+ (dwCount
* 2)] = (char) Buf
->cCharacter
;
512 Buf
->dwTransfered
= Buf
->nLength
;
514 Irp
->IoStatus
.Information
= 0;
515 Status
= STATUS_SUCCESS
;
519 case IOCTL_CONSOLE_READ_OUTPUT_CHARACTER
:
521 POUTPUT_CHARACTER Buf
= (POUTPUT_CHARACTER
)Irp
->AssociatedIrp
.SystemBuffer
;
522 LPSTR pChar
= (LPSTR
)MmGetSystemAddressForMdl(Irp
->MdlAddress
);
527 vidmem
= DeviceExtension
->VideoMemory
;
528 offset
= (Buf
->dwCoord
.Y
* DeviceExtension
->Columns
* 2) +
529 (Buf
->dwCoord
.X
* 2);
531 for (dwCount
= 0; dwCount
< stk
->Parameters
.Write
.Length
; dwCount
++, pChar
++)
533 *pChar
= vidmem
[offset
+ (dwCount
* 2)];
536 Buf
->dwTransfered
= dwCount
;
538 Irp
->IoStatus
.Information
= sizeof(OUTPUT_ATTRIBUTE
);
539 Status
= STATUS_SUCCESS
;
543 case IOCTL_CONSOLE_WRITE_OUTPUT_CHARACTER
:
545 POUTPUT_CHARACTER Buf
= (POUTPUT_CHARACTER
)Irp
->AssociatedIrp
.SystemBuffer
;
546 LPSTR pChar
= (LPSTR
)MmGetSystemAddressForMdl(Irp
->MdlAddress
);
551 vidmem
= DeviceExtension
->VideoMemory
;
552 offset
= (Buf
->dwCoord
.Y
* DeviceExtension
->Columns
* 2) +
553 (Buf
->dwCoord
.X
* 2) + 1;
555 for (dwCount
= 0; dwCount
< stk
->Parameters
.Write
.Length
; dwCount
++, pChar
++)
557 vidmem
[offset
+ (dwCount
* 2)] = (char) *pChar
;
560 Buf
->dwTransfered
= dwCount
;
562 Irp
->IoStatus
.Information
= sizeof(OUTPUT_ATTRIBUTE
);
563 Status
= STATUS_SUCCESS
;
569 Status
= STATUS_NOT_IMPLEMENTED
;
572 Irp
->IoStatus
.Status
= Status
;
573 IoCompleteRequest (Irp
, IO_NO_INCREMENT
);
580 STDCALL
ScrDispatch (PDEVICE_OBJECT DeviceObject
, PIRP Irp
)
582 PIO_STACK_LOCATION stk
= IoGetCurrentIrpStackLocation(Irp
);
585 switch (stk
->MajorFunction
)
588 Status
= STATUS_SUCCESS
;
592 Status
= STATUS_NOT_IMPLEMENTED
;
597 Irp
->IoStatus
.Status
= Status
;
598 IoCompleteRequest (Irp
, IO_NO_INCREMENT
);
609 DriverEntry (PDRIVER_OBJECT DriverObject
, PUNICODE_STRING RegistryPath
)
611 PDEVICE_OBJECT DeviceObject
;
612 UNICODE_STRING DeviceName
;
613 UNICODE_STRING SymlinkName
;
615 DbgPrint ("Screen Driver 0.0.6\n");
617 DriverObject
->MajorFunction
[IRP_MJ_CREATE
] = ScrCreate
;
618 DriverObject
->MajorFunction
[IRP_MJ_CLOSE
] = ScrDispatch
;
619 DriverObject
->MajorFunction
[IRP_MJ_READ
] = ScrDispatch
;
620 DriverObject
->MajorFunction
[IRP_MJ_WRITE
] = ScrWrite
;
621 DriverObject
->MajorFunction
[IRP_MJ_DEVICE_CONTROL
] = ScrIoControl
;
623 RtlInitUnicodeString (&DeviceName
, L
"\\Device\\BlueScreen");
624 IoCreateDevice (DriverObject
,
625 sizeof(DEVICE_EXTENSION
),
632 RtlInitUnicodeString (&SymlinkName
, L
"\\??\\BlueScreen");
633 IoCreateSymbolicLink (&SymlinkName
, &DeviceName
);
635 return (STATUS_SUCCESS
);