KernelLand/Kernel/drv/vterm_vt100.c

   1 /*
   2  * Acess2 Kernel
   3  * - By John Hodge (thePowersGang)
   4  *
   5  * drv/vterm_vt100.c
   6  * - Virtual Terminal - VT100 (Kinda) Emulation
   7  */
   8 #include "vterm.h"
   9
  10 // === CONSTANTS ===
  11 const Uint16    caVT100Colours[] = {
  12                 // Black, Red, Green, Yellow, Blue, Purple, Cyan, Gray
  13                 // Same again, but bright
  14                 VT_COL_BLACK, 0x700, 0x070, 0x770, 0x007, 0x707, 0x077, 0xAAA,
  15                 VT_COL_GREY, 0xF00, 0x0F0, 0xFF0, 0x00F, 0xF0F, 0x0FF, VT_COL_WHITE
  16         };
  17
  18 // === CODE ===
  19 /**
  20  * \brief Handle a standard large escape code
  21  *
  22  * Handles any escape code of the form \x1B[n,...A where n is an integer
  23  * and A is any letter.
  24  */
  25 void VT_int_ParseEscape_StandardLarge(tVTerm *Term, char CmdChar, int argc, int *args)
  26 {
  27          int    tmp = 1;
  28         switch(CmdChar)
  29         {
  30         // Left
  31         case 'D':
  32                 tmp = -1;
  33         // Right
  34         case 'C':
  35                 if(argc == 1)   tmp *= args[0];
  36                 if( Term->Flags & VT_FLAG_ALTBUF )
  37                 {
  38                         if( (Term->AltWritePos + tmp) % Term->TextWidth == 0 ) {
  39                                 Term->AltWritePos -= Term->AltWritePos % Term->TextWidth;
  40                                 Term->AltWritePos += Term->TextWidth - 1;
  41                         }
  42                         else
  43                                 Term->AltWritePos += tmp;
  44                 }
  45                 else
  46                 {
  47                         if( (Term->WritePos + tmp) % Term->TextWidth == 0 ) {
  48                                 Term->WritePos -= Term->WritePos % Term->TextWidth;
  49                                 Term->WritePos += Term->TextWidth - 1;
  50                         }
  51                         else
  52                                 Term->WritePos += tmp;
  53                 }
  54                 break;
  55
  56         // Erase
  57         case 'J':
  58                 switch(args[0])
  59                 {
  60                 case 0: // Erase below
  61                         break;
  62                 case 1: // Erase above
  63                         break;
  64                 case 2: // Erase all
  65                         if( Term->Flags & VT_FLAG_ALTBUF )
  66                         {
  67                                  int    i = Term->TextHeight;
  68                                 while( i-- )    VT_int_ClearLine(Term, i);
  69                                 Term->AltWritePos = 0;
  70                                 VT_int_UpdateScreen(Term, 1);
  71                         }
  72                         else
  73                         {
  74                                  int    i = Term->TextHeight * (giVT_Scrollback + 1);
  75                                 while( i-- )    VT_int_ClearLine(Term, i);
  76                                 Term->WritePos = 0;
  77                                 Term->ViewPos = 0;
  78                                 VT_int_UpdateScreen(Term, 1);
  79                         }
  80                         break;
  81                 }
  82                 break;
  83
  84         // Erase in line
  85         case 'K':
  86                 switch(args[0])
  87                 {
  88                 case 0: // Erase to right
  89                         if( Term->Flags & VT_FLAG_ALTBUF )
  90                         {
  91                                  int    i, max;
  92                                 max = Term->Width - Term->AltWritePos % Term->Width;
  93                                 for( i = 0; i < max; i ++ )
  94                                         Term->AltBuf[Term->AltWritePos+i].Ch = 0;
  95                         }
  96                         else
  97                         {
  98                                  int    i, max;
  99                                 max = Term->Width - Term->WritePos % Term->Width;
 100                                 for( i = 0; i < max; i ++ )
 101                                         Term->Text[Term->WritePos+i].Ch = 0;
 102                         }
 103                         VT_int_UpdateScreen(Term, 0);
 104                         break;
 105                 case 1: // Erase to left
 106                         if( Term->Flags & VT_FLAG_ALTBUF )
 107                         {
 108                                  int    i = Term->AltWritePos % Term->Width;
 109                                 while( i -- )
 110                                         Term->AltBuf[Term->AltWritePos++].Ch = 0;
 111                         }
 112                         else
 113                         {
 114                                  int    i = Term->WritePos % Term->Width;
 115                                 while( i -- )
 116                                         Term->Text[Term->WritePos++].Ch = 0;
 117                         }
 118                         VT_int_UpdateScreen(Term, 0);
 119                         break;
 120                 case 2: // Erase all
 121                         if( Term->Flags & VT_FLAG_ALTBUF )
 122                         {
 123                                 VT_int_ClearLine(Term, Term->AltWritePos / Term->Width);
 124                         }
 125                         else
 126                         {
 127                                 VT_int_ClearLine(Term, Term->WritePos / Term->Width);
 128                         }
 129                         VT_int_UpdateScreen(Term, 0);
 130                         break;
 131                 }
 132                 break;
 133
 134         // Set cursor position
 135         case 'H':
 136                 if( Term->Flags & VT_FLAG_ALTBUF )
 137                         Term->AltWritePos = args[0] + args[1]*Term->TextWidth;
 138                 else
 139                         Term->WritePos = args[0] + args[1]*Term->TextWidth;
 140                 //Log_Debug("VTerm", "args = {%i, %i}", args[0], args[1]);
 141                 break;
 142
 143         // Scroll up `n` lines
 144         case 'S':
 145                 tmp = -1;
 146         // Scroll down `n` lines
 147         case 'T':
 148                 if(argc == 1)   tmp *= args[0];
 149                 if( Term->Flags & VT_FLAG_ALTBUF )
 150                         VT_int_ScrollText(Term, tmp);
 151                 else
 152                 {
 153                         if(Term->ViewPos/Term->TextWidth + tmp < 0)
 154                                 break;
 155                         if(Term->ViewPos/Term->TextWidth + tmp  > Term->TextHeight * (giVT_Scrollback + 1))
 156                                 break;
 157
 158                         Term->ViewPos += Term->TextWidth*tmp;
 159                 }
 160                 break;
 161         // Set Mode (?)
 162         case 'h':
 163                 if( argc >= 1 )
 164                 {
 165                         switch(args[0])
 166                         {
 167                         case 2: // Keyboard action mode
 168                         case 4: // Insert mode
 169                         case 12:        // Send/receive
 170                         case 20:        // Automatic newline
 171                                 break;
 172                         default:        // ?
 173                                 break;
 174                         }
 175                 }
 176                 break;
 177
 178         // Set Font flags
 179         case 'm':
 180                 for( ; argc--; )
 181                 {
 182                          int    colour_idx;
 183                         // Flags
 184                         if( 0 <= args[argc] && args[argc] <= 8)
 185                         {
 186                                 switch(args[argc])
 187                                 {
 188                                 case 0: Term->CurColour = DEFAULT_COLOUR;       break;  // Reset
 189                                 case 1: Term->CurColour |= 0x80000000;  break;  // Bright
 190                                 case 2: Term->CurColour &= ~0x80000000; break;  // Dim
 191                                 }
 192                         }
 193                         // Foreground Colour
 194                         else if(30 <= args[argc] && args[argc] <= 37) {
 195                                 // Get colour index, accounting for bright bit
 196                                 colour_idx = args[argc]-30 + ((Term->CurColour>>28) & 8);
 197                                 Term->CurColour &= 0x8000FFFF;
 198                                 Term->CurColour |= (Uint32)caVT100Colours[ colour_idx ] << 16;
 199                         }
 200                         // Background Colour
 201                         else if(40 <= args[argc] && args[argc] <= 47) {
 202                                 // Get colour index, accounting for bright bit
 203                                 colour_idx = args[argc]-40 + ((Term->CurColour>>12) & 8);
 204                                 Term->CurColour &= 0xFFFF8000;
 205                                 Term->CurColour |= caVT100Colours[ colour_idx ];
 206                         }
 207                         // Foreground Colour - bright
 208                         else if(90 <= args[argc] && args[argc] <= 97 ) {
 209                                 colour_idx = args[argc]-90 + 8;
 210                                 Term->CurColour &= 0x8000FFFF;
 211                                 Term->CurColour |= (Uint32)caVT100Colours[ colour_idx ] << 16;
 212                         }
 213                         // Background Colour - bright
 214                         else if(100 <= args[argc] && args[argc] <= 107 ) {
 215                                 colour_idx = args[argc]-100 + 8;
 216                                 Term->CurColour &= 0xFFFF8000;
 217                                 Term->CurColour |= (Uint32)caVT100Colours[ colour_idx ];
 218                         }
 219                         else {
 220                                 Log_Warning("VTerm", "Unknown font flag %i", args[argc]);
 221                         }
 222                 }
 223                 break;
 224
 225         // Set scrolling region
 226         case 'r':
 227                 if( argc != 2 ) break;
 228                 Term->ScrollTop = args[0];
 229                 Term->ScrollHeight = args[1] - args[0];
 230                 break;
 231
 232         // Save cursor position
 233         case 's':
 234                 if( argc != 0 ) break;
 235                 Term->SavedWritePos = (Term->Flags & VT_FLAG_ALTBUF) ? Term->AltWritePos : Term->WritePos;
 236                 break;
 237
 238         // Restore saved cursor position
 239         case 'u':
 240                 if( argc != 0 ) break;
 241                 *((Term->Flags & VT_FLAG_ALTBUF) ? &Term->AltWritePos : &Term->WritePos) = Term->SavedWritePos;
 242                 break;
 243
 244         default:
 245                 Log_Warning("VTerm", "Unknown control sequence '\\x1B[%c'", CmdChar);
 246                 break;
 247         }
 248 }
 249
 250 /**
 251  * \fn int VT_int_ParseEscape(tVTerm *Term, const char *Buffer)
 252  * \brief Parses a VT100 Escape code
 253  */
 254 int VT_int_ParseEscape(tVTerm *Term, const char *Buffer, size_t Bytes)
 255 {
 256         char    c;
 257          int    argc = 0, j = 0;
 258          int    args[6] = {0,0,0,0};
 259          int    bQuestionMark = 0;
 260         const int       ofs = Term->EscapeCodeLen;
 261         const int       sparespace = sizeof(Term->EscapeCodeCache)-Term->EscapeCodeLen;
 262         const int       copysize = MIN(Bytes, sparespace);
 263
 264         memcpy( Term->EscapeCodeCache + Term->EscapeCodeLen, Buffer, copysize );
 265         Term->EscapeCodeLen += copysize;
 266
 267         Bytes = Term->EscapeCodeLen;
 268         Buffer = Term->EscapeCodeCache;
 269
 270         if( Bytes == j )        return j-ofs;
 271         c = Buffer[j++];
 272         if(c != '\x1b') {
 273                 Term->EscapeCodeLen = 0;
 274                 return 0;
 275         }
 276
 277         if( Bytes == j )        return j-ofs;
 278         c = Buffer[j++];
 279
 280         switch(c)
 281         {
 282         //Large Code
 283         case '[':
 284                 // Get Arguments
 285                 if(Bytes == j)  return j-ofs;
 286                 c = Buffer[j++];
 287                 if(c == '?') {
 288                         bQuestionMark = 1;
 289                         if(Bytes == j)  return j-ofs;
 290                         c = Buffer[j++];
 291                 }
 292                 if( '0' <= c && c <= '9' )
 293                 {
 294                         do {
 295                                 if(c == ';') {
 296                                         if(Bytes == j)  return j-ofs;
 297                                         c = Buffer[j++];
 298                                 }
 299                                 while('0' <= c && c <= '9') {
 300                                         args[argc] *= 10;
 301                                         args[argc] += c-'0';
 302                                         if(Bytes == j)  return j-ofs;
 303                                         c = Buffer[j++];
 304                                 }
 305                                 argc ++;
 306                         } while(c == ';');
 307                 }
 308
 309                 // Get Command
 310                 if( !('a' <= c && c <= 'z') && !('A' <= c && c <= 'Z') )
 311                 {
 312                         // Error - eat ESC only?
 313                         // > j : Entire code skipped
 314                         Term->EscapeCodeLen = 0;
 315                         return j-ofs;
 316                 }
 317
 318                 if( bQuestionMark )
 319                 {
 320                         switch(c)
 321                         {
 322                         // DEC Private Mode Set
 323                         case 'h':
 324                                 if(argc != 1)   break;
 325                                 switch(args[0])
 326                                 {
 327                                 case 25:
 328                                         Term->Flags &= ~VT_FLAG_HIDECSR;
 329                                         break;
 330                                 case 1047:
 331                                         VT_int_ToggleAltBuffer(Term, 1);
 332                                         break;
 333                                 }
 334                                 break;
 335                         case 'l':
 336                                 if(argc != 1)   break;
 337                                 switch(args[0])
 338                                 {
 339                                 case 25:
 340                                         Term->Flags |= VT_FLAG_HIDECSR;
 341                                         break;
 342                                 case 1047:
 343                                         VT_int_ToggleAltBuffer(Term, 0);
 344                                         break;
 345                                 }
 346                                 break;
 347                         default:
 348                                 Log_Warning("VTerm", "Unknown control sequence '\\x1B[?%c'", c);
 349                                 break;
 350                         }
 351                 }
 352                 else
 353                 {
 354                         VT_int_ParseEscape_StandardLarge(Term, c, argc, args);
 355                 }
 356                 break;
 357         case '\0':
 358                 // Ignore \0
 359                 break;
 360         default:
 361                 //Log_Notice("VTerm", "TODO: Handle short escape codes");
 362                 {
 363                         static volatile int tmp = 0;
 364                         if(tmp == 0) {
 365                                 tmp = 1;
 366                                 Debug("VTerm: Unknown short 0x%x", c);
 367                                 tmp = 0;
 368                         }
 369                 }
 370                 break;
 371         }
 372
 373         //Log_Debug("VTerm", "j = %i, Buffer = '%s'", j, Buffer);
 374         Term->EscapeCodeLen = 0;
 375         return j-ofs;
 376 }