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 //      // Reset formatting?
 143 //      case 'R':
 144 //              Term->CurColour = DEFAULT_COLOUR;
 145 //              break;
 146         // Scroll up `n` lines
 147         case 'S':
 148                 tmp = -1;
 149         // Scroll down `n` lines
 150         case 'T':
 151                 if(argc == 1)   tmp *= args[0];
 152                 if( Term->Flags & VT_FLAG_ALTBUF )
 153                         VT_int_ScrollText(Term, tmp);
 154                 else
 155                 {
 156                         if(Term->ViewPos/Term->TextWidth + tmp < 0)
 157                                 break;
 158                         if(Term->ViewPos/Term->TextWidth + tmp  > Term->TextHeight * (giVT_Scrollback + 1))
 159                                 break;
 160
 161                         Term->ViewPos += Term->TextWidth*tmp;
 162                 }
 163                 break;
 164         // Set Mode (?)
 165         case 'h':
 166                 if( argc >= 1 )
 167                 {
 168                         switch(args[0])
 169                         {
 170                         case 2: // Keyboard action mode
 171                         case 4: // Insert mode
 172                         case 12:        // Send/receive
 173                         case 20:        // Automatic newline
 174                                 break;
 175                         default:        // ?
 176                                 break;
 177                         }
 178                 }
 179                 break;
 180
 181         // Set Font flags
 182         case 'm':
 183                 for( ; argc--; )
 184                 {
 185                          int    colour_idx;
 186                         // Flags
 187                         if( 0 <= args[argc] && args[argc] <= 8)
 188                         {
 189                                 switch(args[argc])
 190                                 {
 191                                 case 0: Term->CurColour = DEFAULT_COLOUR;       break;  // Reset
 192                                 case 1: Term->CurColour |= 0x80000000;  break;  // Bright
 193                                 case 2: Term->CurColour &= ~0x80000000; break;  // Dim
 194                                 }
 195                         }
 196                         // Foreground Colour
 197                         else if(30 <= args[argc] && args[argc] <= 37) {
 198                                 // Get colour index, accounting for bright bit
 199                                 colour_idx = args[argc]-30 + ((Term->CurColour>>28) & 8);
 200                                 Term->CurColour &= 0x8000FFFF;
 201                                 Term->CurColour |= (Uint32)caVT100Colours[ colour_idx ] << 16;
 202                         }
 203                         // Background Colour
 204                         else if(40 <= args[argc] && args[argc] <= 47) {
 205                                 // Get colour index, accounting for bright bit
 206                                 colour_idx = args[argc]-40 + ((Term->CurColour>>12) & 8);
 207                                 Term->CurColour &= 0xFFFF8000;
 208                                 Term->CurColour |= caVT100Colours[ colour_idx ];
 209                         }
 210                         // Foreground Colour - bright
 211                         else if(90 <= args[argc] && args[argc] <= 97 ) {
 212                                 colour_idx = args[argc]-90 + 8;
 213                                 Term->CurColour &= 0x8000FFFF;
 214                                 Term->CurColour |= (Uint32)caVT100Colours[ colour_idx ] << 16;
 215                         }
 216                         // Background Colour - bright
 217                         else if(100 <= args[argc] && args[argc] <= 107 ) {
 218                                 colour_idx = args[argc]-100 + 8;
 219                                 Term->CurColour &= 0xFFFF8000;
 220                                 Term->CurColour |= (Uint32)caVT100Colours[ colour_idx ];
 221                         }
 222                         else {
 223                                 Log_Warning("VTerm", "Unknown font flag %i", args[argc]);
 224                         }
 225                 }
 226                 break;
 227
 228         // Set scrolling region
 229         case 'r':
 230                 if( argc != 2 ) break;
 231                 Term->ScrollTop = args[0];
 232                 Term->ScrollHeight = args[1] - args[0];
 233                 break;
 234
 235         // Save cursor position
 236         case 's':
 237                 if( argc != 0 ) break;
 238                 Term->SavedWritePos = (Term->Flags & VT_FLAG_ALTBUF) ? Term->AltWritePos : Term->WritePos;
 239                 break;
 240
 241         // Restore saved cursor position
 242         case 'u':
 243                 if( argc != 0 ) break;
 244                 *((Term->Flags & VT_FLAG_ALTBUF) ? &Term->AltWritePos : &Term->WritePos) = Term->SavedWritePos;
 245                 break;
 246
 247         default:
 248                 Log_Warning("VTerm", "Unknown control sequence '\\x1B[%c'", CmdChar);
 249                 break;
 250         }
 251 }
 252
 253 /**
 254  * \fn int VT_int_ParseEscape(tVTerm *Term, const char *Buffer)
 255  * \brief Parses a VT100 Escape code
 256  */
 257 int VT_int_ParseEscape(tVTerm *Term, const char *Buffer, size_t Bytes)
 258 {
 259         char    c;
 260          int    argc = 0, j = 0;
 261          int    args[6] = {0,0,0,0};
 262          int    bQuestionMark = 0;
 263         const int       ofs = Term->EscapeCodeLen;
 264         const int       sparespace = sizeof(Term->EscapeCodeCache)-Term->EscapeCodeLen;
 265         const int       copysize = MIN(Bytes, sparespace);
 266
 267         memcpy( Term->EscapeCodeCache + Term->EscapeCodeLen, Buffer, copysize );
 268         Term->EscapeCodeLen += copysize;
 269
 270         Bytes = Term->EscapeCodeLen;
 271         Buffer = Term->EscapeCodeCache;
 272
 273         if( Bytes == j )        return j-ofs;
 274         c = Buffer[j++];
 275         if(c != '\x1b') {
 276                 Term->EscapeCodeLen = 0;
 277                 return 0;
 278         }
 279
 280         if( Bytes == j )        return j-ofs;
 281         c = Buffer[j++];
 282
 283         switch(c)
 284         {
 285         //Large Code
 286         case '[':
 287                 // Get Arguments
 288                 if(Bytes == j)  return j-ofs;
 289                 c = Buffer[j++];
 290                 if(c == '?') {
 291                         bQuestionMark = 1;
 292                         if(Bytes == j)  return j-ofs;
 293                         c = Buffer[j++];
 294                 }
 295                 if( '0' <= c && c <= '9' )
 296                 {
 297                         do {
 298                                 if(c == ';') {
 299                                         if(Bytes == j)  return j-ofs;
 300                                         c = Buffer[j++];
 301                                 }
 302                                 while('0' <= c && c <= '9') {
 303                                         args[argc] *= 10;
 304                                         args[argc] += c-'0';
 305                                         if(Bytes == j)  return j-ofs;
 306                                         c = Buffer[j++];
 307                                 }
 308                                 argc ++;
 309                         } while(c == ';');
 310                 }
 311
 312                 // Get Command
 313                 if( !('a' <= c && c <= 'z') && !('A' <= c && c <= 'Z') )
 314                 {
 315                         // Error - eat ESC only?
 316                         // > j : Entire code skipped
 317                         Term->EscapeCodeLen = 0;
 318                         return j-ofs;
 319                 }
 320
 321                 if( bQuestionMark )
 322                 {
 323                         switch(c)
 324                         {
 325                         // DEC Private Mode Set
 326                         case 'h':
 327                                 if(argc != 1)   break;
 328                                 switch(args[0])
 329                                 {
 330                                 case 25:
 331                                         Term->Flags &= ~VT_FLAG_HIDECSR;
 332                                         break;
 333                                 case 1047:
 334                                         VT_int_ToggleAltBuffer(Term, 1);
 335                                         break;
 336                                 }
 337                                 break;
 338                         case 'l':
 339                                 if(argc != 1)   break;
 340                                 switch(args[0])
 341                                 {
 342                                 case 25:
 343                                         Term->Flags |= VT_FLAG_HIDECSR;
 344                                         break;
 345                                 case 1047:
 346                                         VT_int_ToggleAltBuffer(Term, 0);
 347                                         break;
 348                                 }
 349                                 break;
 350                         default:
 351                                 Log_Warning("VTerm", "Unknown control sequence '\\x1B[?%c'", c);
 352                                 break;
 353                         }
 354                 }
 355                 else
 356                 {
 357                         VT_int_ParseEscape_StandardLarge(Term, c, argc, args);
 358                 }
 359                 break;
 360         case '\0':
 361                 // Ignore \0
 362                 break;
 363         default:
 364                 //Log_Notice("VTerm", "TODO: Handle short escape codes");
 365                 {
 366                         static volatile int tmp = 0;
 367                         if(tmp == 0) {
 368                                 tmp = 1;
 369                                 Debug("VTerm: Unknown short 0x%x", c);
 370                                 tmp = 0;
 371                         }
 372                 }
 373                 break;
 374         }
 375
 376         //Log_Debug("VTerm", "j = %i, Buffer = '%s'", j, Buffer);
 377         Term->EscapeCodeLen = 0;
 378         return j-ofs;
 379 }