VTerm - Bugfixing mostly
[tpg/acess2.git] / Kernel / drv / vterm.c
1 /*
2  * Acess2 Virtual Terminal Driver
3  */
4 #define DEBUG   0
5 #include <acess.h>
6 #include <fs_devfs.h>
7 #include <modules.h>
8 #include <tpl_drv_video.h>
9 #include <tpl_drv_keyboard.h>
10 #include <tpl_drv_terminal.h>
11 #include <errno.h>
12 #include <semaphore.h>
13
14 #define USE_CTRL_ALT    1
15
16 // === CONSTANTS ===
17 #define VERSION ((0<<8)|(50))
18
19 #define NUM_VTS 8
20 #define MAX_INPUT_CHARS32       64
21 #define MAX_INPUT_CHARS8        (MAX_INPUT_CHARS32*4)
22 //#define DEFAULT_OUTPUT        "BochsGA"
23 #define DEFAULT_OUTPUT  "Vesa"
24 #define DEFAULT_INPUT   "PS2Keyboard"
25 #define DEFAULT_WIDTH   640
26 #define DEFAULT_HEIGHT  480
27 #define DEFAULT_SCROLLBACK      2       // 2 Screens of text + current screen
28 #define DEFAULT_COLOUR  (VT_COL_BLACK|(0xAAA<<16))
29
30 #define VT_FLAG_HIDECSR 0x01
31 #define VT_FLAG_ALTBUF  0x02    //!< Alternate screen buffer
32 #define VT_FLAG_HASFB   0x10    //!< Set if the VTerm has requested the Framebuffer
33
34 enum eVT_InModes {
35         VT_INMODE_TEXT8,        // UTF-8 Text Mode (VT100/xterm Emulation)
36         VT_INMODE_TEXT32,       // UTF-32 Text Mode (Acess Native)
37         NUM_VT_INMODES
38 };
39
40 // === TYPES ===
41 typedef struct {
42          int    Mode;   //!< Current Mode (see ::eTplTerminal_Modes)
43          int    Flags;  //!< Flags (see VT_FLAG_*)
44         
45         short   NewWidth;       //!< Un-applied dimensions (Width)
46         short   NewHeight;      //!< Un-applied dimensions (Height)
47         short   Width;  //!< Virtual Width
48         short   Height; //!< Virtual Height
49         short   TextWidth;      //!< Text Virtual Width
50         short   TextHeight;     //!< Text Virtual Height
51         
52         Uint32  CurColour;      //!< Current Text Colour
53         
54          int    ViewPos;        //!< View Buffer Offset (Text Only)
55          int    WritePos;       //!< Write Buffer Offset (Text Only)
56         tVT_Char        *Text;
57         
58         tVT_Char        *AltBuf;        //!< Alternate Screen Buffer
59          int    AltWritePos;    //!< Alternate write position
60         short   ScrollTop;      //!< Top of scrolling region (smallest)
61         short   ScrollHeight;   //!< Length of scrolling region
62         
63         tMutex  ReadingLock;    //!< Lock the VTerm when a process is reading from it
64         tTID    ReadingThread;  //!< Owner of the lock
65          int    InputRead;      //!< Input buffer read position
66          int    InputWrite;     //!< Input buffer write position
67         char    InputBuffer[MAX_INPUT_CHARS8];
68 //      tSemaphore      InputSemaphore;
69         
70         Uint32          *Buffer;
71         
72         char    Name[2];        //!< Name of the terminal
73         tVFS_Node       Node;
74 } tVTerm;
75
76 // === IMPORTS ===
77 extern void     Debug_SetKTerminal(const char *File);
78
79 // === PROTOTYPES ===
80  int    VT_Install(char **Arguments);
81 void    VT_InitOutput(void);
82 void    VT_InitInput(void);
83 char    *VT_ReadDir(tVFS_Node *Node, int Pos);
84 tVFS_Node       *VT_FindDir(tVFS_Node *Node, const char *Name);
85  int    VT_Root_IOCtl(tVFS_Node *Node, int Id, void *Data);
86 Uint64  VT_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer);
87 Uint64  VT_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer);
88  int    VT_Terminal_IOCtl(tVFS_Node *Node, int Id, void *Data);
89 void    VT_SetResolution(int Width, int Height);
90 void    VT_SetMode(int Mode);
91 void    VT_SetTerminal(int ID);
92 void    VT_KBCallBack(Uint32 Codepoint);
93 void    VT_int_PutString(tVTerm *Term, Uint8 *Buffer, Uint Count);
94 void    VT_int_ClearLine(tVTerm *Term, int Num);
95  int    VT_int_ParseEscape(tVTerm *Term, char *Buffer);
96 void    VT_int_PutChar(tVTerm *Term, Uint32 Ch);
97 void    VT_int_ScrollText(tVTerm *Term, int Count);
98 void    VT_int_ScrollFramebuffer( tVTerm *Term, int Count );
99 void    VT_int_UpdateScreen( tVTerm *Term, int UpdateAll );
100 void    VT_int_ChangeMode(tVTerm *Term, int NewMode, int NewWidth, int NewHeight);
101 void    VT_int_ToggleAltBuffer(tVTerm *Term, int Enabled);
102
103 // === CONSTANTS ===
104 const Uint16    caVT100Colours[] = {
105                 // Black, Red, Green, Yellow, Blue, Purple, Cyan, Gray
106                 // Same again, but bright
107                 VT_COL_BLACK, 0x700, 0x070, 0x770, 0x007, 0x707, 0x077, 0xAAA,
108                 VT_COL_GREY, 0xF00, 0x0F0, 0xFF0, 0x00F, 0xF0F, 0x0FF, VT_COL_WHITE
109         };
110
111 // === GLOBALS ===
112 MODULE_DEFINE(0, VERSION, VTerm, VT_Install, NULL, DEFAULT_OUTPUT, DEFAULT_INPUT, NULL);
113 tDevFS_Driver   gVT_DrvInfo = {
114         NULL, "VTerm",
115         {
116         .Flags = VFS_FFLAG_DIRECTORY,
117         .Size = NUM_VTS,
118         .Inode = -1,
119         .NumACLs = 0,
120         .ReadDir = VT_ReadDir,
121         .FindDir = VT_FindDir,
122         .IOCtl = VT_Root_IOCtl
123         }
124 };
125 // --- Terminals ---
126 tVTerm  gVT_Terminals[NUM_VTS];
127  int    giVT_CurrentTerminal = 0;
128 tVTerm  *gpVT_CurTerm = &gVT_Terminals[0];
129 // --- Video State ---
130 short   giVT_RealWidth  = DEFAULT_WIDTH;        //!< Screen Width
131 short   giVT_RealHeight = DEFAULT_HEIGHT;       //!< Screen Height
132  int    giVT_Scrollback = DEFAULT_SCROLLBACK;
133 // --- Driver Handles ---
134 char    *gsVT_OutputDevice = NULL;
135 char    *gsVT_InputDevice = NULL;
136  int    giVT_OutputDevHandle = -2;
137  int    giVT_InputDevHandle = -2;
138 // --- Key States --- (Used for VT Switching/Magic Combos)
139  int    gbVT_CtrlDown = 0;
140  int    gbVT_AltDown = 0;
141  int    gbVT_SysrqDown = 0;
142
143 // === CODE ===
144 /**
145  * \fn int VT_Install(char **Arguments)
146  * \brief Installs the Virtual Terminal Driver
147  */
148 int VT_Install(char **Arguments)
149 {
150          int    i;
151         
152         // Scan Arguments
153         if(Arguments)
154         {
155                 char    **args;
156                 const char      *arg;
157                 for(args = Arguments; (arg = *args); args++ )
158                 {
159                         char    data[strlen(arg)+1];
160                         char    *opt = data;
161                         char    *val;
162                         
163                         val = strchr(arg, '=');
164                         strcpy(data, arg);
165                         if( val ) {
166                                 data[ val - arg ] = '\0';
167                                 val ++;
168                         }
169                         Log_Debug("VTerm", "Argument '%s'", arg);
170                         
171                         if( strcmp(opt, "Video") == 0 ) {
172                                 if( !gsVT_OutputDevice && Modules_InitialiseBuiltin( val ) == 0 )
173                                         gsVT_OutputDevice = strdup(val);
174                         }
175                         else if( strcmp(opt, "Input") == 0 ) {
176                                 if( !gsVT_InputDevice && Modules_InitialiseBuiltin( val ) == 0 )
177                                         gsVT_InputDevice = strdup(val);
178                         }
179                         else if( strcmp(opt, "Width") == 0 ) {
180                                 giVT_RealWidth = atoi( val );
181                         }
182                         else if( strcmp(opt, "Height") == 0 ) {
183                                 giVT_RealHeight = atoi( val );
184                         }
185                         else if( strcmp(opt, "Scrollback") == 0 ) {
186                                 giVT_Scrollback = atoi( val );
187                         }
188                 }
189         }
190         
191         // Apply Defaults
192         if(!gsVT_OutputDevice)  gsVT_OutputDevice = strdup(DEFAULT_OUTPUT);
193         if(!gsVT_InputDevice)   gsVT_InputDevice = strdup(DEFAULT_INPUT);
194         
195         // Create paths
196         {
197                 char    *tmp;
198                 tmp = malloc( 9 + strlen(gsVT_OutputDevice) + 1 );
199                 strcpy(tmp, "/Devices/");
200                 strcpy(&tmp[9], gsVT_OutputDevice);
201                 gsVT_OutputDevice = tmp;
202                 tmp = malloc( 9 + strlen(gsVT_InputDevice) + 1 );
203                 strcpy(tmp, "/Devices/");
204                 strcpy(&tmp[9], gsVT_InputDevice);
205                 gsVT_InputDevice = tmp;
206         }
207         
208         Log_Log("VTerm", "Using '%s' as output", gsVT_OutputDevice);
209         Log_Log("VTerm", "Using '%s' as input", gsVT_InputDevice);
210         
211         // Create Nodes
212         for( i = 0; i < NUM_VTS; i++ )
213         {
214                 gVT_Terminals[i].Mode = TERM_MODE_TEXT;
215                 gVT_Terminals[i].Flags = 0;
216                 gVT_Terminals[i].CurColour = DEFAULT_COLOUR;
217                 gVT_Terminals[i].WritePos = 0;
218                 gVT_Terminals[i].AltWritePos = 0;
219                 gVT_Terminals[i].ViewPos = 0;
220                 gVT_Terminals[i].ReadingThread = -1;
221                 gVT_Terminals[i].ScrollHeight = 0;
222                 
223                 // Initialise
224                 VT_int_ChangeMode( &gVT_Terminals[i],
225                         TERM_MODE_TEXT, giVT_RealWidth, giVT_RealHeight );
226                 
227                 gVT_Terminals[i].Name[0] = '0'+i;
228                 gVT_Terminals[i].Name[1] = '\0';
229                 gVT_Terminals[i].Node.Inode = i;
230                 gVT_Terminals[i].Node.ImplPtr = &gVT_Terminals[i];
231                 gVT_Terminals[i].Node.NumACLs = 0;      // Only root can open virtual terminals
232                 
233                 gVT_Terminals[i].Node.Read = VT_Read;
234                 gVT_Terminals[i].Node.Write = VT_Write;
235                 gVT_Terminals[i].Node.IOCtl = VT_Terminal_IOCtl;
236 //              Semaphore_Init(&gVT_Terminals[i].InputSemaphore, 0, MAX_INPUT_CHARS8, "VTerm", gVT_Terminals[i].Name);
237         }
238         
239         // Add to DevFS
240         DevFS_AddDevice( &gVT_DrvInfo );
241         
242         VT_InitOutput();
243         VT_InitInput();
244         
245         // Set kernel output to VT0
246         Debug_SetKTerminal("/Devices/VTerm/0");
247         
248         Log_Log("VTerm", "Returning %i", MODULE_ERR_OK);
249         return MODULE_ERR_OK;
250 }
251
252 /**
253  * \fn void VT_InitOutput()
254  * \brief Initialise Video Output
255  */
256 void VT_InitOutput()
257 {
258         giVT_OutputDevHandle = VFS_Open(gsVT_OutputDevice, VFS_OPENFLAG_WRITE);
259         if(giVT_OutputDevHandle == -1) {
260                 Log_Warning("VTerm", "Oh F**k, I can't open the video device '%s'", gsVT_OutputDevice);
261                 return ;
262         }
263         VT_SetResolution( giVT_RealWidth, giVT_RealHeight );
264         VT_SetTerminal( 0 );
265         VT_SetMode( VIDEO_BUFFMT_TEXT );
266 }
267
268 /**
269  * \fn void VT_InitInput()
270  * \brief Initialises the input
271  */
272 void VT_InitInput()
273 {
274         giVT_InputDevHandle = VFS_Open(gsVT_InputDevice, VFS_OPENFLAG_READ);
275         if(giVT_InputDevHandle == -1) {
276                 Log_Warning("VTerm", "Can't open the input device '%s'", gsVT_InputDevice);
277                 return ;
278         }
279         VFS_IOCtl(giVT_InputDevHandle, KB_IOCTL_SETCALLBACK, VT_KBCallBack);
280 }
281
282 /**
283  * \brief Set the video resolution
284  * \param Width New screen width
285  * \param Height        New screen height
286  */
287 void VT_SetResolution(int Width, int Height)
288 {
289         tVideo_IOCtl_Mode       mode = {0};
290          int    tmp;
291          int    i;
292         
293         // Create the video mode
294         mode.width = Width;
295         mode.height = Height;
296         mode.bpp = 32;
297         mode.flags = 0;
298         
299         // Set video mode
300         VFS_IOCtl( giVT_OutputDevHandle, VIDEO_IOCTL_FINDMODE, &mode );
301         tmp = mode.id;
302         if( Width != mode.width || Height != mode.height )
303         {
304                 Log_Warning("VTerm",
305                         "Selected resolution (%ix%i is not supported) by the device, using (%ix%i)",
306                         giVT_RealWidth, giVT_RealHeight,
307                         mode.width, mode.height
308                         );
309         }
310         VFS_IOCtl( giVT_OutputDevHandle, VIDEO_IOCTL_GETSETMODE, &tmp );
311         
312         // Resize text terminals if needed
313         if( giVT_RealWidth != mode.width || giVT_RealHeight != mode.height )
314         {
315                  int    newBufSize = (giVT_RealWidth/giVT_CharWidth)
316                                         *(giVT_RealHeight/giVT_CharHeight)
317                                         *(giVT_Scrollback+1);
318                 //tVT_Char      *tmp;
319                 // Resize the text terminals
320                 giVT_RealWidth = mode.width;
321                 giVT_RealHeight = mode.height;
322                 for( i = 0; i < NUM_VTS; i ++ )
323                 {
324                         if( gVT_Terminals[i].Mode != TERM_MODE_TEXT )   continue;
325                         
326                         gVT_Terminals[i].TextWidth = giVT_RealWidth/giVT_CharWidth;
327                         gVT_Terminals[i].TextHeight = giVT_RealHeight/giVT_CharHeight;
328                         
329                         gVT_Terminals[i].Text = realloc(
330                                 gVT_Terminals[i].Text,
331                                 newBufSize*sizeof(tVT_Char)
332                                 );
333                 }
334         }
335 }
336
337 /**
338  * \brief Set video output buffer mode
339  */
340 void VT_SetMode(int Mode)
341 {
342         VFS_IOCtl( giVT_OutputDevHandle, VIDEO_IOCTL_SETBUFFORMAT, &Mode );
343 }
344
345 /**
346  * \fn char *VT_ReadDir(tVFS_Node *Node, int Pos)
347  * \brief Read from the VTerm Directory
348  */
349 char *VT_ReadDir(tVFS_Node *Node, int Pos)
350 {
351         if(Pos < 0)     return NULL;
352         if(Pos >= NUM_VTS)      return NULL;
353         return strdup( gVT_Terminals[Pos].Name );
354 }
355
356 /**
357  * \fn tVFS_Node *VT_FindDir(tVFS_Node *Node, const char *Name)
358  * \brief Find an item in the VTerm directory
359  * \param Node  Root node
360  * \param Name  Name (number) of the terminal
361  */
362 tVFS_Node *VT_FindDir(tVFS_Node *Node, const char *Name)
363 {
364          int    num;
365         
366         ENTER("pNode sName", Node, Name);
367         
368         // Open the input and output files if needed
369         if(giVT_OutputDevHandle == -2)  VT_InitOutput();
370         if(giVT_InputDevHandle == -2)   VT_InitInput();
371         
372         // Sanity check name
373         if(Name[0] < '0' || Name[0] > '9' || Name[1] != '\0') {
374                 LEAVE('n');
375                 return NULL;
376         }
377         // Get index
378         num = Name[0] - '0';
379         if(num >= NUM_VTS) {
380                 LEAVE('n');
381                 return NULL;
382         }
383         // Return node
384         LEAVE('p', &gVT_Terminals[num].Node);
385         return &gVT_Terminals[num].Node;
386 }
387
388 /**
389  * \fn int VT_Root_IOCtl(tVFS_Node *Node, int Id, void *Data)
390  * \brief Control the VTerm Driver
391  */
392 int VT_Root_IOCtl(tVFS_Node *Node, int Id, void *Data)
393 {
394          int    len;
395         switch(Id)
396         {
397         case DRV_IOCTL_TYPE:    return DRV_TYPE_MISC;
398         case DRV_IOCTL_IDENT:   memcpy(Data, "VT\0\0", 4);      return 0;
399         case DRV_IOCTL_VERSION: return VERSION;
400         case DRV_IOCTL_LOOKUP:  return 0;
401         
402         case 4: // Get Video Driver
403                 if(Data)        strcpy(Data, gsVT_OutputDevice);
404                 return strlen(gsVT_OutputDevice);
405         
406         case 5: // Set Video Driver
407                 if(!Data)       return -EINVAL;
408                 if(Threads_GetUID() != 0)       return -EACCES;
409                 
410                 len = strlen(Data);
411                 
412                 // TODO: Check if the string used is a heap string
413                 
414                 free(gsVT_OutputDevice);
415                 
416                 gsVT_OutputDevice = malloc(len+1);
417                 strcpy(gsVT_OutputDevice, Data);
418                 
419                 VFS_Close(giVT_OutputDevHandle);
420                 giVT_OutputDevHandle = -1;
421                 
422                 VT_InitOutput();
423                 return 1;
424         }
425         return 0;
426 }
427
428 /**
429  * \fn Uint64 VT_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
430  * \brief Read from a virtual terminal
431  */
432 Uint64 VT_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
433 {
434          int    pos = 0;
435          int    avail;
436         tVTerm  *term = &gVT_Terminals[ Node->Inode ];
437         Uint32  *codepoint_buf = Buffer;
438         Uint32  *codepoint_in;
439         
440         Mutex_Acquire( &term->ReadingLock );
441         
442         // Check current mode
443         switch(term->Mode)
444         {
445         // Text Mode (UTF-8)
446         case TERM_MODE_TEXT:
447                 VFS_SelectNode(Node, VFS_SELECT_READ, NULL, "VT_Read (UTF-8)");
448                 
449                 avail = term->InputWrite - term->InputRead;
450                 if(avail < 0)
451                         avail += MAX_INPUT_CHARS8;
452                 if(avail > Length - pos)
453                         avail = Length - pos;
454                 
455                 while( avail -- )
456                 {
457                         ((char*)Buffer)[pos] = term->InputBuffer[term->InputRead];
458                         pos ++;
459                         term->InputRead ++;
460                         term->InputRead %= MAX_INPUT_CHARS8;
461                 }
462                 break;
463         
464         //case TERM_MODE_FB:
465         // Other - UCS-4
466         default:
467                 VFS_SelectNode(Node, VFS_SELECT_READ, NULL, "VT_Read (UCS-4)");
468                         
469                 avail = term->InputWrite - term->InputRead;
470                 if(avail < 0)
471                         avail += MAX_INPUT_CHARS32;
472                 if(avail > Length - pos)
473                         avail = Length/4 - pos;
474                 
475                 codepoint_in = (void*)term->InputBuffer;
476                 codepoint_buf = Buffer;
477                 
478                 while( avail -- )
479                 {
480                         codepoint_buf[pos] = codepoint_in[term->InputRead];
481                         pos ++;
482                         term->InputRead ++;
483                         term->InputRead %= MAX_INPUT_CHARS32;
484                 }
485                 pos *= 4;
486                 break;
487         }
488         
489         // Mark none avaliable if buffer empty
490         if( term->InputRead == term->InputWrite )
491                 VFS_MarkAvaliable(&term->Node, 0);
492         
493         term->ReadingThread = -1;
494         
495         Mutex_Release( &term->ReadingLock );
496         
497         return pos;
498 }
499
500 /**
501  * \fn Uint64 VT_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
502  * \brief Write to a virtual terminal
503  */
504 Uint64 VT_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
505 {
506         tVTerm  *term = &gVT_Terminals[ Node->Inode ];
507          int    size;
508         
509         // Write
510         switch( term->Mode )
511         {
512         // Print Text
513         case TERM_MODE_TEXT:
514                 VT_int_PutString(term, Buffer, Length);
515                 break;
516         // Framebuffer :)
517         case TERM_MODE_FB:
518         
519                 // - Sanity Checking
520                 size = term->Width*term->Height*4;
521                 if( Offset > size ) {
522                         Log_Notice("VTerm", "VT_Write: Offset (0x%llx) > FBSize (0x%x)",
523                                 Offset, size);
524                         return 0;
525                 }
526                 if( Offset + Length > size ) {
527                         Log_Notice("VTerm", "VT_Write: Offset+Length (0x%llx) > FBSize (0x%x)",
528                                 Offset+Length, size);
529                         Length = size - Offset;
530                 }
531                 
532                 // Copy to the local cache
533                 memcpy( (void*)((Uint)term->Buffer + (Uint)Offset), Buffer, Length );
534                 
535                 // Update screen if needed
536                 if( Node->Inode == giVT_CurrentTerminal )
537                 {
538                         // Fill entire screen?
539                         if( giVT_RealWidth > term->Width || giVT_RealHeight > term->Height )
540                         {
541                                 // No? :( Well, just center it
542                                  int    x, y, w, h;
543                                 x = Offset/4;   y = x / term->Width;    x %= term->Width;
544                                 w = Length/4+x; h = w / term->Width;    w %= term->Width;
545                                 // Center
546                                 x += (giVT_RealWidth - term->Width) / 2;
547                                 y += (giVT_RealHeight - term->Height) / 2;
548                                 while(h--)
549                                 {
550                                         VFS_WriteAt( giVT_OutputDevHandle,
551                                                 (x + y * giVT_RealWidth)*4,
552                                                 term->Width * 4,
553                                                 Buffer
554                                                 );
555                                         Buffer = (void*)( (Uint)Buffer + term->Width*4 );
556                                         y ++;
557                                 }
558                                 return 0;
559                         }
560                         else {
561                                 return VFS_WriteAt( giVT_OutputDevHandle, Offset, Length, Buffer );
562                         }
563                 }
564         // Just pass on (for now)
565         // TODO: Handle locally too to ensure no information is lost on
566         //       VT Switch (and to isolate terminals from each other)
567         case TERM_MODE_2DACCEL:
568         //case TERM_MODE_3DACCEL:
569                 if( Node->Inode == giVT_CurrentTerminal )
570                 {
571                         VFS_Write( giVT_OutputDevHandle, Length, Buffer );
572                 }
573                 break;
574         }
575         
576         return 0;
577 }
578
579 /**
580  * \fn int VT_Terminal_IOCtl(tVFS_Node *Node, int Id, void *Data)
581  * \brief Call an IO Control on a virtual terminal
582  */
583 int VT_Terminal_IOCtl(tVFS_Node *Node, int Id, void *Data)
584 {
585          int    *iData = Data;
586          int    ret;
587         tVTerm  *term = Node->ImplPtr;
588         ENTER("pNode iId pData", Node, Id, Data);
589         
590         if(Id >= DRV_IOCTL_LOOKUP) {
591                 // Only root can fiddle with graphics modes
592                 // TODO: Remove this and replace with user ownership
593                 if( Threads_GetUID() != 0 )     return -1;
594         }
595         
596         switch(Id)
597         {
598         // --- Core Defined
599         case DRV_IOCTL_TYPE:
600                 LEAVE('i', DRV_TYPE_TERMINAL);
601                 return DRV_TYPE_TERMINAL;
602         case DRV_IOCTL_IDENT:
603                 memcpy(Data, "VT\0\0", 4);
604                 LEAVE('i', 0);
605                 return 0;
606         case DRV_IOCTL_VERSION:
607                 LEAVE('x', VERSION);
608                 return VERSION;
609         case DRV_IOCTL_LOOKUP:
610                 LEAVE('i', 0);
611                 return 0;
612         
613         // Get/Set the mode (and apply any changes)
614         case TERM_IOCTL_MODETYPE:
615                 if(Data != NULL)
616                 {
617                         if( CheckMem(Data, sizeof(int)) == 0 ) {
618                                 LEAVE('i', -1);
619                                 return -1;
620                         }
621                         Log_Log("VTerm", "VTerm %i mode set to %i", (int)Node->Inode, *iData);
622                         
623                         // Update mode if needed
624                         if( term->Mode != *iData
625                          || term->NewWidth
626                          || term->NewHeight)
627                         {
628                                 // Adjust for text mode
629                                 if( *iData == TERM_MODE_TEXT ) {
630                                         term->NewHeight *= giVT_CharHeight;
631                                         term->NewWidth *= giVT_CharWidth;
632                                 }
633                                 // Fill unchanged dimensions
634                                 if(term->NewHeight == 0)        term->NewHeight = term->Height;
635                                 if(term->NewWidth == 0) term->NewWidth = term->Width;
636                                 // Set new mode
637                                 VT_int_ChangeMode(term, *iData, term->NewWidth, term->NewHeight);
638                                 // Clear unapplied dimensions
639                                 term->NewWidth = 0;
640                                 term->NewHeight = 0;
641                         }
642                         
643                         // Update the screen dimensions
644                         if(Node->Inode == giVT_CurrentTerminal)
645                                 VT_SetTerminal( giVT_CurrentTerminal );
646                 }
647                 LEAVE('i', term->Mode);
648                 return term->Mode;
649         
650         // Get/set the terminal width
651         case TERM_IOCTL_WIDTH:
652                 if(Data != NULL) {
653                         if( CheckMem(Data, sizeof(int)) == 0 ) {
654                                 LEAVE('i', -1);
655                                 return -1;
656                         }
657                         term->NewWidth = *iData;
658                 }
659                 if( term->NewWidth )
660                         ret = term->NewWidth;
661                 else if( term->Mode == TERM_MODE_TEXT )
662                         ret = term->TextWidth;
663                 else
664                         ret = term->Width;
665                 LEAVE('i', ret);
666                 return ret;
667         
668         // Get/set the terminal height
669         case TERM_IOCTL_HEIGHT:
670                 if(Data != NULL) {
671                         if( CheckMem(Data, sizeof(int)) == 0 ) {
672                                 LEAVE('i', -1);
673                                 return -1;
674                         }
675                         term->NewHeight = *iData;
676                 }
677                 if( term->NewHeight )
678                         ret = term->NewHeight;
679                 else if( term->Mode == TERM_MODE_TEXT )
680                         ret = term->TextHeight;
681                 else
682                         ret = term->Height;
683                 LEAVE('i', ret);
684                 return ret;
685         
686         case TERM_IOCTL_FORCESHOW:
687                 Log_Log("VTerm", "Thread %i forced VTerm %i to be shown",
688                         Threads_GetTID(), (int)Node->Inode);
689                 VT_SetTerminal( Node->Inode );
690                 LEAVE('i', 1);
691                 return 1;
692         
693         case TERM_IOCTL_GETCURSOR:
694                 ret = (term->Flags & VT_FLAG_ALTBUF) ? term->AltWritePos : term->WritePos-term->ViewPos;
695                 LEAVE('i', ret);
696                 return ret;
697         }
698         LEAVE('i', -1);
699         return -1;
700 }
701
702 /**
703  * \fn void VT_SetTerminal(int ID)
704  * \brief Set the current terminal
705  */
706 void VT_SetTerminal(int ID)
707 {       
708         // Update current terminal ID
709         Log_Log("VTerm", "Changed terminal from %i to %i", giVT_CurrentTerminal, ID);
710         giVT_CurrentTerminal = ID;
711         gpVT_CurTerm = &gVT_Terminals[ID];
712         
713         // Update cursor
714         if( gpVT_CurTerm->Mode == TERM_MODE_TEXT && !(gpVT_CurTerm->Flags & VT_FLAG_HIDECSR) )
715         {
716                 tVideo_IOCtl_Pos        pos;
717                  int    offset = (gpVT_CurTerm->Flags & VT_FLAG_ALTBUF) ? gpVT_CurTerm->AltWritePos : gpVT_CurTerm->WritePos - gpVT_CurTerm->ViewPos;
718                 pos.x = offset % gpVT_CurTerm->TextWidth;
719                 pos.y = offset / gpVT_CurTerm->TextWidth;
720                 if( 0 <= pos.y && pos.y < gpVT_CurTerm->TextHeight )
721                         VFS_IOCtl(giVT_OutputDevHandle, VIDEO_IOCTL_SETCURSOR, &pos);
722         }
723         
724         if( gpVT_CurTerm->Mode == TERM_MODE_TEXT )
725                 VT_SetMode( VIDEO_BUFFMT_TEXT );
726         else
727                 VT_SetMode( VIDEO_BUFFMT_FRAMEBUFFER );
728         
729         // Update the screen
730         VT_int_UpdateScreen( &gVT_Terminals[ ID ], 1 );
731 }
732
733 /**
734  * \fn void VT_KBCallBack(Uint32 Codepoint)
735  * \brief Called on keyboard interrupt
736  * \param Codepoint     Pseudo-UTF32 character
737  * 
738  * Handles a key press and sends the key code to the user's buffer.
739  * If the code creates a kernel-magic sequence, it is not passed to the
740  * user and is handled in-kernel.
741  */
742 void VT_KBCallBack(Uint32 Codepoint)
743 {
744         tVTerm  *term = gpVT_CurTerm;
745         
746         // How the hell did we get a codepoint of zero?
747         if(Codepoint == 0)      return;
748         
749         // Key Up
750         if( Codepoint & 0x80000000 )
751         {
752                 Codepoint &= 0x7FFFFFFF;
753                 switch(Codepoint)
754                 {
755                 #if !USE_CTRL_ALT
756                 case KEY_RSHIFT:        gbVT_CtrlDown = 0;      break;
757                 case KEY_LSHIFT:        gbVT_AltDown = 0;       break;
758                 #else
759                 case KEY_LALT:  gbVT_AltDown &= ~1;     break;
760                 case KEY_RALT:  gbVT_AltDown &= ~2;     break;
761                 case KEY_LCTRL: gbVT_CtrlDown &= ~1;    break;
762                 case KEY_RCTRL: gbVT_CtrlDown &= ~2;    break;
763                 #endif
764                 }
765                 return;
766         }
767         
768         switch(Codepoint)
769         {
770         #if !USE_CTRL_ALT       // HACK: Use both shifts instead of Ctrl-Alt
771         case KEY_RSHIFT:        gbVT_CtrlDown = 1;      break;
772         case KEY_LSHIFT:        gbVT_AltDown = 1;       break;
773         #else
774         case KEY_LALT:  gbVT_AltDown |= 1;      break;
775         case KEY_RALT:  gbVT_AltDown |= 2;      break;
776         case KEY_LCTRL: gbVT_CtrlDown |= 1;     break;
777         case KEY_RCTRL: gbVT_CtrlDown |= 2;     break;
778         #endif
779         
780         default:
781                 if(!gbVT_AltDown || !gbVT_CtrlDown)
782                         break;
783                 switch(Codepoint)
784                 {
785                 case KEY_F1:    VT_SetTerminal(0);      return;
786                 case KEY_F2:    VT_SetTerminal(1);      return;
787                 case KEY_F3:    VT_SetTerminal(2);      return;
788                 case KEY_F4:    VT_SetTerminal(3);      return;
789                 case KEY_F5:    VT_SetTerminal(4);      return;
790                 case KEY_F6:    VT_SetTerminal(5);      return;
791                 case KEY_F7:    VT_SetTerminal(6);      return;
792                 case KEY_F8:    VT_SetTerminal(7);      return;
793                 case KEY_F9:    VT_SetTerminal(8);      return;
794                 case KEY_F10:   VT_SetTerminal(9);      return;
795                 case KEY_F11:   VT_SetTerminal(10);     return;
796                 case KEY_F12:   VT_SetTerminal(11);     return;
797                 // Scrolling
798                 case KEY_PGUP:
799                         if( gpVT_CurTerm->Flags & VT_FLAG_ALTBUF )
800                                 return ;
801                         if( gpVT_CurTerm->ViewPos > gpVT_CurTerm->Width )
802                                 gpVT_CurTerm->ViewPos -= gpVT_CurTerm->Width;
803                         else
804                                 gpVT_CurTerm->ViewPos = 0;
805                         return;
806                 case KEY_PGDOWN:
807                         if( gpVT_CurTerm->Flags & VT_FLAG_ALTBUF )
808                                 return ;
809                         if( gpVT_CurTerm->ViewPos < gpVT_CurTerm->Width*gpVT_CurTerm->Height*(giVT_Scrollback-1) )
810                                 gpVT_CurTerm->ViewPos += gpVT_CurTerm->Width;
811                         else
812                                 gpVT_CurTerm->ViewPos = gpVT_CurTerm->Width*gpVT_CurTerm->Height*(giVT_Scrollback-1);
813                         return;
814                 }
815         }
816         
817         // Encode key
818         if(term->Mode == TERM_MODE_TEXT)
819         {
820                 Uint8   buf[6] = {0};
821                  int    len = 0;
822                 
823                 // Ignore Modifer Keys
824                 if(Codepoint > KEY_MODIFIERS)   return;
825                 
826                 // Get UTF-8/ANSI Encoding
827                 switch(Codepoint)
828                 {
829                 case KEY_LEFT:
830                         buf[0] = '\x1B';        buf[1] = '[';   buf[2] = 'D';
831                         len = 3;
832                         break;
833                 case KEY_RIGHT:
834                         buf[0] = '\x1B';        buf[1] = '[';   buf[2] = 'C';
835                         len = 3;
836                         break;
837                 case KEY_UP:
838                         buf[0] = '\x1B';        buf[1] = '[';   buf[2] = 'A';
839                         len = 3;
840                         break;
841                 case KEY_DOWN:
842                         buf[0] = '\x1B';        buf[1] = '[';   buf[2] = 'B';
843                         len = 3;
844                         break;
845                 
846                 case KEY_PGUP:
847                         //buf[0] = '\x1B';      buf[1] = '[';   buf[2] = '5';   // Some overline also
848                         //len = 4;      // Commented out until I'm sure
849                         len = 0;
850                         break;
851                 case KEY_PGDOWN:
852                         len = 0;
853                         break;
854                 
855                 // Attempt to encode in UTF-8
856                 default:
857                         len = WriteUTF8( buf, Codepoint );
858                         if(len == 0) {
859                                 Warning("Codepoint (%x) is unrepresentable in UTF-8", Codepoint);
860                         }
861                         break;
862                 }
863                 
864                 if(len == 0) {
865                         // Unprintable / Don't Pass
866                         return;
867                 }
868                 
869                 // Write
870                 if( MAX_INPUT_CHARS8 - term->InputWrite >= len )
871                         memcpy( &term->InputBuffer[term->InputWrite], buf, len );
872                 else {
873                         memcpy( &term->InputBuffer[term->InputWrite], buf, MAX_INPUT_CHARS8 - term->InputWrite );
874                         memcpy( &term->InputBuffer[0], buf, len - (MAX_INPUT_CHARS8 - term->InputWrite) );
875                 }
876                 // Roll the buffer over
877                 term->InputWrite += len;
878                 term->InputWrite %= MAX_INPUT_CHARS8;
879                 if( (term->InputWrite - term->InputRead + MAX_INPUT_CHARS8)%MAX_INPUT_CHARS8 < len ) {
880                         term->InputRead = term->InputWrite + 1;
881                         term->InputRead %= MAX_INPUT_CHARS8;
882                 }
883         }
884         else
885         {
886                 // Encode the raw UTF-32 Key
887                 Uint32  *raw_in = (void*)term->InputBuffer;
888                 raw_in[ term->InputWrite ] = Codepoint;
889                 term->InputWrite ++;
890                 term->InputWrite %= MAX_INPUT_CHARS32;
891                 if(term->InputRead == term->InputWrite) {
892                         term->InputRead ++;
893                         term->InputRead %= MAX_INPUT_CHARS32;
894                 }
895         }
896         
897         VFS_MarkAvaliable(&term->Node, 1);
898         
899         // Wake up the thread waiting on us
900         //if( term->ReadingThread >= 0 ) {
901         //      Threads_WakeTID(term->ReadingThread);
902         //}
903 }
904
905 /**
906  * \fn void VT_int_ClearLine(tVTerm *Term, int Num)
907  * \brief Clears a line in a virtual terminal
908  */
909 void VT_int_ClearLine(tVTerm *Term, int Num)
910 {
911          int    i;
912         tVT_Char        *cell;
913         
914         if( Num < 0 || Num >= Term->TextHeight * (giVT_Scrollback + 1) )        return ;
915         
916         cell = (Term->Flags & VT_FLAG_ALTBUF) ? Term->AltBuf : Term->Text;
917         cell = &cell[ Num*Term->TextWidth ];
918         
919         for( i = Term->TextWidth; i--; )
920         {
921                 cell[ i ].Ch = 0;
922                 cell[ i ].Colour = Term->CurColour;
923         }
924 }
925
926 /**
927  * \fn int VT_int_ParseEscape(tVTerm *Term, char *Buffer)
928  * \brief Parses a VT100 Escape code
929  */
930 int VT_int_ParseEscape(tVTerm *Term, char *Buffer)
931 {
932         char    c;
933          int    argc = 0, j = 1;
934          int    tmp;
935          int    args[6] = {0,0,0,0};
936          int    bQuestionMark = 0;
937         
938         switch(Buffer[0])
939         {
940         //Large Code
941         case '[':
942                 // Get Arguments
943                 c = Buffer[j++];
944                 if(c == '?') {
945                         bQuestionMark = 1;
946                         c = Buffer[j++];
947                 }
948                 if( '0' <= c && c <= '9' )
949                 {
950                         do {
951                                 if(c == ';')    c = Buffer[j++];
952                                 while('0' <= c && c <= '9') {
953                                         args[argc] *= 10;
954                                         args[argc] += c-'0';
955                                         c = Buffer[j++];
956                                 }
957                                 argc ++;
958                         } while(c == ';');
959                 }
960                 
961                 // Get Command
962                 if(     ('a' <= c && c <= 'z') || ('A' <= c && c <= 'Z'))
963                 {
964                         if( bQuestionMark )
965                         {
966                                 switch(c)
967                                 {
968                                 // DEC Private Mode Set
969                                 case 'h':
970                                         if(argc != 1)   break;
971                                         switch(args[0])
972                                         {
973                                         case 1047:
974                                                 VT_int_ToggleAltBuffer(Term, 1);
975                                                 break;
976                                         }
977                                         break;
978                                 case 'l':
979                                         if(argc != 1)   break;
980                                         switch(args[0])
981                                         {
982                                         case 1047:
983                                                 VT_int_ToggleAltBuffer(Term, 0);
984                                                 break;
985                                         }
986                                         break;
987                                 default:
988                                         Log_Warning("VTerm", "Unknown control sequence '\\x1B[?%c'", c);
989                                         break;
990                                 }
991                         }
992                         else
993                         {
994                                 tmp = 1;
995                                 switch(c)
996                                 {
997                                 // Left
998                                 case 'D':
999                                         tmp = -1;
1000                                 // Right
1001                                 case 'C':
1002                                         if(argc == 1)   tmp *= args[0];
1003                                         if( Term->Flags & VT_FLAG_ALTBUF )
1004                                         {
1005                                                 if( (Term->AltWritePos + tmp) % Term->TextWidth == 0 ) {
1006                                                         Term->AltWritePos -= Term->AltWritePos % Term->TextWidth;
1007                                                         Term->AltWritePos += Term->TextWidth - 1;
1008                                                 }
1009                                                 else
1010                                                         Term->AltWritePos += tmp;
1011                                         }
1012                                         else
1013                                         {
1014                                                 if( (Term->WritePos + tmp) % Term->TextWidth == 0 ) {
1015                                                         Term->WritePos -= Term->WritePos % Term->TextWidth;
1016                                                         Term->WritePos += Term->TextWidth - 1;
1017                                                 }
1018                                                 else
1019                                                         Term->WritePos += tmp;
1020                                         }
1021                                         break;
1022                                 
1023                                 // Erase
1024                                 case 'J':
1025                                         switch(args[0])
1026                                         {
1027                                         case 0: // Erase below
1028                                                 break;
1029                                         case 1: // Erase above
1030                                                 break;
1031                                         case 2: // Erase all
1032                                                 if( Term->Flags & VT_FLAG_ALTBUF )
1033                                                 {
1034                                                          int    i = Term->TextHeight;
1035                                                         while( i-- )    VT_int_ClearLine(Term, i);
1036                                                         Term->AltWritePos = 0;
1037                                                         VT_int_UpdateScreen(Term, 1);
1038                                                 }
1039                                                 else
1040                                                 {
1041                                                          int    i = Term->TextHeight * (giVT_Scrollback + 1);
1042                                                         while( i-- )    VT_int_ClearLine(Term, i);
1043                                                         Term->WritePos = 0;
1044                                                         Term->ViewPos = 0;
1045                                                         VT_int_UpdateScreen(Term, 1);
1046                                                 }
1047                                                 break;
1048                                         }
1049                                         break;
1050                                 // Set cursor position
1051                                 case 'H':
1052                                         if( Term->Flags & VT_FLAG_ALTBUF )
1053                                                 Term->AltWritePos = args[0] + args[1]*Term->TextWidth;
1054                                         else
1055                                                 Term->WritePos = args[0] + args[1]*Term->TextWidth;
1056                                         //Log_Debug("VTerm", "args = {%i, %i}", args[0], args[1]);
1057                                         break;
1058                                 
1059                                 // Scroll up `n` lines
1060                                 case 'S':
1061                                         tmp = -1;
1062                                 // Scroll down `n` lines
1063                                 case 'T':
1064                                         if(argc == 1)   tmp *= args[0];
1065                                         if( Term->Flags & VT_FLAG_ALTBUF )
1066                                                 VT_int_ScrollText(Term, tmp);
1067                                         else
1068                                         {
1069                                                 if(Term->ViewPos/Term->TextWidth + tmp < 0)
1070                                                         break;
1071                                                 if(Term->ViewPos/Term->TextWidth + tmp  > Term->TextHeight * (giVT_Scrollback + 1))
1072                                                         break;
1073                                                 
1074                                                 Term->ViewPos += Term->TextWidth*tmp;
1075                                         }
1076                                         break;
1077                                 
1078                                 // Set Font flags
1079                                 case 'm':
1080                                         for( ; argc--; )
1081                                         {
1082                                                 // Flags
1083                                                 if( 0 <= args[argc] && args[argc] <= 8)
1084                                                 {
1085                                                         switch(args[argc])
1086                                                         {
1087                                                         case 0: Term->CurColour = DEFAULT_COLOUR;       break;  // Reset
1088                                                         case 1: Term->CurColour |= 0x80000000;  break;  // Bright
1089                                                         case 2: Term->CurColour &= ~0x80000000; break;  // Dim
1090                                                         }
1091                                                 }
1092                                                 // Foreground Colour
1093                                                 else if(30 <= args[argc] && args[argc] <= 37) {
1094                                                         Term->CurColour &= 0xF000FFFF;
1095                                                         Term->CurColour |= (Uint32)caVT100Colours[ args[argc]-30+(Term->CurColour>>28) ] << 16;
1096                                                 }
1097                                                 // Background Colour
1098                                                 else if(40 <= args[argc] && args[argc] <= 47) {
1099                                                         Term->CurColour &= 0xFFFF8000;
1100                                                         Term->CurColour |= caVT100Colours[ args[argc]-40+((Term->CurColour>>12)&15) ];
1101                                                 }
1102                                         }
1103                                         break;
1104                                 
1105                                 // Set scrolling region
1106                                 case 'r':
1107                                         if( argc != 2 ) break;
1108                                         Term->ScrollTop = args[0];
1109                                         Term->ScrollHeight = args[1] - args[0];
1110                                         break;
1111                                 
1112                                 default:
1113                                         Log_Warning("VTerm", "Unknown control sequence '\\x1B[%c'", c);
1114                                         break;
1115                                 }
1116                         }
1117                 }
1118                 break;
1119                 
1120         default:        break;
1121         }
1122         
1123         //Log_Debug("VTerm", "j = %i, Buffer = '%s'", j, Buffer);
1124         return j;
1125 }
1126
1127 /**
1128  * \fn void VT_int_PutString(tVTerm *Term, Uint8 *Buffer, Uint Count)
1129  * \brief Print a string to the Virtual Terminal
1130  */
1131 void VT_int_PutString(tVTerm *Term, Uint8 *Buffer, Uint Count)
1132 {
1133         Uint32  val;
1134          int    i;
1135         
1136         // Iterate
1137         for( i = 0; i < Count; i++ )
1138         {
1139                 // Handle escape sequences
1140                 if( Buffer[i] == 0x1B )
1141                 {
1142                         i ++;
1143                         i += VT_int_ParseEscape(Term, (char*)&Buffer[i]) - 1;
1144                         continue;
1145                 }
1146                 
1147                 // Fast check for non UTF-8
1148                 if( Buffer[i] < 128 )   // Plain ASCII
1149                         VT_int_PutChar(Term, Buffer[i]);
1150                 else {  // UTF-8
1151                         i += ReadUTF8(&Buffer[i], &val) - 1;
1152                         VT_int_PutChar(Term, val);
1153                 }
1154         }
1155         // Update Screen
1156         VT_int_UpdateScreen( Term, 0 );
1157         
1158         // Update cursor
1159         if( Term == gpVT_CurTerm && !(Term->Flags & VT_FLAG_HIDECSR) )
1160         {
1161                 tVideo_IOCtl_Pos        pos;
1162                  int    offset = (gpVT_CurTerm->Flags & VT_FLAG_ALTBUF) ? gpVT_CurTerm->AltWritePos : gpVT_CurTerm->WritePos - gpVT_CurTerm->ViewPos;
1163                 pos.x = offset % gpVT_CurTerm->TextWidth;
1164                 pos.y = offset / gpVT_CurTerm->TextWidth;
1165                 if( 0 <= pos.y && pos.y < gpVT_CurTerm->TextHeight )
1166                         VFS_IOCtl(giVT_OutputDevHandle, VIDEO_IOCTL_SETCURSOR, &pos);
1167         }
1168 }
1169
1170 /**
1171  * \fn void VT_int_PutChar(tVTerm *Term, Uint32 Ch)
1172  * \brief Write a single character to a VTerm
1173  */
1174 void VT_int_PutChar(tVTerm *Term, Uint32 Ch)
1175 {
1176          int    i;
1177         tVT_Char        *buffer;
1178          int    write_pos;
1179         
1180         if(Term->Flags & VT_FLAG_ALTBUF) {
1181                 buffer = Term->AltBuf;
1182                 write_pos = Term->AltWritePos;
1183         }
1184         else {
1185                 buffer = Term->Text;
1186                 write_pos = Term->WritePos;
1187         }
1188         
1189         switch(Ch)
1190         {
1191         case '\0':      return; // Ignore NULL byte
1192         case '\n':
1193                 VT_int_UpdateScreen( Term, 0 ); // Update the line before newlining
1194                 write_pos += Term->TextWidth;
1195         case '\r':
1196                 write_pos -= write_pos % Term->TextWidth;
1197                 break;
1198         
1199         case '\t':
1200                 do {
1201                         buffer[ write_pos ].Ch = '\0';
1202                         buffer[ write_pos ].Colour = Term->CurColour;
1203                         write_pos ++;
1204                 } while(write_pos & 7);
1205                 break;
1206         
1207         case '\b':
1208                 // Backspace is invalid at Offset 0
1209                 if(write_pos == 0)      break;
1210                 
1211                 write_pos --;
1212                 // Singe Character
1213                 if(buffer[ write_pos ].Ch != '\0') {
1214                         buffer[ write_pos ].Ch = 0;
1215                         buffer[ write_pos ].Colour = Term->CurColour;
1216                         break;
1217                 }
1218                 // Tab
1219                 i = 7;  // Limit it to 8
1220                 do {
1221                         buffer[ write_pos ].Ch = 0;
1222                         buffer[ write_pos ].Colour = Term->CurColour;
1223                         write_pos --;
1224                 } while(write_pos && i-- && buffer[ write_pos ].Ch == '\0');
1225                 if(buffer[ write_pos ].Ch != '\0')
1226                         write_pos ++;
1227                 break;
1228         
1229         default:
1230                 buffer[ write_pos ].Ch = Ch;
1231                 buffer[ write_pos ].Colour = Term->CurColour;
1232                 // Update the line before wrapping
1233                 if( (write_pos + 1) % Term->TextWidth == 0 )
1234                         VT_int_UpdateScreen( Term, 0 );
1235                 write_pos ++;
1236                 break;
1237         }
1238         
1239         if(Term->Flags & VT_FLAG_ALTBUF)
1240         {
1241                 Term->AltBuf = buffer;
1242                 Term->AltWritePos = write_pos;
1243                 
1244                 if(Term->AltWritePos >= Term->TextWidth*Term->TextHeight)
1245                 {
1246                         Term->AltWritePos -= Term->TextWidth;
1247                         VT_int_ScrollText(Term, 1);
1248                 }
1249                 
1250         }
1251         else
1252         {
1253                 Term->Text = buffer;
1254                 Term->WritePos = write_pos;
1255                 // Move Screen
1256                 // - Check if we need to scroll the entire scrollback buffer
1257                 if(Term->WritePos >= Term->TextWidth*Term->TextHeight*(giVT_Scrollback+1))
1258                 {
1259                          int    base;
1260                         
1261                         // Update previous line
1262                         Term->WritePos -= Term->TextWidth;
1263                         VT_int_UpdateScreen( Term, 0 );
1264                         
1265                         // Update view position
1266                         base = Term->TextWidth*Term->TextHeight*(giVT_Scrollback);
1267                         if(Term->ViewPos < base)
1268                                 Term->ViewPos += Term->Width;
1269                         if(Term->ViewPos > base)
1270                                 Term->ViewPos = base;
1271                         
1272                         VT_int_ScrollText(Term, 1);
1273                 }
1274                 // Ok, so we only need to scroll the screen
1275                 else if(Term->WritePos >= Term->ViewPos + Term->TextWidth*Term->TextHeight)
1276                 {
1277                         // Update the last line
1278                         Term->WritePos -= Term->TextWidth;
1279                         VT_int_UpdateScreen( Term, 0 );
1280                         Term->WritePos += Term->TextWidth;
1281                         
1282                         VT_int_ScrollText(Term, 1);
1283                         
1284                         Term->ViewPos += Term->TextWidth;
1285                 }
1286         }
1287         
1288         //LEAVE('-');
1289 }
1290
1291 void VT_int_ScrollText(tVTerm *Term, int Count)
1292 {
1293         tVT_Char        *buf;
1294          int    height, init_write_pos;
1295          int    len, i;
1296         
1297         if( Term->Flags & VT_FLAG_ALTBUF )
1298         {
1299                 buf = Term->AltBuf;
1300                 height = Term->TextHeight;
1301                 init_write_pos = Term->AltWritePos;
1302         }
1303         else
1304         {
1305                 buf = Term->Text;
1306                 height = Term->TextHeight*giVT_Scrollback;
1307                 init_write_pos = Term->WritePos;
1308         }
1309         
1310         if( Count > 0 )
1311         {
1312                  int    base;
1313                 if(Count > Term->ScrollHeight)  Count = Term->ScrollHeight;
1314                 base = Term->TextWidth*(Term->ScrollTop + Term->ScrollHeight - Count);
1315                 len = Term->TextWidth*(Term->ScrollHeight - Count);
1316                 
1317                 // Scroll terminal cache
1318                 memcpy(
1319                         &buf[Term->TextWidth*Term->ScrollTop],
1320                         &buf[Term->TextWidth*(Term->ScrollTop+Count)],
1321                         len*sizeof(tVT_Char)
1322                         );
1323                 // Clear last rows
1324                 for( i = 0; i < Term->TextWidth*Count; i ++ )
1325                 {
1326                         Term->AltBuf[ base + i ].Ch = 0;
1327                         Term->AltBuf[ base + i ].Colour = Term->CurColour;
1328                 }
1329                 
1330                 // Update Screen
1331                 VT_int_ScrollFramebuffer( Term, Count );
1332                 if( Term->Flags & VT_FLAG_ALTBUF )
1333                         Term->AltWritePos = Term->TextWidth*(Term->ScrollTop + Term->ScrollHeight - Count);
1334                 else
1335                         Term->WritePos = Term->ViewPos + Term->TextWidth*(Term->ScrollTop + Term->ScrollHeight - Count);
1336 //              Log_Debug("VTerm", "Term->WritePos = %i/%i = %i", Term->WritePos, Term->TextWidth, Term->WritePos/Term->TextWidth);
1337                 for( i = 0; i < Count; i ++ )
1338                 {
1339                         VT_int_UpdateScreen( Term, 0 );
1340                         if( Term->Flags & VT_FLAG_ALTBUF )
1341                                 Term->AltWritePos += Term->TextWidth;
1342                         else
1343                                 Term->WritePos += Term->TextWidth;
1344                 }
1345         }
1346         else
1347         {
1348                 Count = -Count;
1349                 if(Count > Term->ScrollHeight)  Count = Term->ScrollHeight;
1350                 
1351                 len = Term->TextWidth*(Term->ScrollHeight - Count);
1352                 
1353                 // Scroll terminal cache
1354                 memcpy(
1355                         &buf[Term->TextWidth*(Term->ScrollTop+Count)],
1356                         &buf[Term->TextWidth*Term->ScrollTop],
1357                         len*sizeof(tVT_Char)
1358                         );
1359                 // Clear preceding rows
1360                 for( i = 0; i < Term->TextWidth*Count; i ++ )
1361                 {
1362                         Term->AltBuf[ i ].Ch = 0;
1363                         Term->AltBuf[ i ].Colour = Term->CurColour;
1364                 }
1365                 
1366                 VT_int_ScrollFramebuffer( Term, -Count );
1367                 if( Term->Flags & VT_FLAG_ALTBUF )
1368                         Term->AltWritePos = Term->TextWidth*Term->ScrollTop;
1369                 else
1370                         Term->WritePos = Term->ViewPos + Term->TextWidth*Term->ScrollTop;
1371                 for( i = 0; i < Count; i ++ )
1372                 {
1373                         VT_int_UpdateScreen( Term, 0 );
1374                         if( Term->Flags & VT_FLAG_ALTBUF )
1375                                 Term->AltWritePos += Term->TextWidth;
1376                         else
1377                                 Term->WritePos += Term->TextWidth;
1378                 }
1379         }
1380         
1381         if( Term->Flags & VT_FLAG_ALTBUF )
1382                 Term->AltWritePos = init_write_pos;
1383         else
1384                 Term->WritePos = init_write_pos;
1385 }
1386
1387 /**
1388  * \fn void VT_int_ScrollFramebuffer( tVTerm *Term, int Count )
1389  * \note Scrolls the framebuffer down by \a Count text lines
1390  */
1391 void VT_int_ScrollFramebuffer( tVTerm *Term, int Count )
1392 {
1393          int    tmp;
1394         struct {
1395                 Uint8   Op;
1396                 Uint16  DstX, DstY;
1397                 Uint16  SrcX, SrcY;
1398                 Uint16  W, H;
1399         } PACKED        buf;
1400         
1401         // Only update if this is the current terminal
1402         if( Term != gpVT_CurTerm )      return;
1403         
1404         if( Count > Term->ScrollHeight )        Count = Term->ScrollHeight;
1405         if( Count < -Term->ScrollHeight )       Count = -Term->ScrollHeight;
1406         
1407         // Switch to 2D Command Stream
1408         tmp = VIDEO_BUFFMT_2DSTREAM;
1409         VFS_IOCtl(giVT_OutputDevHandle, VIDEO_IOCTL_SETBUFFORMAT, &tmp);
1410         
1411         // BLIT to 0,0 from 0,giVT_CharHeight
1412         buf.Op = VIDEO_2DOP_BLIT;
1413         buf.SrcX = 0;   buf.DstX = 0;
1414         buf.W = Term->TextWidth * giVT_CharWidth;
1415         if( Count > 0 )
1416         {
1417                 buf.SrcY = (Term->ScrollTop+Count) * giVT_CharHeight;
1418                 buf.DstY = Term->ScrollTop * giVT_CharHeight;
1419         }
1420         else    // Scroll up, move text down
1421         {
1422                 Count = -Count;
1423                 buf.SrcY = Term->ScrollTop * giVT_CharHeight;
1424                 buf.DstY = (Term->ScrollTop+Count) * giVT_CharHeight;
1425         }
1426         buf.H = (Term->ScrollHeight-Count) * giVT_CharHeight;
1427         VFS_WriteAt(giVT_OutputDevHandle, 0, sizeof(buf), &buf);
1428         
1429         // Restore old mode (this function is only called during text mode)
1430         tmp = VIDEO_BUFFMT_TEXT;
1431         VFS_IOCtl(giVT_OutputDevHandle, VIDEO_IOCTL_SETBUFFORMAT, &tmp);
1432 }
1433
1434 /**
1435  * \fn void VT_int_UpdateScreen( tVTerm *Term, int UpdateAll )
1436  * \brief Updates the video framebuffer
1437  */
1438 void VT_int_UpdateScreen( tVTerm *Term, int UpdateAll )
1439 {
1440         tVT_Char        *buffer;
1441          int    view_pos, write_pos;
1442         // Only update if this is the current terminal
1443         if( Term != gpVT_CurTerm )      return;
1444         
1445         switch( Term->Mode )
1446         {
1447         case TERM_MODE_TEXT:
1448                 view_pos = (Term->Flags & VT_FLAG_ALTBUF) ? 0 : Term->ViewPos;
1449                 write_pos = (Term->Flags & VT_FLAG_ALTBUF) ? Term->AltWritePos : Term->WritePos;
1450                 buffer = (Term->Flags & VT_FLAG_ALTBUF) ? Term->AltBuf : Term->Text;
1451                 // Re copy the entire screen?
1452                 if(UpdateAll) {
1453                         VFS_WriteAt(
1454                                 giVT_OutputDevHandle,
1455                                 0,
1456                                 Term->TextWidth*Term->TextHeight*sizeof(tVT_Char),
1457                                 &buffer[view_pos]
1458                                 );
1459                 }
1460                 // Only copy the current line
1461                 else {
1462                          int    ofs = write_pos - write_pos % Term->TextWidth;
1463                         VFS_WriteAt(
1464                                 giVT_OutputDevHandle,
1465                                 (ofs - view_pos)*sizeof(tVT_Char),
1466                                 Term->TextWidth*sizeof(tVT_Char),
1467                                 &buffer[ofs]
1468                                 );
1469                 }
1470                 break;
1471         case TERM_MODE_FB:
1472                 VFS_WriteAt(
1473                         giVT_OutputDevHandle,
1474                         0,
1475                         Term->Width*Term->Height*sizeof(Uint32),
1476                         Term->Buffer
1477                         );
1478                 break;
1479         }
1480 }
1481
1482 /**
1483  * \brief Update the screen mode
1484  * \param Term  Terminal to update
1485  * \param NewMode       New mode to set
1486  * \param NewWidth      New framebuffer width
1487  * \param NewHeight     New framebuffer height
1488  */
1489 void VT_int_ChangeMode(tVTerm *Term, int NewMode, int NewWidth, int NewHeight)
1490 {
1491         
1492         // TODO: Increase RealWidth/RealHeight when this happens
1493         if(NewWidth > giVT_RealWidth)   NewWidth = giVT_RealWidth;
1494         if(NewHeight > giVT_RealHeight) NewHeight = giVT_RealHeight;
1495         
1496         Term->Mode = NewMode;
1497         
1498         if(NewWidth != Term->Width || NewHeight != Term->Height)
1499         {
1500                  int    oldW = Term->Width;
1501                  int    oldTW = Term->TextWidth;
1502                  int    oldH = Term->Height;
1503                  int    oldTH = Term->TextHeight;
1504                 tVT_Char        *oldTBuf = Term->Text;
1505                 Uint32  *oldFB = Term->Buffer;
1506                  int    w, h, i;
1507                 // Calculate new dimensions
1508                 Term->Width = NewWidth;
1509                 Term->Height = NewHeight;
1510                 Term->TextWidth = NewWidth / giVT_CharWidth;
1511                 Term->TextHeight = NewHeight / giVT_CharHeight;
1512                 Term->ScrollHeight = Term->TextHeight - (oldTH - Term->ScrollHeight) - Term->ScrollTop;
1513         
1514                 // Allocate new buffers
1515                 // - Text
1516                 Term->Text = calloc(
1517                         Term->TextWidth * Term->TextHeight * (giVT_Scrollback+1),
1518                         sizeof(tVT_Char)
1519                         );
1520                 if(oldTBuf) {
1521                         // Copy old buffer
1522                         w = (oldTW > Term->TextWidth) ? Term->TextWidth : oldTW;
1523                         h = (oldTH > Term->TextHeight) ? Term->TextHeight : oldTH;
1524                         h *= giVT_Scrollback + 1;
1525                         for( i = 0; i < h; i ++ )
1526                         {
1527                                 memcpy(
1528                                         &Term->Text[i*Term->TextWidth],
1529                                         &oldTBuf[i*oldTW],
1530                                         w*sizeof(tVT_Char)
1531                                         );      
1532                         }
1533                         free(oldTBuf);
1534                 }
1535                 
1536                 // - Alternate Text
1537                 Term->AltBuf = realloc(
1538                         Term->AltBuf,
1539                         Term->TextWidth * Term->TextHeight * sizeof(tVT_Char)
1540                         );
1541                 
1542                 // - Framebuffer
1543                 Term->Buffer = calloc( Term->Width * Term->Height, sizeof(Uint32) );
1544                 if(oldFB) {
1545                         // Copy old buffer
1546                         w = (oldW > Term->Width) ? Term->Width : oldW;
1547                         h = (oldH > Term->Height) ? Term->Height : oldH;
1548                         for( i = 0; i < h; i ++ )
1549                         {
1550                                 memcpy(
1551                                         &Term->Buffer[i*Term->Width],
1552                                         &oldFB[i*oldW],
1553                                         w*sizeof(Uint32)
1554                                         );
1555                         }
1556                         free(oldFB);
1557                 }
1558         }
1559         
1560         
1561         // Debug
1562         switch(NewMode)
1563         {
1564         case TERM_MODE_TEXT:
1565                 Log_Log("VTerm", "Set VT %p to text mode (%ix%i)",
1566                         Term, Term->TextWidth, Term->TextHeight);
1567                 break;
1568         case TERM_MODE_FB:
1569                 Log_Log("VTerm", "Set VT %p to framebuffer mode (%ix%i)",
1570                         Term, Term->Width, Term->Height);
1571                 break;
1572         //case TERM_MODE_2DACCEL:
1573         //case TERM_MODE_3DACCEL:
1574         //      return;
1575         }
1576 }
1577
1578
1579 void VT_int_ToggleAltBuffer(tVTerm *Term, int Enabled)
1580 {       
1581         if(Enabled)
1582                 Term->Flags |= VT_FLAG_ALTBUF;
1583         else
1584                 Term->Flags &= ~VT_FLAG_ALTBUF;
1585 }
1586
1587 // ---
1588 // Font Render
1589 // ---
1590 #define MONOSPACE_FONT  10816
1591
1592 #if MONOSPACE_FONT == 10808     // 8x8
1593 # include "vterm_font_8x8.h"
1594 #elif MONOSPACE_FONT == 10816   // 8x16
1595 # include "vterm_font_8x16.h"
1596 #endif
1597
1598 // === PROTOTYPES ===
1599 Uint8   *VT_Font_GetChar(Uint32 Codepoint);
1600
1601 // === GLOBALS ===
1602 int     giVT_CharWidth = FONT_WIDTH;
1603 int     giVT_CharHeight = FONT_HEIGHT;
1604
1605 // === CODE ===
1606 /**
1607  * \brief Render a font character
1608  */
1609 void VT_Font_Render(Uint32 Codepoint, void *Buffer, int Depth, int Pitch, Uint32 BGC, Uint32 FGC)
1610 {
1611         Uint8   *font;
1612          int    x, y;
1613         
1614         // 8-bpp and below
1615         if( Depth <= 8 )
1616         {
1617                 Uint8   *buf = Buffer;
1618                 
1619                 font = VT_Font_GetChar(Codepoint);
1620                 
1621                 for(y = 0; y < FONT_HEIGHT; y ++)
1622                 {
1623                         for(x = 0; x < FONT_WIDTH; x ++)
1624                         {
1625                                 if(*font & (1 << (FONT_WIDTH-x-1)))
1626                                         buf[x] = FGC;
1627                                 else
1628                                         buf[x] = BGC;
1629                         }
1630                         buf = (void*)( (tVAddr)buf + Pitch );
1631                         font ++;
1632                 }
1633         }
1634         // 16-bpp and below
1635         else if( Depth <= 16 )
1636         {
1637                 Uint16  *buf = Buffer;
1638                 
1639                 font = VT_Font_GetChar(Codepoint);
1640                 
1641                 for(y = 0; y < FONT_HEIGHT; y ++)
1642                 {
1643                         for(x = 0; x < FONT_WIDTH; x ++)
1644                         {
1645                                 if(*font & (1 << (FONT_WIDTH-x-1)))
1646                                         buf[x] = FGC;
1647                                 else
1648                                         buf[x] = BGC;
1649                         }
1650                         buf = (void*)( (tVAddr)buf + Pitch );
1651                         font ++;
1652                 }
1653         }
1654         // 24-bpp colour
1655         // - Special handling to not overwrite the next pixel
1656         //TODO: Endian issues here
1657         else if( Depth == 24 )
1658         {
1659                 Uint8   *buf = Buffer;
1660                 Uint8   bg_r = (BGC >> 16) & 0xFF;
1661                 Uint8   bg_g = (BGC >>  8) & 0xFF;
1662                 Uint8   bg_b = (BGC >>  0) & 0xFF;
1663                 Uint8   fg_r = (FGC >> 16) & 0xFF;
1664                 Uint8   fg_g = (FGC >>  8) & 0xFF;
1665                 Uint8   fg_b = (FGC >>  0) & 0xFF;
1666                 
1667                 font = VT_Font_GetChar(Codepoint);
1668                 
1669                 for(y = 0; y < FONT_HEIGHT; y ++)
1670                 {
1671                         for(x = 0; x < FONT_WIDTH; x ++)
1672                         {
1673                                 Uint8   r, g, b;
1674                                 
1675                                 if(*font & (1 << (FONT_WIDTH-x-1))) {
1676                                         r = fg_r;       g = fg_g;       b = fg_b;
1677                                 }
1678                                 else {
1679                                         r = bg_r;       g = bg_g;       b = bg_b;
1680                                 }
1681                                 buf[x*3+0] = b;
1682                                 buf[x*3+1] = g;
1683                                 buf[x*3+2] = r;
1684                         }
1685                         buf = (void*)( (tVAddr)buf + Pitch );
1686                         font ++;
1687                 }
1688         }
1689         // 32-bpp colour (nice and easy)
1690         else if( Depth == 32 )
1691         {
1692                 Uint32  *buf = Buffer;
1693                 
1694                 font = VT_Font_GetChar(Codepoint);
1695                 
1696                 for(y = 0; y < FONT_HEIGHT; y ++)
1697                 {
1698                         for(x = 0; x < FONT_WIDTH; x ++)
1699                         {
1700                                 if(*font & (1 << (FONT_WIDTH-x-1)))
1701                                         buf[x] = FGC;
1702                                 else
1703                                         buf[x] = BGC;
1704                         }
1705                         buf = (Uint32*)( (tVAddr)buf + Pitch );
1706                         font ++;
1707                 }
1708         }
1709 }
1710
1711 /**
1712  * \fn Uint32 VT_Colour12to24(Uint16 Col12)
1713  * \brief Converts a 12-bit colour into 24 bits
1714  */
1715 Uint32 VT_Colour12to24(Uint16 Col12)
1716 {
1717         Uint32  ret;
1718          int    tmp;
1719         tmp = Col12 & 0xF;
1720         ret  = (tmp << 0) | (tmp << 4);
1721         tmp = (Col12 & 0xF0) >> 4;
1722         ret |= (tmp << 8) | (tmp << 12);
1723         tmp = (Col12 & 0xF00) >> 8;
1724         ret |= (tmp << 16) | (tmp << 20);
1725         return ret;
1726 }
1727 /**
1728  * \brief Converts a 12-bit colour into 15 bits
1729  */
1730 Uint16 VT_Colour12to15(Uint16 Col12)
1731 {
1732         Uint32  ret;
1733          int    tmp;
1734         tmp = Col12 & 0xF;
1735         ret  = (tmp << 1) | (tmp & 1);
1736         tmp = (Col12 & 0xF0) >> 4;
1737         ret |= ( (tmp << 1) | (tmp & 1) ) << 5;
1738         tmp = (Col12 & 0xF00) >> 8;
1739         ret |= ( (tmp << 1) | (tmp & 1) ) << 10;
1740         return ret;
1741 }
1742
1743 /**
1744  * \brief Converts a 12-bit colour into any other depth
1745  * \param Col12 12-bit source colour
1746  * \param Depth Desired bit deptj
1747  * \note Green then blue get the extra avaliable bits (16:5-6-5, 14:4-5-5)
1748  */
1749 Uint32 VT_Colour12toN(Uint16 Col12, int Depth)
1750 {
1751         Uint32  ret;
1752         Uint32  r, g, b;
1753          int    rSize, gSize, bSize;
1754         
1755         // Fast returns
1756         if( Depth == 24 )       return VT_Colour12to24(Col12);
1757         if( Depth == 15 )       return VT_Colour12to15(Col12);
1758         // - 32 is a special case, it's usually 24-bit colour with an unused byte
1759         if( Depth == 32 )       return VT_Colour12to24(Col12);
1760         
1761         // Bounds checks
1762         if( Depth < 8 ) return 0;
1763         if( Depth > 32 )        return 0;
1764         
1765         r = Col12 & 0xF;
1766         g = (Col12 & 0xF0) >> 4;
1767         b = (Col12 & 0xF00) >> 8;
1768         
1769         rSize = gSize = bSize = Depth / 3;
1770         if( rSize + gSize + bSize < Depth )     // Depth % 3 == 1
1771                 gSize ++;
1772         if( rSize + gSize + bSize < Depth )     // Depth % 3 == 2
1773                 bSize ++;
1774         
1775         // Expand
1776         r <<= rSize - 4;        g <<= gSize - 4;        b <<= bSize - 4;
1777         // Fill with the lowest bit
1778         if( Col12 & 0x001 )     r |= (1 << (rSize - 4)) - 1;
1779         if( Col12 & 0x010 )     r |= (1 << (gSize - 4)) - 1;
1780         if( Col12 & 0x100 )     r |= (1 << (bSize - 4)) - 1;
1781         
1782         // Create output
1783         ret  = r;
1784         ret |= g << rSize;
1785         ret |= b << (rSize + gSize);
1786         
1787         return ret;
1788 }
1789
1790 /**
1791  * \fn Uint8 *VT_Font_GetChar(Uint32 Codepoint)
1792  * \brief Gets an index into the font array given a Unicode Codepoint
1793  * \note See http://en.wikipedia.org/wiki/CP437
1794  */
1795 Uint8 *VT_Font_GetChar(Uint32 Codepoint)
1796 {
1797          int    index = 0;
1798         if(Codepoint < 128)
1799                 return &VTermFont[Codepoint*FONT_HEIGHT];
1800         switch(Codepoint)
1801         {
1802         case 0xC7:      index = 128;    break;  // Ç
1803         case 0xFC:      index = 129;    break;  // ü
1804         case 0xE9:      index = 130;    break;  // é
1805         case 0xE2:      index = 131;    break;  // â
1806         case 0xE4:      index = 132;    break;  // ä
1807         case 0xE0:      index = 133;    break;  // à
1808         case 0xE5:      index = 134;    break;  // å
1809         case 0xE7:      index = 135;    break;  // ç
1810         case 0xEA:      index = 136;    break;  // ê
1811         case 0xEB:      index = 137;    break;  // ë
1812         case 0xE8:      index = 138;    break;  // è
1813         case 0xEF:      index = 139;    break;  // ï
1814         case 0xEE:      index = 140;    break;  // î
1815         case 0xEC:      index = 141;    break;  // ì
1816         case 0xC4:      index = 142;    break;  // Ä
1817         case 0xC5:      index = 143;    break;  // Å
1818         }
1819         
1820         return &VTermFont[index*FONT_HEIGHT];
1821 }
1822
1823 EXPORTAS(&giVT_CharWidth, giVT_CharWidth);
1824 EXPORTAS(&giVT_CharHeight, giVT_CharHeight);
1825 EXPORT(VT_Font_Render);
1826 EXPORT(VT_Colour12to24);

UCC git Repository :: git.ucc.asn.au