Kernel/drv/vterm.c

   1 /*
   2  * Acess2 Virtual Terminal Driver
   3  */
   4 #include <common.h>
   5 #include <fs_devfs.h>
   6 #include <modules.h>
   7 #include <tpl_drv_video.h>
   8 #include <tpl_drv_keyboard.h>
   9 #include <tpl_drv_terminal.h>
  10 #include <errno.h>
  11
  12 // === CONSTANTS ===
  13 #define VERSION ((0<<8)|(50))
  14
  15 #define NUM_VTS 7
  16 #define MAX_INPUT_CHARS32       64
  17 #define MAX_INPUT_CHARS8        (MAX_INPUT_CHARS32*4)
  18 #define VT_SCROLLBACK   1       // 2 Screens of text
  19 #define DEFAULT_OUTPUT  "VGA"
  20 //#define DEFAULT_OUTPUT        "BochsGA"
  21 #define DEFAULT_INPUT   "PS2Keyboard"
  22 #define DEFAULT_WIDTH   80
  23 #define DEFAULT_HEIGHT  25
  24 #define DEFAULT_COLOUR  (VT_COL_BLACK|(0xAAA<<16))
  25
  26 #define VT_FLAG_HIDECSR 0x01
  27
  28 enum eVT_InModes {
  29         VT_INMODE_TEXT8,        // UTF-8 Text Mode (VT100 Emulation)
  30         VT_INMODE_TEXT32,       // UTF-32 Text Mode (Acess Native)
  31         NUM_VT_INMODES
  32 };
  33
  34 // === TYPES ===
  35 typedef struct {
  36          int    Mode;   //!< Current Mode (see ::eTplTerminal_Modes)
  37          int    Flags;  //!< Flags (see VT_FLAG_*)
  38         short   Width;  //!< Virtual Width
  39         short   Height; //!< Virtual Height
  40         short   RealWidth;      //!< Real Width
  41         short   RealHeight;     //!< Real Height
  42
  43          int    ViewPos;        //!< View Buffer Offset (Text Only)
  44          int    WritePos;       //!< Write Buffer Offset (Text Only)
  45         Uint32  CurColour;      //!< Current Text Colour
  46         char    Name[2];        //!< Name of the terminal
  47
  48          int    InputRead;      //!< Input buffer read position
  49          int    InputWrite;     //!< Input buffer write position
  50         char    InputBuffer[MAX_INPUT_CHARS8];
  51         union {
  52                 tVT_Char        *Text;
  53                 Uint32          *Buffer;
  54         };
  55         tVFS_Node       Node;
  56 } tVTerm;
  57
  58 // === PROTOTYPES ===
  59  int    VT_Install(char **Arguments);
  60 char    *VT_ReadDir(tVFS_Node *Node, int Pos);
  61 tVFS_Node       *VT_FindDir(tVFS_Node *Node, char *Name);
  62  int    VT_Root_IOCtl(tVFS_Node *Node, int Id, void *Data);
  63 Uint64  VT_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer);
  64 Uint64  VT_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer);
  65  int    VT_Terminal_IOCtl(tVFS_Node *Node, int Id, void *Data);
  66 void    VT_SetTerminal(int ID);
  67 void    VT_KBCallBack(Uint32 Codepoint);
  68 void    VT_int_PutString(tVTerm *Term, Uint8 *Buffer, Uint Count);
  69  int    VT_int_ParseEscape(tVTerm *Term, char *Buffer);
  70 void    VT_int_PutChar(tVTerm *Term, Uint32 Ch);
  71 void    VT_int_UpdateScreen( tVTerm *Term, int UpdateAll );
  72 void    VT_int_ChangeMode(tVTerm *Term, int NewMode);
  73
  74 // === CONSTANTS ===
  75 const Uint16    caVT100Colours[] = {
  76                 VT_COL_BLACK, 0x700, 0x070, 0x770, 0x007, 0x707, 0x077, 0xAAA,
  77                 VT_COL_GREY, 0xF00, 0x0F0, 0xFF0, 0x00F, 0xF0F, 0x0FF, VT_COL_WHITE
  78         };
  79
  80 // === GLOBALS ===
  81 MODULE_DEFINE(0, VERSION, VTerm, VT_Install, NULL, DEFAULT_OUTPUT, DEFAULT_INPUT, NULL);
  82 tDevFS_Driver   gVT_DrvInfo = {
  83         NULL, "VTerm",
  84         {
  85         .Flags = VFS_FFLAG_DIRECTORY,
  86         .Size = NUM_VTS,
  87         .Inode = -1,
  88         .NumACLs = 0,
  89         .ReadDir = VT_ReadDir,
  90         .FindDir = VT_FindDir,
  91         .IOCtl = VT_Root_IOCtl
  92         }
  93 };
  94 // --- Terminals ---
  95 tVTerm  gVT_Terminals[NUM_VTS];
  96  int    giVT_CurrentTerminal = 0;
  97 // --- Driver Handles ---
  98 char    *gsVT_OutputDevice = NULL;
  99 char    *gsVT_InputDevice = NULL;
 100  int    giVT_OutputDevHandle = -2;
 101  int    giVT_InputDevHandle = -2;
 102 // --- Key States --- (Used for VT Switching/Magic Combos)
 103  int    gbVT_CtrlDown = 0;
 104  int    gbVT_AltDown = 0;
 105  int    gbVT_SysrqDown = 0;
 106
 107 // === CODE ===
 108 /**
 109  * \fn int VT_Install(char **Arguments)
 110  * \brief Installs the Virtual Terminal Driver
 111  */
 112 int VT_Install(char **Arguments)
 113 {
 114         char    **args = Arguments;
 115         char    *arg;
 116          int    i;
 117
 118         // Scan Arguments
 119         if(Arguments)
 120         {
 121                 for( ; (arg = *args); args++ )
 122                 {
 123                         if(arg[0] != '-')       continue;
 124
 125                         switch(arg[1])
 126                         {
 127                         // Set output device
 128                         case 'o':
 129                                 if(args[1] ==  NULL)    break;
 130                                 if(gsVT_OutputDevice)   free(gsVT_OutputDevice);
 131                                 gsVT_OutputDevice = malloc(strlen(args[1])+1);
 132                                 strcpy(gsVT_OutputDevice, args[1]);
 133                                 args ++;
 134                                 break;
 135
 136                         // Set input device
 137                         case 'i':
 138                                 if(args[1] == NULL)     break;
 139                                 if(gsVT_InputDevice)    free(gsVT_InputDevice);
 140                                 gsVT_InputDevice = malloc(strlen(args[1])+1);
 141                                 strcpy(gsVT_InputDevice, args[1]);
 142                                 args ++;
 143                                 break;
 144
 145                         }
 146                 }
 147         }
 148
 149         // Apply Defaults
 150         if(!gsVT_OutputDevice)  gsVT_OutputDevice = "/Devices/"DEFAULT_OUTPUT;
 151         if(!gsVT_InputDevice)   gsVT_InputDevice = "/Devices/"DEFAULT_INPUT;
 152
 153         LOG("Using '%s' as output", gsVT_OutputDevice);
 154         LOG("Using '%s' as input", gsVT_InputDevice);
 155
 156         // Create Nodes
 157         for( i = 0; i < NUM_VTS; i++ )
 158         {
 159                 gVT_Terminals[i].Mode = TERM_MODE_TEXT;
 160                 gVT_Terminals[i].Flags = 0;
 161                 gVT_Terminals[i].Width = DEFAULT_WIDTH;
 162                 gVT_Terminals[i].Height = DEFAULT_HEIGHT;
 163                 gVT_Terminals[i].CurColour = DEFAULT_COLOUR;
 164                 gVT_Terminals[i].WritePos = 0;
 165                 gVT_Terminals[i].ViewPos = 0;
 166
 167                 gVT_Terminals[i].Buffer = calloc( DEFAULT_WIDTH*DEFAULT_HEIGHT*VT_SCROLLBACK, sizeof(tVT_Char) );
 168
 169                 gVT_Terminals[i].Name[0] = '0'+i;
 170                 gVT_Terminals[i].Name[1] = '\0';
 171                 gVT_Terminals[i].Node.Inode = i;
 172                 gVT_Terminals[i].Node.ImplPtr = &gVT_Terminals[i];
 173                 gVT_Terminals[i].Node.NumACLs = 0;      // Only root can open virtual terminals
 174
 175                 gVT_Terminals[i].Node.Read = VT_Read;
 176                 gVT_Terminals[i].Node.Write = VT_Write;
 177                 gVT_Terminals[i].Node.IOCtl = VT_Terminal_IOCtl;
 178         }
 179
 180         // Add to DevFS
 181         DevFS_AddDevice( &gVT_DrvInfo );
 182
 183         return 0;
 184 }
 185
 186 /**
 187  * \fn void VT_InitOutput()
 188  * \brief Initialise Video Output
 189  */
 190 void VT_InitOutput()
 191 {
 192         giVT_OutputDevHandle = VFS_Open(gsVT_OutputDevice, VFS_OPENFLAG_WRITE);
 193         LOG("giVT_OutputDevHandle = %x\n", giVT_OutputDevHandle);
 194         VT_SetTerminal( 0 );
 195 }
 196
 197 /**
 198  * \fn void VT_InitInput()
 199  * \brief Initialises the input
 200  */
 201 void VT_InitInput()
 202 {
 203         giVT_InputDevHandle = VFS_Open(gsVT_InputDevice, VFS_OPENFLAG_READ);
 204         LOG("giVT_InputDevHandle = %x\n", giVT_InputDevHandle);
 205         if(giVT_InputDevHandle == -1)   return ;
 206         VFS_IOCtl(giVT_InputDevHandle, KB_IOCTL_SETCALLBACK, VT_KBCallBack);
 207 }
 208
 209 /**
 210  * \fn char *VT_ReadDir(tVFS_Node *Node, int Pos)
 211  * \brief Read from the VTerm Directory
 212  */
 213 char *VT_ReadDir(tVFS_Node *Node, int Pos)
 214 {
 215         if(Pos < 0)     return NULL;
 216         if(Pos >= NUM_VTS)      return NULL;
 217         return strdup( gVT_Terminals[Pos].Name );
 218 }
 219
 220 /**
 221  * \fn tVFS_Node *VT_FindDir(tVFS_Node *Node, char *Name)
 222  * \brief Find an item in the VTerm directory
 223  */
 224 tVFS_Node *VT_FindDir(tVFS_Node *Node, char *Name)
 225 {
 226          int    num;
 227
 228         //ENTER("pNode sName", Node, Name);
 229
 230         // Open the input and output files if needed
 231         if(giVT_OutputDevHandle == -2)  VT_InitOutput();
 232         if(giVT_InputDevHandle == -2)   VT_InitInput();
 233
 234         // Sanity check name
 235         if(Name[0] < '0' || Name[0] > '9' || Name[1] != '\0') {
 236                 LEAVE('n');
 237                 return NULL;
 238         }
 239         // Get index
 240         num = Name[0] - '0';
 241         if(num >= NUM_VTS) {
 242                 LEAVE('n');
 243                 return NULL;
 244         }
 245         // Return node
 246         //LEAVE('p', &gVT_Terminals[num].Node);
 247         return &gVT_Terminals[num].Node;
 248 }
 249
 250 /**
 251  * \fn int VT_Root_IOCtl(tVFS_Node *Node, int Id, void *Data)
 252  * \brief Control the VTerm Driver
 253  */
 254 int VT_Root_IOCtl(tVFS_Node *Node, int Id, void *Data)
 255 {
 256          int    len;
 257         switch(Id)
 258         {
 259         case DRV_IOCTL_TYPE:    return DRV_TYPE_MISC;
 260         case DRV_IOCTL_IDENT:   memcpy(Data, "VT\0\0", 4);      return 0;
 261         case DRV_IOCTL_VERSION: return VERSION;
 262         case DRV_IOCTL_LOOKUP:  return 0;
 263
 264         case 4: // Get Video Driver
 265                 if(Data)        strcpy(Data, gsVT_OutputDevice);
 266                 return strlen(gsVT_OutputDevice);
 267
 268         case 5: // Set Video Driver
 269                 if(!Data)       return -EINVAL;
 270                 if(Threads_GetUID() != 0)       return -EACCES;
 271
 272                 len = strlen(Data);
 273
 274                 free(gsVT_OutputDevice);
 275
 276                 gsVT_OutputDevice = malloc(len+1);
 277                 strcpy(gsVT_OutputDevice, Data);
 278
 279                 VFS_Close(giVT_OutputDevHandle);
 280                 giVT_OutputDevHandle = -1;
 281
 282                 VT_InitOutput();
 283                 return 1;
 284         }
 285         return 0;
 286 }
 287
 288 /**
 289  * \fn Uint64 VT_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
 290  * \brief Read from a virtual terminal
 291  */
 292 Uint64 VT_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
 293 {
 294          int    pos = 0;
 295         tVTerm  *term = &gVT_Terminals[ Node->Inode ];
 296
 297         // Check current mode
 298         switch(term->Mode)
 299         {
 300         case TERM_MODE_TEXT:
 301                 while(pos < Length)
 302                 {
 303                         while(term->InputRead == term->InputWrite)      Threads_Yield();
 304
 305                         ((char*)Buffer)[pos] = term->InputBuffer[term->InputRead];
 306                         pos ++;
 307                         term->InputRead ++;
 308                         term->InputRead %= MAX_INPUT_CHARS8;
 309                 }
 310                 break;
 311
 312         case TERM_MODE_FB:
 313         case TERM_MODE_OPENGL:
 314                 while(pos < Length)
 315                 {
 316                         while(term->InputRead == term->InputWrite)      Threads_Yield();
 317                         ((Uint32*)Buffer)[pos] = ((Uint32*)term->InputBuffer)[term->InputRead];
 318                         pos ++;
 319                         term->InputRead ++;
 320                         term->InputRead %= MAX_INPUT_CHARS32;
 321                 }
 322                 break;
 323         }
 324         return 0;
 325 }
 326
 327 /**
 328  * \fn Uint64 VT_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
 329  * \brief Write to a virtual terminal
 330  */
 331 Uint64 VT_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
 332 {
 333         tVTerm  *term = &gVT_Terminals[ Node->Inode ];
 334
 335         //ENTER("pNode XOffset XLength pBuffer",  Node, Offset, Length, Buffer);
 336
 337         // Write
 338         switch( term->Mode )
 339         {
 340         case TERM_MODE_TEXT:
 341                 VT_int_PutString(term, Buffer, Length);
 342                 break;
 343         }
 344
 345         //LEAVE('i', 0);
 346         return 0;
 347 }
 348
 349 /**
 350  * \fn int VT_Terminal_IOCtl(tVFS_Node *Node, int Id, void *Data)
 351  * \brief Call an IO Control on a virtual terminal
 352  */
 353 int VT_Terminal_IOCtl(tVFS_Node *Node, int Id, void *Data)
 354 {
 355          int    *iData = Data;
 356         tVTerm  *term = Node->ImplPtr;
 357         switch(Id)
 358         {
 359         case DRV_IOCTL_TYPE:    return DRV_TYPE_TERMINAL;
 360         case DRV_IOCTL_IDENT:   memcpy(Data, "VT\0\0", 4);      return 0;
 361         case DRV_IOCTL_VERSION: return VERSION;
 362         case DRV_IOCTL_LOOKUP:  return 0;
 363
 364         // Get/Set the mode (and apply any changes)
 365         case TERM_IOCTL_MODETYPE:
 366                 if(Data == NULL)        return term->Mode;
 367
 368                 if(term->Mode != *iData) {
 369                         VT_int_ChangeMode(term, *iData);
 370                 }
 371
 372                 // Update the screen dimensions
 373                 if(giVT_CurrentTerminal == Node->Inode)
 374                         VT_SetTerminal( giVT_CurrentTerminal );
 375                 break;
 376
 377         // Get/set the terminal width
 378         case TERM_IOCTL_WIDTH:
 379                 if(Data == NULL)        return term->Width;
 380                 term->Width = *iData;
 381                 break;
 382
 383         // Get/set the terminal height
 384         case TERM_IOCTL_HEIGHT:
 385                 if(Data == NULL)        return term->Height;
 386                 term->Height = *iData;
 387                 break;
 388
 389         default:
 390                 return -1;
 391         }
 392         return 0;
 393 }
 394
 395 /**
 396  * \fn void VT_SetTerminal(int ID)
 397  * \brief Set the current terminal
 398  */
 399 void VT_SetTerminal(int ID)
 400 {
 401         tVideo_IOCtl_Mode       mode = {0};
 402          int    modeNum;
 403
 404         // Create the video mode
 405         mode.width = gVT_Terminals[ ID ].Width;
 406         mode.height = gVT_Terminals[ ID ].Height;
 407         // - Text Mode
 408         if(gVT_Terminals[ ID ].Mode == TERM_MODE_TEXT) {
 409                 mode.bpp = 12;
 410                 mode.flags = VIDEO_FLAG_TEXT;
 411         }
 412         // - Framebuffer or 3D
 413         else {
 414                 mode.bpp = 32;
 415                 mode.flags = 0;
 416         }
 417
 418         // Set video mode
 419         VFS_IOCtl( giVT_OutputDevHandle, VIDEO_IOCTL_FINDMODE, &mode );
 420         modeNum = mode.id;
 421         gVT_Terminals[ ID ].RealWidth = mode.width;
 422         gVT_Terminals[ ID ].RealHeight = mode.height;
 423         VFS_IOCtl( giVT_OutputDevHandle, VIDEO_IOCTL_SETMODE, &modeNum );
 424
 425         // Update current terminal ID
 426         Log("Changed terminal from %i to %i", giVT_CurrentTerminal, ID);
 427         giVT_CurrentTerminal = ID;
 428
 429         // Update the screen
 430         VT_int_UpdateScreen( &gVT_Terminals[ ID ], 1 );
 431 }
 432
 433 /**
 434  * \fn void VT_KBCallBack(Uint32 Codepoint)
 435  * \brief Called on keyboard interrupt
 436  */
 437 void VT_KBCallBack(Uint32 Codepoint)
 438 {
 439         tVTerm  *term = &gVT_Terminals[giVT_CurrentTerminal];
 440
 441         // How the hell did we get a Codepoint of zero?
 442         if(Codepoint == 0)      return;
 443
 444         // Key Up
 445         if( Codepoint & 0x80000000 )
 446         {
 447                 Codepoint &= 0x7FFFFFFF;
 448                 switch(Codepoint)
 449                 {
 450                 case KEY_LALT:
 451                 case KEY_RALT:
 452                         gbVT_AltDown = 0;
 453                         break;
 454                 case KEY_LCTRL:
 455                 case KEY_RCTRL:
 456                         gbVT_CtrlDown = 0;
 457                         break;
 458                 }
 459                 return;
 460         }
 461
 462         switch(Codepoint)
 463         {
 464         case KEY_LALT:
 465         case KEY_RALT:
 466                 gbVT_AltDown = 1;
 467                 break;
 468         case KEY_LCTRL:
 469         case KEY_RCTRL:
 470                 gbVT_CtrlDown = 1;
 471                 break;
 472
 473         default:
 474                 if(!gbVT_AltDown || !gbVT_CtrlDown)
 475                         break;
 476                 switch(Codepoint)
 477                 {
 478                 case KEY_F1:    VT_SetTerminal(0);      return;
 479                 case KEY_F2:    VT_SetTerminal(1);      return;
 480                 case KEY_F3:    VT_SetTerminal(2);      return;
 481                 case KEY_F4:    VT_SetTerminal(3);      return;
 482                 case KEY_F5:    VT_SetTerminal(4);      return;
 483                 case KEY_F6:    VT_SetTerminal(5);      return;
 484                 case KEY_F7:    VT_SetTerminal(6);      return;
 485                 case KEY_F8:    VT_SetTerminal(7);      return;
 486                 case KEY_F9:    VT_SetTerminal(8);      return;
 487                 case KEY_F10:   VT_SetTerminal(9);      return;
 488                 case KEY_F11:   VT_SetTerminal(10);     return;
 489                 case KEY_F12:   VT_SetTerminal(11);     return;
 490                 }
 491         }
 492
 493         // Encode key
 494         if(term->Mode == TERM_MODE_TEXT)
 495         {
 496                 Uint8   buf[6] = {0};
 497                  int    len;
 498
 499                 // Ignore Modifer Keys
 500                 if(Codepoint > KEY_MODIFIERS)   return;
 501
 502                 // Get UTF-8/ANSI Encoding
 503                 switch(Codepoint)
 504                 {
 505                 case KEY_LEFT:
 506                         buf[0] = '\x1B';        buf[1] = '[';
 507                         buf[2] = 'D';   len = 3;
 508                         break;
 509                 case KEY_RIGHT:
 510                         buf[0] = '\x1B';        buf[1] = '[';
 511                         buf[2] = 'C';   len = 3;
 512                         break;
 513                 default:
 514                         len = WriteUTF8( buf, Codepoint );
 515                         //Log("Codepoint = 0x%x", Codepoint);
 516                         break;
 517                 }
 518
 519                 //Log("len = %i, buf = %s", len, buf);
 520
 521                 // Write
 522                 if( MAX_INPUT_CHARS8 - term->InputWrite >= len )
 523                         memcpy( &term->InputBuffer[term->InputWrite], buf, len );
 524                 else {
 525                         memcpy( &term->InputBuffer[term->InputWrite], buf, MAX_INPUT_CHARS8 - term->InputWrite );
 526                         memcpy( &term->InputBuffer[0], buf, len - (MAX_INPUT_CHARS8 - term->InputWrite) );
 527                 }
 528                 // Roll the buffer over
 529                 term->InputWrite += len;
 530                 term->InputWrite %= MAX_INPUT_CHARS8;
 531                 if( (term->InputWrite - term->InputRead + MAX_INPUT_CHARS8)%MAX_INPUT_CHARS8 < len ) {
 532                         term->InputRead = term->InputWrite + 1;
 533                         term->InputRead %= MAX_INPUT_CHARS8;
 534                 }
 535
 536         }
 537         else
 538         {
 539                 // Encode the raw UTF-32 Key
 540                 ((Uint32*)term->InputBuffer)[ term->InputWrite ] = Codepoint;
 541                 term->InputWrite ++;
 542                 term->InputWrite %= MAX_INPUT_CHARS32;
 543                 if(term->InputRead == term->InputWrite) {
 544                         term->InputRead ++;
 545                         term->InputRead %= MAX_INPUT_CHARS32;
 546                 }
 547         }
 548 }
 549
 550 /**
 551  * \fn void VT_int_PutString(tVTerm *Term, Uint8 *Buffer, Uint Count)
 552  * \brief Print a string to the Virtual Terminal
 553  */
 554 void VT_int_PutString(tVTerm *Term, Uint8 *Buffer, Uint Count)
 555 {
 556         Uint32  val;
 557          int    i;
 558         for( i = 0; i < Count; i++ )
 559         {
 560                 if( Buffer[i] == 0x1B ) // Escape Sequence
 561                 {
 562                         i ++;
 563                         i += VT_int_ParseEscape(Term, (char*)&Buffer[i]);
 564                         continue;
 565                 }
 566
 567                 if( Buffer[i] < 128 )   // Plain ASCII
 568                         VT_int_PutChar(Term, Buffer[i]);
 569                 else {  // UTF-8
 570                         i += ReadUTF8(&Buffer[i], &val);
 571                         VT_int_PutChar(Term, val);
 572                 }
 573         }
 574
 575         // Update cursor
 576         if( !(Term->Flags & VT_FLAG_HIDECSR) )
 577         {
 578                 tVideo_IOCtl_Pos        pos;
 579                 pos.x = Term->WritePos % Term->Width;
 580                 pos.y = Term->WritePos / Term->Width;
 581                 VFS_IOCtl(giVT_OutputDevHandle, VIDEO_IOCTL_SETCURSOR, &pos);
 582         }
 583 }
 584
 585 /**
 586  * \fn void VT_int_ClearLine(tVTerm *Term, int Num)
 587  * \brief Clears a line in a virtual terminal
 588  */
 589 void VT_int_ClearLine(tVTerm *Term, int Num)
 590 {
 591          int    i;
 592         //ENTER("pTerm iNum", Term, Num);
 593         for( i = Term->Width; i--; )
 594         {
 595                 Term->Text[ Num*Term->Width + i ].Ch = 0;
 596                 Term->Text[ Num*Term->Width + i ].Colour = Term->CurColour;
 597         }
 598         //LEAVE('-');
 599 }
 600
 601 /**
 602  * \fn int VT_int_ParseEscape(tVTerm *Term, char *Buffer)
 603  * \brief Parses a VT100 Escape code
 604  */
 605 int VT_int_ParseEscape(tVTerm *Term, char *Buffer)
 606 {
 607         char    c;
 608          int    argc = 0, j = 1;
 609          int    tmp;
 610          int    args[4] = {0,0,0,0};
 611
 612         switch(Buffer[0]) {
 613         //Large Code
 614         case '[':
 615                 // Get Arguments
 616                 c = Buffer[1];
 617                 do {
 618                         while('0' <= c && c <= '9') {
 619                                 args[argc] *= 10;
 620                                 args[argc] += c-'0';
 621                                 c = Buffer[++j];
 622                         }
 623                         if( j != 1 )    argc ++;
 624                 } while(c == ';');
 625
 626                 // Get string (what does this do?)
 627                 if(c == '"') {
 628                         c = Buffer[++j];
 629                         while(c != '"')
 630                                 c = Buffer[++j];
 631                 }
 632
 633                 // Get Command
 634                 if(     ('a' <= c && c <= 'z') || ('A' <= c && c <= 'Z'))
 635                 {
 636                         switch(c)
 637                         {
 638                         // Left
 639                         case 'D':
 640                                 if(argc == 1)   tmp = args[0];
 641                                 else    tmp = 1;
 642
 643                                 if( Term->WritePos-(tmp-1) % Term->Width == 0 )
 644                                         Term->WritePos -= Term->WritePos % Term->Width;
 645                                 else
 646                                         Term->WritePos -= tmp;
 647                                 break;
 648
 649                         // Right
 650                         case 'C':
 651                                 if(argc == 1)   tmp = args[0];
 652                                 else    tmp = 1;
 653                                 if( (Term->WritePos + tmp) % Term->Width == 0 ) {
 654                                         Term->WritePos -= Term->WritePos % Term->Width;
 655                                         Term->WritePos += Term->Width - 1;
 656                                 } else
 657                                         Term->WritePos += tmp;
 658                                 break;
 659
 660                         // Clear By Line
 661                         case 'J':
 662                                 // Clear Screen
 663                                 switch(args[0])
 664                                 {
 665                                 case 2:
 666                                         {
 667                                          int    i = Term->Height * VT_SCROLLBACK;
 668                                         while( i-- )    VT_int_ClearLine(Term, i);
 669                                         Term->WritePos = 0;
 670                                         Term->ViewPos = 0;
 671                                         VT_int_UpdateScreen(Term, 1);
 672                                         }
 673                                         break;
 674                                 }
 675                                 break;
 676                         // Set Font flags
 677                         case 'm':
 678                                 for( ; argc--; )
 679                                 {
 680                                         // Flags
 681                                         if( 0 <= args[argc] && args[argc] <= 8)
 682                                         {
 683                                                 switch(args[argc])
 684                                                 {
 685                                                 case 0: Term->CurColour = DEFAULT_COLOUR;       break;  // Reset
 686                                                 case 1: Term->CurColour |= 0x80000000;  break;  // Bright
 687                                                 case 2: Term->CurColour &= ~0x80000000; break;  // Dim
 688                                                 }
 689                                         }
 690                                         // Foreground Colour
 691                                         else if(30 <= args[argc] && args[argc] <= 37) {
 692                                                 Term->CurColour &= 0xF000FFFF;
 693                                                 Term->CurColour |= (Uint32)caVT100Colours[ args[argc]-30+(Term->CurColour>>28) ] << 16;
 694                                         }
 695                                         // Background Colour
 696                                         else if(40 <= args[argc] && args[argc] <= 47) {
 697                                                 Term->CurColour &= 0xFFFF8000;
 698                                                 Term->CurColour |= caVT100Colours[ args[argc]-40+((Term->CurColour>>12)&15) ];
 699                                         }
 700                                 }
 701                                 break;
 702                         }
 703                 }
 704                 break;
 705
 706         default:
 707                 break;
 708         }
 709
 710         return j + 1;
 711 }
 712
 713 /**
 714  * \fn void VT_int_PutChar(tVTerm *Term, Uint32 Ch)
 715  * \brief Write a single character to a VTerm
 716  */
 717 void VT_int_PutChar(tVTerm *Term, Uint32 Ch)
 718 {
 719          int    i;
 720         //ENTER("pTerm xCh", Term, Ch);
 721         //LOG("Term = {WritePos:%i, ViewPos:%i}\n", Term->WritePos, Term->ViewPos);
 722
 723         switch(Ch)
 724         {
 725         case '\0':      return; // Ignore NULL byte
 726         case '\n':
 727                 Term->WritePos += Term->Width;
 728         case '\r':
 729                 Term->WritePos -= Term->WritePos % Term->Width;
 730                 break;
 731
 732         case '\t':
 733                 do {
 734                         Term->Text[ Term->WritePos ].Ch = '\0';
 735                         Term->Text[ Term->WritePos ].Colour = Term->CurColour;
 736                         Term->WritePos ++;
 737                 } while(Term->WritePos & 7);
 738                 break;
 739
 740         case '\b':
 741                 // Backspace is invalid at Offset 0
 742                 if(Term->WritePos == 0) break;
 743
 744                 Term->WritePos --;
 745                 // Singe Character
 746                 if(Term->Text[ Term->WritePos ].Ch != '\0') {
 747                         Term->Text[ Term->WritePos ].Ch = 0;
 748                         Term->Text[ Term->WritePos ].Colour = Term->CurColour;
 749                         break;
 750                 }
 751                 // Tab
 752                 i = 7;  // Limit it to 8
 753                 do {
 754                         Term->Text[ Term->WritePos ].Ch = 0;
 755                         Term->Text[ Term->WritePos ].Colour = Term->CurColour;
 756                         Term->WritePos --;
 757                 } while(Term->WritePos && i-- && Term->Text[ Term->WritePos ].Ch == '\0');
 758                 if(Term->Text[ Term->WritePos ].Ch != '\0')
 759                         Term->WritePos ++;
 760                 break;
 761
 762         default:
 763                 Term->Text[ Term->WritePos ].Ch = Ch;
 764                 Term->Text[ Term->WritePos ].Colour = Term->CurColour;
 765                 Term->WritePos ++;
 766                 break;
 767         }
 768
 769
 770         // Move Screen
 771         if(Term->WritePos >= Term->Width*Term->Height*VT_SCROLLBACK)
 772         {
 773                  int    base, i;
 774                 Term->WritePos -= Term->Width;
 775
 776                 // Update view position
 777                 base = Term->Width*Term->Height*(VT_SCROLLBACK-1);
 778                 if(Term->ViewPos < base)        Term->ViewPos += Term->Width;
 779                 if(Term->ViewPos > base)        Term->ViewPos = base;
 780
 781                 // Scroll terminal cache
 782                 base = Term->Width*(Term->Height*VT_SCROLLBACK-1);
 783
 784                 // Scroll Back
 785                 memcpy(
 786                         Term->Text,
 787                         &Term->Text[Term->Width],
 788                         Term->Width*(Term->Height-1)*VT_SCROLLBACK*sizeof(tVT_Char)
 789                         );
 790
 791                 // Clear last row
 792                 for( i = 0; i < Term->Width; i ++ )
 793                 {
 794                         Term->Text[ base + i ].Ch = 0;
 795                         Term->Text[ base + i ].Colour = Term->CurColour;
 796                 }
 797
 798                 VT_int_UpdateScreen( Term, 1 );
 799         }
 800         else if(Term->WritePos > Term->Width*Term->Height+Term->ViewPos)
 801         {
 802                 Term->ViewPos += Term->Width;
 803                 VT_int_UpdateScreen( Term, 1 );
 804         }
 805         else
 806                 VT_int_UpdateScreen( Term, 0 );
 807
 808         //LEAVE('-');
 809 }
 810
 811 /**
 812  * \fn void VT_int_UpdateScreen( tVTerm *Term, int UpdateAll )
 813  * \brief Updates the video framebuffer
 814  */
 815 void VT_int_UpdateScreen( tVTerm *Term, int UpdateAll )
 816 {
 817         // Only update if this is the current terminal
 818         if( Term != &gVT_Terminals[giVT_CurrentTerminal] )      return;
 819
 820         if( Term->Mode == TERM_MODE_TEXT )
 821         {
 822                 if(UpdateAll) {
 823                         VFS_WriteAt(
 824                                 giVT_OutputDevHandle,
 825                                 0,
 826                                 Term->Width*Term->Height*sizeof(tVT_Char),
 827                                 &Term->Text[Term->ViewPos]
 828                                 );
 829                 } else {
 830                          int    pos = Term->WritePos - Term->WritePos % Term->Width;
 831                         VFS_WriteAt(
 832                                 giVT_OutputDevHandle,
 833                                 (pos - Term->ViewPos)*sizeof(tVT_Char),
 834                                 Term->Width*sizeof(tVT_Char),
 835                                 &Term->Text[pos]
 836                                 );
 837                 }
 838         }
 839         else
 840         {
 841                 VFS_WriteAt(
 842                         giVT_OutputDevHandle,
 843                         0,
 844                         Term->Width*Term->Height*sizeof(Uint32),
 845                         &Term->Buffer
 846                         );
 847         }
 848 }
 849
 850 /**
 851  * \fn void VT_int_ChangeMode(tVTerm *Term, int NewMode)
 852  * \brief Change the mode of a VTerm
 853  */
 854 void VT_int_ChangeMode(tVTerm *Term, int NewMode)
 855 {
 856         switch(NewMode)
 857         {
 858         case TERM_MODE_TEXT:
 859                 free(Term->Buffer);
 860                 Term->Text = calloc( Term->Width*Term->Height*VT_SCROLLBACK, sizeof(tVT_Char) );
 861                 break;
 862         case TERM_MODE_FB:
 863                 free(Term->Text);
 864                 Term->Buffer = calloc( Term->Width*Term->Height, sizeof(Uint32) );
 865                 break;
 866         case TERM_MODE_OPENGL:
 867                 return;
 868         }
 869
 870         Term->Mode = NewMode;
 871 }
 872
 873 // ---
 874 // Font Render
 875 // ---
 876 #define MONOSPACE_FONT  10816
 877
 878 #if MONOSPACE_FONT == 10808     // 8x8
 879 # include "vterm_font_8x8.h"
 880 #elif MONOSPACE_FONT == 10816   // 8x16
 881 # include "vterm_font_8x16.h"
 882 #endif
 883
 884 // === PROTOTYPES ===
 885 Uint8   *VT_Font_GetChar(Uint32 Codepoint);
 886
 887 // === GLOBALS ===
 888 int     giVT_CharWidth = FONT_WIDTH;
 889 int     giVT_CharHeight = FONT_HEIGHT;
 890
 891 // === CODE ===
 892 /**
 893  * \fn void VT_Font_Render(Uint32 Codepoint, void *Buffer, int Pitch, Uint32 BGC, Uint32 FGC)
 894  * \brief Render a font character
 895  */
 896 void VT_Font_Render(Uint32 Codepoint, void *Buffer, int Pitch, Uint32 BGC, Uint32 FGC)
 897 {
 898         Uint8   *font;
 899         Uint32  *buf = Buffer;
 900          int    x, y;
 901         font = VT_Font_GetChar(Codepoint);
 902
 903         for(y = 0; y < FONT_HEIGHT; y ++)
 904         {
 905                 for(x = 0; x < FONT_WIDTH; x ++)
 906                 {
 907                         if(*font & (1 << (FONT_WIDTH-x)))
 908                                 buf[x] = FGC;
 909                         else
 910                                 buf[x] = BGC;
 911                 }
 912                 buf += Pitch;
 913                 font ++;
 914         }
 915 }
 916
 917 /**
 918  * \fn Uint32 VT_Colour12to24(Uint16 Col12)
 919  * \brief Converts a
 920  */
 921 Uint32 VT_Colour12to24(Uint16 Col12)
 922 {
 923         Uint32  ret;
 924          int    tmp;
 925         tmp = Col12 & 0xF;
 926         ret  = (tmp << 0) | (tmp << 4);
 927         tmp = (Col12 & 0xF0) >> 4;
 928         ret |= (tmp << 8) | (tmp << 12);
 929         tmp = (Col12 & 0xF00) >> 8;
 930         ret |= (tmp << 16) | (tmp << 20);
 931         return ret;
 932 }
 933
 934 /**
 935  * \fn Uint8 *VT_Font_GetChar(Uint32 Codepoint)
 936  * \brief Gets an index into the font array given a Unicode Codepoint
 937  * \note See http://en.wikipedia.org/wiki/CP437
 938  */
 939 Uint8 *VT_Font_GetChar(Uint32 Codepoint)
 940 {
 941          int    index = 0;
 942         if(Codepoint < 128)
 943                 return &VTermFont[Codepoint*FONT_HEIGHT];
 944         switch(Codepoint)
 945         {
 946         case 0xC7:      index = 128;    break;  // Ç
 947         case 0xFC:      index = 129;    break;  // ü
 948         case 0xE9:      index = 130;    break;  // é
 949         case 0xE2:      index = 131;    break;  // â
 950         case 0xE4:      index = 132;    break;  // ä
 951         case 0xE0:      index = 133;    break;  // à
 952         case 0xE5:      index = 134;    break;  // å
 953         case 0xE7:      index = 135;    break;  // ç
 954         case 0xEA:      index = 136;    break;  // ê
 955         case 0xEB:      index = 137;    break;  // ë
 956         case 0xE8:      index = 138;    break;  // è
 957         case 0xEF:      index = 139;    break;  // ï
 958         case 0xEE:      index = 140;    break;  // î
 959         case 0xEC:      index = 141;    break;  // ì
 960         case 0xC4:      index = 142;    break;  // Ä
 961         case 0xC5:      index = 143;    break;  // Å
 962         }
 963
 964         return &VTermFont[index*FONT_HEIGHT];
 965 }
 966
 967 EXPORTAS(&giVT_CharWidth, giVT_CharWidth);
 968 EXPORTAS(&giVT_CharHeight, giVT_CharHeight);
 969 EXPORT(VT_Font_Render);
 970 EXPORT(VT_Colour12to24);