Kernel/drv/vterm.c

   1 /*
   2  * Acess2 Virtual Terminal Driver
   3  */
   4 #define DEBUG   0
   5 #include <acess.h>
   6 #include <fs_devfs.h>
   7 #include <modules.h>
   8 #include <tpl_drv_video.h>
   9 #include <tpl_drv_keyboard.h>
  10 #include <tpl_drv_terminal.h>
  11 #include <errno.h>
  12 #include <semaphore.h>
  13
  14 #define USE_CTRL_ALT    0
  15
  16 // === CONSTANTS ===
  17 #define VERSION ((0<<8)|(50))
  18
  19 #define NUM_VTS 8
  20 #define MAX_INPUT_CHARS32       64
  21 #define MAX_INPUT_CHARS8        (MAX_INPUT_CHARS32*4)
  22 //#define DEFAULT_OUTPUT        "BochsGA"
  23 #define DEFAULT_OUTPUT  "Vesa"
  24 #define DEFAULT_INPUT   "PS2Keyboard"
  25 #define DEFAULT_WIDTH   640
  26 #define DEFAULT_HEIGHT  480
  27 #define DEFAULT_SCROLLBACK      2       // 2 Screens of text + current screen
  28 #define DEFAULT_COLOUR  (VT_COL_BLACK|(0xAAA<<16))
  29
  30 #define VT_FLAG_HIDECSR 0x01
  31 #define VT_FLAG_HASFB   0x10    //!< Set if the VTerm has requested the Framebuffer
  32
  33 enum eVT_InModes {
  34         VT_INMODE_TEXT8,        // UTF-8 Text Mode (VT100/xterm Emulation)
  35         VT_INMODE_TEXT32,       // UTF-32 Text Mode (Acess Native)
  36         NUM_VT_INMODES
  37 };
  38
  39 // === TYPES ===
  40 typedef struct {
  41          int    Mode;   //!< Current Mode (see ::eTplTerminal_Modes)
  42          int    Flags;  //!< Flags (see VT_FLAG_*)
  43
  44         short   NewWidth;       //!< Un-applied dimensions (Width)
  45         short   NewHeight;      //!< Un-applied dimensions (Height)
  46         short   Width;  //!< Virtual Width
  47         short   Height; //!< Virtual Height
  48         short   TextWidth;      //!< Text Virtual Width
  49         short   TextHeight;     //!< Text Virtual Height
  50
  51          int    ViewPos;        //!< View Buffer Offset (Text Only)
  52          int    WritePos;       //!< Write Buffer Offset (Text Only)
  53         Uint32  CurColour;      //!< Current Text Colour
  54
  55         tMutex  ReadingLock;    //!< Lock the VTerm when a process is reading from it
  56         tTID    ReadingThread;  //!< Owner of the lock
  57          int    InputRead;      //!< Input buffer read position
  58          int    InputWrite;     //!< Input buffer write position
  59         char    InputBuffer[MAX_INPUT_CHARS8];
  60         tSemaphore      InputSemaphore;
  61
  62         tVT_Char        *Text;
  63         Uint32          *Buffer;
  64
  65         char    Name[2];        //!< Name of the terminal
  66         tVFS_Node       Node;
  67 } tVTerm;
  68
  69 // === IMPORTS ===
  70 extern void     Debug_SetKTerminal(const char *File);
  71
  72 // === PROTOTYPES ===
  73  int    VT_Install(char **Arguments);
  74 void    VT_InitOutput(void);
  75 void    VT_InitInput(void);
  76 char    *VT_ReadDir(tVFS_Node *Node, int Pos);
  77 tVFS_Node       *VT_FindDir(tVFS_Node *Node, const char *Name);
  78  int    VT_Root_IOCtl(tVFS_Node *Node, int Id, void *Data);
  79 Uint64  VT_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer);
  80 Uint64  VT_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer);
  81  int    VT_Terminal_IOCtl(tVFS_Node *Node, int Id, void *Data);
  82 void    VT_SetResolution(int Width, int Height);
  83 void    VT_SetMode(int Mode);
  84 void    VT_SetTerminal(int ID);
  85 void    VT_KBCallBack(Uint32 Codepoint);
  86 void    VT_int_PutString(tVTerm *Term, Uint8 *Buffer, Uint Count);
  87 void    VT_int_ClearLine(tVTerm *Term, int Num);
  88  int    VT_int_ParseEscape(tVTerm *Term, char *Buffer);
  89 void    VT_int_PutChar(tVTerm *Term, Uint32 Ch);
  90 void    VT_int_ScrollFramebuffer( tVTerm *Term );
  91 void    VT_int_UpdateScreen( tVTerm *Term, int UpdateAll );
  92 void    VT_int_ChangeMode(tVTerm *Term, int NewMode, int NewWidth, int NewHeight);
  93
  94 // === CONSTANTS ===
  95 const Uint16    caVT100Colours[] = {
  96                 // Black, Red, Green, Yellow, Blue, Purple, Cyan, Gray
  97                 // Same again, but bright
  98                 VT_COL_BLACK, 0x700, 0x070, 0x770, 0x007, 0x707, 0x077, 0xAAA,
  99                 VT_COL_GREY, 0xF00, 0x0F0, 0xFF0, 0x00F, 0xF0F, 0x0FF, VT_COL_WHITE
 100         };
 101
 102 // === GLOBALS ===
 103 MODULE_DEFINE(0, VERSION, VTerm, VT_Install, NULL, DEFAULT_OUTPUT, DEFAULT_INPUT, NULL);
 104 tDevFS_Driver   gVT_DrvInfo = {
 105         NULL, "VTerm",
 106         {
 107         .Flags = VFS_FFLAG_DIRECTORY,
 108         .Size = NUM_VTS,
 109         .Inode = -1,
 110         .NumACLs = 0,
 111         .ReadDir = VT_ReadDir,
 112         .FindDir = VT_FindDir,
 113         .IOCtl = VT_Root_IOCtl
 114         }
 115 };
 116 // --- Terminals ---
 117 tVTerm  gVT_Terminals[NUM_VTS];
 118  int    giVT_CurrentTerminal = 0;
 119 tVTerm  *gpVT_CurTerm = &gVT_Terminals[0];
 120 // --- Video State ---
 121 short   giVT_RealWidth  = DEFAULT_WIDTH;        //!< Screen Width
 122 short   giVT_RealHeight = DEFAULT_HEIGHT;       //!< Screen Height
 123  int    giVT_Scrollback = DEFAULT_SCROLLBACK;
 124 // --- Driver Handles ---
 125 char    *gsVT_OutputDevice = NULL;
 126 char    *gsVT_InputDevice = NULL;
 127  int    giVT_OutputDevHandle = -2;
 128  int    giVT_InputDevHandle = -2;
 129 // --- Key States --- (Used for VT Switching/Magic Combos)
 130  int    gbVT_CtrlDown = 0;
 131  int    gbVT_AltDown = 0;
 132  int    gbVT_SysrqDown = 0;
 133
 134 // === CODE ===
 135 /**
 136  * \fn int VT_Install(char **Arguments)
 137  * \brief Installs the Virtual Terminal Driver
 138  */
 139 int VT_Install(char **Arguments)
 140 {
 141          int    i;
 142
 143         // Scan Arguments
 144         if(Arguments)
 145         {
 146                 char    **args;
 147                 const char      *arg;
 148                 for(args = Arguments; (arg = *args); args++ )
 149                 {
 150                         char    data[strlen(arg)+1];
 151                         char    *opt = data;
 152                         char    *val;
 153
 154                         val = strchr(arg, '=');
 155                         strcpy(data, arg);
 156                         if( val ) {
 157                                 data[ val - arg ] = '\0';
 158                                 val ++;
 159                         }
 160                         Log_Debug("VTerm", "Argument '%s'", arg);
 161
 162                         if( strcmp(opt, "Video") == 0 ) {
 163                                 gsVT_OutputDevice = strdup(val);
 164                         }
 165                         else if( strcmp(opt, "Input") == 0 ) {
 166                                 gsVT_InputDevice = strdup(val);
 167                         }
 168                         else if( strcmp(opt, "Width") == 0 ) {
 169                                 giVT_RealWidth = atoi( val );
 170                         }
 171                         else if( strcmp(opt, "Height") == 0 ) {
 172                                 giVT_RealHeight = atoi( val );
 173                         }
 174                         else if( strcmp(opt, "Scrollback") == 0 ) {
 175                                 giVT_Scrollback = atoi( val );
 176                         }
 177                 }
 178         }
 179
 180         if(gsVT_OutputDevice)   Modules_InitialiseBuiltin( gsVT_OutputDevice );
 181         if(gsVT_InputDevice)    Modules_InitialiseBuiltin( gsVT_InputDevice );
 182
 183         // Apply Defaults
 184         if(!gsVT_OutputDevice)  gsVT_OutputDevice = strdup(DEFAULT_OUTPUT);
 185         if(!gsVT_InputDevice)   gsVT_InputDevice = strdup(DEFAULT_INPUT);
 186
 187         // Create paths
 188         {
 189                 char    *tmp;
 190                 tmp = malloc( 9 + strlen(gsVT_OutputDevice) + 1 );
 191                 strcpy(tmp, "/Devices/");
 192                 strcpy(&tmp[9], gsVT_OutputDevice);
 193                 gsVT_OutputDevice = tmp;
 194                 tmp = malloc( 9 + strlen(gsVT_InputDevice) + 1 );
 195                 strcpy(tmp, "/Devices/");
 196                 strcpy(&tmp[9], gsVT_InputDevice);
 197                 gsVT_InputDevice = tmp;
 198         }
 199
 200         Log_Log("VTerm", "Using '%s' as output", gsVT_OutputDevice);
 201         Log_Log("VTerm", "Using '%s' as input", gsVT_InputDevice);
 202
 203         // Create Nodes
 204         for( i = 0; i < NUM_VTS; i++ )
 205         {
 206                 gVT_Terminals[i].Mode = TERM_MODE_TEXT;
 207                 gVT_Terminals[i].Flags = 0;
 208                 gVT_Terminals[i].CurColour = DEFAULT_COLOUR;
 209                 gVT_Terminals[i].WritePos = 0;
 210                 gVT_Terminals[i].ViewPos = 0;
 211                 gVT_Terminals[i].ReadingThread = -1;
 212
 213                 // Initialise
 214                 VT_int_ChangeMode( &gVT_Terminals[i],
 215                         TERM_MODE_TEXT, giVT_RealWidth, giVT_RealHeight );
 216
 217                 gVT_Terminals[i].Name[0] = '0'+i;
 218                 gVT_Terminals[i].Name[1] = '\0';
 219                 gVT_Terminals[i].Node.Inode = i;
 220                 gVT_Terminals[i].Node.ImplPtr = &gVT_Terminals[i];
 221                 gVT_Terminals[i].Node.NumACLs = 0;      // Only root can open virtual terminals
 222
 223                 gVT_Terminals[i].Node.Read = VT_Read;
 224                 gVT_Terminals[i].Node.Write = VT_Write;
 225                 gVT_Terminals[i].Node.IOCtl = VT_Terminal_IOCtl;
 226                 Semaphore_Init(&gVT_Terminals[i].InputSemaphore, 0, MAX_INPUT_CHARS8, "VTerm", gVT_Terminals[i].Name);
 227         }
 228
 229         // Add to DevFS
 230         DevFS_AddDevice( &gVT_DrvInfo );
 231
 232         VT_InitOutput();
 233         VT_InitInput();
 234
 235         // Set kernel output to VT0
 236         Debug_SetKTerminal("/Devices/VTerm/0");
 237
 238         Log_Log("VTerm", "Returning %i", MODULE_ERR_OK);
 239         return MODULE_ERR_OK;
 240 }
 241
 242 /**
 243  * \fn void VT_InitOutput()
 244  * \brief Initialise Video Output
 245  */
 246 void VT_InitOutput()
 247 {
 248         giVT_OutputDevHandle = VFS_Open(gsVT_OutputDevice, VFS_OPENFLAG_WRITE);
 249         if(giVT_OutputDevHandle == -1) {
 250                 Log_Warning("VTerm", "Oh F**k, I can't open the video device '%s'", gsVT_OutputDevice);
 251                 return ;
 252         }
 253         VT_SetResolution( giVT_RealWidth, giVT_RealHeight );
 254         VT_SetTerminal( 0 );
 255         VT_SetMode( VIDEO_BUFFMT_TEXT );
 256 }
 257
 258 /**
 259  * \fn void VT_InitInput()
 260  * \brief Initialises the input
 261  */
 262 void VT_InitInput()
 263 {
 264         giVT_InputDevHandle = VFS_Open(gsVT_InputDevice, VFS_OPENFLAG_READ);
 265         if(giVT_InputDevHandle == -1) {
 266                 Log_Warning("VTerm", "Can't open the input device '%s'", gsVT_InputDevice);
 267                 return ;
 268         }
 269         VFS_IOCtl(giVT_InputDevHandle, KB_IOCTL_SETCALLBACK, VT_KBCallBack);
 270 }
 271
 272 /**
 273  * \brief Set the video resolution
 274  * \param Width New screen width
 275  * \param Height        New screen height
 276  */
 277 void VT_SetResolution(int Width, int Height)
 278 {
 279         tVideo_IOCtl_Mode       mode = {0};
 280          int    tmp;
 281          int    i;
 282
 283         // Create the video mode
 284         mode.width = Width;
 285         mode.height = Height;
 286         mode.bpp = 32;
 287         mode.flags = 0;
 288
 289         // Set video mode
 290         VFS_IOCtl( giVT_OutputDevHandle, VIDEO_IOCTL_FINDMODE, &mode );
 291         tmp = mode.id;
 292         if( Width != mode.width || Height != mode.height )
 293         {
 294                 Log_Warning("VTerm",
 295                         "Selected resolution (%ix%i is not supported) by the device, using (%ix%i)",
 296                         giVT_RealWidth, giVT_RealHeight,
 297                         mode.width, mode.height
 298                         );
 299         }
 300         VFS_IOCtl( giVT_OutputDevHandle, VIDEO_IOCTL_GETSETMODE, &tmp );
 301
 302         // Resize text terminals if needed
 303         if( giVT_RealWidth != mode.width || giVT_RealHeight != mode.height )
 304         {
 305                  int    newBufSize = (giVT_RealWidth/giVT_CharWidth)
 306                                         *(giVT_RealHeight/giVT_CharHeight)
 307                                         *(giVT_Scrollback+1);
 308                 //tVT_Char      *tmp;
 309                 // Resize the text terminals
 310                 giVT_RealWidth = mode.width;
 311                 giVT_RealHeight = mode.height;
 312                 for( i = 0; i < NUM_VTS; i ++ )
 313                 {
 314                         if( gVT_Terminals[i].Mode != TERM_MODE_TEXT )   continue;
 315
 316                         gVT_Terminals[i].Text = realloc(
 317                                 gVT_Terminals[i].Text,
 318                                 newBufSize*sizeof(tVT_Char)
 319                                 );
 320                 }
 321         }
 322 }
 323
 324 /**
 325  * \brief Set video output buffer mode
 326  */
 327 void VT_SetMode(int Mode)
 328 {
 329         VFS_IOCtl( giVT_OutputDevHandle, VIDEO_IOCTL_SETBUFFORMAT, &Mode );
 330 }
 331
 332 /**
 333  * \fn char *VT_ReadDir(tVFS_Node *Node, int Pos)
 334  * \brief Read from the VTerm Directory
 335  */
 336 char *VT_ReadDir(tVFS_Node *Node, int Pos)
 337 {
 338         if(Pos < 0)     return NULL;
 339         if(Pos >= NUM_VTS)      return NULL;
 340         return strdup( gVT_Terminals[Pos].Name );
 341 }
 342
 343 /**
 344  * \fn tVFS_Node *VT_FindDir(tVFS_Node *Node, const char *Name)
 345  * \brief Find an item in the VTerm directory
 346  * \param Node  Root node
 347  * \param Name  Name (number) of the terminal
 348  */
 349 tVFS_Node *VT_FindDir(tVFS_Node *Node, const char *Name)
 350 {
 351          int    num;
 352
 353         ENTER("pNode sName", Node, Name);
 354
 355         // Open the input and output files if needed
 356         if(giVT_OutputDevHandle == -2)  VT_InitOutput();
 357         if(giVT_InputDevHandle == -2)   VT_InitInput();
 358
 359         // Sanity check name
 360         if(Name[0] < '0' || Name[0] > '9' || Name[1] != '\0') {
 361                 LEAVE('n');
 362                 return NULL;
 363         }
 364         // Get index
 365         num = Name[0] - '0';
 366         if(num >= NUM_VTS) {
 367                 LEAVE('n');
 368                 return NULL;
 369         }
 370         // Return node
 371         LEAVE('p', &gVT_Terminals[num].Node);
 372         return &gVT_Terminals[num].Node;
 373 }
 374
 375 /**
 376  * \fn int VT_Root_IOCtl(tVFS_Node *Node, int Id, void *Data)
 377  * \brief Control the VTerm Driver
 378  */
 379 int VT_Root_IOCtl(tVFS_Node *Node, int Id, void *Data)
 380 {
 381          int    len;
 382         switch(Id)
 383         {
 384         case DRV_IOCTL_TYPE:    return DRV_TYPE_MISC;
 385         case DRV_IOCTL_IDENT:   memcpy(Data, "VT\0\0", 4);      return 0;
 386         case DRV_IOCTL_VERSION: return VERSION;
 387         case DRV_IOCTL_LOOKUP:  return 0;
 388
 389         case 4: // Get Video Driver
 390                 if(Data)        strcpy(Data, gsVT_OutputDevice);
 391                 return strlen(gsVT_OutputDevice);
 392
 393         case 5: // Set Video Driver
 394                 if(!Data)       return -EINVAL;
 395                 if(Threads_GetUID() != 0)       return -EACCES;
 396
 397                 len = strlen(Data);
 398
 399                 // TODO: Check if the string used is a heap string
 400
 401                 free(gsVT_OutputDevice);
 402
 403                 gsVT_OutputDevice = malloc(len+1);
 404                 strcpy(gsVT_OutputDevice, Data);
 405
 406                 VFS_Close(giVT_OutputDevHandle);
 407                 giVT_OutputDevHandle = -1;
 408
 409                 VT_InitOutput();
 410                 return 1;
 411         }
 412         return 0;
 413 }
 414
 415 /**
 416  * \fn Uint64 VT_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
 417  * \brief Read from a virtual terminal
 418  */
 419 Uint64 VT_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
 420 {
 421          int    pos = 0;
 422         tVTerm  *term = &gVT_Terminals[ Node->Inode ];
 423
 424         Mutex_Acquire( &term->ReadingLock );
 425
 426         // Check current mode
 427         switch(term->Mode)
 428         {
 429         // Text Mode (UTF-8)
 430         case TERM_MODE_TEXT:
 431                 while(pos < Length)
 432                 {
 433                         int avail_bytes;
 434                         avail_bytes = Semaphore_Wait( &term->InputSemaphore, Length );
 435                         if( avail_bytes == -1 ) {
 436                                 break ;
 437                         }
 438
 439                         while( avail_bytes -- )
 440                         {
 441                                 ((char*)Buffer)[pos] = term->InputBuffer[term->InputRead];
 442                                 pos ++;
 443                                 term->InputRead ++;
 444                                 term->InputRead %= MAX_INPUT_CHARS8;
 445                         }
 446                 }
 447                 break;
 448
 449         //case TERM_MODE_FB:
 450         // Other - UCS-4
 451         default:
 452                 while(pos < Length)
 453                 {
 454                          int    avail;
 455                         avail = Semaphore_Wait( &term->InputSemaphore, Length/4 * 4 );
 456                         if( avail == -1 ) {
 457                                 break ;
 458                         }
 459
 460                         while( avail > 3 )
 461                         {
 462                                 ((Uint32*)Buffer)[pos] = ((Uint32*)term->InputBuffer)[term->InputRead];
 463                                 pos ++;
 464                                 term->InputRead ++;
 465                                 term->InputRead %= MAX_INPUT_CHARS32;
 466                                 avail -= 4;
 467                         }
 468                 }
 469                 pos *= 4;
 470                 break;
 471         }
 472
 473         term->ReadingThread = -1;
 474         Mutex_Release( &term->ReadingLock );
 475
 476         return pos;
 477 }
 478
 479 /**
 480  * \fn Uint64 VT_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
 481  * \brief Write to a virtual terminal
 482  */
 483 Uint64 VT_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
 484 {
 485         tVTerm  *term = &gVT_Terminals[ Node->Inode ];
 486          int    size;
 487
 488         // Write
 489         switch( term->Mode )
 490         {
 491         // Print Text
 492         case TERM_MODE_TEXT:
 493                 VT_int_PutString(term, Buffer, Length);
 494                 break;
 495         // Framebuffer :)
 496         case TERM_MODE_FB:
 497
 498                 // - Sanity Checking
 499                 size = term->Width*term->Height*4;
 500                 if( Offset > size ) {
 501                         Log_Notice("VTerm", "VT_Write: Offset (0x%llx) > FBSize (0x%x)",
 502                                 Offset, size);
 503                         return 0;
 504                 }
 505                 if( Offset + Length > size ) {
 506                         Log_Notice("VTerm", "VT_Write: Offset+Length (0x%llx) > FBSize (0x%x)",
 507                                 Offset+Length, size);
 508                         Length = size - Offset;
 509                 }
 510
 511                 // Copy to the local cache
 512                 memcpy( (void*)((Uint)term->Buffer + (Uint)Offset), Buffer, Length );
 513
 514                 // Update screen if needed
 515                 if( Node->Inode == giVT_CurrentTerminal )
 516                 {
 517                         // Fill entire screen?
 518                         if( giVT_RealWidth > term->Width || giVT_RealHeight > term->Height )
 519                         {
 520                                 // No? :( Well, just center it
 521                                  int    x, y, w, h;
 522                                 x = Offset/4;   y = x / term->Width;    x %= term->Width;
 523                                 w = Length/4+x; h = w / term->Width;    w %= term->Width;
 524                                 // Center
 525                                 x += (giVT_RealWidth - term->Width) / 2;
 526                                 y += (giVT_RealHeight - term->Height) / 2;
 527                                 while(h--)
 528                                 {
 529                                         VFS_WriteAt( giVT_OutputDevHandle,
 530                                                 (x + y * giVT_RealWidth)*4,
 531                                                 term->Width * 4,
 532                                                 Buffer
 533                                                 );
 534                                         Buffer = (void*)( (Uint)Buffer + term->Width*4 );
 535                                         y ++;
 536                                 }
 537                                 return 0;
 538                         }
 539                         else {
 540                                 return VFS_WriteAt( giVT_OutputDevHandle, Offset, Length, Buffer );
 541                         }
 542                 }
 543         // Just pass on (for now)
 544         // TODO: Handle locally too to ensure no information is lost on
 545         //       VT Switch (and to isolate terminals from each other)
 546         case TERM_MODE_2DACCEL:
 547         //case TERM_MODE_3DACCEL:
 548                 if( Node->Inode == giVT_CurrentTerminal )
 549                 {
 550                         VFS_Write( giVT_OutputDevHandle, Length, Buffer );
 551                 }
 552                 break;
 553         }
 554
 555         return 0;
 556 }
 557
 558 /**
 559  * \fn int VT_Terminal_IOCtl(tVFS_Node *Node, int Id, void *Data)
 560  * \brief Call an IO Control on a virtual terminal
 561  */
 562 int VT_Terminal_IOCtl(tVFS_Node *Node, int Id, void *Data)
 563 {
 564          int    *iData = Data;
 565          int    ret;
 566         tVTerm  *term = Node->ImplPtr;
 567         ENTER("pNode iId pData", Node, Id, Data);
 568
 569         if(Id >= DRV_IOCTL_LOOKUP) {
 570                 // Only root can fiddle with graphics modes
 571                 // TODO: Remove this and replace with user ownership
 572                 if( Threads_GetUID() != 0 )     return -1;
 573         }
 574
 575         switch(Id)
 576         {
 577         // --- Core Defined
 578         case DRV_IOCTL_TYPE:
 579                 LEAVE('i', DRV_TYPE_TERMINAL);
 580                 return DRV_TYPE_TERMINAL;
 581         case DRV_IOCTL_IDENT:
 582                 memcpy(Data, "VT\0\0", 4);
 583                 LEAVE('i', 0);
 584                 return 0;
 585         case DRV_IOCTL_VERSION:
 586                 LEAVE('x', VERSION);
 587                 return VERSION;
 588         case DRV_IOCTL_LOOKUP:
 589                 LEAVE('i', 0);
 590                 return 0;
 591
 592         // Get/Set the mode (and apply any changes)
 593         case TERM_IOCTL_MODETYPE:
 594                 if(Data != NULL)
 595                 {
 596                         if( CheckMem(Data, sizeof(int)) == 0 ) {
 597                                 LEAVE('i', -1);
 598                                 return -1;
 599                         }
 600                         Log_Log("VTerm", "VTerm %i mode set to %i", (int)Node->Inode, *iData);
 601
 602                         // Update mode if needed
 603                         if( term->Mode != *iData
 604                          || term->NewWidth
 605                          || term->NewHeight)
 606                         {
 607                                 // Adjust for text mode
 608                                 if( *iData == TERM_MODE_TEXT ) {
 609                                         term->NewHeight *= giVT_CharHeight;
 610                                         term->NewWidth *= giVT_CharWidth;
 611                                 }
 612                                 // Fill unchanged dimensions
 613                                 if(term->NewHeight == 0)        term->NewHeight = term->Height;
 614                                 if(term->NewWidth == 0) term->NewWidth = term->Width;
 615                                 // Set new mode
 616                                 VT_int_ChangeMode(term, *iData, term->NewWidth, term->NewHeight);
 617                                 // Clear unapplied dimensions
 618                                 term->NewWidth = 0;
 619                                 term->NewHeight = 0;
 620                         }
 621
 622                         // Update the screen dimensions
 623                         if(Node->Inode == giVT_CurrentTerminal)
 624                                 VT_SetTerminal( giVT_CurrentTerminal );
 625                 }
 626                 LEAVE('i', term->Mode);
 627                 return term->Mode;
 628
 629         // Get/set the terminal width
 630         case TERM_IOCTL_WIDTH:
 631                 if(Data != NULL) {
 632                         if( CheckMem(Data, sizeof(int)) == 0 ) {
 633                                 LEAVE('i', -1);
 634                                 return -1;
 635                         }
 636                         term->NewWidth = *iData;
 637                 }
 638                 if( term->NewWidth )
 639                         ret = term->NewWidth;
 640                 else if( term->Mode == TERM_MODE_TEXT )
 641                         ret = term->TextWidth;
 642                 else
 643                         ret = term->Width;
 644                 LEAVE('i', ret);
 645                 return ret;
 646
 647         // Get/set the terminal height
 648         case TERM_IOCTL_HEIGHT:
 649                 if(Data != NULL) {
 650                         if( CheckMem(Data, sizeof(int)) == 0 ) {
 651                                 LEAVE('i', -1);
 652                                 return -1;
 653                         }
 654                         term->NewHeight = *iData;
 655                 }
 656                 if( term->NewHeight )
 657                         ret = term->NewHeight;
 658                 else if( term->Mode == TERM_MODE_TEXT )
 659                         ret = term->TextHeight;
 660                 else
 661                         ret = term->Height;
 662                 LEAVE('i', ret);
 663                 return ret;
 664
 665         case TERM_IOCTL_FORCESHOW:
 666                 Log_Log("VTerm", "Thread %i forced VTerm %i to be shown",
 667                         Threads_GetTID(), (int)Node->Inode);
 668                 VT_SetTerminal( Node->Inode );
 669                 LEAVE('i', 1);
 670                 return 1;
 671         }
 672         LEAVE('i', -1);
 673         return -1;
 674 }
 675
 676 /**
 677  * \fn void VT_SetTerminal(int ID)
 678  * \brief Set the current terminal
 679  */
 680 void VT_SetTerminal(int ID)
 681 {
 682         // Update current terminal ID
 683         Log_Log("VTerm", "Changed terminal from %i to %i", giVT_CurrentTerminal, ID);
 684         giVT_CurrentTerminal = ID;
 685         gpVT_CurTerm = &gVT_Terminals[ID];
 686
 687         // Update cursor
 688         if( gpVT_CurTerm->Mode == TERM_MODE_TEXT && !(gpVT_CurTerm->Flags & VT_FLAG_HIDECSR) )
 689         {
 690                 tVideo_IOCtl_Pos        pos;
 691                 pos.x = (gpVT_CurTerm->WritePos - gpVT_CurTerm->ViewPos) % gpVT_CurTerm->TextWidth;
 692                 pos.y = (gpVT_CurTerm->WritePos - gpVT_CurTerm->ViewPos) / gpVT_CurTerm->TextWidth;
 693                 if( pos.x < gpVT_CurTerm->TextHeight )
 694                         VFS_IOCtl(giVT_OutputDevHandle, VIDEO_IOCTL_SETCURSOR, &pos);
 695         }
 696
 697         if( gpVT_CurTerm->Mode == TERM_MODE_TEXT )
 698                 VT_SetMode( VIDEO_BUFFMT_TEXT );
 699         else
 700                 VT_SetMode( VIDEO_BUFFMT_FRAMEBUFFER );
 701
 702         // Update the screen
 703         VT_int_UpdateScreen( &gVT_Terminals[ ID ], 1 );
 704 }
 705
 706 /**
 707  * \fn void VT_KBCallBack(Uint32 Codepoint)
 708  * \brief Called on keyboard interrupt
 709  * \param Codepoint     Pseudo-UTF32 character
 710  *
 711  * Handles a key press and sends the key code to the user's buffer.
 712  * If the code creates a kernel-magic sequence, it is not passed to the
 713  * user and is handled in-kernel.
 714  */
 715 void VT_KBCallBack(Uint32 Codepoint)
 716 {
 717         tVTerm  *term = gpVT_CurTerm;
 718
 719         // How the hell did we get a codepoint of zero?
 720         if(Codepoint == 0)      return;
 721
 722         // Key Up
 723         if( Codepoint & 0x80000000 )
 724         {
 725                 Codepoint &= 0x7FFFFFFF;
 726                 switch(Codepoint)
 727                 {
 728                 #if !USE_CTRL_ALT
 729                 case KEY_RSHIFT:        gbVT_CtrlDown = 0;      break;
 730                 case KEY_LSHIFT:        gbVT_AltDown = 0;       break;
 731                 #else
 732                 case KEY_LALT:  gbVT_AltDown &= ~1;     break;
 733                 case KEY_RALT:  gbVT_AltDown &= ~2;     break;
 734                 case KEY_LCTRL: gbVT_CtrlDown &= ~1     break;
 735                 case KEY_RCTRL: gbVT_CtrlDown &= ~2;    break;
 736                 #endif
 737                 }
 738                 return;
 739         }
 740
 741         switch(Codepoint)
 742         {
 743         #if !USE_CTRL_ALT       // HACK: Use both shifts instead of Ctrl-Alt
 744         case KEY_RSHIFT:        gbVT_CtrlDown = 1;      break;
 745         case KEY_LSHIFT:        gbVT_AltDown = 1;       break;
 746         #else
 747         case KEY_LALT:  gbVT_AltDown |= 1;      break;
 748         case KEY_RALT:  gbVT_AltDown |= 2;      break;
 749         case KEY_LCTRL: gbVT_CtrlDown |= 1;     break;
 750         case KEY_RCTRL: gbVT_CtrlDown |= 2;     break;
 751         #endif
 752
 753         default:
 754                 if(!gbVT_AltDown || !gbVT_CtrlDown)
 755                         break;
 756                 switch(Codepoint)
 757                 {
 758                 case KEY_F1:    VT_SetTerminal(0);      return;
 759                 case KEY_F2:    VT_SetTerminal(1);      return;
 760                 case KEY_F3:    VT_SetTerminal(2);      return;
 761                 case KEY_F4:    VT_SetTerminal(3);      return;
 762                 case KEY_F5:    VT_SetTerminal(4);      return;
 763                 case KEY_F6:    VT_SetTerminal(5);      return;
 764                 case KEY_F7:    VT_SetTerminal(6);      return;
 765                 case KEY_F8:    VT_SetTerminal(7);      return;
 766                 case KEY_F9:    VT_SetTerminal(8);      return;
 767                 case KEY_F10:   VT_SetTerminal(9);      return;
 768                 case KEY_F11:   VT_SetTerminal(10);     return;
 769                 case KEY_F12:   VT_SetTerminal(11);     return;
 770                 // Scrolling
 771                 case KEY_PGUP:
 772                         if( gpVT_CurTerm->ViewPos > gpVT_CurTerm->Width )
 773                                 gpVT_CurTerm->ViewPos -= gpVT_CurTerm->Width;
 774                         else
 775                                 gpVT_CurTerm->ViewPos = 0;
 776                         return;
 777                 case KEY_PGDOWN:
 778                         if( gpVT_CurTerm->ViewPos < gpVT_CurTerm->Width*gpVT_CurTerm->Height*(giVT_Scrollback-1) )
 779                                 gpVT_CurTerm->ViewPos += gpVT_CurTerm->Width;
 780                         else
 781                                 gpVT_CurTerm->ViewPos = gpVT_CurTerm->Width*gpVT_CurTerm->Height*(giVT_Scrollback-1);
 782                         return;
 783                 }
 784         }
 785
 786         // Encode key
 787         if(term->Mode == TERM_MODE_TEXT)
 788         {
 789                 Uint8   buf[6] = {0};
 790                  int    len = 0;
 791
 792                 // Ignore Modifer Keys
 793                 if(Codepoint > KEY_MODIFIERS)   return;
 794
 795                 // Get UTF-8/ANSI Encoding
 796                 switch(Codepoint)
 797                 {
 798                 case KEY_LEFT:
 799                         buf[0] = '\x1B';        buf[1] = '[';   buf[2] = 'D';
 800                         len = 3;
 801                         break;
 802                 case KEY_RIGHT:
 803                         buf[0] = '\x1B';        buf[1] = '[';   buf[2] = 'C';
 804                         len = 3;
 805                         break;
 806                 case KEY_UP:
 807                         buf[0] = '\x1B';        buf[1] = '[';   buf[2] = 'A';
 808                         len = 3;
 809                         break;
 810                 case KEY_DOWN:
 811                         buf[0] = '\x1B';        buf[1] = '[';   buf[2] = 'B';
 812                         len = 3;
 813                         break;
 814
 815                 case KEY_PGUP:
 816                         buf[0] = '\x1B';        buf[1] = '[';   buf[2] = '5';   // Some overline also
 817                         //len = 4;      // Commented out until I'm sure
 818                         break;
 819                 case KEY_PGDOWN:
 820                         len = 0;
 821                         break;
 822
 823                 // Attempt to encode in UTF-8
 824                 default:
 825                         len = WriteUTF8( buf, Codepoint );
 826                         if(len == 0) {
 827                                 Warning("Codepoint (%x) is unrepresentable in UTF-8", Codepoint);
 828                         }
 829                         break;
 830                 }
 831
 832                 if(len == 0) {
 833                         // Unprintable / Don't Pass
 834                         return;
 835                 }
 836
 837                 // Write
 838                 if( MAX_INPUT_CHARS8 - term->InputWrite >= len )
 839                         memcpy( &term->InputBuffer[term->InputWrite], buf, len );
 840                 else {
 841                         memcpy( &term->InputBuffer[term->InputWrite], buf, MAX_INPUT_CHARS8 - term->InputWrite );
 842                         memcpy( &term->InputBuffer[0], buf, len - (MAX_INPUT_CHARS8 - term->InputWrite) );
 843                 }
 844                 // Roll the buffer over
 845                 term->InputWrite += len;
 846                 term->InputWrite %= MAX_INPUT_CHARS8;
 847                 if( (term->InputWrite - term->InputRead + MAX_INPUT_CHARS8)%MAX_INPUT_CHARS8 < len ) {
 848                         term->InputRead = term->InputWrite + 1;
 849                         term->InputRead %= MAX_INPUT_CHARS8;
 850                 }
 851
 852                 Semaphore_Signal(&term->InputSemaphore, 1);
 853         }
 854         else
 855         {
 856                 // Encode the raw UTF-32 Key
 857                 ((Uint32*)term->InputBuffer)[ term->InputWrite ] = Codepoint;
 858                 term->InputWrite ++;
 859                 term->InputWrite %= MAX_INPUT_CHARS32;
 860                 if(term->InputRead == term->InputWrite) {
 861                         term->InputRead ++;
 862                         term->InputRead %= MAX_INPUT_CHARS32;
 863                 }
 864                 Semaphore_Signal(&term->InputSemaphore, 4);
 865         }
 866
 867         // Wake up the thread waiting on us
 868         //if( term->ReadingThread >= 0 ) {
 869         //      Threads_WakeTID(term->ReadingThread);
 870         //}
 871 }
 872
 873 /**
 874  * \fn void VT_int_ClearLine(tVTerm *Term, int Num)
 875  * \brief Clears a line in a virtual terminal
 876  */
 877 void VT_int_ClearLine(tVTerm *Term, int Num)
 878 {
 879          int    i;
 880         tVT_Char        *cell = &Term->Text[ Num*Term->TextWidth ];
 881         if( Num < 0 || Num >= Term->TextHeight * (giVT_Scrollback + 1) )        return ;
 882         //ENTER("pTerm iNum", Term, Num);
 883         for( i = Term->TextWidth; i--; )
 884         {
 885                 cell[ i ].Ch = 0;
 886                 cell[ i ].Colour = Term->CurColour;
 887         }
 888         //LEAVE('-');
 889 }
 890
 891 /**
 892  * \fn int VT_int_ParseEscape(tVTerm *Term, char *Buffer)
 893  * \brief Parses a VT100 Escape code
 894  */
 895 int VT_int_ParseEscape(tVTerm *Term, char *Buffer)
 896 {
 897         char    c;
 898          int    argc = 0, j = 1;
 899          int    tmp;
 900          int    args[6] = {0,0,0,0};
 901
 902         switch(Buffer[0])
 903         {
 904         //Large Code
 905         case '[':
 906                 // Get Arguments
 907                 c = Buffer[j++];
 908                 if( '0' <= c && c <= '9' )
 909                 {
 910                         do {
 911                                 if(c == ';')    c = Buffer[j++];
 912                                 while('0' <= c && c <= '9') {
 913                                         args[argc] *= 10;
 914                                         args[argc] += c-'0';
 915                                         c = Buffer[j++];
 916                                 }
 917                                 argc ++;
 918                         } while(c == ';');
 919                 }
 920
 921                 // Get Command
 922                 if(     ('a' <= c && c <= 'z') || ('A' <= c && c <= 'Z'))
 923                 {
 924                         switch(c)
 925                         {
 926                         // Left
 927                         case 'D':
 928                                 if(argc == 1)   tmp = args[0];
 929                                 else    tmp = 1;
 930
 931                                 if( Term->WritePos-(tmp-1) % Term->TextWidth == 0 )
 932                                         Term->WritePos -= Term->WritePos % Term->TextWidth;
 933                                 else
 934                                         Term->WritePos -= tmp;
 935                                 break;
 936
 937                         // Right
 938                         case 'C':
 939                                 if(argc == 1)   tmp = args[0];
 940                                 else    tmp = 1;
 941                                 if( (Term->WritePos + tmp) % Term->TextWidth == 0 ) {
 942                                         Term->WritePos -= Term->WritePos % Term->TextWidth;
 943                                         Term->WritePos += Term->TextWidth - 1;
 944                                 } else
 945                                         Term->WritePos += tmp;
 946                                 break;
 947
 948                         // Clear By Line
 949                         case 'J':
 950                                 // Clear Screen
 951                                 switch(args[0])
 952                                 {
 953                                 case 2:
 954                                         {
 955                                          int    i = Term->TextHeight * (giVT_Scrollback + 1);
 956                                         while( i-- )    VT_int_ClearLine(Term, i);
 957                                         Term->WritePos = 0;
 958                                         Term->ViewPos = 0;
 959                                         VT_int_UpdateScreen(Term, 1);
 960                                         }
 961                                         break;
 962                                 }
 963                                 break;
 964                         // Set cursor position
 965                         case 'h':
 966                                 Term->WritePos = args[0] + args[1]*Term->TextWidth;
 967                                 Log_Debug("VTerm", "args = {%i, %i}", args[0], args[1]);
 968                                 break;
 969                         // Set Font flags
 970                         case 'm':
 971                                 for( ; argc--; )
 972                                 {
 973                                         // Flags
 974                                         if( 0 <= args[argc] && args[argc] <= 8)
 975                                         {
 976                                                 switch(args[argc])
 977                                                 {
 978                                                 case 0: Term->CurColour = DEFAULT_COLOUR;       break;  // Reset
 979                                                 case 1: Term->CurColour |= 0x80000000;  break;  // Bright
 980                                                 case 2: Term->CurColour &= ~0x80000000; break;  // Dim
 981                                                 }
 982                                         }
 983                                         // Foreground Colour
 984                                         else if(30 <= args[argc] && args[argc] <= 37) {
 985                                                 Term->CurColour &= 0xF000FFFF;
 986                                                 Term->CurColour |= (Uint32)caVT100Colours[ args[argc]-30+(Term->CurColour>>28) ] << 16;
 987                                         }
 988                                         // Background Colour
 989                                         else if(40 <= args[argc] && args[argc] <= 47) {
 990                                                 Term->CurColour &= 0xFFFF8000;
 991                                                 Term->CurColour |= caVT100Colours[ args[argc]-40+((Term->CurColour>>12)&15) ];
 992                                         }
 993                                 }
 994                                 break;
 995                         default:
 996                                 Log_Warning("VTerm", "Unknown control sequence");
 997                                 break;
 998                         }
 999                 }
1000                 break;
1001
1002         default:        break;
1003         }
1004
1005         //Log_Debug("VTerm", "j = %i, Buffer = '%s'", j, Buffer);
1006         return j;
1007 }
1008
1009 /**
1010  * \fn void VT_int_PutString(tVTerm *Term, Uint8 *Buffer, Uint Count)
1011  * \brief Print a string to the Virtual Terminal
1012  */
1013 void VT_int_PutString(tVTerm *Term, Uint8 *Buffer, Uint Count)
1014 {
1015         Uint32  val;
1016          int    i;
1017
1018         // Iterate
1019         for( i = 0; i < Count; i++ )
1020         {
1021                 // Handle escape sequences
1022                 if( Buffer[i] == 0x1B )
1023                 {
1024                         i ++;
1025                         i += VT_int_ParseEscape(Term, (char*)&Buffer[i]) - 1;
1026                         continue;
1027                 }
1028
1029                 // Fast check for non UTF-8
1030                 if( Buffer[i] < 128 )   // Plain ASCII
1031                         VT_int_PutChar(Term, Buffer[i]);
1032                 else {  // UTF-8
1033                         i += ReadUTF8(&Buffer[i], &val) - 1;
1034                         VT_int_PutChar(Term, val);
1035                 }
1036         }
1037         // Update Screen
1038         VT_int_UpdateScreen( Term, 0 );
1039
1040         // Update cursor
1041         if( Term == gpVT_CurTerm && !(Term->Flags & VT_FLAG_HIDECSR) )
1042         {
1043                 tVideo_IOCtl_Pos        pos;
1044                 pos.x = (Term->WritePos - Term->ViewPos) % Term->TextWidth;
1045                 pos.y = (Term->WritePos - Term->ViewPos) / Term->TextWidth;
1046                 VFS_IOCtl(giVT_OutputDevHandle, VIDEO_IOCTL_SETCURSOR, &pos);
1047         }
1048 }
1049
1050 /**
1051  * \fn void VT_int_PutChar(tVTerm *Term, Uint32 Ch)
1052  * \brief Write a single character to a VTerm
1053  */
1054 void VT_int_PutChar(tVTerm *Term, Uint32 Ch)
1055 {
1056          int    i;
1057
1058         switch(Ch)
1059         {
1060         case '\0':      return; // Ignore NULL byte
1061         case '\n':
1062                 VT_int_UpdateScreen( Term, 0 ); // Update the line before newlining
1063                 Term->WritePos += Term->TextWidth;
1064         case '\r':
1065                 Term->WritePos -= Term->WritePos % Term->TextWidth;
1066                 break;
1067
1068         case '\t':
1069                 do {
1070                         Term->Text[ Term->WritePos ].Ch = '\0';
1071                         Term->Text[ Term->WritePos ].Colour = Term->CurColour;
1072                         Term->WritePos ++;
1073                 } while(Term->WritePos & 7);
1074                 break;
1075
1076         case '\b':
1077                 // Backspace is invalid at Offset 0
1078                 if(Term->WritePos == 0) break;
1079
1080                 Term->WritePos --;
1081                 // Singe Character
1082                 if(Term->Text[ Term->WritePos ].Ch != '\0') {
1083                         Term->Text[ Term->WritePos ].Ch = 0;
1084                         Term->Text[ Term->WritePos ].Colour = Term->CurColour;
1085                         break;
1086                 }
1087                 // Tab
1088                 i = 7;  // Limit it to 8
1089                 do {
1090                         Term->Text[ Term->WritePos ].Ch = 0;
1091                         Term->Text[ Term->WritePos ].Colour = Term->CurColour;
1092                         Term->WritePos --;
1093                 } while(Term->WritePos && i-- && Term->Text[ Term->WritePos ].Ch == '\0');
1094                 if(Term->Text[ Term->WritePos ].Ch != '\0')
1095                         Term->WritePos ++;
1096                 break;
1097
1098         default:
1099                 Term->Text[ Term->WritePos ].Ch = Ch;
1100                 Term->Text[ Term->WritePos ].Colour = Term->CurColour;
1101                 Term->WritePos ++;
1102                 break;
1103         }
1104
1105         // Move Screen
1106         // - Check if we need to scroll the entire scrollback buffer
1107         if(Term->WritePos >= Term->TextWidth*Term->TextHeight*(giVT_Scrollback+1))
1108         {
1109                  int    base;
1110
1111                 // Move back by one
1112                 Term->WritePos -= Term->TextWidth;
1113                 // Update the scren
1114                 VT_int_UpdateScreen( Term, 0 );
1115
1116                 // Update view position
1117                 base = Term->TextWidth*Term->TextHeight*(giVT_Scrollback);
1118                 if(Term->ViewPos < base)
1119                         Term->ViewPos += Term->Width;
1120                 if(Term->ViewPos > base)
1121                         Term->ViewPos = base;
1122
1123                 // Scroll terminal cache
1124                 base = Term->TextWidth*(Term->TextHeight*(giVT_Scrollback+1)-1);
1125                 memcpy(
1126                         Term->Text,
1127                         &Term->Text[Term->TextWidth],
1128                         base*sizeof(tVT_Char)
1129                         );
1130
1131                 // Clear last row
1132                 for( i = 0; i < Term->TextWidth; i ++ )
1133                 {
1134                         Term->Text[ base + i ].Ch = 0;
1135                         Term->Text[ base + i ].Colour = Term->CurColour;
1136                 }
1137
1138                 VT_int_ScrollFramebuffer( Term );
1139                 VT_int_UpdateScreen( Term, 0 );
1140         }
1141         // Ok, so we only need to scroll the screen
1142         else if(Term->WritePos >= Term->ViewPos + Term->TextWidth*Term->TextHeight)
1143         {
1144                 //Debug("Term->WritePos (%i) >= %i",
1145                 //      Term->WritePos,
1146                 //      Term->ViewPos + Term->Width*Term->Height
1147                 //      );
1148                 //Debug("Scrolling screen only");
1149
1150                 // Update the last line
1151                 Term->WritePos -= Term->TextWidth;
1152                 VT_int_UpdateScreen( Term, 0 );
1153                 Term->WritePos += Term->TextWidth;
1154                 VT_int_ClearLine(Term, Term->WritePos / Term->TextWidth);
1155
1156                 // Scroll
1157                 Term->ViewPos += Term->TextWidth;
1158                 //Debug("Term->ViewPos = %i", Term->ViewPos);
1159                 VT_int_ScrollFramebuffer( Term );
1160                 VT_int_UpdateScreen( Term, 0 );
1161         }
1162
1163         //LEAVE('-');
1164 }
1165
1166 /**
1167  * \fn void VT_int_ScrollFramebuffer( tVTerm *Term )
1168  * \note Scrolls the framebuffer by 1 text line
1169  */
1170 void VT_int_ScrollFramebuffer( tVTerm *Term )
1171 {
1172          int    tmp;
1173         struct {
1174                 Uint8   Op;
1175                 Uint16  DstX, DstY;
1176                 Uint16  SrcX, SrcY;
1177                 Uint16  W, H;
1178         } PACKED        buf;
1179
1180         // Only update if this is the current terminal
1181         if( Term != gpVT_CurTerm )      return;
1182
1183         // Switch to 2D Command Stream
1184         tmp = VIDEO_BUFFMT_2DSTREAM;
1185         VFS_IOCtl(giVT_OutputDevHandle, VIDEO_IOCTL_SETBUFFORMAT, &tmp);
1186
1187         // BLIT from 0,0 to 0,giVT_CharHeight
1188         buf.Op = VIDEO_2DOP_BLIT;
1189         buf.DstX = 0;   buf.DstY = 0;
1190         buf.SrcX = 0;   buf.SrcY = giVT_CharHeight;
1191         buf.W = Term->TextWidth * giVT_CharWidth;
1192         buf.H = (Term->TextHeight-1) * giVT_CharHeight;
1193         VFS_WriteAt(giVT_OutputDevHandle, 0, sizeof(buf), &buf);
1194
1195         // Restore old mode (this function is only called during text mode)
1196         tmp = VIDEO_BUFFMT_TEXT;
1197         VFS_IOCtl(giVT_OutputDevHandle, VIDEO_IOCTL_SETBUFFORMAT, &tmp);
1198 }
1199
1200 /**
1201  * \fn void VT_int_UpdateScreen( tVTerm *Term, int UpdateAll )
1202  * \brief Updates the video framebuffer
1203  */
1204 void VT_int_UpdateScreen( tVTerm *Term, int UpdateAll )
1205 {
1206         // Only update if this is the current terminal
1207         if( Term != gpVT_CurTerm )      return;
1208
1209         switch( Term->Mode )
1210         {
1211         case TERM_MODE_TEXT:
1212                 // Re copy the entire screen?
1213                 if(UpdateAll) {
1214                         VFS_WriteAt(
1215                                 giVT_OutputDevHandle,
1216                                 0,
1217                                 Term->TextWidth*Term->TextHeight*sizeof(tVT_Char),
1218                                 &Term->Text[Term->ViewPos]
1219                                 );
1220                 }
1221                 // Only copy the current line
1222                 else {
1223                          int    pos = Term->WritePos - Term->WritePos % Term->TextWidth;
1224                         VFS_WriteAt(
1225                                 giVT_OutputDevHandle,
1226                                 (pos - Term->ViewPos)*sizeof(tVT_Char),
1227                                 Term->TextWidth*sizeof(tVT_Char),
1228                                 &Term->Text[pos]
1229                                 );
1230                 }
1231                 break;
1232         case TERM_MODE_FB:
1233                 VFS_WriteAt(
1234                         giVT_OutputDevHandle,
1235                         0,
1236                         Term->Width*Term->Height*sizeof(Uint32),
1237                         Term->Buffer
1238                         );
1239                 break;
1240         }
1241 }
1242
1243 /**
1244  * \brief Update the screen mode
1245  * \param Term  Terminal to update
1246  * \param NewMode       New mode to set
1247  * \param NewWidth      New framebuffer width
1248  * \param NewHeight     New framebuffer height
1249  */
1250 void VT_int_ChangeMode(tVTerm *Term, int NewMode, int NewWidth, int NewHeight)
1251 {
1252          int    oldW = Term->Width;
1253          int    oldTW = oldW / giVT_CharWidth;
1254          int    oldH = Term->Height;
1255          int    oldTH = oldH / giVT_CharWidth;
1256         tVT_Char        *oldTBuf = Term->Text;
1257         Uint32  *oldFB = Term->Buffer;
1258          int    w, h, i;
1259
1260         // TODO: Increase RealWidth/RealHeight when this happens
1261         if(NewWidth > giVT_RealWidth)   NewWidth = giVT_RealWidth;
1262         if(NewHeight > giVT_RealHeight) NewHeight = giVT_RealHeight;
1263
1264         // Calculate new dimensions
1265         Term->TextWidth = NewWidth / giVT_CharWidth;
1266         Term->TextHeight = NewHeight / giVT_CharHeight;
1267         Term->Width = NewWidth;
1268         Term->Height = NewHeight;
1269         Term->Mode = NewMode;
1270
1271         // Allocate new buffers
1272         // - Text
1273         Term->Text = calloc(
1274                 Term->TextWidth * Term->TextHeight * (giVT_Scrollback+1),
1275                 sizeof(tVT_Char)
1276                 );
1277         if(oldTBuf) {
1278                 // Copy old buffer
1279                 w = oldTW;
1280                 if( w > Term->TextWidth )       w = Term->TextWidth;
1281                 h = oldTH;
1282                 if( h > Term->TextHeight )      h = Term->TextHeight;
1283                 h *= giVT_Scrollback + 1;
1284                 for( i = 0; i < h; i ++ )
1285                 {
1286                         memcpy(
1287                                 &Term->Text[i*Term->TextWidth],
1288                                 &oldTBuf[i*oldTW],
1289                                 w*sizeof(tVT_Char)
1290                                 );
1291
1292                 }
1293         }
1294
1295         // - Framebuffer
1296         Term->Buffer = calloc( Term->Width * Term->Height, sizeof(Uint32) );
1297         if(oldFB) {
1298                 // Copy old buffer
1299                 w = oldW;
1300                 if( w > Term->Width )   w = Term->Width;
1301                 h = oldH;
1302                 if( h > Term->Height )  h = Term->Height;
1303                 for( i = 0; i < h; i ++ )
1304                 {
1305                         memcpy(
1306                                 &Term->Buffer[i*Term->Width],
1307                                 &oldFB[i*oldW],
1308                                 w*sizeof(Uint32)
1309                                 );
1310                 }
1311         }
1312
1313
1314         // Debug
1315         switch(NewMode)
1316         {
1317         case TERM_MODE_TEXT:
1318                 Log_Log("VTerm", "Set VT %p to text mode (%ix%i)",
1319                         Term, Term->TextWidth, Term->TextHeight);
1320                 break;
1321         case TERM_MODE_FB:
1322                 Log_Log("VTerm", "Set VT %p to framebuffer mode (%ix%i)",
1323                         Term, Term->Width, Term->Height);
1324                 break;
1325         //case TERM_MODE_2DACCEL:
1326         //case TERM_MODE_3DACCEL:
1327         //      return;
1328         }
1329 }
1330
1331 // ---
1332 // Font Render
1333 // ---
1334 #define MONOSPACE_FONT  10816
1335
1336 #if MONOSPACE_FONT == 10808     // 8x8
1337 # include "vterm_font_8x8.h"
1338 #elif MONOSPACE_FONT == 10816   // 8x16
1339 # include "vterm_font_8x16.h"
1340 #endif
1341
1342 // === PROTOTYPES ===
1343 Uint8   *VT_Font_GetChar(Uint32 Codepoint);
1344
1345 // === GLOBALS ===
1346 int     giVT_CharWidth = FONT_WIDTH;
1347 int     giVT_CharHeight = FONT_HEIGHT;
1348
1349 // === CODE ===
1350 /**
1351  * \brief Render a font character
1352  */
1353 void VT_Font_Render(Uint32 Codepoint, void *Buffer, int Depth, int Pitch, Uint32 BGC, Uint32 FGC)
1354 {
1355         Uint8   *font;
1356          int    x, y;
1357
1358         // 8-bpp and below
1359         if( Depth <= 8 )
1360         {
1361                 Uint8   *buf = Buffer;
1362
1363                 font = VT_Font_GetChar(Codepoint);
1364
1365                 for(y = 0; y < FONT_HEIGHT; y ++)
1366                 {
1367                         for(x = 0; x < FONT_WIDTH; x ++)
1368                         {
1369                                 if(*font & (1 << (FONT_WIDTH-x-1)))
1370                                         buf[x] = FGC;
1371                                 else
1372                                         buf[x] = BGC;
1373                         }
1374                         buf = (void*)( (tVAddr)buf + Pitch );
1375                         font ++;
1376                 }
1377         }
1378         // 16-bpp and below
1379         else if( Depth <= 16 )
1380         {
1381                 Uint16  *buf = Buffer;
1382
1383                 font = VT_Font_GetChar(Codepoint);
1384
1385                 for(y = 0; y < FONT_HEIGHT; y ++)
1386                 {
1387                         for(x = 0; x < FONT_WIDTH; x ++)
1388                         {
1389                                 if(*font & (1 << (FONT_WIDTH-x-1)))
1390                                         buf[x] = FGC;
1391                                 else
1392                                         buf[x] = BGC;
1393                         }
1394                         buf = (void*)( (tVAddr)buf + Pitch );
1395                         font ++;
1396                 }
1397         }
1398         // 24-bpp colour
1399         // - Special handling to not overwrite the next pixel
1400         //TODO: Endian issues here
1401         else if( Depth == 24 )
1402         {
1403                 Uint8   *buf = Buffer;
1404                 Uint8   bg_r = (BGC >> 16) & 0xFF;
1405                 Uint8   bg_g = (BGC >>  8) & 0xFF;
1406                 Uint8   bg_b = (BGC >>  0) & 0xFF;
1407                 Uint8   fg_r = (FGC >> 16) & 0xFF;
1408                 Uint8   fg_g = (FGC >>  8) & 0xFF;
1409                 Uint8   fg_b = (FGC >>  0) & 0xFF;
1410
1411                 font = VT_Font_GetChar(Codepoint);
1412
1413                 for(y = 0; y < FONT_HEIGHT; y ++)
1414                 {
1415                         for(x = 0; x < FONT_WIDTH; x ++)
1416                         {
1417                                 Uint8   r, g, b;
1418
1419                                 if(*font & (1 << (FONT_WIDTH-x-1))) {
1420                                         r = fg_r;       g = fg_g;       b = fg_b;
1421                                 }
1422                                 else {
1423                                         r = bg_r;       g = bg_g;       b = bg_b;
1424                                 }
1425                                 buf[x*3+0] = b;
1426                                 buf[x*3+1] = g;
1427                                 buf[x*3+2] = r;
1428                         }
1429                         buf = (void*)( (tVAddr)buf + Pitch );
1430                         font ++;
1431                 }
1432         }
1433         // 32-bpp colour (nice and easy)
1434         else if( Depth == 32 )
1435         {
1436                 Uint32  *buf = Buffer;
1437
1438                 font = VT_Font_GetChar(Codepoint);
1439
1440                 for(y = 0; y < FONT_HEIGHT; y ++)
1441                 {
1442                         for(x = 0; x < FONT_WIDTH; x ++)
1443                         {
1444                                 if(*font & (1 << (FONT_WIDTH-x-1)))
1445                                         buf[x] = FGC;
1446                                 else
1447                                         buf[x] = BGC;
1448                         }
1449                         buf = (Uint32*)( (tVAddr)buf + Pitch );
1450                         font ++;
1451                 }
1452         }
1453 }
1454
1455 /**
1456  * \fn Uint32 VT_Colour12to24(Uint16 Col12)
1457  * \brief Converts a 12-bit colour into 24 bits
1458  */
1459 Uint32 VT_Colour12to24(Uint16 Col12)
1460 {
1461         Uint32  ret;
1462          int    tmp;
1463         tmp = Col12 & 0xF;
1464         ret  = (tmp << 0) | (tmp << 4);
1465         tmp = (Col12 & 0xF0) >> 4;
1466         ret |= (tmp << 8) | (tmp << 12);
1467         tmp = (Col12 & 0xF00) >> 8;
1468         ret |= (tmp << 16) | (tmp << 20);
1469         return ret;
1470 }
1471 /**
1472  * \brief Converts a 12-bit colour into 15 bits
1473  */
1474 Uint16 VT_Colour12to15(Uint16 Col12)
1475 {
1476         Uint32  ret;
1477          int    tmp;
1478         tmp = Col12 & 0xF;
1479         ret  = (tmp << 1) | (tmp & 1);
1480         tmp = (Col12 & 0xF0) >> 4;
1481         ret |= ( (tmp << 1) | (tmp & 1) ) << 5;
1482         tmp = (Col12 & 0xF00) >> 8;
1483         ret |= ( (tmp << 1) | (tmp & 1) ) << 10;
1484         return ret;
1485 }
1486
1487 /**
1488  * \brief Converts a 12-bit colour into any other depth
1489  * \param Col12 12-bit source colour
1490  * \param Depth Desired bit deptj
1491  * \note Green then blue get the extra avaliable bits (16:5-6-5, 14:4-5-5)
1492  */
1493 Uint32 VT_Colour12toN(Uint16 Col12, int Depth)
1494 {
1495         Uint32  ret;
1496         Uint32  r, g, b;
1497          int    rSize, gSize, bSize;
1498
1499         // Fast returns
1500         if( Depth == 24 )       return VT_Colour12to24(Col12);
1501         if( Depth == 15 )       return VT_Colour12to15(Col12);
1502         // - 32 is a special case, it's usually 24-bit colour with an unused byte
1503         if( Depth == 32 )       return VT_Colour12to24(Col12);
1504
1505         // Bounds checks
1506         if( Depth < 8 ) return 0;
1507         if( Depth > 32 )        return 0;
1508
1509         r = Col12 & 0xF;
1510         g = (Col12 & 0xF0) >> 4;
1511         b = (Col12 & 0xF00) >> 8;
1512
1513         rSize = gSize = bSize = Depth / 3;
1514         if( rSize + gSize + bSize < Depth )     // Depth % 3 == 1
1515                 gSize ++;
1516         if( rSize + gSize + bSize < Depth )     // Depth % 3 == 2
1517                 bSize ++;
1518
1519         // Expand
1520         r <<= rSize - 4;        g <<= gSize - 4;        b <<= bSize - 4;
1521         // Fill with the lowest bit
1522         if( Col12 & 0x001 )     r |= (1 << (rSize - 4)) - 1;
1523         if( Col12 & 0x010 )     r |= (1 << (gSize - 4)) - 1;
1524         if( Col12 & 0x100 )     r |= (1 << (bSize - 4)) - 1;
1525
1526         // Create output
1527         ret  = r;
1528         ret |= g << rSize;
1529         ret |= b << (rSize + gSize);
1530
1531         return ret;
1532 }
1533
1534 /**
1535  * \fn Uint8 *VT_Font_GetChar(Uint32 Codepoint)
1536  * \brief Gets an index into the font array given a Unicode Codepoint
1537  * \note See http://en.wikipedia.org/wiki/CP437
1538  */
1539 Uint8 *VT_Font_GetChar(Uint32 Codepoint)
1540 {
1541          int    index = 0;
1542         if(Codepoint < 128)
1543                 return &VTermFont[Codepoint*FONT_HEIGHT];
1544         switch(Codepoint)
1545         {
1546         case 0xC7:      index = 128;    break;  // Ç
1547         case 0xFC:      index = 129;    break;  // ü
1548         case 0xE9:      index = 130;    break;  // é
1549         case 0xE2:      index = 131;    break;  // â
1550         case 0xE4:      index = 132;    break;  // ä
1551         case 0xE0:      index = 133;    break;  // à
1552         case 0xE5:      index = 134;    break;  // å
1553         case 0xE7:      index = 135;    break;  // ç
1554         case 0xEA:      index = 136;    break;  // ê
1555         case 0xEB:      index = 137;    break;  // ë
1556         case 0xE8:      index = 138;    break;  // è
1557         case 0xEF:      index = 139;    break;  // ï
1558         case 0xEE:      index = 140;    break;  // î
1559         case 0xEC:      index = 141;    break;  // ì
1560         case 0xC4:      index = 142;    break;  // Ä
1561         case 0xC5:      index = 143;    break;  // Å
1562         }
1563
1564         return &VTermFont[index*FONT_HEIGHT];
1565 }
1566
1567 EXPORTAS(&giVT_CharWidth, giVT_CharWidth);
1568 EXPORTAS(&giVT_CharHeight, giVT_CharHeight);
1569 EXPORT(VT_Font_Render);
1570 EXPORT(VT_Colour12to24);