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