Kernel/drv/vterm.c

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