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