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