vt100.c 7.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442
  1. #include <stdlib.h>
  2. #include <stdio.h>
  3. #include <unistd.h>
  4. #include <fcntl.h>
  5. #include <string.h>
  6. #include <sys/ioctl.h>
  7. #include <sys/time.h>
  8. #include <sys/types.h>
  9. #include <sys/select.h>
  10. #include <errno.h>
  11. #include <tinyrl/vt100.h>
  12. struct vt100_s {
  13. FILE *istream;
  14. FILE *ostream;
  15. int timeout; // Input timeout in seconds
  16. };
  17. typedef struct {
  18. const char *sequence;
  19. vt100_esc_e code;
  20. } vt100_decode_t;
  21. // This table maps the vt100 escape codes to an enumeration
  22. static vt100_decode_t esc_map[] = {
  23. {"[A", VT100_CURSOR_UP},
  24. {"[B", VT100_CURSOR_DOWN},
  25. {"[C", VT100_CURSOR_RIGHT},
  26. {"[D", VT100_CURSOR_LEFT},
  27. {"[H", VT100_HOME},
  28. {"[1~", VT100_HOME},
  29. {"[F", VT100_END},
  30. {"[4~", VT100_END},
  31. {"[2~", VT100_INSERT},
  32. {"[3~", VT100_DELETE},
  33. {"[5~", VT100_PGUP},
  34. {"[6~", VT100_PGDOWN},
  35. };
  36. vt100_t *vt100_new(FILE *istream, FILE *ostream)
  37. {
  38. vt100_t *vt100 = NULL;
  39. vt100 = malloc(sizeof(vt100_t));
  40. if (!vt100)
  41. return NULL;
  42. // Initialize
  43. vt100->istream = istream;
  44. vt100->ostream = ostream;
  45. vt100->timeout = -1; // No timeout by default
  46. return vt100;
  47. }
  48. void vt100_free(vt100_t *vt100)
  49. {
  50. free(vt100);
  51. }
  52. FILE *vt100_istream(const vt100_t *vt100)
  53. {
  54. if (!vt100)
  55. return NULL;
  56. return vt100->istream;
  57. }
  58. void vt100_set_istream(vt100_t *vt100, FILE *istream)
  59. {
  60. if (!vt100)
  61. return;
  62. vt100->istream = istream;
  63. }
  64. FILE *vt100_ostream(const vt100_t *vt100)
  65. {
  66. if (!vt100)
  67. return NULL;
  68. return vt100->ostream;
  69. }
  70. void vt100_set_ostream(vt100_t *vt100, FILE *ostream)
  71. {
  72. if (!vt100)
  73. return;
  74. vt100->ostream = ostream;
  75. }
  76. int vt100_timeout(vt100_t *vt100)
  77. {
  78. if (!vt100)
  79. return -1;
  80. return vt100->timeout;
  81. }
  82. void vt100__set_timeout(vt100_t *vt100, int timeout)
  83. {
  84. if (!vt100)
  85. return;
  86. vt100->timeout = timeout;
  87. }
  88. vt100_esc_e vt100_esc_decode(const vt100_t *vt100, const char *esc_seq)
  89. {
  90. vt100_esc_e result = VT100_UNKNOWN;
  91. unsigned int i = 0;
  92. for (i = 0; i < (sizeof(esc_map) / sizeof(vt100_decode_t)); i++) {
  93. if (strcmp(esc_map[i].sequence, esc_seq))
  94. continue;
  95. result = esc_map[i].code;
  96. break;
  97. }
  98. vt100 = vt100; // Happy compiler
  99. return result;
  100. }
  101. int vt100_printf(const vt100_t *vt100, const char *fmt, ...)
  102. {
  103. va_list args;
  104. int len = 0;
  105. // If ostream is not set don't consider it as a error. Consider it
  106. // as a printf to NULL.
  107. if (!vt100 || !vt100->ostream)
  108. return 0;
  109. va_start(args, fmt);
  110. len = vt100_vprintf(vt100, fmt, args);
  111. va_end(args);
  112. return len;
  113. }
  114. int vt100_vprintf(const vt100_t *vt100, const char *fmt, va_list args)
  115. {
  116. if (!vt100 || !vt100->ostream)
  117. return 0;
  118. return vfprintf(vt100->ostream, fmt, args);
  119. }
  120. int vt100_getchar(const vt100_t *vt100)
  121. {
  122. unsigned char c = 0;
  123. int istream_fd = -1;
  124. fd_set rfds = {};
  125. struct timeval tv = {};
  126. int retval = 0;
  127. ssize_t res = VT100_RET_ERR;
  128. if (!vt100 || !vt100->istream)
  129. return VT100_RET_ERR;
  130. istream_fd = fileno(vt100->istream);
  131. // Simple variant
  132. // Just wait for the input if no timeout specified
  133. if (vt100->timeout <= 0) {
  134. while (((res = read(istream_fd, &c, 1)) < 0) &&
  135. (EAGAIN == errno));
  136. // EOF or error
  137. if (res < 0)
  138. return VT100_RET_ERR;
  139. if (0 == res)
  140. return VT100_RET_EOF;
  141. return c;
  142. }
  143. // Variant with timeout
  144. // Set timeout for the select()
  145. FD_ZERO(&rfds);
  146. FD_SET(istream_fd, &rfds);
  147. tv.tv_sec = vt100->timeout;
  148. tv.tv_usec = 0;
  149. while (((retval = select(istream_fd + 1, &rfds, NULL, NULL, &tv)) < 0) &&
  150. (EAGAIN == errno));
  151. // Error or timeout
  152. if (retval < 0)
  153. return VT100_RET_ERR;
  154. if (0 == retval)
  155. return VT100_RET_TIMEOUT;
  156. res = read(istream_fd, &c, 1);
  157. // EOF or error
  158. if (res < 0)
  159. return VT100_RET_ERR;
  160. if (0 == res)
  161. return VT100_RET_EOF;
  162. return c;
  163. }
  164. int vt100_oflush(const vt100_t *vt100)
  165. {
  166. if (!vt100 || !vt100->ostream)
  167. return 0;
  168. return fflush(vt100->ostream);
  169. }
  170. int vt100_ierror(const vt100_t *vt100)
  171. {
  172. if (!vt100 || !vt100->istream)
  173. return 0;
  174. return ferror(vt100->istream);
  175. }
  176. int vt100_oerror(const vt100_t *vt100)
  177. {
  178. if (!vt100 || !vt100->ostream)
  179. return 0;
  180. return ferror(vt100->ostream);
  181. }
  182. int vt100_ieof(const vt100_t *vt100)
  183. {
  184. if (!vt100 || !vt100->istream)
  185. return 0;
  186. return feof(vt100->istream);
  187. }
  188. int vt100_eof(const vt100_t *vt100)
  189. {
  190. if (!vt100 || !vt100->istream)
  191. return 0;
  192. return feof(vt100->istream);
  193. }
  194. size_t vt100_width(const vt100_t *vt100)
  195. {
  196. #ifdef TIOCGWINSZ
  197. struct winsize ws = {};
  198. int res = 0;
  199. #endif
  200. const size_t default_width = 80;
  201. if(!vt100 || !vt100->ostream)
  202. return default_width;
  203. #ifdef TIOCGWINSZ
  204. ws.ws_col = 0;
  205. res = ioctl(fileno(vt100->ostream), TIOCGWINSZ, &ws);
  206. if (res || (0 == ws.ws_col))
  207. return default_width;
  208. return (size_t)ws.ws_col;
  209. #else
  210. return default_width;
  211. #endif
  212. }
  213. size_t vt100_height(const vt100_t *vt100)
  214. {
  215. #ifdef TIOCGWINSZ
  216. struct winsize ws = {};
  217. int res = 0;
  218. #endif
  219. const size_t default_height = 25;
  220. if(!vt100 || !vt100->ostream)
  221. return default_height;
  222. #ifdef TIOCGWINSZ
  223. ws.ws_row = 0;
  224. res = ioctl(fileno(vt100->ostream), TIOCGWINSZ, &ws);
  225. if (res || (0 == ws.ws_row))
  226. return default_height;
  227. return (size_t)ws.ws_row;
  228. #else
  229. return default_height;
  230. #endif
  231. }
  232. void vt100_ding(const vt100_t *vt100)
  233. {
  234. vt100_printf(vt100, "%c", KEY_BEL);
  235. vt100_oflush(vt100);
  236. }
  237. void vt100_attr_reset(const vt100_t *vt100)
  238. {
  239. vt100_printf(vt100, "%c[0m", KEY_ESC);
  240. }
  241. void vt100_attr_bright(const vt100_t *vt100)
  242. {
  243. vt100_printf(vt100, "%c[1m", KEY_ESC);
  244. }
  245. void vt100_attr_dim(const vt100_t *vt100)
  246. {
  247. vt100_printf(vt100, "%c[2m", KEY_ESC);
  248. }
  249. void vt100_attr_underscore(const vt100_t *vt100)
  250. {
  251. vt100_printf(vt100, "%c[4m", KEY_ESC);
  252. }
  253. void vt100_attr_blink(const vt100_t *vt100)
  254. {
  255. vt100_printf(vt100, "%c[5m", KEY_ESC);
  256. }
  257. void vt100_attr_reverse(const vt100_t *vt100)
  258. {
  259. vt100_printf(vt100, "%c[7m", KEY_ESC);
  260. }
  261. void vt100_attr_hidden(const vt100_t *vt100)
  262. {
  263. vt100_printf(vt100, "%c[8m", KEY_ESC);
  264. }
  265. void vt100_erase_line(const vt100_t *vt100)
  266. {
  267. vt100_printf(vt100, "%c[2K", KEY_ESC);
  268. }
  269. void vt100_clear_screen(const vt100_t *vt100)
  270. {
  271. vt100_printf(vt100, "%c[2J", KEY_ESC);
  272. }
  273. void vt100_cursor_save(const vt100_t *vt100)
  274. {
  275. vt100_printf(vt100, "%c7", KEY_ESC); // VT100
  276. // vt100_printf(vt100, "%c[s", KEY_ESC); // ANSI
  277. }
  278. void vt100_cursor_restore(const vt100_t *vt100)
  279. {
  280. vt100_printf(vt100, "%c8", KEY_ESC); // VT100
  281. // vt100_printf(vt100, "%c[u", KEY_ESC); // ANSI
  282. }
  283. void vt100_cursor_forward(const vt100_t *vt100, size_t count)
  284. {
  285. vt100_printf(vt100, "%c[%dC", KEY_ESC, count);
  286. }
  287. void vt100_cursor_back(const vt100_t *vt100, size_t count)
  288. {
  289. vt100_printf(vt100, "%c[%dD", KEY_ESC, count);
  290. }
  291. void vt100_cursor_up(const vt100_t *vt100, size_t count)
  292. {
  293. vt100_printf(vt100, "%c[%dA", KEY_ESC, count);
  294. }
  295. void vt100_cursor_down(const vt100_t *vt100, size_t count)
  296. {
  297. vt100_printf(vt100, "%c[%dB", KEY_ESC, count);
  298. }
  299. void vt100_scroll_up(const vt100_t *vt100)
  300. {
  301. vt100_printf(vt100, "%cD", KEY_ESC);
  302. }
  303. void vt100_scroll_down(const vt100_t *vt100)
  304. {
  305. vt100_printf(vt100, "%cM", KEY_ESC);
  306. }
  307. void vt100_next_line(const vt100_t *vt100)
  308. {
  309. vt100_printf(vt100, "%cE", KEY_ESC);
  310. }
  311. void vt100_cursor_home(const vt100_t *vt100)
  312. {
  313. vt100_printf(vt100, "%c[H", KEY_ESC);
  314. }
  315. void vt100_erase(const vt100_t *vt100, size_t count)
  316. {
  317. vt100_printf(vt100, "%c[%dP", KEY_ESC, count);
  318. }
  319. void vt100_erase_down(const vt100_t *vt100)
  320. {
  321. vt100_printf(vt100, "%c[J", KEY_ESC);
  322. }