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