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