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