inject_csi.c

   1 #include "inject_csi.h"
   2 #include "roteprivate.h"
   3 #include <stdlib.h>
   4 #include <string.h>
   5
   6 #define MAX_CSI_ES_PARAMS 32
   7
   8 static inline void clamp_cursor_to_bounds(RoteTerm *rt) {
   9    if (rt->crow < 0) rt->curpos_dirty = true, rt->crow = 0;
  10    if (rt->ccol < 0) rt->curpos_dirty = true, rt->ccol = 0;
  11
  12    if (rt->crow >= rt->rows)
  13       rt->curpos_dirty = true, rt->crow = rt->rows - 1;
  14
  15    if (rt->ccol >= rt->cols)
  16       rt->curpos_dirty = true, rt->ccol = rt->cols - 1;
  17 }
  18
  19 /* interprets a 'set attribute' (SGR) CSI escape sequence */
  20 static void interpret_csi_SGR(RoteTerm *rt, int param[], int pcount) {
  21    int i;
  22
  23    if (pcount == 0) {
  24       /* special case: reset attributes */
  25       rt->curattr = 0x70;
  26       return;
  27    }
  28
  29    for (i = 0; i < pcount; i++) {
  30       if (param[i] == 0) rt->curattr = 0x70;
  31       else if (param[i] == 1 || param[i] == 2 || param[i] == 4)  /* set bold */
  32          rt->curattr |= 0x80;
  33       else if (param[i] == 5) rt->curattr |= 0x08;  /* set blink */
  34       else if (param[i] == 7) rt->curattr = 0x07;   /* reverse video */
  35       else if (param[i] >= 30 && param[i] <= 37)    /* set fg */
  36          ROTE_ATTR_MOD_FG(rt->curattr, param[i] - 30);
  37       else if (param[i] >= 40 && param[i] <= 47)    /* set bg */
  38          ROTE_ATTR_MOD_BG(rt->curattr, param[i] - 40);
  39       else if (param[i] == 39)  /* reset foreground to default */
  40          ROTE_ATTR_MOD_FG(rt->curattr, 7);
  41       else if (param[i] == 49)  /* reset background to default */
  42          ROTE_ATTR_MOD_BG(rt->curattr, 0);
  43    }
  44 }
  45
  46 /* interprets an 'erase display' (ED) escape sequence */
  47 static void interpret_csi_ED(RoteTerm *rt, int param[], int pcount) {
  48    int r, c;
  49    int start_row, start_col, end_row, end_col;
  50
  51    /* decide range */
  52    if (pcount && param[0] == 2)
  53                       start_row = 0, start_col = 0, end_row = rt->rows - 1,
  54                       end_col = rt->cols - 1;
  55
  56    else if (pcount && param[0] == 1)
  57                       start_row = 0, start_col = 0, end_row = rt->crow,
  58                       end_col = rt->ccol;
  59
  60    else start_row = rt->crow, start_col = rt->ccol,
  61         end_row = rt->rows - 1, end_col = rt->cols - 1;
  62
  63    /* clean range */
  64    for (r = start_row; r <= end_row; r++) {
  65       rt->line_dirty[r] = true;
  66
  67       for (c = (r == start_row ? start_col : 0);
  68                              c <= (r == end_row ? end_col : rt->cols - 1);
  69                              c++) {
  70          rt->cells[r][c].ch = 0x20;
  71          rt->cells[r][c].attr = rt->curattr;
  72       }
  73    }
  74 }
  75
  76 /* interprets a 'move cursor' (CUP) escape sequence */
  77 static void interpret_csi_CUP(RoteTerm *rt, int param[], int pcount) {
  78    if (pcount == 0) {
  79       /* special case */
  80       rt->crow = rt->ccol = 0;
  81       return;
  82    }
  83    else if (pcount < 2) return;  /* malformed */
  84
  85    rt->crow = param[0] - 1;  /* convert from 1-based to 0-based */
  86    rt->ccol = param[1] - 1;  /* convert from 1-based to 0-based */
  87
  88    rt->curpos_dirty = true;
  89
  90    clamp_cursor_to_bounds(rt);
  91 }
  92
  93 /* Interpret the 'relative mode' sequences: CUU, CUD, CUF, CUB, CNL,
  94  * CPL, CHA, HPR, VPA, VPR, HPA */
  95 static void interpret_csi_C(RoteTerm *rt, char verb,
  96                                                 int param[], int pcount) {
  97    int n = (pcount && param[0] > 0) ? param[0] : 1;
  98
  99    switch (verb) {
 100       case 'A':           rt->crow -= n; break;
 101       case 'B': case 'e': rt->crow += n; break;
 102       case 'C': case 'a': rt->ccol += n; break;
 103       case 'D':           rt->ccol -= n; break;
 104       case 'E':           rt->crow += n; rt->ccol = 0; break;
 105       case 'F':           rt->crow -= n; rt->ccol = 0; break;
 106       case 'G': case '`': rt->ccol  = param[0] - 1; break;
 107       case 'd':           rt->crow  = param[0] - 1; break;
 108    }
 109
 110    rt->curpos_dirty = true;
 111    clamp_cursor_to_bounds(rt);
 112 }
 113
 114 /* Interpret the 'erase line' escape sequence */
 115 static void interpret_csi_EL(RoteTerm *rt, int param[], int pcount) {
 116    int erase_start, erase_end, i;
 117    int cmd = pcount ? param[0] : 0;
 118
 119    switch (cmd) {
 120       case 1:  erase_start = 0;           erase_end = rt->ccol;     break;
 121       case 2:  erase_start = 0;           erase_end = rt->cols - 1; break;
 122       default: erase_start = rt->ccol;    erase_end = rt->cols - 1; break;
 123    }
 124
 125    for (i = erase_start; i <= erase_end; i++) {
 126       rt->cells[rt->crow][i].ch = 0x20;
 127       rt->cells[rt->crow][i].attr = rt->curattr;
 128    }
 129
 130    rt->line_dirty[rt->crow] = true;
 131 }
 132
 133 /* Interpret the 'insert blanks' sequence (ICH) */
 134 static void interpret_csi_ICH(RoteTerm *rt, int param[], int pcount) {
 135    int n = (pcount && param[0] > 0) ? param[0] : 1;
 136    int i;
 137    for (i = rt->cols - 1; i >= rt->ccol + n; i--)
 138       rt->cells[rt->crow][i] = rt->cells[rt->crow][i - n];
 139    for (i = rt->ccol; i < rt->ccol + n; i++) {
 140       rt->cells[rt->crow][i].ch = 0x20;
 141       rt->cells[rt->crow][i].attr = rt->curattr;
 142    }
 143
 144    rt->line_dirty[rt->crow] = true;
 145 }
 146
 147 /* Interpret the 'delete chars' sequence (DCH) */
 148 static void interpret_csi_DCH(RoteTerm *rt, int param[], int pcount) {
 149    int n = (pcount && param[0] > 0) ? param[0] : 1;
 150    int i;
 151    for (i = rt->ccol; i < rt->cols; i++) {
 152      if (i + n < rt->cols)
 153          rt->cells[rt->crow][i] = rt->cells[rt->crow][i + n];
 154      else {
 155          rt->cells[rt->crow][i].ch = 0x20;
 156          rt->cells[rt->crow][i].attr = rt->curattr;
 157      }
 158    }
 159
 160    rt->line_dirty[rt->crow] = true;
 161 }
 162
 163 /* Interpret an 'insert line' sequence (IL) */
 164 static void interpret_csi_IL(RoteTerm *rt, int param[], int pcount) {
 165    int n = (pcount && param[0] > 0) ? param[0] : 1;
 166    int i, j;
 167
 168    for (i = rt->pd->scrollbottom; i >= rt->crow + n; i--)
 169       memcpy(rt->cells[i], rt->cells[i - n], sizeof(RoteCell) * rt->cols);
 170
 171    for (i = rt->crow; i < rt->crow + n && i <= rt->pd->scrollbottom; i++) {
 172       rt->line_dirty[i] = true;
 173       for (j = 0; j < rt->cols; j++)
 174          rt->cells[i][j].ch = 0x20, rt->cells[i][j].attr = rt->curattr;
 175    }
 176
 177 }
 178
 179 /* Interpret a 'delete line' sequence (DL) */
 180 static void interpret_csi_DL(RoteTerm *rt, int param[], int pcount) {
 181    int n = (pcount && param[0] > 0) ? param[0] : 1;
 182    int i, j;
 183
 184    for (i = rt->crow; i <= rt->pd->scrollbottom; i++) {
 185       rt->line_dirty[i] = true;
 186       if (i + n <= rt->pd->scrollbottom)
 187          memcpy(rt->cells[i], rt->cells[i+n], sizeof(RoteCell) * rt->cols);
 188       else {
 189          for (j = 0; j < rt->cols; j++)
 190             rt->cells[i][j].ch = 0x20, rt->cells[i][j].attr = rt->curattr;
 191       }
 192    }
 193 }
 194
 195 /* Interpret an 'erase characters' (ECH) sequence */
 196 static void interpret_csi_ECH(RoteTerm *rt, int param[], int pcount) {
 197    int n = (pcount && param[0] > 0) ? param[0] : 1;
 198    int i;
 199
 200    for (i = rt->ccol; i < rt->ccol + n && i < rt->cols; i++) {
 201       rt->cells[rt->crow][i].ch = 0x20;
 202       rt->cells[rt->crow][i].attr = rt->curattr;
 203    }
 204
 205    rt->line_dirty[rt->crow] = true;
 206 }
 207
 208 /* Interpret a 'set scrolling region' (DECSTBM) sequence */
 209 static void interpret_csi_DECSTBM(RoteTerm *rt, int param[], int pcount) {
 210    int newtop, newbottom;
 211
 212    if (!pcount) {
 213       newtop = 0;
 214       newbottom = rt->rows - 1;
 215    }
 216    else if (pcount < 2) return; /* malformed */
 217    else {
 218       newtop = param[0] - 1;
 219       newbottom = param[1] - 1;
 220    }
 221
 222    /* clamp to bounds */
 223    if (newtop < 0) newtop = 0;
 224    if (newtop >= rt->rows) newtop = rt->rows - 1;
 225    if (newbottom < 0) newbottom = 0;
 226    if (newbottom >= rt->rows) newbottom = rt->rows - 1;
 227
 228    /* check for range validity */
 229    if (newtop > newbottom) return;
 230    rt->pd->scrolltop = newtop;
 231    rt->pd->scrollbottom = newbottom;
 232 }
 233
 234 static void interpret_csi_SAVECUR(RoteTerm *rt, int param[], int pcount) {
 235    rt->pd->saved_x = rt->ccol;
 236    rt->pd->saved_y = rt->crow;
 237 }
 238
 239 static void interpret_csi_RESTORECUR(RoteTerm *rt, int param[], int pcount) {
 240    rt->ccol = rt->pd->saved_x;
 241    rt->crow = rt->pd->saved_y;
 242    rt->curpos_dirty = true;
 243 }
 244
 245 void rote_es_interpret_csi(RoteTerm *rt) {
 246    static int csiparam[MAX_CSI_ES_PARAMS];
 247    int param_count = 0;
 248    const char *p = rt->pd->esbuf + 1;
 249    char verb = rt->pd->esbuf[rt->pd->esbuf_len - 1];
 250
 251    if (!strncmp(rt->pd->esbuf, "[?", 2)) { /* private-mode CSI, ignore */
 252       #ifdef DEBUG
 253       fprintf(stderr, "Ignoring private-mode CSI: <%s>\n", rt->pd->esbuf);
 254       #endif
 255       return;
 256    }
 257
 258    /* parse numeric parameters */
 259    while ((*p >= '0' && *p <= '9') || *p == ';') {
 260       if (*p == ';') {
 261          if (param_count >= MAX_CSI_ES_PARAMS) return; /* too long! */
 262          csiparam[param_count++] = 0;
 263       }
 264       else {
 265          if (param_count == 0) csiparam[param_count++] = 0;
 266          csiparam[param_count - 1] *= 10;
 267          csiparam[param_count - 1] += *p - '0';
 268       }
 269
 270       p++;
 271    }
 272
 273    /* delegate handling depending on command character (verb) */
 274    switch (verb) {
 275       case 'm': /* it's a 'set attribute' sequence */
 276          interpret_csi_SGR(rt, csiparam, param_count); break;
 277       case 'J': /* it's an 'erase display' sequence */
 278          interpret_csi_ED(rt, csiparam, param_count); break;
 279       case 'H': case 'f': /* it's a 'move cursor' sequence */
 280          interpret_csi_CUP(rt, csiparam, param_count); break;
 281       case 'A': case 'B': case 'C': case 'D': case 'E': case 'F': case 'G':
 282       case 'e': case 'a': case 'd': case '`':
 283          /* it is a 'relative move' */
 284          interpret_csi_C(rt, verb, csiparam, param_count); break;
 285       case 'K': /* erase line */
 286          interpret_csi_EL(rt, csiparam, param_count); break;
 287       case '@': /* insert characters */
 288          interpret_csi_ICH(rt, csiparam, param_count); break;
 289       case 'P': /* delete characters */
 290          interpret_csi_DCH(rt, csiparam, param_count); break;
 291       case 'L': /* insert lines */
 292          interpret_csi_IL(rt, csiparam, param_count); break;
 293       case 'M': /* delete lines */
 294          interpret_csi_DL(rt, csiparam, param_count); break;
 295       case 'X': /* erase chars */
 296          interpret_csi_ECH(rt, csiparam, param_count); break;
 297       case 'r': /* set scrolling region */
 298          interpret_csi_DECSTBM(rt, csiparam, param_count); break;
 299       case 's': /* save cursor location */
 300          interpret_csi_SAVECUR(rt, csiparam, param_count); break;
 301       case 'u': /* restore cursor location */
 302          interpret_csi_RESTORECUR(rt, csiparam, param_count); break;
 303       #ifdef DEBUG
 304       default:
 305          fprintf(stderr, "Unrecogized CSI: <%s>\n", rt->pd->esbuf); break;
 306       #endif
 307    }
 308 }
 309