Added cursor manipulation to vterm & vga
[tpg/acess2.git] / Kernel / drv / vterm.c
1 /*
2  * Acess2 Virtual Terminal Driver
3  */
4 #include <common.h>
5 #include <fs_devfs.h>
6 #include <modules.h>
7 #include <tpl_drv_video.h>
8 #include <tpl_drv_keyboard.h>
9
10 // === CONSTANTS ===
11 #define NUM_VTS 4
12 #define MAX_INPUT_CHARS 64
13 #define VT_SCROLLBACK   4       // 4 Screens of text
14 #define DEFAULT_OUTPUT  "/Devices/VGA"
15 #define DEFAULT_INPUT   "/Devices/PS2Keyboard"
16 #define DEFAULT_WIDTH   80
17 #define DEFAULT_HEIGHT  25
18 #define DEFAULT_COLOUR  (VT_COL_BLACK|(VT_COL_WHITE<<16))
19
20 #define VT_FLAG_HIDECSR 0x01
21
22 enum eVT_Modes {
23         VT_MODE_TEXT8,  // UTF-8 Text Mode (VT100 Emulation)
24         VT_MODE_TEXT32, // UTF-32 Text Mode (Acess Native)
25         VT_MODE_8BPP,   // 256 Colour Mode
26         VT_MODE_16BPP,  // 16 bit Colour Mode
27         VT_MODE_24BPP,  // 24 bit Colour Mode
28         VT_MODE_32BPP,  // 32 bit Colour Mode
29         NUM_VT_MODES
30 };
31
32 // === TYPES ===
33 typedef struct {
34          int    Mode;
35          int    Flags;
36          int    Width, Height;
37          int    ViewPos, WritePos;
38         Uint32  CurColour;
39         char    Name[2];
40          int    InputRead;
41          int    InputWrite;
42         Uint32  InputBuffer[MAX_INPUT_CHARS];
43         union {
44                 tVT_Char        *Text;
45                 Uint32          *Buffer;
46         };
47         tVFS_Node       Node;
48 } tVTerm;
49
50 // === PROTOTYPES ===
51  int    VT_Install(char **Arguments);
52 char    *VT_ReadDir(tVFS_Node *Node, int Pos);
53 tVFS_Node       *VT_FindDir(tVFS_Node *Node, char *Name);
54 Uint64  VT_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer);
55 Uint64  VT_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer);
56  int    VT_IOCtl(tVFS_Node *Node, int Id, void *Data);
57 void    VT_KBCallBack(Uint32 Codepoint);
58 void    VT_int_PutString(tVTerm *Term, Uint8 *Buffer, Uint Count);
59  int    VT_int_ParseEscape(tVTerm *Term, char *Buffer);
60 void    VT_int_PutChar(tVTerm *Term, Uint32 Ch);
61 void    VT_int_UpdateScreen( tVTerm *Term, int UpdateAll );
62
63 // === CONSTANTS ===
64 const Uint16    caVT100Colours[] = {
65                 VT_COL_BLACK, 0, 0, 0, 0, 0, 0, VT_COL_LTGREY,
66                 VT_COL_GREY, 0, 0, 0, 0, 0, 0, VT_COL_WHITE
67         };
68
69 // === GLOBALS ===
70 MODULE_DEFINE(0, 0x0032, VTerm, VT_Install, NULL, NULL);
71 tDevFS_Driver   gVT_DrvInfo = {
72         NULL, "VTerm",
73         {
74         .Flags = VFS_FFLAG_DIRECTORY,
75         .Inode = -1,
76         .NumACLs = 0,
77         .ReadDir = VT_ReadDir,
78         .FindDir = VT_FindDir
79         }
80 };
81 tVTerm  gVT_Terminals[NUM_VTS];
82 char    *gsVT_OutputDevice = NULL;
83 char    *gsVT_InputDevice = NULL;
84  int    giVT_OutputDevHandle = -2;
85  int    giVT_InputDevHandle = -2;
86  int    giVT_CurrentTerminal = 0;
87
88 // === CODE ===
89 /**
90  * \fn int VT_Install(char **Arguments)
91  */
92 int VT_Install(char **Arguments)
93 {
94         char    **args = Arguments;
95         char    *arg;
96          int    i;
97         
98         // Scan Arguments
99         if(Arguments)
100         {
101                 for( ; (arg = *args); args++ )
102                 {
103                         if(arg[0] != '-')       continue;
104                         
105                         switch(arg[1])
106                         {
107                         // Set output device
108                         case 'o':
109                                 if(args[1] ==  NULL)    break;
110                                 if(gsVT_OutputDevice)   free(gsVT_OutputDevice);
111                                 gsVT_OutputDevice = malloc(strlen(args[1])+1);
112                                 strcpy(gsVT_OutputDevice, args[1]);
113                                 args ++;
114                                 break;
115                         
116                         // Set input device
117                         case 'i':
118                                 if(args[1] == NULL)     break;
119                                 if(gsVT_InputDevice)    free(gsVT_InputDevice);
120                                 gsVT_InputDevice = malloc(strlen(args[1])+1);
121                                 strcpy(gsVT_InputDevice, args[1]);
122                                 args ++;
123                                 break;
124                         
125                         }
126                 }
127         }
128         
129         // Apply Defaults
130         if(!gsVT_OutputDevice)  gsVT_OutputDevice = DEFAULT_OUTPUT;
131         if(!gsVT_InputDevice)   gsVT_InputDevice = DEFAULT_INPUT;
132         
133         LOG("Using '%s' as output", gsVT_OutputDevice);
134         LOG("Using '%s' as input", gsVT_InputDevice);
135         
136         // Create Nodes
137         for( i = 0; i < NUM_VTS; i++ )
138         {
139                 gVT_Terminals[i].Mode = VT_MODE_TEXT8;
140                 gVT_Terminals[i].Flags = 0;
141                 gVT_Terminals[i].Width = DEFAULT_WIDTH;
142                 gVT_Terminals[i].Height = DEFAULT_HEIGHT;
143                 gVT_Terminals[i].CurColour = DEFAULT_COLOUR;
144                 gVT_Terminals[i].WritePos = 0;
145                 gVT_Terminals[i].ViewPos = 0;
146                 
147                 gVT_Terminals[i].Buffer = malloc( DEFAULT_WIDTH*DEFAULT_HEIGHT*sizeof(tVT_Char) );
148                 memset( gVT_Terminals[i].Buffer, 0, DEFAULT_WIDTH*DEFAULT_HEIGHT*sizeof(tVT_Char) );
149                 
150                 gVT_Terminals[i].Name[0] = '0'+i;
151                 gVT_Terminals[i].Name[1] = '\0';
152                 gVT_Terminals[i].Node.Inode = i;
153                 gVT_Terminals[i].Node.NumACLs = 0;      // Only root can open virtual terminals
154                 
155                 gVT_Terminals[i].Node.Read = VT_Read;
156                 gVT_Terminals[i].Node.Write = VT_Write;
157                 gVT_Terminals[i].Node.IOCtl = VT_IOCtl;
158         }
159         
160         // Add to DevFS
161         DevFS_AddDevice( &gVT_DrvInfo );
162         
163         return 0;
164 }
165
166 /**
167  * \fn void VT_InitOutput()
168  * \brief Initialise Video Output
169  */
170 void VT_InitOutput()
171 {
172         giVT_OutputDevHandle = VFS_Open(gsVT_OutputDevice, VFS_OPENFLAG_WRITE);
173         LOG("giVT_OutputDevHandle = %x\n", giVT_OutputDevHandle);
174 }
175
176 /**
177  * \fn void VT_InitInput()
178  * \brief Initialises the input
179  */
180 void VT_InitInput()
181 {
182         giVT_InputDevHandle = VFS_Open(gsVT_InputDevice, VFS_OPENFLAG_READ);
183         LOG("giVT_InputDevHandle = %x\n", giVT_InputDevHandle);
184         if(giVT_InputDevHandle == -1)   return ;
185         VFS_IOCtl(giVT_InputDevHandle, KB_IOCTL_SETCALLBACK, VT_KBCallBack);
186 }
187
188 /**
189  * \fn char *VT_ReadDir(tVFS_Node *Node, int Pos)
190  * \brief Read from the VTerm Directory
191  */
192 char *VT_ReadDir(tVFS_Node *Node, int Pos)
193 {
194         if(Pos < 0)     return NULL;
195         if(Pos >= NUM_VTS)      return NULL;
196         return gVT_Terminals[Pos].Name;
197 }
198
199 /**
200  * \fn tVFS_Node *VT_FindDir(tVFS_Node *Node, char *Name)
201  * \brief Find an item in the VTerm directory
202  */
203 tVFS_Node *VT_FindDir(tVFS_Node *Node, char *Name)
204 {
205          int    num;
206         
207         //ENTER("pNode sName", Node, Name);
208         
209         // Open the input and output files if needed
210         if(giVT_OutputDevHandle == -2)  VT_InitOutput();
211         if(giVT_InputDevHandle == -2)   VT_InitInput();
212         
213         // Sanity check name
214         if(Name[0] < '0' || Name[0] > '9' || Name[1] != '\0') {
215                 LEAVE('n');
216                 return NULL;
217         }
218         // Get index
219         num = Name[0] - '0';
220         if(num >= NUM_VTS) {
221                 LEAVE('n');
222                 return NULL;
223         }
224         // Return node
225         //LEAVE('p', &gVT_Terminals[num].Node);
226         return &gVT_Terminals[num].Node;
227 }
228
229 /**
230  * \fn Uint64 VT_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
231  * \brief Read from a virtual terminal
232  */
233 Uint64 VT_Read(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
234 {
235          int    pos = 0;
236         tVTerm  *term = &gVT_Terminals[ Node->Inode ];
237         
238         // Check current mode
239         switch(term->Mode)
240         {
241         case VT_MODE_TEXT8:
242                 while(pos < Length)
243                 {
244                         while(term->InputRead == term->InputWrite)      Proc_Yield();
245                         while(term->InputRead != term->InputWrite)
246                         {
247                                 LOG("WriteUTF8(%p, 0x%x)", Buffer+pos, term->InputBuffer[term->InputRead]);
248                                 pos += WriteUTF8(Buffer+pos, term->InputBuffer[term->InputRead]);
249                                 term->InputRead ++;
250                         }
251                 }
252                 break;
253         
254         case VT_MODE_TEXT32:
255                 while(pos < Length)
256                 {
257                         while(term->InputRead == term->InputWrite)      Proc_Yield();
258                         while(term->InputRead != term->InputWrite)
259                         {
260                                 ((Uint32*)Buffer)[pos] = term->InputBuffer[term->InputRead];
261                                 pos ++;
262                                 term->InputRead ++;
263                         }
264                 }
265                 break;
266         }
267         return 0;
268 }
269
270 /**
271  * \fn Uint64 VT_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
272  * \brief Write to a virtual terminal
273  */
274 Uint64 VT_Write(tVFS_Node *Node, Uint64 Offset, Uint64 Length, void *Buffer)
275 {
276         tVTerm  *term = &gVT_Terminals[ Node->Inode ];
277         
278         //ENTER("pNode XOffset XLength pBuffer",  Node, Offset, Length, Buffer);
279         
280         // Write
281         switch( term->Mode )
282         {
283         case VT_MODE_TEXT8:
284                 VT_int_PutString(term, Buffer, Length);
285                 break;
286         case VT_MODE_TEXT32:
287                 //VT_int_PutString32(term, Buffer, Length);
288                 break;
289         }
290         
291         //LEAVE('i', 0);
292         return 0;
293 }
294
295 /**
296  * \fn int VT_IOCtl(tVFS_Node *Node, int Id, void *Data)
297  * \brief Call an IO Control on a virtual terminal
298  */
299 int VT_IOCtl(tVFS_Node *Node, int Id, void *Data)
300 {
301         return 0;
302 }
303
304 /**
305  * \fn void VT_KBCallBack(Uint32 Codepoint)
306  * \brief Called on keyboard interrupt
307  */
308 void VT_KBCallBack(Uint32 Codepoint)
309 {
310         tVTerm  *term = &gVT_Terminals[giVT_CurrentTerminal];
311         
312         term->InputBuffer[ term->InputWrite ] = Codepoint;
313         term->InputWrite ++;
314         term->InputWrite %= MAX_INPUT_CHARS;
315         if(term->InputRead == term->InputWrite) {
316                 term->InputRead ++;
317                 term->InputRead %= MAX_INPUT_CHARS;
318         }
319 }
320
321 /**
322  * \fn void VT_int_PutString(tVTerm *Term, Uint8 *Buffer, Uint Count)
323  * \brief Print a string to the Virtual Terminal
324  */
325 void VT_int_PutString(tVTerm *Term, Uint8 *Buffer, Uint Count)
326 {
327         Uint32  val;
328          int    i;
329         for( i = 0; i < Count; i++ )
330         {
331                 if( Buffer[i] == 0x1B ) // Escape Sequence
332                 {
333                         i += VT_int_ParseEscape(Term, (char*)&Buffer[i]);
334                         continue;
335                 }
336                 
337                 if( Buffer[i] < 128 )   // Plain ASCII
338                         VT_int_PutChar(Term, Buffer[i]);
339                 else {  // UTF-8
340                         i += ReadUTF8(&Buffer[i], &val);
341                         VT_int_PutChar(Term, val);
342                 }
343         }
344         
345         // Update cursor
346         if(Term->Flags & VT_FLAG_HIDECSR)
347         {
348                 tVideo_IOCtl_Pos        pos;
349                 pos.x = Term->WritePos % Term->Width;
350                 pos.y = Term->WritePos / Term->Width;
351                 VFS_IOCtl(giVT_OutputDevHandle, VIDEO_IOCTL_SETCURSOR, &pos);
352         }
353 }
354
355 /**
356  * \fn int VT_int_ParseEscape(tVTerm *Term, char *Buffer)
357  * \brief Parses a VT100 Escape code
358  */
359 int VT_int_ParseEscape(tVTerm *Term, char *Buffer)
360 {
361         char    c;
362          int    argc = 0, j = 1;
363          int    args[4] = {0,0,0,0};
364         
365         switch(Buffer[0]) {
366         //Large Code
367         case '[':
368                 // Get Arguments
369                 c = Buffer[1];
370                 do {
371                         while('0' <= c && c <= '9') {
372                                 args[argc] *= 10;
373                                 args[argc] += c-'0';
374                                 c = Buffer[++j];
375                         }
376                         argc ++;
377                 } while(c == ';');
378                 
379                 // Get string (what does this do?)
380                 if(c == '"') {
381                         c = Buffer[++j];
382                         while(c != '"')
383                                 c = Buffer[++j];
384                 }
385                 
386                 // Get Command
387                 if(     ('a' <= c && c <= 'z') || ('A' <= c && c <= 'Z'))
388                 {
389                         switch(c) {
390                         //Clear By Line
391                         case 'J':
392                                 // Clear Screen
393                                 if(args[0] == 2) {
394                                         memset(Term->Text, 0, Term->Width*Term->Height*VT_SCROLLBACK*sizeof(tVT_Char));
395                                         Term->WritePos = 0;
396                                         Term->ViewPos = 0;
397                                 }
398                                 break;
399                         // Set Font flags
400                         case 'm':
401                                 for( ; argc--; )
402                                 {
403                                         // Flags
404                                         if( 0 <= args[argc] && args[argc] <= 8)
405                                         {
406                                                 switch(args[argc])
407                                                 {
408                                                 case 0: Term->CurColour = DEFAULT_COLOUR;       break;  // Reset
409                                                 case 1: Term->CurColour |= 0x80000000;  break;  // Bright
410                                                 case 2: Term->CurColour &= ~0x80000000; break;  // Dim
411                                                 }
412                                         }
413                                         // Foreground Colour
414                                         else if(30 <= args[argc] && args[argc] <= 37) {
415                                                 Term->CurColour &= 0xF000FFFF;
416                                                 Term->CurColour |= (Uint32)caVT100Colours[ args[argc]-30+(Term->CurColour>>28) ] << 16;
417                                         }
418                                         // Background Colour
419                                         else if(40 <= args[argc] && args[argc] <= 47) {
420                                                 Term->CurColour &= 0xFFFF8000;
421                                                 Term->CurColour |= caVT100Colours[ args[argc]-40+((Term->CurColour>>12)&15) ];
422                                         }
423                                 }
424                                 break;
425                         }
426                 }
427                 break;
428                 
429         default:
430                 break;
431         }
432         
433         return j + 1;
434 }
435
436 /**
437  * \fn void VT_int_PutChar(tVTerm *Term, Uint32 Ch)
438  * \brief Write a single character to a VTerm
439  */
440 void VT_int_PutChar(tVTerm *Term, Uint32 Ch)
441 {
442          int    i;
443         //ENTER("pTerm xCh", Term, Ch);
444         //LOG("Term = {WritePos:%i, ViewPos:%i}\n", Term->WritePos, Term->ViewPos);
445         
446         switch(Ch)
447         {
448         case '\n':
449                 Term->WritePos += Term->Width;
450         case '\r':
451                 Term->WritePos -= Term->WritePos % Term->Width;
452                 break;
453         
454         case '\t':
455                 do {
456                         Term->Text[ Term->WritePos ].Ch = '\t';
457                         Term->Text[ Term->WritePos ].Colour = Term->CurColour;
458                         Term->WritePos ++;
459                 } while(Term->WritePos & 7);
460                 break;
461         
462         case '\b':
463                 // Backspace is invalid at Offset 0
464                 if(Term->WritePos == 0) break;
465                 
466                 Term->WritePos --;
467                 // Singe Character
468                 if(Term->Text[ Term->WritePos ].Ch != '\t') {
469                         Term->Text[ Term->WritePos ].Ch = 0;
470                         Term->Text[ Term->WritePos ].Colour = Term->CurColour;
471                         break;
472                 }
473                 // Tab
474                 i = 7;  // Limit it to 8
475                 do {
476                         Term->Text[ Term->WritePos ].Ch = 0;
477                         Term->Text[ Term->WritePos ].Colour = Term->CurColour;
478                         Term->WritePos --;
479                 } while(Term->WritePos && i-- && Term->Text[ Term->WritePos ].Ch == '\t');
480                 break;
481         
482         default:
483                 Term->Text[ Term->WritePos ].Ch = Ch;
484                 Term->Text[ Term->WritePos ].Colour = Term->CurColour;
485                 Term->WritePos ++;
486                 break;
487         }
488         
489         if(Term->WritePos >= Term->Width*Term->Height*VT_SCROLLBACK)
490         {
491                  int    base, i;
492                 Term->WritePos -= Term->Width;
493                 
494                 // Update view position
495                 base = Term->Width*Term->Height*(VT_SCROLLBACK-1);
496                 if(Term->ViewPos < base)        Term->ViewPos += Term->Width;
497                 if(Term->ViewPos > base)        Term->ViewPos = base;
498                 
499                 // Scroll terminal cache
500                 base = Term->Width*(Term->Height*VT_SCROLLBACK-1);
501                 
502                 // Scroll Back
503                 memcpy( Term->Text, &Term->Text[Term->Width], base*sizeof(tVT_Char) );
504                 
505                 // Clear last row
506                 for( i = 0; i < Term->Width; i ++ )
507                 {
508                         Term->Text[ base + i ].Ch = 0;
509                         Term->Text[ base + i ].Colour = Term->CurColour;
510                 }
511                 
512                 VT_int_UpdateScreen( Term, 1 );
513         }
514         else
515                 VT_int_UpdateScreen( Term, 0 );
516         
517         //LEAVE('-');
518 }
519
520 /**
521  * \fn void VT_int_UpdateScreen( tVTerm *Term, int UpdateAll )
522  * \brief Updates the video framebuffer
523  */
524 void VT_int_UpdateScreen( tVTerm *Term, int UpdateAll )
525 {
526         if(UpdateAll) {
527                 VFS_WriteAt(
528                         giVT_OutputDevHandle,
529                         0,
530                         Term->Width*Term->Height*sizeof(tVT_Char),
531                         &Term->Text[Term->ViewPos]
532                         );
533         } else {
534                  int    pos = Term->WritePos - Term->WritePos % Term->Width;
535                 VFS_WriteAt(
536                         giVT_OutputDevHandle,
537                         (pos - Term->ViewPos)*sizeof(tVT_Char),
538                         Term->Width*sizeof(tVT_Char),
539                         &Term->Text[pos]
540                         );
541         }
542 }
543
544 // ---
545 // Font Render
546 // ---
547 #define MONOSPACE_FONT  10816
548
549 #if MONOSPACE_FONT == 10808     // 8x8
550 # include "vterm_font_8x8.h"
551 #elif MONOSPACE_FONT == 10816   // 8x16
552 # include "vterm_font_8x16.h"
553 #endif
554
555
556 int VT_Font_GetWidth(Uint32 Codepoint)
557 {
558         return FONT_WIDTH;
559 }
560 int VT_Font_GetHeight(Uint32 Codepoint)
561 {
562         return FONT_HEIGHT;
563 }
564
565 void VT_Font_Render(Uint32 Codepoint, void *Buffer, Uint32 BGC, Uint32 FGC)
566 {
567 //      Uint8   *font;
568         
569 }
570
571 /**
572  * \fn Uint8 *VT_Font_GetChar(Uint32 Codepoint)
573  * \brief Gets an index into the font array given a Unicode Codepoint
574  * \note See http://en.wikipedia.org/wiki/CP437
575  */
576 Uint8 *VT_Font_GetChar(Uint32 Codepoint)
577 {
578          int    index = 0;
579         if(Codepoint < 128)
580                 return &VTermFont[Codepoint*FONT_HEIGHT];
581         switch(Codepoint)
582         {
583         case 0xC7:      index = 128;    break;  // Ç
584         case 0xFC:      index = 129;    break;  // ü
585         case 0xE9:      index = 130;    break;  // é
586         case 0xE2:      index = 131;    break;  // â
587         case 0xE4:      index = 132;    break;  // ä
588         case 0xE0:      index = 133;    break;  // à
589         case 0xE5:      index = 134;    break;  // å
590         case 0xE7:      index = 135;    break;  // ç
591         case 0xEA:      index = 136;    break;  // ê
592         case 0xEB:      index = 137;    break;  // ë
593         case 0xE8:      index = 138;    break;  // è
594         case 0xEF:      index = 139;    break;  // ï
595         case 0xEE:      index = 140;    break;  // î
596         case 0xEC:      index = 141;    break;  // ì
597         case 0xC4:      index = 142;    break;  // Ä
598         case 0xC5:      index = 143;    break;  // Å
599         }
600         
601         return &VTermFont[index*FONT_HEIGHT];
602 }

UCC git Repository :: git.ucc.asn.au