Fixed cursor behavior in VTerm
[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
13 #define USE_CTRL_ALT    0
14
15 // === CONSTANTS ===
16 #define VERSION ((0<<8)|(50))
17
18 #define NUM_VTS 8
19 #define MAX_INPUT_CHARS32       64
20 #define MAX_INPUT_CHARS8        (MAX_INPUT_CHARS32*4)
21 //#define DEFAULT_OUTPUT        "BochsGA"
22 #define DEFAULT_OUTPUT  "Vesa"
23 #define DEFAULT_INPUT   "PS2Keyboard"
24 #define DEFAULT_WIDTH   640
25 #define DEFAULT_HEIGHT  480
26 #define DEFAULT_SCROLLBACK      2       // 2 Screens of text + current screen
27 #define DEFAULT_COLOUR  (VT_COL_BLACK|(0xAAA<<16))
28
29 #define VT_FLAG_HIDECSR 0x01
30 #define VT_FLAG_HASFB   0x10    //!< Set if the VTerm has requested the Framebuffer
31
32 enum eVT_InModes {
33         VT_INMODE_TEXT8,        // UTF-8 Text Mode (VT100 Emulation)
34         VT_INMODE_TEXT32,       // UTF-32 Text Mode (Acess Native)
35         NUM_VT_INMODES
36 };
37
38 // === TYPES ===
39 typedef struct {
40          int    Mode;   //!< Current Mode (see ::eTplTerminal_Modes)
41          int    Flags;  //!< Flags (see VT_FLAG_*)
42          
43         
44         short   NewWidth;       //!< Un-applied dimensions (Width)
45         short   NewHeight;      //!< Un-applied dimensions (Height)
46         short   Width;  //!< Virtual Width
47         short   Height; //!< Virtual Height
48         short   TextWidth;      //!< Text Virtual Width
49         short   TextHeight;     //!< Text Virtual Height
50         
51          int    ViewPos;        //!< View Buffer Offset (Text Only)
52          int    WritePos;       //!< Write Buffer Offset (Text Only)
53         Uint32  CurColour;      //!< Current Text Colour
54         
55          int    InputRead;      //!< Input buffer read position
56          int    InputWrite;     //!< Input buffer write position
57         char    InputBuffer[MAX_INPUT_CHARS8];
58         
59         tVT_Char        *Text;
60         Uint32          *Buffer;
61         
62         char    Name[2];        //!< Name of the terminal
63         tVFS_Node       Node;
64 } tVTerm;
65
66 // === IMPORTS ===
67 extern void     Debug_SetKTerminal(char *File);
68
69 // === PROTOTYPES ===
70  int    VT_Install(char **Arguments);
71 void    VT_InitOutput(void);
72 void    VT_InitInput(void);
73 char    *VT_ReadDir(tVFS_Node *Node, int Pos);
74 tVFS_Node       *VT_FindDir(tVFS_Node *Node, char *Name);
75  int    VT_Root_IOCtl(tVFS_Node *Node, int Id, void *Data);
76 Uint64  VT_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer);
77 Uint64  VT_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer);
78  int    VT_Terminal_IOCtl(tVFS_Node *Node, int Id, void *Data);
79 void    VT_SetResolution(int Width, int Height);
80 void    VT_SetMode(int Mode);
81 void    VT_SetTerminal(int ID);
82 void    VT_KBCallBack(Uint32 Codepoint);
83 void    VT_int_PutString(tVTerm *Term, Uint8 *Buffer, Uint Count);
84  int    VT_int_ParseEscape(tVTerm *Term, char *Buffer);
85 void    VT_int_PutChar(tVTerm *Term, Uint32 Ch);
86 void    VT_int_ScrollFramebuffer( tVTerm *Term );
87 void    VT_int_UpdateScreen( tVTerm *Term, int UpdateAll );
88 void    VT_int_ChangeMode(tVTerm *Term, int NewMode, int NewWidth, int NewHeight);
89
90 // === CONSTANTS ===
91 const Uint16    caVT100Colours[] = {
92                 // Black, Red, Green, Yellow, Blue, Purple, Cyan, Gray
93                 // Same again, but bright
94                 VT_COL_BLACK, 0x700, 0x070, 0x770, 0x007, 0x707, 0x077, 0xAAA,
95                 VT_COL_GREY, 0xF00, 0x0F0, 0xFF0, 0x00F, 0xF0F, 0x0FF, VT_COL_WHITE
96         };
97
98 // === GLOBALS ===
99 MODULE_DEFINE(0, VERSION, VTerm, VT_Install, NULL, DEFAULT_OUTPUT, DEFAULT_INPUT, NULL);
100 tDevFS_Driver   gVT_DrvInfo = {
101         NULL, "VTerm",
102         {
103         .Flags = VFS_FFLAG_DIRECTORY,
104         .Size = NUM_VTS,
105         .Inode = -1,
106         .NumACLs = 0,
107         .ReadDir = VT_ReadDir,
108         .FindDir = VT_FindDir,
109         .IOCtl = VT_Root_IOCtl
110         }
111 };
112 // --- Terminals ---
113 tVTerm  gVT_Terminals[NUM_VTS];
114  int    giVT_CurrentTerminal = 0;
115 tVTerm  *gpVT_CurTerm = &gVT_Terminals[0];
116 // --- Video State ---
117 short   giVT_RealWidth  = DEFAULT_WIDTH;        //!< Screen Width
118 short   giVT_RealHeight = DEFAULT_HEIGHT;       //!< Screen Height
119  int    giVT_Scrollback = DEFAULT_SCROLLBACK;
120 // --- Driver Handles ---
121 char    *gsVT_OutputDevice = NULL;
122 char    *gsVT_InputDevice = NULL;
123  int    giVT_OutputDevHandle = -2;
124  int    giVT_InputDevHandle = -2;
125 // --- Key States --- (Used for VT Switching/Magic Combos)
126  int    gbVT_CtrlDown = 0;
127  int    gbVT_AltDown = 0;
128  int    gbVT_SysrqDown = 0;
129
130 // === CODE ===
131 /**
132  * \fn int VT_Install(char **Arguments)
133  * \brief Installs the Virtual Terminal Driver
134  */
135 int VT_Install(char **Arguments)
136 {
137          int    i;
138         
139         // Scan Arguments
140         if(Arguments)
141         {
142                 char    **args = Arguments;
143                 char    *arg, *opt, *val;
144                 for( ; (arg = *args); args++ )
145                 {
146                         Log_Debug("VTerm", "Argument '%s'", arg);
147                         opt = arg;
148                         val = arg + strpos(arg, '=');   *val++ = '\0';
149                         
150                         if( strcmp(opt, "Video") == 0 ) {
151                                 if(gsVT_OutputDevice)   free(gsVT_OutputDevice);
152                                 gsVT_OutputDevice = strdup(val);
153                         }
154                         else if( strcmp(opt, "Input") == 0 ) {
155                                 if(gsVT_InputDevice)    free(gsVT_InputDevice);
156                                 gsVT_InputDevice = strdup(val);
157                         }
158                         else if( strcmp(opt, "Width") == 0 ) {
159                                 giVT_RealWidth = atoi( val );
160                         }
161                         else if( strcmp(opt, "Height") == 0 ) {
162                                 giVT_RealHeight = atoi( val );
163                         }
164                         else if( strcmp(opt, "Scrollback") == 0 ) {
165                                 giVT_Scrollback = atoi( val );
166                         }
167                 }
168         }
169         
170         // Apply Defaults
171         if(!gsVT_OutputDevice)  gsVT_OutputDevice = "/Devices/"DEFAULT_OUTPUT;
172         if(!gsVT_InputDevice)   gsVT_InputDevice = "/Devices/"DEFAULT_INPUT;
173         
174         Log_Log("VTerm", "Using '%s' as output", gsVT_OutputDevice);
175         Log_Log("VTerm", "Using '%s' as input", gsVT_InputDevice);
176         
177         // Create Nodes
178         for( i = 0; i < NUM_VTS; i++ )
179         {
180                 gVT_Terminals[i].Mode = TERM_MODE_TEXT;
181                 gVT_Terminals[i].Flags = 0;
182                 gVT_Terminals[i].CurColour = DEFAULT_COLOUR;
183                 gVT_Terminals[i].WritePos = 0;
184                 gVT_Terminals[i].ViewPos = 0;
185                 
186                 // Initialise
187                 VT_int_ChangeMode( &gVT_Terminals[i],
188                         TERM_MODE_TEXT, giVT_RealWidth, giVT_RealHeight );
189                 
190                 gVT_Terminals[i].Name[0] = '0'+i;
191                 gVT_Terminals[i].Name[1] = '\0';
192                 gVT_Terminals[i].Node.Inode = i;
193                 gVT_Terminals[i].Node.ImplPtr = &gVT_Terminals[i];
194                 gVT_Terminals[i].Node.NumACLs = 0;      // Only root can open virtual terminals
195                 
196                 gVT_Terminals[i].Node.Read = VT_Read;
197                 gVT_Terminals[i].Node.Write = VT_Write;
198                 gVT_Terminals[i].Node.IOCtl = VT_Terminal_IOCtl;
199         }
200         
201         // Add to DevFS
202         DevFS_AddDevice( &gVT_DrvInfo );
203         
204         VT_InitOutput();
205         VT_InitInput();
206         
207         // Set kernel output to VT0
208         Debug_SetKTerminal("/Devices/VTerm/0");
209         
210         Log_Log("VTerm", "Returning %i", MODULE_ERR_OK);
211         return MODULE_ERR_OK;
212 }
213
214 /**
215  * \fn void VT_InitOutput()
216  * \brief Initialise Video Output
217  */
218 void VT_InitOutput()
219 {
220         giVT_OutputDevHandle = VFS_Open(gsVT_OutputDevice, VFS_OPENFLAG_WRITE);
221         if(giVT_InputDevHandle == -1) {
222                 Log_Warning("VTerm", "Oh F**k, I can't open the video device '%s'", gsVT_OutputDevice);
223                 return ;
224         }
225         VT_SetResolution( giVT_RealWidth, giVT_RealHeight );
226         VT_SetTerminal( 0 );
227         VT_SetMode( VIDEO_BUFFMT_TEXT );
228 }
229
230 /**
231  * \fn void VT_InitInput()
232  * \brief Initialises the input
233  */
234 void VT_InitInput()
235 {
236         giVT_InputDevHandle = VFS_Open(gsVT_InputDevice, VFS_OPENFLAG_READ);
237         if(giVT_InputDevHandle == -1)   return ;
238         VFS_IOCtl(giVT_InputDevHandle, KB_IOCTL_SETCALLBACK, VT_KBCallBack);
239 }
240
241 /**
242  * \brief Set the video resolution
243  * \param Width New screen width
244  * \param Height        New screen height
245  */
246 void VT_SetResolution(int Width, int Height)
247 {
248         tVideo_IOCtl_Mode       mode = {0};
249          int    tmp;
250          int    i;
251         
252         // Create the video mode
253         mode.width = Width;
254         mode.height = Height;
255         mode.bpp = 32;
256         mode.flags = 0;
257         
258         // Set video mode
259         VFS_IOCtl( giVT_OutputDevHandle, VIDEO_IOCTL_FINDMODE, &mode );
260         tmp = mode.id;
261         if( Width != mode.width || Height != mode.height )
262         {
263                 Log_Warning("VTerm",
264                         "Selected resolution (%ix%i is not supported) by the device, using (%ix%i)",
265                         giVT_RealWidth, giVT_RealHeight,
266                         mode.width, mode.height
267                         );
268         }
269         VFS_IOCtl( giVT_OutputDevHandle, VIDEO_IOCTL_GETSETMODE, &tmp );
270         
271         // Resize text terminals if needed
272         if( giVT_RealWidth != mode.width || giVT_RealHeight != mode.height )
273         {
274                  int    newBufSize = (giVT_RealWidth/giVT_CharWidth)
275                                         *(giVT_RealHeight/giVT_CharHeight)
276                                         *(giVT_Scrollback+1);
277                 //tVT_Char      *tmp;
278                 // Resize the text terminals
279                 giVT_RealWidth = mode.width;
280                 giVT_RealHeight = mode.height;
281                 for( i = 0; i < NUM_VTS; i ++ )
282                 {
283                         if( gVT_Terminals[i].Mode != TERM_MODE_TEXT )   continue;
284                         
285                         gVT_Terminals[i].Text = realloc(
286                                 gVT_Terminals[i].Text,
287                                 newBufSize*sizeof(tVT_Char)
288                                 );
289                 }
290         }
291 }
292
293 /**
294  * \brief Set video output buffer mode
295  */
296 void VT_SetMode(int Mode)
297 {
298         VFS_IOCtl( giVT_OutputDevHandle, VIDEO_IOCTL_SETBUFFORMAT, &Mode );
299 }
300
301 /**
302  * \fn char *VT_ReadDir(tVFS_Node *Node, int Pos)
303  * \brief Read from the VTerm Directory
304  */
305 char *VT_ReadDir(tVFS_Node *Node, int Pos)
306 {
307         if(Pos < 0)     return NULL;
308         if(Pos >= NUM_VTS)      return NULL;
309         return strdup( gVT_Terminals[Pos].Name );
310 }
311
312 /**
313  * \fn tVFS_Node *VT_FindDir(tVFS_Node *Node, char *Name)
314  * \brief Find an item in the VTerm directory
315  * \param Node  Root node
316  * \param Name  Name (number) of the terminal
317  */
318 tVFS_Node *VT_FindDir(tVFS_Node *Node, char *Name)
319 {
320          int    num;
321         
322         ENTER("pNode sName", Node, Name);
323         
324         // Open the input and output files if needed
325         if(giVT_OutputDevHandle == -2)  VT_InitOutput();
326         if(giVT_InputDevHandle == -2)   VT_InitInput();
327         
328         // Sanity check name
329         if(Name[0] < '0' || Name[0] > '9' || Name[1] != '\0') {
330                 LEAVE('n');
331                 return NULL;
332         }
333         // Get index
334         num = Name[0] - '0';
335         if(num >= NUM_VTS) {
336                 LEAVE('n');
337                 return NULL;
338         }
339         // Return node
340         LEAVE('p', &gVT_Terminals[num].Node);
341         return &gVT_Terminals[num].Node;
342 }
343
344 /**
345  * \fn int VT_Root_IOCtl(tVFS_Node *Node, int Id, void *Data)
346  * \brief Control the VTerm Driver
347  */
348 int VT_Root_IOCtl(tVFS_Node *Node, int Id, void *Data)
349 {
350          int    len;
351         switch(Id)
352         {
353         case DRV_IOCTL_TYPE:    return DRV_TYPE_MISC;
354         case DRV_IOCTL_IDENT:   memcpy(Data, "VT\0\0", 4);      return 0;
355         case DRV_IOCTL_VERSION: return VERSION;
356         case DRV_IOCTL_LOOKUP:  return 0;
357         
358         case 4: // Get Video Driver
359                 if(Data)        strcpy(Data, gsVT_OutputDevice);
360                 return strlen(gsVT_OutputDevice);
361         
362         case 5: // Set Video Driver
363                 if(!Data)       return -EINVAL;
364                 if(Threads_GetUID() != 0)       return -EACCES;
365                 
366                 len = strlen(Data);
367                 
368                 free(gsVT_OutputDevice);
369                 
370                 gsVT_OutputDevice = malloc(len+1);
371                 strcpy(gsVT_OutputDevice, Data);
372                 
373                 VFS_Close(giVT_OutputDevHandle);
374                 giVT_OutputDevHandle = -1;
375                 
376                 VT_InitOutput();
377                 return 1;
378         }
379         return 0;
380 }
381
382 /**
383  * \fn Uint64 VT_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
384  * \brief Read from a virtual terminal
385  */
386 Uint64 VT_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
387 {
388          int    pos = 0;
389         tVTerm  *term = &gVT_Terminals[ Node->Inode ];
390         
391         // Check current mode
392         switch(term->Mode)
393         {
394         // Text Mode (UTF-8)
395         case TERM_MODE_TEXT:
396                 while(pos < Length)
397                 {
398                         while(term->InputRead == term->InputWrite)      Threads_Yield();
399                         
400                         ((char*)Buffer)[pos] = term->InputBuffer[term->InputRead];
401                         pos ++;
402                         term->InputRead ++;
403                         term->InputRead %= MAX_INPUT_CHARS8;
404                 }
405                 break;
406         
407         //case TERM_MODE_FB:
408         // Other - UCS-4
409         default:
410                 while(pos < Length)
411                 {
412                         while(term->InputRead == term->InputWrite)      Threads_Yield();
413                         ((Uint32*)Buffer)[pos] = ((Uint32*)term->InputBuffer)[term->InputRead];
414                         pos ++;
415                         term->InputRead ++;
416                         term->InputRead %= MAX_INPUT_CHARS32;
417                 }
418                 break;
419         }
420         return 0;
421 }
422
423 /**
424  * \fn Uint64 VT_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
425  * \brief Write to a virtual terminal
426  */
427 Uint64 VT_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
428 {
429         tVTerm  *term = &gVT_Terminals[ Node->Inode ];
430          int    size;
431         
432         // Write
433         switch( term->Mode )
434         {
435         // Print Text
436         case TERM_MODE_TEXT:
437                 VT_int_PutString(term, Buffer, Length);
438                 break;
439         // Framebuffer :)
440         case TERM_MODE_FB:
441         
442                 // - Sanity Checking
443                 size = term->Width*term->Height*4;
444                 if( Offset > size ) {
445                         Log_Notice("VTerm", "VT_Write: Offset (0x%llx) > FBSize (0x%x)",
446                                 Offset, size);
447                         return 0;
448                 }
449                 if( Offset + Length > size ) {
450                         Log_Notice("VTerm", "VT_Write: Offset+Length (0x%llx) > FBSize (0x%x)",
451                                 Offset+Length, size);
452                         Length = size - Offset;
453                 }
454                 
455                 // Copy to the local cache
456                 memcpy( (void*)((Uint)term->Buffer + (Uint)Offset), Buffer, Length );
457                 
458                 // Update screen if needed
459                 if( Node->Inode == giVT_CurrentTerminal )
460                 {
461                         // Fill entire screen?
462                         if( giVT_RealWidth > term->Width || giVT_RealHeight > term->Height )
463                         {
464                                 // No? :( Well, just center it
465                                  int    x, y, w, h;
466                                 x = Offset/4;   y = x / term->Width;    x %= term->Width;
467                                 w = Length/4+x; h = w / term->Width;    w %= term->Width;
468                                 // Center
469                                 x += (giVT_RealWidth - term->Width) / 2;
470                                 y += (giVT_RealHeight - term->Height) / 2;
471                                 while(h--)
472                                 {
473                                         VFS_WriteAt( giVT_OutputDevHandle,
474                                                 (x + y * giVT_RealWidth)*4,
475                                                 term->Width * 4,
476                                                 Buffer
477                                                 );
478                                         Buffer = (void*)( (Uint)Buffer + term->Width*4 );
479                                         y ++;
480                                 }
481                                 return 0;
482                         }
483                         else {
484                                 return VFS_WriteAt( giVT_OutputDevHandle, Offset, Length, Buffer );
485                         }
486                 }
487         // Just pass on (for now)
488         // TODO: Handle locally too to ensure no information is lost on
489         //       VT Switch (and to isolate terminals from each other)
490         case TERM_MODE_2DACCEL:
491         //case TERM_MODE_3DACCEL:
492                 if( Node->Inode == giVT_CurrentTerminal )
493                 {
494                         VFS_Write( giVT_OutputDevHandle, Length, Buffer );
495                 }
496                 break;
497         }
498         
499         return 0;
500 }
501
502 /**
503  * \fn int VT_Terminal_IOCtl(tVFS_Node *Node, int Id, void *Data)
504  * \brief Call an IO Control on a virtual terminal
505  */
506 int VT_Terminal_IOCtl(tVFS_Node *Node, int Id, void *Data)
507 {
508          int    *iData = Data;
509          int    ret;
510         tVTerm  *term = Node->ImplPtr;
511         ENTER("pNode iId pData", Node, Id, Data);
512         
513         if(Id >= DRV_IOCTL_LOOKUP) {
514                 // Only root can fiddle with graphics modes
515                 // TODO: Remove this and replace with user ownership
516                 if( Threads_GetUID() != 0 )     return -1;
517         }
518         
519         switch(Id)
520         {
521         // --- Core Defined
522         case DRV_IOCTL_TYPE:
523                 LEAVE('i', DRV_TYPE_TERMINAL);
524                 return DRV_TYPE_TERMINAL;
525         case DRV_IOCTL_IDENT:
526                 memcpy(Data, "VT\0\0", 4);
527                 LEAVE('i', 0);
528                 return 0;
529         case DRV_IOCTL_VERSION:
530                 LEAVE('x', VERSION);
531                 return VERSION;
532         case DRV_IOCTL_LOOKUP:
533                 LEAVE('i', 0);
534                 return 0;
535         
536         // Get/Set the mode (and apply any changes)
537         case TERM_IOCTL_MODETYPE:
538                 if(Data != NULL)
539                 {
540                         if( CheckMem(Data, sizeof(int)) == 0 ) {
541                                 LEAVE('i', -1);
542                                 return -1;
543                         }
544                         Log_Log("VTerm", "VTerm %i mode set to %i", (int)Node->Inode, *iData);
545                         
546                         // Update mode if needed
547                         if( term->Mode != *iData
548                          || term->NewWidth
549                          || term->NewHeight)
550                         {
551                                 // Adjust for text mode
552                                 if( *iData == TERM_MODE_TEXT ) {
553                                         term->NewHeight *= giVT_CharHeight;
554                                         term->NewWidth *= giVT_CharWidth;
555                                 }
556                                 // Fill unchanged dimensions
557                                 if(term->NewHeight == 0)        term->NewHeight = term->Height;
558                                 if(term->NewWidth == 0) term->NewWidth = term->Width;
559                                 // Set new mode
560                                 VT_int_ChangeMode(term, *iData, term->NewWidth, term->NewHeight);
561                                 // Clear unapplied dimensions
562                                 term->NewWidth = 0;
563                                 term->NewHeight = 0;
564                         }
565                         
566                         // Update the screen dimensions
567                         if(Node->Inode == giVT_CurrentTerminal)
568                                 VT_SetTerminal( giVT_CurrentTerminal );
569                 }
570                 LEAVE('i', term->Mode);
571                 return term->Mode;
572         
573         // Get/set the terminal width
574         case TERM_IOCTL_WIDTH:
575                 if(Data != NULL) {
576                         if( CheckMem(Data, sizeof(int)) == 0 ) {
577                                 LEAVE('i', -1);
578                                 return -1;
579                         }
580                         term->NewWidth = *iData;
581                 }
582                 if( term->NewWidth )
583                         ret = term->NewWidth;
584                 else if( term->Mode == TERM_MODE_TEXT )
585                         ret = term->TextWidth;
586                 else
587                         ret = term->Width;
588                 LEAVE('i', ret);
589                 return ret;
590         
591         // Get/set the terminal height
592         case TERM_IOCTL_HEIGHT:
593                 if(Data != NULL) {
594                         if( CheckMem(Data, sizeof(int)) == 0 ) {
595                                 LEAVE('i', -1);
596                                 return -1;
597                         }
598                         term->NewHeight = *iData;
599                 }
600                 if( term->NewHeight )
601                         ret = term->NewHeight;
602                 else if( term->Mode == TERM_MODE_TEXT )
603                         ret = term->TextHeight = *iData;
604                 else
605                         ret = term->Height;
606                 LEAVE('i', ret);
607                 return ret;
608         
609         case TERM_IOCTL_FORCESHOW:
610                 Log_Log("VTerm", "Thread %i forced VTerm %i to be shown",
611                         Threads_GetTID(), (int)Node->Inode);
612                 VT_SetTerminal( Node->Inode );
613                 LEAVE('i', 1);
614                 return 1;
615         }
616         LEAVE('i', -1);
617         return -1;
618 }
619
620 /**
621  * \fn void VT_SetTerminal(int ID)
622  * \brief Set the current terminal
623  */
624 void VT_SetTerminal(int ID)
625 {       
626         // Update current terminal ID
627         Log_Log("VTerm", "Changed terminal from %i to %i", giVT_CurrentTerminal, ID);
628         giVT_CurrentTerminal = ID;
629         gpVT_CurTerm = &gVT_Terminals[ID];
630         
631         // Update cursor
632         if( gpVT_CurTerm->Mode == TERM_MODE_TEXT && !(gpVT_CurTerm->Flags & VT_FLAG_HIDECSR) )
633         {
634                 tVideo_IOCtl_Pos        pos;
635                 pos.x = (gpVT_CurTerm->WritePos - gpVT_CurTerm->ViewPos) % gpVT_CurTerm->TextWidth;
636                 pos.y = (gpVT_CurTerm->WritePos - gpVT_CurTerm->ViewPos) / gpVT_CurTerm->TextWidth;
637                 VFS_IOCtl(giVT_OutputDevHandle, VIDEO_IOCTL_SETCURSOR, &pos);
638         }
639         
640         if( gpVT_CurTerm->Mode == TERM_MODE_TEXT )
641                 VT_SetMode( VIDEO_BUFFMT_TEXT );
642         else
643                 VT_SetMode( VIDEO_BUFFMT_FRAMEBUFFER );
644         
645         // Update the screen
646         VT_int_UpdateScreen( &gVT_Terminals[ ID ], 1 );
647 }
648
649 /**
650  * \fn void VT_KBCallBack(Uint32 Codepoint)
651  * \brief Called on keyboard interrupt
652  * \param Codepoint     Pseudo-UTF32 character
653  * 
654  * Handles a key press and sends the key code to the user's buffer.
655  * If the code creates a kernel-magic sequence, it is not passed to the
656  * user and is handled in-kernel.
657  */
658 void VT_KBCallBack(Uint32 Codepoint)
659 {
660         tVTerm  *term = gpVT_CurTerm;
661         
662         // How the hell did we get a codepoint of zero?
663         if(Codepoint == 0)      return;
664         
665         // Key Up
666         if( Codepoint & 0x80000000 )
667         {
668                 Codepoint &= 0x7FFFFFFF;
669                 switch(Codepoint)
670                 {
671                 #if !USE_CTRL_ALT
672                 case KEY_RSHIFT:        gbVT_CtrlDown = 0;      break;
673                 case KEY_LSHIFT:        gbVT_AltDown = 0;       break;
674                 #else
675                 case KEY_LALT:  gbVT_AltDown &= ~1;     break;
676                 case KEY_RALT:  gbVT_AltDown &= ~2;     break;
677                 case KEY_LCTRL: gbVT_CtrlDown &= ~1     break;
678                 case KEY_RCTRL: gbVT_CtrlDown &= ~2;    break;
679                 #endif
680                 }
681                 return;
682         }
683         
684         switch(Codepoint)
685         {
686         #if !USE_CTRL_ALT       // HACK: Use both shifts instead of Ctrl-Alt
687         case KEY_RSHIFT:        gbVT_CtrlDown = 1;      break;
688         case KEY_LSHIFT:        gbVT_AltDown = 1;       break;
689         #else
690         case KEY_LALT:  gbVT_AltDown |= 1;      break;
691         case KEY_RALT:  gbVT_AltDown |= 2;      break;
692         case KEY_LCTRL: gbVT_CtrlDown |= 1;     break;
693         case KEY_RCTRL: gbVT_CtrlDown |= 2;     break;
694         #endif
695         
696         default:
697                 if(!gbVT_AltDown || !gbVT_CtrlDown)
698                         break;
699                 switch(Codepoint)
700                 {
701                 case KEY_F1:    VT_SetTerminal(0);      return;
702                 case KEY_F2:    VT_SetTerminal(1);      return;
703                 case KEY_F3:    VT_SetTerminal(2);      return;
704                 case KEY_F4:    VT_SetTerminal(3);      return;
705                 case KEY_F5:    VT_SetTerminal(4);      return;
706                 case KEY_F6:    VT_SetTerminal(5);      return;
707                 case KEY_F7:    VT_SetTerminal(6);      return;
708                 case KEY_F8:    VT_SetTerminal(7);      return;
709                 case KEY_F9:    VT_SetTerminal(8);      return;
710                 case KEY_F10:   VT_SetTerminal(9);      return;
711                 case KEY_F11:   VT_SetTerminal(10);     return;
712                 case KEY_F12:   VT_SetTerminal(11);     return;
713                 // Scrolling
714                 case KEY_PGUP:
715                         if( gpVT_CurTerm->ViewPos > gpVT_CurTerm->Width )
716                                 gpVT_CurTerm->ViewPos -= gpVT_CurTerm->Width;
717                         else
718                                 gpVT_CurTerm->ViewPos = 0;
719                         return;
720                 case KEY_PGDOWN:
721                         if( gpVT_CurTerm->ViewPos < gpVT_CurTerm->Width*gpVT_CurTerm->Height*(giVT_Scrollback-1) )
722                                 gpVT_CurTerm->ViewPos += gpVT_CurTerm->Width;
723                         else
724                                 gpVT_CurTerm->ViewPos = gpVT_CurTerm->Width*gpVT_CurTerm->Height*(giVT_Scrollback-1);
725                         return;
726                 }
727         }
728         
729         // Encode key
730         if(term->Mode == TERM_MODE_TEXT)
731         {
732                 Uint8   buf[6] = {0};
733                  int    len = 0;
734                 
735                 // Ignore Modifer Keys
736                 if(Codepoint > KEY_MODIFIERS)   return;
737                 
738                 // Get UTF-8/ANSI Encoding
739                 switch(Codepoint)
740                 {
741                 case KEY_LEFT:
742                         buf[0] = '\x1B';        buf[1] = '[';   buf[2] = 'D';
743                         len = 3;
744                         break;
745                 case KEY_RIGHT:
746                         buf[0] = '\x1B';        buf[1] = '[';   buf[2] = 'C';
747                         len = 3;
748                         break;
749                 case KEY_UP:
750                         buf[0] = '\x1B';        buf[1] = '[';   buf[2] = 'A';
751                         len = 3;
752                         break;
753                 case KEY_DOWN:
754                         buf[0] = '\x1B';        buf[1] = '[';   buf[2] = 'B';
755                         len = 3;
756                         break;
757                 
758                 case KEY_PGUP:
759                         buf[0] = '\x1B';        buf[1] = '[';   buf[2] = '5';   // Some overline also
760                         //len = 4;      // Commented out until I'm sure
761                         break;
762                 case KEY_PGDOWN:
763                         len = 0;
764                         break;
765                 
766                 // Attempt to encode in UTF-8
767                 default:
768                         len = WriteUTF8( buf, Codepoint );
769                         if(len == 0) {
770                                 Warning("Codepoint (%x) is unrepresentable in UTF-8", Codepoint);
771                         }
772                         break;
773                 }
774                 
775                 if(len == 0) {
776                         // Unprintable / Don't Pass
777                         return;
778                 }
779                 
780                 // Write
781                 if( MAX_INPUT_CHARS8 - term->InputWrite >= len )
782                         memcpy( &term->InputBuffer[term->InputWrite], buf, len );
783                 else {
784                         memcpy( &term->InputBuffer[term->InputWrite], buf, MAX_INPUT_CHARS8 - term->InputWrite );
785                         memcpy( &term->InputBuffer[0], buf, len - (MAX_INPUT_CHARS8 - term->InputWrite) );
786                 }
787                 // Roll the buffer over
788                 term->InputWrite += len;
789                 term->InputWrite %= MAX_INPUT_CHARS8;
790                 if( (term->InputWrite - term->InputRead + MAX_INPUT_CHARS8)%MAX_INPUT_CHARS8 < len ) {
791                         term->InputRead = term->InputWrite + 1;
792                         term->InputRead %= MAX_INPUT_CHARS8;
793                 }
794                 
795         }
796         else
797         {
798                 // Encode the raw UTF-32 Key
799                 ((Uint32*)term->InputBuffer)[ term->InputWrite ] = Codepoint;
800                 term->InputWrite ++;
801                 term->InputWrite %= MAX_INPUT_CHARS32;
802                 if(term->InputRead == term->InputWrite) {
803                         term->InputRead ++;
804                         term->InputRead %= MAX_INPUT_CHARS32;
805                 }
806         }
807 }
808
809 /**
810  * \fn void VT_int_ClearLine(tVTerm *Term, int Num)
811  * \brief Clears a line in a virtual terminal
812  */
813 void VT_int_ClearLine(tVTerm *Term, int Num)
814 {
815          int    i;
816         tVT_Char        *cell = &Term->Text[ Num*Term->TextWidth ];
817         if( Num < 0 || Num >= Term->TextHeight )        return ;
818         //ENTER("pTerm iNum", Term, Num);
819         for( i = Term->TextWidth; i--; )
820         {
821                 cell[ i ].Ch = 0;
822                 cell[ i ].Colour = Term->CurColour;
823         }
824         //LEAVE('-');
825 }
826
827 /**
828  * \fn int VT_int_ParseEscape(tVTerm *Term, char *Buffer)
829  * \brief Parses a VT100 Escape code
830  */
831 int VT_int_ParseEscape(tVTerm *Term, char *Buffer)
832 {
833         char    c;
834          int    argc = 0, j = 1;
835          int    tmp;
836          int    args[6] = {0,0,0,0};
837         
838         switch(Buffer[0])
839         {
840         //Large Code
841         case '[':
842                 // Get Arguments
843                 c = Buffer[j++];
844                 if( '0' <= c && c <= '9' )
845                 {
846                         do {
847                                 if(c == ';')    c = Buffer[j++];
848                                 while('0' <= c && c <= '9') {
849                                         args[argc] *= 10;
850                                         args[argc] += c-'0';
851                                         c = Buffer[j++];
852                                 }
853                                 argc ++;
854                         } while(c == ';');
855                 }
856                 
857                 /*
858                 // Get string (what does this do?)
859                 if(c == '"') {
860                         c = Buffer[j++];
861                         while(c != '"')
862                                 c = Buffer[j++];
863                 }
864                 */
865                 
866                 //Log_Debug("VTerm", "argc = %i", argc);
867                 
868                 // Get Command
869                 if(     ('a' <= c && c <= 'z') || ('A' <= c && c <= 'Z'))
870                 {
871                         switch(c)
872                         {
873                         // Left
874                         case 'D':
875                                 if(argc == 1)   tmp = args[0];
876                                 else    tmp = 1;
877                                 
878                                 if( Term->WritePos-(tmp-1) % Term->TextWidth == 0 )
879                                         Term->WritePos -= Term->WritePos % Term->TextWidth;
880                                 else
881                                         Term->WritePos -= tmp;
882                                 break;
883                         
884                         // Right
885                         case 'C':
886                                 if(argc == 1)   tmp = args[0];
887                                 else    tmp = 1;
888                                 if( (Term->WritePos + tmp) % Term->TextWidth == 0 ) {
889                                         Term->WritePos -= Term->WritePos % Term->TextWidth;
890                                         Term->WritePos += Term->TextWidth - 1;
891                                 } else
892                                         Term->WritePos += tmp;
893                                 break;
894                         
895                         // Clear By Line
896                         case 'J':
897                                 // Clear Screen
898                                 switch(args[0])
899                                 {
900                                 case 2:
901                                         {
902                                          int    i = Term->TextHeight * (giVT_Scrollback + 1);
903                                         while( i-- )    VT_int_ClearLine(Term, i);
904                                         Term->WritePos = 0;
905                                         Term->ViewPos = 0;
906                                         VT_int_UpdateScreen(Term, 1);
907                                         }
908                                         break;
909                                 }
910                                 break;
911                         // Set cursor position
912                         case 'h':
913                                 Term->WritePos = args[0] + args[1]*Term->TextWidth;
914                                 Log_Debug("VTerm", "args = {%i, %i}", args[0], args[1]);
915                                 break;
916                         // Set Font flags
917                         case 'm':
918                                 for( ; argc--; )
919                                 {
920                                         // Flags
921                                         if( 0 <= args[argc] && args[argc] <= 8)
922                                         {
923                                                 switch(args[argc])
924                                                 {
925                                                 case 0: Term->CurColour = DEFAULT_COLOUR;       break;  // Reset
926                                                 case 1: Term->CurColour |= 0x80000000;  break;  // Bright
927                                                 case 2: Term->CurColour &= ~0x80000000; break;  // Dim
928                                                 }
929                                         }
930                                         // Foreground Colour
931                                         else if(30 <= args[argc] && args[argc] <= 37) {
932                                                 Term->CurColour &= 0xF000FFFF;
933                                                 Term->CurColour |= (Uint32)caVT100Colours[ args[argc]-30+(Term->CurColour>>28) ] << 16;
934                                         }
935                                         // Background Colour
936                                         else if(40 <= args[argc] && args[argc] <= 47) {
937                                                 Term->CurColour &= 0xFFFF8000;
938                                                 Term->CurColour |= caVT100Colours[ args[argc]-40+((Term->CurColour>>12)&15) ];
939                                         }
940                                 }
941                                 break;
942                         default:
943                                 Log_Warning("VTerm", "Unknown control sequence");
944                                 break;
945                         }
946                 }
947                 break;
948                 
949         default:        break;
950         }
951         
952         //Log_Debug("VTerm", "j = %i, Buffer = '%s'", j, Buffer);
953         return j;
954 }
955
956 /**
957  * \fn void VT_int_PutString(tVTerm *Term, Uint8 *Buffer, Uint Count)
958  * \brief Print a string to the Virtual Terminal
959  */
960 void VT_int_PutString(tVTerm *Term, Uint8 *Buffer, Uint Count)
961 {
962         Uint32  val;
963          int    i;
964         
965         // Iterate
966         for( i = 0; i < Count; i++ )
967         {
968                 // Handle escape sequences
969                 if( Buffer[i] == 0x1B )
970                 {
971                         i ++;
972                         i += VT_int_ParseEscape(Term, (char*)&Buffer[i]) - 1;
973                         continue;
974                 }
975                 
976                 // Fast check for non UTF-8
977                 if( Buffer[i] < 128 )   // Plain ASCII
978                         VT_int_PutChar(Term, Buffer[i]);
979                 else {  // UTF-8
980                         i += ReadUTF8(&Buffer[i], &val) - 1;
981                         VT_int_PutChar(Term, val);
982                 }
983         }
984         // Update Screen
985         VT_int_UpdateScreen( Term, 0 );
986         
987         // Update cursor
988         if( Term == gpVT_CurTerm && !(Term->Flags & VT_FLAG_HIDECSR) )
989         {
990                 tVideo_IOCtl_Pos        pos;
991                 pos.x = (Term->WritePos - Term->ViewPos) % Term->TextWidth;
992                 pos.y = (Term->WritePos - Term->ViewPos) / Term->TextWidth;
993                 VFS_IOCtl(giVT_OutputDevHandle, VIDEO_IOCTL_SETCURSOR, &pos);
994         }
995 }
996
997 /**
998  * \fn void VT_int_PutChar(tVTerm *Term, Uint32 Ch)
999  * \brief Write a single character to a VTerm
1000  */
1001 void VT_int_PutChar(tVTerm *Term, Uint32 Ch)
1002 {
1003          int    i;
1004                 
1005         switch(Ch)
1006         {
1007         case '\0':      return; // Ignore NULL byte
1008         case '\n':
1009                 VT_int_UpdateScreen( Term, 0 ); // Update the line before newlining
1010                 Term->WritePos += Term->TextWidth;
1011         case '\r':
1012                 Term->WritePos -= Term->WritePos % Term->TextWidth;
1013                 break;
1014         
1015         case '\t':
1016                 do {
1017                         Term->Text[ Term->WritePos ].Ch = '\0';
1018                         Term->Text[ Term->WritePos ].Colour = Term->CurColour;
1019                         Term->WritePos ++;
1020                 } while(Term->WritePos & 7);
1021                 break;
1022         
1023         case '\b':
1024                 // Backspace is invalid at Offset 0
1025                 if(Term->WritePos == 0) break;
1026                 
1027                 Term->WritePos --;
1028                 // Singe Character
1029                 if(Term->Text[ Term->WritePos ].Ch != '\0') {
1030                         Term->Text[ Term->WritePos ].Ch = 0;
1031                         Term->Text[ Term->WritePos ].Colour = Term->CurColour;
1032                         break;
1033                 }
1034                 // Tab
1035                 i = 7;  // Limit it to 8
1036                 do {
1037                         Term->Text[ Term->WritePos ].Ch = 0;
1038                         Term->Text[ Term->WritePos ].Colour = Term->CurColour;
1039                         Term->WritePos --;
1040                 } while(Term->WritePos && i-- && Term->Text[ Term->WritePos ].Ch == '\0');
1041                 if(Term->Text[ Term->WritePos ].Ch != '\0')
1042                         Term->WritePos ++;
1043                 break;
1044         
1045         default:
1046                 Term->Text[ Term->WritePos ].Ch = Ch;
1047                 Term->Text[ Term->WritePos ].Colour = Term->CurColour;
1048                 Term->WritePos ++;
1049                 break;
1050         }
1051         
1052         // Move Screen
1053         // - Check if we need to scroll the entire scrollback buffer
1054         if(Term->WritePos >= Term->TextWidth*Term->TextHeight*(giVT_Scrollback+1))
1055         {
1056                  int    base, i;
1057                 
1058                 //Debug("Scrolling entire buffer");
1059                 
1060                 // Move back by one
1061                 Term->WritePos -= Term->TextWidth;
1062                 // Update the scren
1063                 VT_int_UpdateScreen( Term, 0 );
1064                 
1065                 // Update view position
1066                 base = Term->TextWidth*Term->TextHeight*(giVT_Scrollback);
1067                 if(Term->ViewPos < base)
1068                         Term->ViewPos += Term->Width;
1069                 if(Term->ViewPos > base)
1070                         Term->ViewPos = base;
1071                 
1072                 // Scroll terminal cache
1073                 base = Term->TextWidth*(Term->TextHeight*(giVT_Scrollback+1)-1);
1074                 memcpy(
1075                         Term->Text,
1076                         &Term->Text[Term->TextWidth],
1077                         base*sizeof(tVT_Char)
1078                         );
1079                 
1080                 // Clear last row
1081                 for( i = 0; i < Term->TextWidth; i ++ )
1082                 {
1083                         Term->Text[ base + i ].Ch = 0;
1084                         Term->Text[ base + i ].Colour = Term->CurColour;
1085                 }
1086                 
1087                 VT_int_ScrollFramebuffer( Term );
1088                 VT_int_UpdateScreen( Term, 0 );
1089         }
1090         // Ok, so we only need to scroll the screen
1091         else if(Term->WritePos >= Term->ViewPos + Term->TextWidth*Term->TextHeight)
1092         {
1093                 //Debug("Term->WritePos (%i) >= %i",
1094                 //      Term->WritePos,
1095                 //      Term->ViewPos + Term->Width*Term->Height
1096                 //      );
1097                 //Debug("Scrolling screen only");
1098                 
1099                 // Update the last line
1100                 Term->WritePos -= Term->TextWidth;
1101                 VT_int_UpdateScreen( Term, 0 );
1102                 Term->WritePos += Term->TextWidth;
1103                 
1104                 // Scroll
1105                 Term->ViewPos += Term->TextWidth;
1106                 //Debug("Term->ViewPos = %i", Term->ViewPos);
1107                 VT_int_ScrollFramebuffer( Term );
1108                 VT_int_UpdateScreen( Term, 0 );
1109         }
1110         
1111         //LEAVE('-');
1112 }
1113
1114 /**
1115  * \fn void VT_int_ScrollFramebuffer( tVTerm *Term )
1116  * \note Scrolls the framebuffer by 1 text line
1117  */
1118 void VT_int_ScrollFramebuffer( tVTerm *Term )
1119 {
1120          int    tmp;
1121         struct {
1122                 Uint8   Op;
1123                 Uint16  DstX, DstY;
1124                 Uint16  SrcX, SrcY;
1125                 Uint16  W, H;
1126         } PACKED        buf;
1127         
1128         // Only update if this is the current terminal
1129         if( Term != gpVT_CurTerm )      return;
1130         
1131         // Switch to 2D Command Stream
1132         tmp = VIDEO_BUFFMT_2DSTREAM;
1133         VFS_IOCtl(giVT_OutputDevHandle, VIDEO_IOCTL_SETBUFFORMAT, &tmp);
1134         
1135         // BLIT from 0,0 to 0,giVT_CharHeight
1136         buf.Op = VIDEO_2DOP_BLIT;
1137         buf.DstX = 0;   buf.DstY = 0;
1138         buf.SrcX = 0;   buf.SrcY = giVT_CharHeight;
1139         buf.W = Term->TextWidth * giVT_CharWidth;
1140         buf.H = (Term->TextHeight-1) * giVT_CharHeight;
1141         VFS_WriteAt(giVT_OutputDevHandle, 0, sizeof(buf), &buf);
1142         
1143         // Restore old mode (this function is only called during text mode)
1144         tmp = VIDEO_BUFFMT_TEXT;
1145         VFS_IOCtl(giVT_OutputDevHandle, VIDEO_IOCTL_SETBUFFORMAT, &tmp);
1146 }
1147
1148 /**
1149  * \fn void VT_int_UpdateScreen( tVTerm *Term, int UpdateAll )
1150  * \brief Updates the video framebuffer
1151  */
1152 void VT_int_UpdateScreen( tVTerm *Term, int UpdateAll )
1153 {
1154         // Only update if this is the current terminal
1155         if( Term != gpVT_CurTerm )      return;
1156         
1157         switch( Term->Mode )
1158         {
1159         case TERM_MODE_TEXT:
1160                 // Re copy the entire screen?
1161                 if(UpdateAll) {
1162                         VFS_WriteAt(
1163                                 giVT_OutputDevHandle,
1164                                 0,
1165                                 Term->TextWidth*Term->TextHeight*sizeof(tVT_Char),
1166                                 &Term->Text[Term->ViewPos]
1167                                 );
1168                 }
1169                 // Only copy the current line
1170                 else {
1171                          int    pos = Term->WritePos - Term->WritePos % Term->TextWidth;
1172                         VFS_WriteAt(
1173                                 giVT_OutputDevHandle,
1174                                 (pos - Term->ViewPos)*sizeof(tVT_Char),
1175                                 Term->TextWidth*sizeof(tVT_Char),
1176                                 &Term->Text[pos]
1177                                 );
1178                 }
1179                 break;
1180         case TERM_MODE_FB:
1181                 VFS_WriteAt(
1182                         giVT_OutputDevHandle,
1183                         0,
1184                         Term->Width*Term->Height*sizeof(Uint32),
1185                         Term->Buffer
1186                         );
1187                 break;
1188         }
1189 }
1190
1191 /**
1192  * \brief Update the screen mode
1193  * \param Term  Terminal to update
1194  * \param NewMode       New mode to set
1195  * \param NewWidth      New framebuffer width
1196  * \param NewHeight     New framebuffer height
1197  */
1198 void VT_int_ChangeMode(tVTerm *Term, int NewMode, int NewWidth, int NewHeight)
1199 {
1200          int    oldW = Term->Width;
1201          int    oldTW = oldW / giVT_CharWidth;
1202          int    oldH = Term->Height;
1203          int    oldTH = oldH / giVT_CharWidth;
1204         tVT_Char        *oldTBuf = Term->Text;
1205         Uint32  *oldFB = Term->Buffer;
1206          int    w, h, i;
1207         
1208         // TODO: Increase RealWidth/RealHeight when this happens
1209         if(NewWidth > giVT_RealWidth)   NewWidth = giVT_RealWidth;
1210         if(NewHeight > giVT_RealHeight) NewHeight = giVT_RealHeight;
1211         
1212         // Calculate new dimensions
1213         Term->TextWidth = NewWidth / giVT_CharWidth;
1214         Term->TextHeight = NewHeight / giVT_CharHeight;
1215         Term->Width = NewWidth;
1216         Term->Height = NewHeight;
1217         Term->Mode = NewMode;
1218         
1219         // Allocate new buffers
1220         // - Text
1221         Term->Text = calloc(
1222                 Term->TextWidth * Term->TextHeight * (giVT_Scrollback+1),
1223                 sizeof(tVT_Char)
1224                 );
1225         if(oldTBuf) {
1226                 // Copy old buffer
1227                 w = oldTW;
1228                 if( w > Term->TextWidth )       w = Term->TextWidth;
1229                 h = oldTH;
1230                 if( h > Term->TextHeight )      h = Term->TextHeight;
1231                 h *= giVT_Scrollback + 1;
1232                 for( i = 0; i < h; i ++ )
1233                 {
1234                         memcpy(
1235                                 &Term->Text[i*Term->TextWidth],
1236                                 &oldTBuf[i*oldTW],
1237                                 w*sizeof(tVT_Char)
1238                                 );
1239                                 
1240                 }
1241         }
1242         
1243         // - Framebuffer
1244         Term->Buffer = calloc( Term->Width * Term->Height, sizeof(Uint32) );
1245         if(oldFB) {
1246                 // Copy old buffer
1247                 w = oldW;
1248                 if( w > Term->Width )   w = Term->Width;
1249                 h = oldH;
1250                 if( h > Term->Height )  h = Term->Height;
1251                 for( i = 0; i < h; i ++ )
1252                 {
1253                         memcpy(
1254                                 &Term->Buffer[i*Term->Width],
1255                                 &oldFB[i*oldW],
1256                                 w*sizeof(Uint32)
1257                                 );
1258                 }
1259         }
1260         
1261         
1262         // Debug
1263         switch(NewMode)
1264         {
1265         case TERM_MODE_TEXT:
1266                 Log_Log("VTerm", "Set VT %p to text mode (%ix%i)",
1267                         Term, Term->TextWidth, Term->TextHeight);
1268                 break;
1269         case TERM_MODE_FB:
1270                 Log_Log("VTerm", "Set VT %p to framebuffer mode (%ix%i)",
1271                         Term, Term->Width, Term->Height);
1272                 break;
1273         //case TERM_MODE_2DACCEL:
1274         //case TERM_MODE_3DACCEL:
1275         //      return;
1276         }
1277 }
1278
1279 // ---
1280 // Font Render
1281 // ---
1282 #define MONOSPACE_FONT  10816
1283
1284 #if MONOSPACE_FONT == 10808     // 8x8
1285 # include "vterm_font_8x8.h"
1286 #elif MONOSPACE_FONT == 10816   // 8x16
1287 # include "vterm_font_8x16.h"
1288 #endif
1289
1290 // === PROTOTYPES ===
1291 Uint8   *VT_Font_GetChar(Uint32 Codepoint);
1292
1293 // === GLOBALS ===
1294 int     giVT_CharWidth = FONT_WIDTH;
1295 int     giVT_CharHeight = FONT_HEIGHT;
1296
1297 // === CODE ===
1298 /**
1299  * \fn void VT_Font_Render(Uint32 Codepoint, void *Buffer, int Pitch, Uint32 BGC, Uint32 FGC)
1300  * \brief Render a font character
1301  */
1302 void VT_Font_Render(Uint32 Codepoint, void *Buffer, int Pitch, Uint32 BGC, Uint32 FGC)
1303 {
1304         Uint8   *font;
1305         Uint32  *buf = Buffer;
1306          int    x, y;
1307         
1308         font = VT_Font_GetChar(Codepoint);
1309         
1310         for(y = 0; y < FONT_HEIGHT; y ++)
1311         {
1312                 for(x = 0; x < FONT_WIDTH; x ++)
1313                 {
1314                         if(*font & (1 << (FONT_WIDTH-x-1)))
1315                                 buf[x] = FGC;
1316                         else
1317                                 buf[x] = BGC;
1318                 }
1319                 buf += Pitch;
1320                 font ++;
1321         }
1322 }
1323
1324 /**
1325  * \fn Uint32 VT_Colour12to24(Uint16 Col12)
1326  * \brief Converts a 
1327  */
1328 Uint32 VT_Colour12to24(Uint16 Col12)
1329 {
1330         Uint32  ret;
1331          int    tmp;
1332         tmp = Col12 & 0xF;
1333         ret  = (tmp << 0) | (tmp << 4);
1334         tmp = (Col12 & 0xF0) >> 4;
1335         ret |= (tmp << 8) | (tmp << 12);
1336         tmp = (Col12 & 0xF00) >> 8;
1337         ret |= (tmp << 16) | (tmp << 20);
1338         return ret;
1339 }
1340
1341 /**
1342  * \fn Uint8 *VT_Font_GetChar(Uint32 Codepoint)
1343  * \brief Gets an index into the font array given a Unicode Codepoint
1344  * \note See http://en.wikipedia.org/wiki/CP437
1345  */
1346 Uint8 *VT_Font_GetChar(Uint32 Codepoint)
1347 {
1348          int    index = 0;
1349         if(Codepoint < 128)
1350                 return &VTermFont[Codepoint*FONT_HEIGHT];
1351         switch(Codepoint)
1352         {
1353         case 0xC7:      index = 128;    break;  // Ç
1354         case 0xFC:      index = 129;    break;  // ü
1355         case 0xE9:      index = 130;    break;  // é
1356         case 0xE2:      index = 131;    break;  // â
1357         case 0xE4:      index = 132;    break;  // ä
1358         case 0xE0:      index = 133;    break;  // à
1359         case 0xE5:      index = 134;    break;  // å
1360         case 0xE7:      index = 135;    break;  // ç
1361         case 0xEA:      index = 136;    break;  // ê
1362         case 0xEB:      index = 137;    break;  // ë
1363         case 0xE8:      index = 138;    break;  // è
1364         case 0xEF:      index = 139;    break;  // ï
1365         case 0xEE:      index = 140;    break;  // î
1366         case 0xEC:      index = 141;    break;  // ì
1367         case 0xC4:      index = 142;    break;  // Ä
1368         case 0xC5:      index = 143;    break;  // Å
1369         }
1370         
1371         return &VTermFont[index*FONT_HEIGHT];
1372 }
1373
1374 EXPORTAS(&giVT_CharWidth, giVT_CharWidth);
1375 EXPORTAS(&giVT_CharHeight, giVT_CharHeight);
1376 EXPORT(VT_Font_Render);
1377 EXPORT(VT_Colour12to24);

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