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