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