]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/teken/teken_subr.h
Merge from vendor: libdtrace MD parts needed by fasttrap.
[FreeBSD/FreeBSD.git] / sys / teken / teken_subr.h
1 /*-
2  * Copyright (c) 2008-2009 Ed Schouten <ed@FreeBSD.org>
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright
11  *    notice, this list of conditions and the following disclaimer in the
12  *    documentation and/or other materials provided with the distribution.
13  *
14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24  * SUCH DAMAGE.
25  *
26  * $FreeBSD$
27  */
28
29 static void teken_subr_cursor_up(teken_t *, unsigned int);
30 static void teken_subr_erase_line(teken_t *, unsigned int);
31 static void teken_subr_regular_character(teken_t *, teken_char_t);
32 static void teken_subr_reset_to_initial_state(teken_t *);
33 static void teken_subr_save_cursor(teken_t *);
34
35 static inline int
36 teken_tab_isset(teken_t *t, unsigned int col)
37 {
38         unsigned int b, o;
39
40         if (col >= T_NUMCOL)
41                 return ((col % 8) == 0);
42
43         b = col / (sizeof(unsigned int) * 8);
44         o = col % (sizeof(unsigned int) * 8);
45
46         return (t->t_tabstops[b] & (1 << o));
47 }
48
49 static inline void
50 teken_tab_clear(teken_t *t, unsigned int col)
51 {
52         unsigned int b, o;
53
54         if (col >= T_NUMCOL)
55                 return;
56
57         b = col / (sizeof(unsigned int) * 8);
58         o = col % (sizeof(unsigned int) * 8);
59
60         t->t_tabstops[b] &= ~(1 << o);
61 }
62
63 static inline void
64 teken_tab_set(teken_t *t, unsigned int col)
65 {
66         unsigned int b, o;
67
68         if (col >= T_NUMCOL)
69                 return;
70
71         b = col / (sizeof(unsigned int) * 8);
72         o = col % (sizeof(unsigned int) * 8);
73
74         t->t_tabstops[b] |= 1 << o;
75 }
76
77 static void
78 teken_tab_default(teken_t *t)
79 {
80         unsigned int i;
81
82         memset(&t->t_tabstops, 0, T_NUMCOL / 8);
83
84         for (i = 8; i < T_NUMCOL; i += 8)
85                 teken_tab_set(t, i);
86 }
87
88 static void
89 teken_subr_do_scroll(teken_t *t, int amount)
90 {
91         teken_rect_t tr;
92         teken_pos_t tp;
93
94         teken_assert(t->t_cursor.tp_row <= t->t_winsize.tp_row);
95         teken_assert(t->t_scrollreg.ts_end <= t->t_winsize.tp_row);
96         teken_assert(amount != 0);
97
98         /* Copy existing data 1 line up. */
99         if (amount > 0) {
100                 /* Scroll down. */
101
102                 /* Copy existing data up. */
103                 if (t->t_scrollreg.ts_begin + amount < t->t_scrollreg.ts_end) {
104                         tr.tr_begin.tp_row = t->t_scrollreg.ts_begin + amount;
105                         tr.tr_begin.tp_col = 0;
106                         tr.tr_end.tp_row = t->t_scrollreg.ts_end;
107                         tr.tr_end.tp_col = t->t_winsize.tp_col;
108                         tp.tp_row = t->t_scrollreg.ts_begin;
109                         tp.tp_col = 0;
110                         teken_funcs_copy(t, &tr, &tp);
111
112                         tr.tr_begin.tp_row = t->t_scrollreg.ts_end - amount;
113                 } else {
114                         tr.tr_begin.tp_row = t->t_scrollreg.ts_begin;
115                 }
116
117                 /* Clear the last lines. */
118                 tr.tr_begin.tp_col = 0;
119                 tr.tr_end.tp_row = t->t_scrollreg.ts_end;
120                 tr.tr_end.tp_col = t->t_winsize.tp_col;
121                 teken_funcs_fill(t, &tr, BLANK, &t->t_curattr);
122         } else {
123                 /* Scroll up. */
124                 amount = -amount;
125
126                 /* Copy existing data down. */
127                 if (t->t_scrollreg.ts_begin + amount < t->t_scrollreg.ts_end) {
128                         tr.tr_begin.tp_row = t->t_scrollreg.ts_begin;
129                         tr.tr_begin.tp_col = 0;
130                         tr.tr_end.tp_row = t->t_scrollreg.ts_end - amount;
131                         tr.tr_end.tp_col = t->t_winsize.tp_col;
132                         tp.tp_row = t->t_scrollreg.ts_begin + amount;
133                         tp.tp_col = 0;
134                         teken_funcs_copy(t, &tr, &tp);
135
136                         tr.tr_end.tp_row = t->t_scrollreg.ts_begin + amount;
137                 } else {
138                         tr.tr_end.tp_row = t->t_scrollreg.ts_end;
139                 }
140
141                 /* Clear the first lines. */
142                 tr.tr_begin.tp_row = t->t_scrollreg.ts_begin;
143                 tr.tr_begin.tp_col = 0;
144                 tr.tr_end.tp_col = t->t_winsize.tp_col;
145                 teken_funcs_fill(t, &tr, BLANK, &t->t_curattr);
146         }
147 }
148
149 static ssize_t
150 teken_subr_do_cpr(teken_t *t, unsigned int cmd, char response[16])
151 {
152
153         switch (cmd) {
154         case 5: /* Operating status. */
155                 strcpy(response, "0n");
156                 return (2);
157         case 6: { /* Cursor position. */
158                 int len;
159
160                 len = snprintf(response, 16, "%u;%uR",
161                     (t->t_cursor.tp_row - t->t_originreg.ts_begin) + 1,
162                     t->t_cursor.tp_col + 1);
163
164                 if (len >= 16)
165                         return (-1);
166                 return (len);
167         }
168         case 15: /* Printer status. */
169                 strcpy(response, "13n");
170                 return (3);
171         case 25: /* UDK status. */
172                 strcpy(response, "20n");
173                 return (3);
174         case 26: /* Keyboard status. */
175                 strcpy(response, "27;1n");
176                 return (5);
177         default:
178                 teken_printf("Unknown DSR\n");
179                 return (-1);
180         }
181 }
182
183 static void
184 teken_subr_alignment_test(teken_t *t)
185 {
186         teken_rect_t tr;
187
188         t->t_cursor.tp_row = t->t_cursor.tp_col = 0;
189         t->t_scrollreg.ts_begin = 0;
190         t->t_scrollreg.ts_end = t->t_winsize.tp_row;
191         t->t_originreg = t->t_scrollreg;
192         t->t_stateflags &= ~(TS_WRAPPED|TS_ORIGIN);
193         teken_funcs_cursor(t);
194
195         tr.tr_begin.tp_row = 0;
196         tr.tr_begin.tp_col = 0;
197         tr.tr_end = t->t_winsize;
198         teken_funcs_fill(t, &tr, 'E', &t->t_defattr);
199 }
200
201 static void
202 teken_subr_backspace(teken_t *t)
203 {
204
205         if (t->t_stateflags & TS_CONS25) {
206                 if (t->t_cursor.tp_col == 0) {
207                         if (t->t_cursor.tp_row == t->t_originreg.ts_begin)
208                                 return;
209                         t->t_cursor.tp_row--;
210                         t->t_cursor.tp_col = t->t_winsize.tp_col - 1;
211                 } else {
212                         t->t_cursor.tp_col--;
213                 }
214         } else {
215                 if (t->t_cursor.tp_col == 0)
216                         return;
217
218                 t->t_cursor.tp_col--;
219                 t->t_stateflags &= ~TS_WRAPPED;
220         }
221
222         teken_funcs_cursor(t);
223 }
224
225 static void
226 teken_subr_bell(teken_t *t)
227 {
228
229         teken_funcs_bell(t);
230 }
231
232 static void
233 teken_subr_carriage_return(teken_t *t)
234 {
235
236         t->t_cursor.tp_col = 0;
237         t->t_stateflags &= ~TS_WRAPPED;
238         teken_funcs_cursor(t);
239 }
240
241 static void
242 teken_subr_cursor_backward(teken_t *t, unsigned int ncols)
243 {
244
245         if (ncols > t->t_cursor.tp_col)
246                 t->t_cursor.tp_col = 0;
247         else
248                 t->t_cursor.tp_col -= ncols;
249         t->t_stateflags &= ~TS_WRAPPED;
250         teken_funcs_cursor(t);
251 }
252
253 static void
254 teken_subr_cursor_backward_tabulation(teken_t *t, unsigned int ntabs)
255 {
256
257         do {
258                 /* Stop when we've reached the beginning of the line. */
259                 if (t->t_cursor.tp_col == 0)
260                         break;
261
262                 t->t_cursor.tp_col--;
263                 
264                 /* Tab marker set. */
265                 if (teken_tab_isset(t, t->t_cursor.tp_col))
266                         ntabs--;
267         } while (ntabs > 0);
268
269         teken_funcs_cursor(t);
270 }
271
272 static void
273 teken_subr_cursor_down(teken_t *t, unsigned int nrows)
274 {
275
276         if (t->t_cursor.tp_row + nrows >= t->t_scrollreg.ts_end)
277                 t->t_cursor.tp_row = t->t_scrollreg.ts_end - 1;
278         else
279                 t->t_cursor.tp_row += nrows;
280         t->t_stateflags &= ~TS_WRAPPED;
281         teken_funcs_cursor(t);
282 }
283
284 static void
285 teken_subr_cursor_forward(teken_t *t, unsigned int ncols)
286 {
287
288         if (t->t_cursor.tp_col + ncols >= t->t_winsize.tp_col)
289                 t->t_cursor.tp_col = t->t_winsize.tp_col - 1;
290         else
291                 t->t_cursor.tp_col += ncols;
292         t->t_stateflags &= ~TS_WRAPPED;
293         teken_funcs_cursor(t);
294 }
295
296 static void
297 teken_subr_cursor_forward_tabulation(teken_t *t, unsigned int ntabs)
298 {
299
300         do {
301                 /* Stop when we've reached the end of the line. */
302                 if (t->t_cursor.tp_col == t->t_winsize.tp_col - 1)
303                         break;
304
305                 t->t_cursor.tp_col++;
306                 
307                 /* Tab marker set. */
308                 if (teken_tab_isset(t, t->t_cursor.tp_col))
309                         ntabs--;
310         } while (ntabs > 0);
311
312         teken_funcs_cursor(t);
313 }
314
315 static void
316 teken_subr_cursor_next_line(teken_t *t, unsigned int ncols)
317 {
318
319         t->t_cursor.tp_col = 0;
320         teken_subr_cursor_down(t, ncols);
321 }
322
323 static void
324 teken_subr_cursor_position(teken_t *t, unsigned int row, unsigned int col)
325 {
326
327         t->t_cursor.tp_row = t->t_originreg.ts_begin + row - 1;
328         if (row >= t->t_originreg.ts_end)
329                 t->t_cursor.tp_row = t->t_originreg.ts_end - 1;
330
331         t->t_cursor.tp_col = col - 1;
332         if (t->t_cursor.tp_col >= t->t_winsize.tp_col)
333                 t->t_cursor.tp_col = t->t_winsize.tp_col - 1;
334
335         t->t_stateflags &= ~TS_WRAPPED;
336         teken_funcs_cursor(t);
337 }
338
339 static void
340 teken_subr_cursor_position_report(teken_t *t, unsigned int cmd)
341 {
342         char response[18] = "\x1B[";
343         ssize_t len;
344
345         len = teken_subr_do_cpr(t, cmd, response + 2);
346         if (len < 0)
347                 return;
348
349         teken_funcs_respond(t, response, len + 2);
350 }
351
352 static void
353 teken_subr_cursor_previous_line(teken_t *t, unsigned int ncols)
354 {
355
356         t->t_cursor.tp_col = 0;
357         teken_subr_cursor_up(t, ncols);
358 }
359
360 static void
361 teken_subr_cursor_up(teken_t *t, unsigned int nrows)
362 {
363
364         if (t->t_scrollreg.ts_begin + nrows >= t->t_cursor.tp_row)
365                 t->t_cursor.tp_row = t->t_scrollreg.ts_begin;
366         else
367                 t->t_cursor.tp_row -= nrows;
368         t->t_stateflags &= ~TS_WRAPPED;
369         teken_funcs_cursor(t);
370 }
371
372 static void
373 teken_subr_delete_character(teken_t *t, unsigned int ncols)
374 {
375         teken_rect_t tr;
376
377         tr.tr_begin.tp_row = t->t_cursor.tp_row;
378         tr.tr_end.tp_row = t->t_cursor.tp_row + 1;
379         tr.tr_end.tp_col = t->t_winsize.tp_col;
380
381         if (t->t_cursor.tp_col + ncols >= t->t_winsize.tp_col) {
382                 tr.tr_begin.tp_col = t->t_cursor.tp_col;
383         } else {
384                 /* Copy characters to the left. */
385                 tr.tr_begin.tp_col = t->t_cursor.tp_col + ncols;
386                 teken_funcs_copy(t, &tr, &t->t_cursor);
387
388                 tr.tr_begin.tp_col = t->t_winsize.tp_col - ncols;
389         }
390
391         /* Blank trailing columns. */
392         teken_funcs_fill(t, &tr, BLANK, &t->t_curattr);
393 }
394
395 static void
396 teken_subr_delete_line(teken_t *t, unsigned int nrows)
397 {
398         teken_rect_t tr;
399
400         /* Ignore if outside scrolling region. */
401         if (t->t_cursor.tp_row < t->t_scrollreg.ts_begin ||
402             t->t_cursor.tp_row >= t->t_scrollreg.ts_end)
403                 return;
404
405         tr.tr_begin.tp_col = 0;
406         tr.tr_end.tp_row = t->t_scrollreg.ts_end;
407         tr.tr_end.tp_col = t->t_winsize.tp_col;
408
409         if (t->t_cursor.tp_row + nrows >= t->t_scrollreg.ts_end) {
410                 tr.tr_begin.tp_row = t->t_cursor.tp_row;
411         } else {
412                 teken_pos_t tp;
413
414                 /* Copy rows up. */
415                 tr.tr_begin.tp_row = t->t_cursor.tp_row + nrows;
416                 tp.tp_row = t->t_cursor.tp_row;
417                 tp.tp_col = 0;
418                 teken_funcs_copy(t, &tr, &tp);
419
420                 tr.tr_begin.tp_row = t->t_scrollreg.ts_end - nrows;
421         }
422
423         /* Blank trailing rows. */
424         teken_funcs_fill(t, &tr, BLANK, &t->t_curattr);
425 }
426
427 static void
428 teken_subr_device_control_string(teken_t *t)
429 {
430
431         teken_printf("Unsupported device control string\n");
432         t->t_stateflags |= TS_INSTRING;
433 }
434
435 static void
436 teken_subr_device_status_report(teken_t *t, unsigned int cmd)
437 {
438         char response[19] = "\x1B[?";
439         ssize_t len;
440
441         len = teken_subr_do_cpr(t, cmd, response + 3);
442         if (len < 0)
443                 return;
444
445         teken_funcs_respond(t, response, len + 3);
446 }
447
448 static void
449 teken_subr_double_height_double_width_line_top(teken_t *t __unused)
450 {
451
452         teken_printf("double height double width top\n");
453 }
454
455 static void
456 teken_subr_double_height_double_width_line_bottom(teken_t *t __unused)
457 {
458
459         teken_printf("double height double width bottom\n");
460 }
461
462 static void
463 teken_subr_erase_character(teken_t *t, unsigned int ncols)
464 {
465         teken_rect_t tr;
466
467         tr.tr_begin = t->t_cursor;
468         tr.tr_end.tp_row = t->t_cursor.tp_row + 1;
469
470         if (t->t_cursor.tp_col + ncols >= t->t_winsize.tp_col)
471                 tr.tr_end.tp_col = t->t_winsize.tp_col;
472         else
473                 tr.tr_end.tp_col = t->t_cursor.tp_col + ncols;
474
475         teken_funcs_fill(t, &tr, BLANK, &t->t_curattr);
476 }
477
478 static void
479 teken_subr_erase_display(teken_t *t, unsigned int mode)
480 {
481         teken_rect_t r;
482
483         r.tr_begin.tp_col = 0;
484         r.tr_end.tp_col = t->t_winsize.tp_col;
485
486         switch (mode) {
487         case 1: /* Erase from the top to the cursor. */
488                 teken_subr_erase_line(t, 1);
489
490                 /* Erase lines above. */
491                 if (t->t_cursor.tp_row == 0)
492                         return;
493                 r.tr_begin.tp_row = 0;
494                 r.tr_end.tp_row = t->t_cursor.tp_row;
495                 break;
496         case 2: /* Erase entire display. */
497                 r.tr_begin.tp_row = 0;
498                 r.tr_end.tp_row = t->t_winsize.tp_row;
499                 break;
500         default: /* Erase from cursor to the bottom. */
501                 teken_subr_erase_line(t, 0);
502
503                 /* Erase lines below. */
504                 if (t->t_cursor.tp_row == t->t_winsize.tp_row - 1)
505                         return;
506                 r.tr_begin.tp_row = t->t_cursor.tp_row + 1;
507                 r.tr_end.tp_row = t->t_winsize.tp_row;
508                 break;
509         }
510
511         teken_funcs_fill(t, &r, BLANK, &t->t_curattr);
512 }
513
514 static void
515 teken_subr_erase_line(teken_t *t, unsigned int mode)
516 {
517         teken_rect_t r;
518
519         r.tr_begin.tp_row = t->t_cursor.tp_row;
520         r.tr_end.tp_row = t->t_cursor.tp_row + 1;
521
522         switch (mode) {
523         case 1: /* Erase from the beginning of the line to the cursor. */
524                 r.tr_begin.tp_col = 0;
525                 r.tr_end.tp_col = t->t_cursor.tp_col + 1;
526                 break;
527         case 2: /* Erase entire line. */
528                 r.tr_begin.tp_col = 0;
529                 r.tr_end.tp_col = t->t_winsize.tp_col;
530                 break;
531         default: /* Erase from cursor to the end of the line. */
532                 r.tr_begin.tp_col = t->t_cursor.tp_col;
533                 r.tr_end.tp_col = t->t_winsize.tp_col;
534                 break;
535         }
536
537         teken_funcs_fill(t, &r, BLANK, &t->t_curattr);
538 }
539
540 static void
541 teken_subr_g0_scs_special_graphics(teken_t *t __unused)
542 {
543
544         t->t_scs[0] = teken_scs_special_graphics;
545 }
546
547 static void
548 teken_subr_g0_scs_uk_national(teken_t *t __unused)
549 {
550
551         t->t_scs[0] = teken_scs_uk_national;
552 }
553
554 static void
555 teken_subr_g0_scs_us_ascii(teken_t *t __unused)
556 {
557
558         t->t_scs[0] = teken_scs_us_ascii;
559 }
560
561 static void
562 teken_subr_g1_scs_special_graphics(teken_t *t __unused)
563 {
564
565         t->t_scs[1] = teken_scs_special_graphics;
566 }
567
568 static void
569 teken_subr_g1_scs_uk_national(teken_t *t __unused)
570 {
571
572         t->t_scs[1] = teken_scs_uk_national;
573 }
574
575 static void
576 teken_subr_g1_scs_us_ascii(teken_t *t __unused)
577 {
578
579         t->t_scs[1] = teken_scs_us_ascii;
580 }
581
582 static void
583 teken_subr_horizontal_position_absolute(teken_t *t, unsigned int col)
584 {
585
586         t->t_cursor.tp_col = col - 1;
587         if (t->t_cursor.tp_col >= t->t_winsize.tp_col)
588                 t->t_cursor.tp_col = t->t_winsize.tp_col - 1;
589
590         t->t_stateflags &= ~TS_WRAPPED;
591         teken_funcs_cursor(t);
592 }
593
594 static void
595 teken_subr_horizontal_tab(teken_t *t)
596 {
597
598         if (t->t_stateflags & TS_CONS25) {
599                 teken_subr_cursor_forward_tabulation(t, 1);
600         } else {
601                 teken_rect_t tr;
602
603                 tr.tr_begin = t->t_cursor;
604                 teken_subr_cursor_forward_tabulation(t, 1);
605                 tr.tr_end.tp_row = tr.tr_begin.tp_row + 1;
606                 tr.tr_end.tp_col = t->t_cursor.tp_col;
607
608                 /* Blank region that we skipped. */
609                 if (tr.tr_end.tp_col > tr.tr_begin.tp_col)
610                         teken_funcs_fill(t, &tr, BLANK, &t->t_curattr);
611         }
612 }
613
614 static void
615 teken_subr_horizontal_tab_set(teken_t *t)
616 {
617
618         teken_tab_set(t, t->t_cursor.tp_col);
619 }
620
621 static void
622 teken_subr_index(teken_t *t)
623 {
624
625         if (t->t_cursor.tp_row < t->t_scrollreg.ts_end - 1) {
626                 t->t_cursor.tp_row++;
627                 t->t_stateflags &= ~TS_WRAPPED;
628                 teken_funcs_cursor(t);
629         } else {
630                 teken_subr_do_scroll(t, 1);
631         }
632 }
633
634 static void
635 teken_subr_insert_character(teken_t *t, unsigned int ncols)
636 {
637         teken_rect_t tr;
638
639         tr.tr_begin = t->t_cursor;
640         tr.tr_end.tp_row = t->t_cursor.tp_row + 1;
641
642         if (t->t_cursor.tp_col + ncols >= t->t_winsize.tp_col) {
643                 tr.tr_end.tp_col = t->t_winsize.tp_col;
644         } else {
645                 teken_pos_t tp;
646
647                 /* Copy characters to the right. */
648                 tr.tr_end.tp_col = t->t_winsize.tp_col - ncols;
649                 tp.tp_row = t->t_cursor.tp_row;
650                 tp.tp_col = t->t_cursor.tp_col + ncols;
651                 teken_funcs_copy(t, &tr, &tp);
652
653                 tr.tr_end.tp_col = t->t_cursor.tp_col + ncols;
654         }
655
656         /* Blank current location. */
657         teken_funcs_fill(t, &tr, BLANK, &t->t_curattr);
658 }
659
660 static void
661 teken_subr_insert_line(teken_t *t, unsigned int nrows)
662 {
663         teken_rect_t tr;
664
665         /* Ignore if outside scrolling region. */
666         if (t->t_cursor.tp_row < t->t_scrollreg.ts_begin ||
667             t->t_cursor.tp_row >= t->t_scrollreg.ts_end)
668                 return;
669
670         tr.tr_begin.tp_row = t->t_cursor.tp_row;
671         tr.tr_begin.tp_col = 0;
672         tr.tr_end.tp_col = t->t_winsize.tp_col;
673
674         if (t->t_cursor.tp_row + nrows >= t->t_scrollreg.ts_end) {
675                 tr.tr_end.tp_row = t->t_scrollreg.ts_end;
676         } else {
677                 teken_pos_t tp;
678
679                 /* Copy lines down. */
680                 tr.tr_end.tp_row = t->t_scrollreg.ts_end - nrows;
681                 tp.tp_row = t->t_cursor.tp_row + nrows;
682                 tp.tp_col = 0;
683                 teken_funcs_copy(t, &tr, &tp);
684
685                 tr.tr_end.tp_row = t->t_cursor.tp_row + nrows;
686         }
687
688         /* Blank current location. */
689         teken_funcs_fill(t, &tr, BLANK, &t->t_curattr);
690 }
691
692 static void
693 teken_subr_keypad_application_mode(teken_t *t)
694 {
695
696         teken_funcs_param(t, TP_KEYPADAPP, 1);
697 }
698
699 static void
700 teken_subr_keypad_numeric_mode(teken_t *t)
701 {
702
703         teken_funcs_param(t, TP_KEYPADAPP, 0);
704 }
705
706 static void
707 teken_subr_newline(teken_t *t)
708 {
709
710         t->t_cursor.tp_row++;
711
712         if (t->t_cursor.tp_row >= t->t_scrollreg.ts_end) {
713                 teken_subr_do_scroll(t, 1);
714                 t->t_cursor.tp_row = t->t_scrollreg.ts_end - 1;
715         }
716
717         t->t_stateflags &= ~TS_WRAPPED;
718         teken_funcs_cursor(t);
719 }
720
721 static void
722 teken_subr_newpage(teken_t *t)
723 {
724
725         if (t->t_stateflags & TS_CONS25) {
726                 teken_rect_t tr;
727
728                 tr.tr_begin.tp_row = tr.tr_begin.tp_col = 0;
729                 tr.tr_end = t->t_winsize;
730                 teken_funcs_fill(t, &tr, BLANK, &t->t_curattr);
731
732                 t->t_cursor.tp_row = t->t_cursor.tp_col = 0;
733                 teken_funcs_cursor(t);
734         } else {
735                 teken_subr_newline(t);
736         }
737 }
738
739 static void
740 teken_subr_next_line(teken_t *t)
741 {
742
743         t->t_cursor.tp_col = 0;
744         teken_subr_newline(t);
745 }
746
747 static void
748 teken_subr_operating_system_command(teken_t *t)
749 {
750
751         teken_printf("Unsupported operating system command\n");
752         t->t_stateflags |= TS_INSTRING;
753 }
754
755 static void
756 teken_subr_pan_down(teken_t *t, unsigned int nrows)
757 {
758
759         teken_subr_do_scroll(t, (int)nrows);
760 }
761
762 static void
763 teken_subr_pan_up(teken_t *t, unsigned int nrows)
764 {
765
766         teken_subr_do_scroll(t, -(int)nrows);
767 }
768
769 static void
770 teken_subr_primary_device_attributes(teken_t *t, unsigned int request)
771 {
772
773         if (request == 0) {
774                 const char response[] = "\x1B[?1;2c";
775
776                 teken_funcs_respond(t, response, sizeof response - 1);
777         } else {
778                 teken_printf("Unknown DA1\n");
779         }
780 }
781
782 static void
783 teken_subr_do_putchar(teken_t *t, const teken_pos_t *tp, teken_char_t c,
784     int width)
785 {
786
787         if (t->t_stateflags & TS_INSERT &&
788             tp->tp_col < t->t_winsize.tp_col - width) {
789                 teken_rect_t ctr;
790                 teken_pos_t ctp;
791
792                 /* Insert mode. Move existing characters to the right. */
793                 ctr.tr_begin = *tp;
794                 ctr.tr_end.tp_row = tp->tp_row + 1;
795                 ctr.tr_end.tp_col = t->t_winsize.tp_col - width;
796                 ctp.tp_row = tp->tp_row;
797                 ctp.tp_col = tp->tp_col + width;
798                 teken_funcs_copy(t, &ctr, &ctp);
799         }
800
801         if (width == 2 && tp->tp_col + 1 < t->t_winsize.tp_col) {
802                 teken_pos_t tp2;
803
804                 /*
805                  * Store a space behind double width characters before
806                  * actually printing them. This prevents artifacts when
807                  * the consumer doesn't render it using double width
808                  * glyphs.
809                  */
810                 tp2.tp_row = tp->tp_row;
811                 tp2.tp_col = tp->tp_col + 1;
812                 teken_funcs_putchar(t, &tp2, BLANK, &t->t_curattr);
813         }
814
815         teken_funcs_putchar(t, tp, c, &t->t_curattr);
816 }
817
818 static void
819 teken_subr_regular_character(teken_t *t, teken_char_t c)
820 {
821         int width;
822
823         if (t->t_stateflags & TS_8BIT) {
824                 if (!(t->t_stateflags & TS_CONS25) && (c <= 0x1b || c == 0x7f))
825                         return;
826                 c = teken_scs_process(t, c);
827                 width = 1;
828         } else {
829                 c = teken_scs_process(t, c);
830                 width = teken_wcwidth(c);
831                 /* XXX: Don't process zero-width characters yet. */
832                 if (width <= 0)
833                         return;
834         }
835
836         if (t->t_stateflags & TS_CONS25) {
837                 teken_subr_do_putchar(t, &t->t_cursor, c, width);
838                 t->t_cursor.tp_col += width;
839
840                 if (t->t_cursor.tp_col >= t->t_winsize.tp_col) {
841                         if (t->t_cursor.tp_row == t->t_scrollreg.ts_end - 1) {
842                                 /* Perform scrolling. */
843                                 teken_subr_do_scroll(t, 1);
844                         } else {
845                                 /* No scrolling needed. */
846                                 if (t->t_cursor.tp_row <
847                                     t->t_winsize.tp_row - 1)
848                                         t->t_cursor.tp_row++;
849                         }
850                         t->t_cursor.tp_col = 0;
851                 }
852         } else if (t->t_cursor.tp_col == t->t_winsize.tp_col - 1 &&
853             (t->t_stateflags & (TS_WRAPPED|TS_AUTOWRAP)) ==
854             (TS_WRAPPED|TS_AUTOWRAP)) {
855                 teken_pos_t tp;
856
857                 /* Perform line wrapping. */
858
859                 if (t->t_cursor.tp_row == t->t_scrollreg.ts_end - 1) {
860                         /* Perform scrolling. */
861                         teken_subr_do_scroll(t, 1);
862                         tp.tp_row = t->t_scrollreg.ts_end - 1;
863                 } else {
864                         /* No scrolling needed. */
865                         tp.tp_row = t->t_cursor.tp_row + 1;
866                         if (tp.tp_row == t->t_winsize.tp_row) {
867                                 /*
868                                  * Corner case: regular character
869                                  * outside scrolling region, but at the
870                                  * bottom of the screen.
871                                  */
872                                 teken_subr_do_putchar(t, &t->t_cursor,
873                                     c, width);
874                                 return;
875                         }
876                 }
877
878                 tp.tp_col = 0;
879                 teken_subr_do_putchar(t, &tp, c, width);
880
881                 t->t_cursor.tp_row = tp.tp_row;
882                 t->t_cursor.tp_col = width;
883                 t->t_stateflags &= ~TS_WRAPPED;
884         } else {
885                 /* No line wrapping needed. */
886                 teken_subr_do_putchar(t, &t->t_cursor, c, width);
887                 t->t_cursor.tp_col += width;
888
889                 if (t->t_cursor.tp_col >= t->t_winsize.tp_col) {
890                         t->t_stateflags |= TS_WRAPPED;
891                         t->t_cursor.tp_col = t->t_winsize.tp_col - 1;
892                 } else {
893                         t->t_stateflags &= ~TS_WRAPPED;
894                 }
895         }
896
897         teken_funcs_cursor(t);
898 }
899
900 static void
901 teken_subr_reset_dec_mode(teken_t *t, unsigned int cmd)
902 {
903
904         switch (cmd) {
905         case 1: /* Cursor keys mode. */
906                 t->t_stateflags &= ~TS_CURSORKEYS;
907                 break;
908         case 2: /* DECANM: ANSI/VT52 mode. */
909                 teken_printf("DECRST VT52\n");
910                 break;
911         case 3: /* 132 column mode. */
912                 teken_funcs_param(t, TP_132COLS, 0);
913                 teken_subr_reset_to_initial_state(t);
914                 break;
915         case 5: /* Inverse video. */
916                 teken_printf("DECRST inverse video\n");
917                 break;
918         case 6: /* Origin mode. */
919                 t->t_stateflags &= ~TS_ORIGIN;
920                 t->t_originreg.ts_begin = 0;
921                 t->t_originreg.ts_end = t->t_winsize.tp_row;
922                 t->t_cursor.tp_row = t->t_cursor.tp_col = 0;
923                 t->t_stateflags &= ~TS_WRAPPED;
924                 teken_funcs_cursor(t);
925                 break;
926         case 7: /* Autowrap mode. */
927                 t->t_stateflags &= ~TS_AUTOWRAP;
928                 break;
929         case 8: /* Autorepeat mode. */
930                 teken_funcs_param(t, TP_AUTOREPEAT, 0);
931                 break;
932         case 25: /* Hide cursor. */
933                 teken_funcs_param(t, TP_SHOWCURSOR, 0);
934                 break;
935         case 40: /* Disallow 132 columns. */
936                 teken_printf("DECRST allow 132\n");
937                 break;
938         case 45: /* Disable reverse wraparound. */
939                 teken_printf("DECRST reverse wraparound\n");
940                 break;
941         case 47: /* Switch to alternate buffer. */
942                 teken_printf("Switch to alternate buffer\n");
943                 break;
944         case 1000: /* Mouse input. */
945                 teken_funcs_param(t, TP_MOUSE, 0);
946                 break;
947         default:
948                 teken_printf("Unknown DECRST: %u\n", cmd);
949         }
950 }
951
952 static void
953 teken_subr_reset_mode(teken_t *t, unsigned int cmd)
954 {
955
956         switch (cmd) {
957         case 4:
958                 t->t_stateflags &= ~TS_INSERT;
959                 break;
960         default:
961                 teken_printf("Unknown reset mode: %u\n", cmd);
962         }
963 }
964
965 static void
966 teken_subr_do_reset(teken_t *t)
967 {
968
969         t->t_curattr = t->t_defattr;
970         t->t_cursor.tp_row = t->t_cursor.tp_col = 0;
971         t->t_scrollreg.ts_begin = 0;
972         t->t_scrollreg.ts_end = t->t_winsize.tp_row;
973         t->t_originreg = t->t_scrollreg;
974         t->t_stateflags &= TS_8BIT|TS_CONS25;
975         t->t_stateflags |= TS_AUTOWRAP;
976
977         t->t_scs[0] = teken_scs_us_ascii;
978         t->t_scs[1] = teken_scs_us_ascii;
979         t->t_curscs = 0;
980
981         teken_subr_save_cursor(t);
982         teken_tab_default(t);
983 }
984
985 static void
986 teken_subr_reset_to_initial_state(teken_t *t)
987 {
988
989         teken_subr_do_reset(t);
990         teken_subr_erase_display(t, 2);
991         teken_funcs_param(t, TP_SHOWCURSOR, 1);
992         teken_funcs_cursor(t);
993 }
994
995 static void
996 teken_subr_restore_cursor(teken_t *t)
997 {
998
999         t->t_cursor = t->t_saved_cursor;
1000         t->t_curattr = t->t_saved_curattr;
1001         t->t_scs[t->t_curscs] = t->t_saved_curscs;
1002         t->t_stateflags &= ~TS_WRAPPED;
1003
1004         /* Get out of origin mode when the cursor is moved outside. */
1005         if (t->t_cursor.tp_row < t->t_originreg.ts_begin ||
1006             t->t_cursor.tp_row >= t->t_originreg.ts_end) {
1007                 t->t_stateflags &= ~TS_ORIGIN;
1008                 t->t_originreg.ts_begin = 0;
1009                 t->t_originreg.ts_end = t->t_winsize.tp_row;
1010         }
1011
1012         teken_funcs_cursor(t);
1013 }
1014
1015 static void
1016 teken_subr_reverse_index(teken_t *t)
1017 {
1018
1019         if (t->t_cursor.tp_row > t->t_scrollreg.ts_begin) {
1020                 t->t_cursor.tp_row--;
1021                 t->t_stateflags &= ~TS_WRAPPED;
1022                 teken_funcs_cursor(t);
1023         } else {
1024                 teken_subr_do_scroll(t, -1);
1025         }
1026 }
1027
1028 static void
1029 teken_subr_save_cursor(teken_t *t)
1030 {
1031
1032         t->t_saved_cursor = t->t_cursor;
1033         t->t_saved_curattr = t->t_curattr;
1034         t->t_saved_curscs = t->t_scs[t->t_curscs];
1035 }
1036
1037 static void
1038 teken_subr_secondary_device_attributes(teken_t *t, unsigned int request)
1039 {
1040
1041         if (request == 0) {
1042                 const char response[] = "\x1B[>0;10;0c";
1043                 teken_funcs_respond(t, response, sizeof response - 1);
1044         } else {
1045                 teken_printf("Unknown DA2\n");
1046         }
1047 }
1048
1049 static void
1050 teken_subr_set_dec_mode(teken_t *t, unsigned int cmd)
1051 {
1052
1053         switch (cmd) {
1054         case 1: /* Cursor keys mode. */
1055                 t->t_stateflags |= TS_CURSORKEYS;
1056                 break;
1057         case 2: /* DECANM: ANSI/VT52 mode. */
1058                 teken_printf("DECSET VT52\n");
1059                 break;
1060         case 3: /* 132 column mode. */
1061                 teken_funcs_param(t, TP_132COLS, 1);
1062                 teken_subr_reset_to_initial_state(t);
1063                 break;
1064         case 5: /* Inverse video. */
1065                 teken_printf("DECSET inverse video\n");
1066                 break;
1067         case 6: /* Origin mode. */
1068                 t->t_stateflags |= TS_ORIGIN;
1069                 t->t_originreg = t->t_scrollreg;
1070                 t->t_cursor.tp_row = t->t_scrollreg.ts_begin;
1071                 t->t_cursor.tp_col = 0;
1072                 t->t_stateflags &= ~TS_WRAPPED;
1073                 teken_funcs_cursor(t);
1074                 break;
1075         case 7: /* Autowrap mode. */
1076                 t->t_stateflags |= TS_AUTOWRAP;
1077                 break;
1078         case 8: /* Autorepeat mode. */
1079                 teken_funcs_param(t, TP_AUTOREPEAT, 1);
1080                 break;
1081         case 25: /* Display cursor. */
1082                 teken_funcs_param(t, TP_SHOWCURSOR, 1);
1083                 break;
1084         case 40: /* Allow 132 columns. */
1085                 teken_printf("DECSET allow 132\n");
1086                 break;
1087         case 45: /* Enable reverse wraparound. */
1088                 teken_printf("DECSET reverse wraparound\n");
1089                 break;
1090         case 47: /* Switch to alternate buffer. */
1091                 teken_printf("Switch away from alternate buffer\n");
1092                 break;
1093         case 1000: /* Mouse input. */
1094                 teken_funcs_param(t, TP_MOUSE, 1);
1095                 break;
1096         default:
1097                 teken_printf("Unknown DECSET: %u\n", cmd);
1098         }
1099 }
1100
1101 static void
1102 teken_subr_set_mode(teken_t *t, unsigned int cmd)
1103 {
1104
1105         switch (cmd) {
1106         case 4:
1107                 teken_printf("Insert mode\n");
1108                 t->t_stateflags |= TS_INSERT;
1109                 break;
1110         default:
1111                 teken_printf("Unknown set mode: %u\n", cmd);
1112         }
1113 }
1114
1115 static void
1116 teken_subr_set_graphic_rendition(teken_t *t, unsigned int ncmds,
1117     unsigned int cmds[])
1118 {
1119         unsigned int i, n;
1120
1121         /* No attributes means reset. */
1122         if (ncmds == 0) {
1123                 t->t_curattr = t->t_defattr;
1124                 return;
1125         }
1126
1127         for (i = 0; i < ncmds; i++) {
1128                 n = cmds[i];
1129
1130                 switch (n) {
1131                 case 0: /* Reset. */
1132                         t->t_curattr = t->t_defattr;
1133                         break;
1134                 case 1: /* Bold. */
1135                         t->t_curattr.ta_format |= TF_BOLD;
1136                         break;
1137                 case 4: /* Underline. */
1138                         t->t_curattr.ta_format |= TF_UNDERLINE;
1139                         break;
1140                 case 5: /* Blink. */
1141                         t->t_curattr.ta_format |= TF_BLINK;
1142                         break;
1143                 case 7: /* Reverse. */
1144                         t->t_curattr.ta_format |= TF_REVERSE;
1145                         break;
1146                 case 22: /* Remove bold. */
1147                         t->t_curattr.ta_format &= ~TF_BOLD;
1148                         break;
1149                 case 24: /* Remove underline. */
1150                         t->t_curattr.ta_format &= ~TF_UNDERLINE;
1151                         break;
1152                 case 25: /* Remove blink. */
1153                         t->t_curattr.ta_format &= ~TF_BLINK;
1154                         break;
1155                 case 27: /* Remove reverse. */
1156                         t->t_curattr.ta_format &= ~TF_REVERSE;
1157                         break;
1158                 case 30: /* Set foreground color: black */
1159                 case 31: /* Set foreground color: red */
1160                 case 32: /* Set foreground color: green */
1161                 case 33: /* Set foreground color: brown */
1162                 case 34: /* Set foreground color: blue */
1163                 case 35: /* Set foreground color: magenta */
1164                 case 36: /* Set foreground color: cyan */
1165                 case 37: /* Set foreground color: white */
1166                         t->t_curattr.ta_fgcolor = n - 30;
1167                         break;
1168                 case 38: /* Set foreground color: 256 color mode */
1169                         if (i + 2 >= ncmds || cmds[i + 1] != 5)
1170                                 continue;
1171                         t->t_curattr.ta_fgcolor = cmds[i + 2];
1172                         i += 2;
1173                         break;
1174                 case 39: /* Set default foreground color. */
1175                         t->t_curattr.ta_fgcolor = t->t_defattr.ta_fgcolor;
1176                         break;
1177                 case 40: /* Set background color: black */
1178                 case 41: /* Set background color: red */
1179                 case 42: /* Set background color: green */
1180                 case 43: /* Set background color: brown */
1181                 case 44: /* Set background color: blue */
1182                 case 45: /* Set background color: magenta */
1183                 case 46: /* Set background color: cyan */
1184                 case 47: /* Set background color: white */
1185                         t->t_curattr.ta_bgcolor = n - 40;
1186                         break;
1187                 case 48: /* Set background color: 256 color mode */
1188                         if (i + 2 >= ncmds || cmds[i + 1] != 5)
1189                                 continue;
1190                         t->t_curattr.ta_bgcolor = cmds[i + 2];
1191                         i += 2;
1192                         break;
1193                 case 49: /* Set default background color. */
1194                         t->t_curattr.ta_bgcolor = t->t_defattr.ta_bgcolor;
1195                         break;
1196                 case 90: /* Set bright foreground color: black */
1197                 case 91: /* Set bright foreground color: red */
1198                 case 92: /* Set bright foreground color: green */
1199                 case 93: /* Set bright foreground color: brown */
1200                 case 94: /* Set bright foreground color: blue */
1201                 case 95: /* Set bright foreground color: magenta */
1202                 case 96: /* Set bright foreground color: cyan */
1203                 case 97: /* Set bright foreground color: white */
1204                         t->t_curattr.ta_fgcolor = n - 90 + 8;
1205                         break;
1206                 case 100: /* Set bright background color: black */
1207                 case 101: /* Set bright background color: red */
1208                 case 102: /* Set bright background color: green */
1209                 case 103: /* Set bright background color: brown */
1210                 case 104: /* Set bright background color: blue */
1211                 case 105: /* Set bright background color: magenta */
1212                 case 106: /* Set bright background color: cyan */
1213                 case 107: /* Set bright background color: white */
1214                         t->t_curattr.ta_bgcolor = n - 100 + 8;
1215                         break;
1216                 default:
1217                         teken_printf("unsupported attribute %u\n", n);
1218                 }
1219         }
1220 }
1221
1222 static void
1223 teken_subr_set_top_and_bottom_margins(teken_t *t, unsigned int top,
1224     unsigned int bottom)
1225 {
1226
1227         /* Adjust top row number. */
1228         if (top > 0)
1229                 top--;
1230         /* Adjust bottom row number. */
1231         if (bottom == 0 || bottom > t->t_winsize.tp_row)
1232                 bottom = t->t_winsize.tp_row;
1233
1234         /* Invalid arguments. */
1235         if (top >= bottom - 1) {
1236                 top = 0;
1237                 bottom = t->t_winsize.tp_row;
1238         }
1239
1240         /* Apply scrolling region. */
1241         t->t_scrollreg.ts_begin = top;
1242         t->t_scrollreg.ts_end = bottom;
1243         if (t->t_stateflags & TS_ORIGIN)
1244                 t->t_originreg = t->t_scrollreg;
1245
1246         /* Home cursor to the top left of the scrolling region. */
1247         t->t_cursor.tp_row = t->t_originreg.ts_begin;
1248         t->t_cursor.tp_col = 0;
1249         t->t_stateflags &= ~TS_WRAPPED;
1250         teken_funcs_cursor(t);
1251 }
1252
1253 static void
1254 teken_subr_single_height_double_width_line(teken_t *t __unused)
1255 {
1256
1257         teken_printf("single height double width???\n");
1258 }
1259
1260 static void
1261 teken_subr_single_height_single_width_line(teken_t *t __unused)
1262 {
1263
1264         teken_printf("single height single width???\n");
1265 }
1266
1267 static void
1268 teken_subr_string_terminator(teken_t *t __unused)
1269 {
1270
1271         /*
1272          * Strings are already terminated in teken_input_char() when ^[
1273          * is inserted.
1274          */
1275 }
1276
1277 static void
1278 teken_subr_tab_clear(teken_t *t, unsigned int cmd)
1279 {
1280
1281         switch (cmd) {
1282         case 0:
1283                 teken_tab_clear(t, t->t_cursor.tp_col);
1284                 break;
1285         case 3:
1286                 memset(&t->t_tabstops, 0, T_NUMCOL / 8);
1287                 break;
1288         }
1289 }
1290
1291 static void
1292 teken_subr_vertical_position_absolute(teken_t *t, unsigned int row)
1293 {
1294
1295         t->t_cursor.tp_row = t->t_originreg.ts_begin + row - 1;
1296         if (row >= t->t_originreg.ts_end)
1297                 t->t_cursor.tp_row = t->t_originreg.ts_end - 1;
1298
1299
1300         t->t_stateflags &= ~TS_WRAPPED;
1301         teken_funcs_cursor(t);
1302 }