helos1/extlib/libvterm/parser.c

#include "vterm_internal.h"

#include <stdio.h>
#include <string.h>

#include "../../runtime/printf.h"

#undef DEBUG_PARSER

static bool is_intermed(unsigned char c) {
	return c >= 0x20 && c <= 0x2f;
}

static void do_control(VTerm *vt, unsigned char control) {
	if (vt->parser.callbacks && vt->parser.callbacks->control)
		if ((*vt->parser.callbacks->control)(control, vt->parser.cbdata))
			return;

	DEBUG_LOG("libvterm: Unhandled control 0x%02x\n", control);
}

static void do_csi(VTerm *vt, char command) {
#ifdef DEBUG_PARSER
	printf("Parsed CSI args as:\n", arglen, args);
	printf(" leader: %s\n", vt->parser.csi_leader);
	for (int argi = 0; argi < vt->parser.csi_argi; argi++) {
		printf(" %lu", CSI_ARG(vt->parser.csi_args[argi]));
		if (!CSI_ARG_HAS_MORE(vt->parser.csi_args[argi]))
			printf("\n");
		printf(" intermed: %s\n", vt->parser.intermed);
	}
#endif

	if (vt->parser.callbacks && vt->parser.callbacks->csi)
		if ((*vt->parser.callbacks->csi)(
				vt->parser.csi_leaderlen ? vt->parser.csi_leader : NULL,
				vt->parser.csi_args,
				vt->parser.csi_argi,
				vt->parser.intermedlen ? vt->parser.intermed : NULL,
				command,
				vt->parser.cbdata))
			return;

	DEBUG_LOG("libvterm: Unhandled CSI %c\n", command);
}

static void do_escape(VTerm *vt, char command) {
	char seq[INTERMED_MAX + 1];

	size_t len = vt->parser.intermedlen;
	strncpy(seq, vt->parser.intermed, len);
	seq[len++] = command;
	seq[len]   = 0;

	if (vt->parser.callbacks && vt->parser.callbacks->escape)
		if ((*vt->parser.callbacks->escape)(seq, len, vt->parser.cbdata))
			return;

	DEBUG_LOG("libvterm: Unhandled escape ESC 0x%02x\n", command);
}

static void append_strbuffer(VTerm *vt, const char *str, size_t len) {
	if (len > vt->parser.strbuffer_len - vt->parser.strbuffer_cur) {
		len = vt->parser.strbuffer_len - vt->parser.strbuffer_cur;
		DEBUG_LOG("Truncating strbuffer preserve to %zd bytes\n", len);
	}

	if (len > 0) {
		strncpy(vt->parser.strbuffer + vt->parser.strbuffer_cur, str, len);
		vt->parser.strbuffer_cur += len;
	}
}

static void start_string(VTerm *vt, VTermParserStringType type) {
	vt->parser.stringtype = type;

	vt->parser.strbuffer_cur = 0;
}

static void more_string(VTerm *vt, const char *str, size_t len) {
	append_strbuffer(vt, str, len);
}

static void done_string(VTerm *vt, const char *str, size_t len) {
	if (vt->parser.strbuffer_cur) {
		if (str)
			append_strbuffer(vt, str, len);

		str = vt->parser.strbuffer;
		len = vt->parser.strbuffer_cur;
	} else if (!str) {
		DEBUG_LOG("parser.c: TODO: No strbuffer _and_ no final fragment???\n");
		len = 0;
	}

	switch (vt->parser.stringtype) {
		case VTERM_PARSER_OSC:
			if (vt->parser.callbacks && vt->parser.callbacks->osc)
				if ((*vt->parser.callbacks->osc)(str, len, vt->parser.cbdata))
					return;

			DEBUG_LOG("libvterm: Unhandled OSC %.*s\n", (int)len, str);
			return;

		case VTERM_PARSER_DCS:
			if (vt->parser.callbacks && vt->parser.callbacks->dcs)
				if ((*vt->parser.callbacks->dcs)(str, len, vt->parser.cbdata))
					return;

			DEBUG_LOG("libvterm: Unhandled DCS %.*s\n", (int)len, str);
			return;

		case VTERM_N_PARSER_TYPES:
			return;
	}
}

size_t vterm_input_write(VTerm *vt, const char *bytes, size_t len) {
	size_t      pos = 0;
	const char *string_start;

	switch (vt->parser.state) {
		case NORMAL:
		case CSI_LEADER:
		case CSI_ARGS:
		case CSI_INTERMED:
		case ESC:
			string_start = NULL;
			break;
		case STRING:
		case ESC_IN_STRING:
			string_start = bytes;
			break;
	}

#define ENTER_STRING_STATE(st)              \
	do {                                    \
		vt->parser.state = STRING;          \
		string_start     = bytes + pos + 1; \
	} while (0)
#define ENTER_STATE(st)          \
	do {                         \
		vt->parser.state = st;   \
		string_start     = NULL; \
	} while (0)
#define ENTER_NORMAL_STATE() ENTER_STATE(NORMAL)

	for (; pos < len; pos++) {
		unsigned char c = bytes[pos];

		if (c == 0x00 || c == 0x7f) { // NUL, DEL
			if (vt->parser.state >= STRING) {
				more_string(vt, string_start, bytes + pos - string_start);
				string_start = bytes + pos + 1;
			}
			continue;
		}
		if (c == 0x18 || c == 0x1a) { // CAN, SUB
			ENTER_NORMAL_STATE();
			continue;
		} else if (c == 0x1b) { // ESC
			vt->parser.intermedlen = 0;
			if (vt->parser.state == STRING)
				vt->parser.state = ESC_IN_STRING;
			else
				ENTER_STATE(ESC);
			continue;
		} else if (c == 0x07 && // BEL, can stand for ST in OSC or DCS state
				   vt->parser.state == STRING) {
			// fallthrough
		} else if (c < 0x20) { // other C0
			if (vt->parser.state >= STRING)
				more_string(vt, string_start, bytes + pos - string_start);
			do_control(vt, c);
			if (vt->parser.state >= STRING)
				string_start = bytes + pos + 1;
			continue;
		}
		// else fallthrough

		switch (vt->parser.state) {
			case ESC_IN_STRING:
				if (c == 0x5c) { // ST
					vt->parser.state = STRING;
					done_string(vt, string_start, bytes + pos - string_start - 1);
					ENTER_NORMAL_STATE();
					break;
				}
				vt->parser.state = ESC;
				// else fallthrough

			case ESC:
				switch (c) {
					case 0x50: // DCS
						start_string(vt, VTERM_PARSER_DCS);
						ENTER_STRING_STATE();
						break;
					case 0x5b: // CSI
						vt->parser.csi_leaderlen = 0;
						ENTER_STATE(CSI_LEADER);
						break;
					case 0x5d: // OSC
						start_string(vt, VTERM_PARSER_OSC);
						ENTER_STRING_STATE();
						break;
					default:
						if (is_intermed(c)) {
							if (vt->parser.intermedlen < INTERMED_MAX - 1)
								vt->parser.intermed[vt->parser.intermedlen++] = c;
						} else if (!vt->parser.intermedlen && c >= 0x40 && c < 0x60) {
							do_control(vt, c + 0x40);
							ENTER_NORMAL_STATE();
						} else if (c >= 0x30 && c < 0x7f) {
							do_escape(vt, c);
							ENTER_NORMAL_STATE();
						} else {
							DEBUG_LOG("TODO: Unhandled byte %02x in Escape\n", c);
						}
				}
				break;

			case CSI_LEADER:
				/* Extract leader bytes 0x3c to 0x3f */
				if (c >= 0x3c && c <= 0x3f) {
					if (vt->parser.csi_leaderlen < CSI_LEADER_MAX - 1)
						vt->parser.csi_leader[vt->parser.csi_leaderlen++] = c;
					break;
				}

				/* else fallthrough */
				vt->parser.csi_leader[vt->parser.csi_leaderlen] = 0;

				vt->parser.csi_argi    = 0;
				vt->parser.csi_args[0] = CSI_ARG_MISSING;
				vt->parser.state       = CSI_ARGS;

				/* fallthrough */
			case CSI_ARGS:
				/* Numerical value of argument */
				if (c >= '0' && c <= '9') {
					if (vt->parser.csi_args[vt->parser.csi_argi] == CSI_ARG_MISSING)
						vt->parser.csi_args[vt->parser.csi_argi] = 0;
					vt->parser.csi_args[vt->parser.csi_argi] *= 10;
					vt->parser.csi_args[vt->parser.csi_argi] += c - '0';
					break;
				}
				if (c == ':') {
					vt->parser.csi_args[vt->parser.csi_argi] |= CSI_ARG_FLAG_MORE;
					c = ';';
				}
				if (c == ';') {
					vt->parser.csi_argi++;
					vt->parser.csi_args[vt->parser.csi_argi] = CSI_ARG_MISSING;
					break;
				}

				/* else fallthrough */
				vt->parser.csi_argi++;
				vt->parser.intermedlen = 0;
				vt->parser.state       = CSI_INTERMED;
			case CSI_INTERMED:
				if (is_intermed(c)) {
					if (vt->parser.intermedlen < INTERMED_MAX - 1)
						vt->parser.intermed[vt->parser.intermedlen++] = c;
					break;
				} else if (c == 0x1b) {
					/* ESC in CSI cancels */
				} else if (c >= 0x40 && c <= 0x7e) {
					vt->parser.intermed[vt->parser.intermedlen] = 0;
					do_csi(vt, c);
				}
				/* else was invalid CSI */

				ENTER_NORMAL_STATE();
				break;

			case STRING:
				if (c == 0x07 || (c == 0x9c && !vt->mode.utf8)) {
					done_string(vt, string_start, bytes + pos - string_start);
					ENTER_NORMAL_STATE();
				}
				break;

			case NORMAL:
				if (c >= 0x80 && c < 0xa0 && !vt->mode.utf8) {
					switch (c) {
						case 0x90: // DCS
							start_string(vt, VTERM_PARSER_DCS);
							ENTER_STRING_STATE();
							break;
						case 0x9b: // CSI
							ENTER_STATE(CSI_LEADER);
							break;
						case 0x9d: // OSC
							start_string(vt, VTERM_PARSER_OSC);
							ENTER_STRING_STATE();
							break;
						default:
							do_control(vt, c);
							break;
					}
				} else {
					size_t eaten = 0;
					if (vt->parser.callbacks && vt->parser.callbacks->text)
						eaten = (*vt->parser.callbacks->text)(bytes + pos, len - pos, vt->parser.cbdata);

					if (!eaten) {
						DEBUG_LOG("libvterm: Text callback did not consume any input\n");
						/* force it to make progress */
						eaten = 1;
					}

					pos += (eaten - 1); // we'll ++ it again in a moment
				}
				break;
		}
	}

	return len;
}

void vterm_parser_set_callbacks(VTerm *vt, const VTermParserCallbacks *callbacks, void *user) {
	vt->parser.callbacks = callbacks;
	vt->parser.cbdata    = user;
}

void *vterm_parser_get_cbdata(VTerm *vt) {
	return vt->parser.cbdata;
}