stdio.cpp 13 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612
  1. #include <AK/PrintfImplementation.h>
  2. #include <AK/StdLibExtras.h>
  3. #include <AK/ValueRestorer.h>
  4. #include <Kernel/Syscall.h>
  5. #include <assert.h>
  6. #include <errno.h>
  7. #include <fcntl.h>
  8. #include <stdarg.h>
  9. #include <stdio.h>
  10. #include <stdlib.h>
  11. #include <string.h>
  12. #include <sys/types.h>
  13. #include <unistd.h>
  14. extern "C" {
  15. static FILE __default_streams[4];
  16. FILE* stdin;
  17. FILE* stdout;
  18. FILE* stderr;
  19. void init_FILE(FILE& fp, int fd, int mode)
  20. {
  21. fp.fd = fd;
  22. fp.buffer = fp.default_buffer;
  23. fp.buffer_size = BUFSIZ;
  24. fp.mode = mode;
  25. }
  26. static FILE* make_FILE(int fd)
  27. {
  28. auto* fp = (FILE*)malloc(sizeof(FILE));
  29. memset(fp, 0, sizeof(FILE));
  30. init_FILE(*fp, fd, isatty(fd));
  31. return fp;
  32. }
  33. void __stdio_init()
  34. {
  35. stdin = &__default_streams[0];
  36. stdout = &__default_streams[1];
  37. stderr = &__default_streams[2];
  38. init_FILE(*stdin, 0, isatty(0) ? _IOLBF : _IOFBF);
  39. init_FILE(*stdout, 1, isatty(1) ? _IOLBF : _IOFBF);
  40. init_FILE(*stderr, 2, _IONBF);
  41. }
  42. int setvbuf(FILE* stream, char* buf, int mode, size_t size)
  43. {
  44. if (mode != _IONBF && mode != _IOLBF && mode != _IOFBF) {
  45. errno = EINVAL;
  46. return -1;
  47. }
  48. stream->mode = mode;
  49. if (buf) {
  50. stream->buffer = buf;
  51. stream->buffer_size = size;
  52. } else {
  53. stream->buffer = stream->default_buffer;
  54. stream->buffer_size = BUFSIZ;
  55. }
  56. stream->buffer_index = 0;
  57. return 0;
  58. }
  59. void setbuf(FILE* stream, char* buf)
  60. {
  61. setvbuf(stream, buf, buf ? _IOFBF : _IONBF, BUFSIZ);
  62. }
  63. void setlinebuf(FILE* stream)
  64. {
  65. setvbuf(stream, nullptr, _IOLBF, 0);
  66. }
  67. int fileno(FILE* stream)
  68. {
  69. assert(stream);
  70. return stream->fd;
  71. }
  72. int feof(FILE* stream)
  73. {
  74. assert(stream);
  75. return stream->eof;
  76. }
  77. int fflush(FILE* stream)
  78. {
  79. // FIXME: fflush(NULL) should flush all open output streams.
  80. ASSERT(stream);
  81. if (!stream->buffer_index)
  82. return 0;
  83. int rc = write(stream->fd, stream->buffer, stream->buffer_index);
  84. stream->buffer_index = 0;
  85. stream->error = 0;
  86. stream->eof = 0;
  87. if (rc < 0) {
  88. stream->error = errno;
  89. return EOF;
  90. }
  91. return 0;
  92. }
  93. char* fgets(char* buffer, int size, FILE* stream)
  94. {
  95. assert(stream);
  96. ssize_t nread = 0;
  97. for (;;) {
  98. if (nread >= size)
  99. break;
  100. int ch = fgetc(stream);
  101. if (ch == EOF) {
  102. if (nread == 0)
  103. return nullptr;
  104. break;
  105. }
  106. buffer[nread++] = ch;
  107. if (!ch || ch == '\n')
  108. break;
  109. }
  110. if (nread < size)
  111. buffer[nread] = '\0';
  112. return buffer;
  113. }
  114. int fgetc(FILE* stream)
  115. {
  116. assert(stream);
  117. char ch;
  118. size_t nread = fread(&ch, sizeof(char), 1, stream);
  119. if (nread <= 0) {
  120. stream->eof = nread == 0;
  121. stream->error = errno;
  122. return EOF;
  123. }
  124. return ch;
  125. }
  126. int getc(FILE* stream)
  127. {
  128. return fgetc(stream);
  129. }
  130. int getchar()
  131. {
  132. return getc(stdin);
  133. }
  134. ssize_t getdelim(char **lineptr, size_t *n, int delim, FILE *stream)
  135. {
  136. char *ptr, *eptr;
  137. if (*lineptr == nullptr || *n == 0) {
  138. *n = BUFSIZ;
  139. if ((*lineptr = static_cast<char*>(malloc(*n))) == nullptr) {
  140. return -1;
  141. }
  142. }
  143. for (ptr = *lineptr, eptr = *lineptr + *n;;) {
  144. int c = fgetc(stream);
  145. if (c == -1) {
  146. if (feof(stream)) {
  147. return ptr == *lineptr ? -1 : ptr - *lineptr;
  148. } else {
  149. return -1;
  150. }
  151. }
  152. *ptr++ = c;
  153. if (c == delim) {
  154. *ptr = '\0';
  155. return ptr - *lineptr;
  156. }
  157. if (ptr + 2 >= eptr) {
  158. char *nbuf;
  159. size_t nbuf_sz = *n * 2;
  160. ssize_t d = ptr - *lineptr;
  161. if ((nbuf = static_cast<char*>(realloc(*lineptr, nbuf_sz))) == nullptr) {
  162. return -1;
  163. }
  164. *lineptr = nbuf;
  165. *n = nbuf_sz;
  166. eptr = nbuf + nbuf_sz;
  167. ptr = nbuf + d;
  168. }
  169. }
  170. }
  171. ssize_t getline(char **lineptr, size_t *n, FILE *stream)
  172. {
  173. return getdelim(lineptr, n, '\n', stream);
  174. }
  175. int ungetc(int c, FILE* stream)
  176. {
  177. ASSERT(stream);
  178. if (stream->have_ungotten)
  179. return EOF;
  180. stream->have_ungotten = true;
  181. stream->ungotten = c;
  182. stream->eof = false;
  183. return c;
  184. }
  185. int fputc(int ch, FILE* stream)
  186. {
  187. assert(stream);
  188. assert(stream->buffer_index < stream->buffer_size);
  189. stream->buffer[stream->buffer_index++] = ch;
  190. if (stream->buffer_index >= stream->buffer_size)
  191. fflush(stream);
  192. else if (stream->mode == _IONBF || (stream->mode == _IOLBF && ch == '\n'))
  193. fflush(stream);
  194. if (stream->eof || stream->error)
  195. return EOF;
  196. return (u8)ch;
  197. }
  198. int putc(int ch, FILE* stream)
  199. {
  200. return fputc(ch, stream);
  201. }
  202. int putchar(int ch)
  203. {
  204. return putc(ch, stdout);
  205. }
  206. int fputs(const char* s, FILE* stream)
  207. {
  208. for (; *s; ++s) {
  209. int rc = putc(*s, stream);
  210. if (rc == EOF)
  211. return EOF;
  212. }
  213. return 1;
  214. }
  215. int puts(const char* s)
  216. {
  217. int rc = fputs(s, stdout);
  218. if (rc == EOF)
  219. return EOF;
  220. return fputc('\n', stdout);
  221. }
  222. void clearerr(FILE* stream)
  223. {
  224. assert(stream);
  225. stream->eof = false;
  226. stream->error = 0;
  227. }
  228. int ferror(FILE* stream)
  229. {
  230. return stream->error;
  231. }
  232. size_t fread(void* ptr, size_t size, size_t nmemb, FILE* stream)
  233. {
  234. assert(stream);
  235. if (!size)
  236. return 0;
  237. ssize_t nread = 0;
  238. if (stream->have_ungotten) {
  239. // FIXME: Support ungotten character even if size != 1.
  240. ASSERT(size == 1);
  241. ((char*)ptr)[0] = stream->ungotten;
  242. stream->have_ungotten = false;
  243. --nmemb;
  244. if (!nmemb)
  245. return 1;
  246. ptr = &((char*)ptr)[1];
  247. ++nread;
  248. }
  249. ssize_t rc = read(stream->fd, ptr, nmemb * size);
  250. if (rc < 0) {
  251. stream->error = errno;
  252. return 0;
  253. }
  254. if (rc == 0)
  255. stream->eof = true;
  256. nread += rc;
  257. return nread / size;
  258. }
  259. size_t fwrite(const void* ptr, size_t size, size_t nmemb, FILE* stream)
  260. {
  261. assert(stream);
  262. auto* bytes = (const u8*)ptr;
  263. ssize_t nwritten = 0;
  264. for (size_t i = 0; i < (size * nmemb); ++i) {
  265. int rc = fputc(bytes[i], stream);
  266. if (rc == EOF)
  267. break;
  268. ++nwritten;
  269. }
  270. return nwritten / size;
  271. }
  272. int fseek(FILE* stream, long offset, int whence)
  273. {
  274. assert(stream);
  275. fflush(stream);
  276. off_t off = lseek(stream->fd, offset, whence);
  277. if (off < 0)
  278. return off;
  279. stream->eof = false;
  280. stream->error = 0;
  281. stream->have_ungotten = false;
  282. stream->ungotten = 0;
  283. return 0;
  284. }
  285. long ftell(FILE* stream)
  286. {
  287. assert(stream);
  288. fflush(stream);
  289. return lseek(stream->fd, 0, SEEK_CUR);
  290. }
  291. void rewind(FILE* stream)
  292. {
  293. fseek(stream, 0, SEEK_SET);
  294. }
  295. int dbgprintf(const char* fmt, ...)
  296. {
  297. va_list ap;
  298. va_start(ap, fmt);
  299. int ret = printf_internal([](char*&, char ch) { dbgputch(ch); }, nullptr, fmt, ap);
  300. va_end(ap);
  301. return ret;
  302. }
  303. static void stdout_putch(char*&, char ch)
  304. {
  305. putchar(ch);
  306. }
  307. static FILE* __current_stream = nullptr;
  308. static void stream_putch(char*&, char ch)
  309. {
  310. fputc(ch, __current_stream);
  311. }
  312. int vfprintf(FILE* stream, const char* fmt, va_list ap)
  313. {
  314. __current_stream = stream;
  315. return printf_internal(stream_putch, nullptr, fmt, ap);
  316. }
  317. int fprintf(FILE* stream, const char* fmt, ...)
  318. {
  319. va_list ap;
  320. va_start(ap, fmt);
  321. int ret = vfprintf(stream, fmt, ap);
  322. va_end(ap);
  323. return ret;
  324. }
  325. int vprintf(const char* fmt, va_list ap)
  326. {
  327. return printf_internal(stdout_putch, nullptr, fmt, ap);
  328. }
  329. int printf(const char* fmt, ...)
  330. {
  331. va_list ap;
  332. va_start(ap, fmt);
  333. int ret = vprintf(fmt, ap);
  334. va_end(ap);
  335. return ret;
  336. }
  337. static void buffer_putch(char*& bufptr, char ch)
  338. {
  339. *bufptr++ = ch;
  340. }
  341. int vsprintf(char* buffer, const char* fmt, va_list ap)
  342. {
  343. int ret = printf_internal(buffer_putch, buffer, fmt, ap);
  344. buffer[ret] = '\0';
  345. return ret;
  346. }
  347. int sprintf(char* buffer, const char* fmt, ...)
  348. {
  349. va_list ap;
  350. va_start(ap, fmt);
  351. int ret = vsprintf(buffer, fmt, ap);
  352. buffer[ret] = '\0';
  353. va_end(ap);
  354. return ret;
  355. }
  356. static size_t __vsnprintf_space_remaining;
  357. static void sized_buffer_putch(char*& bufptr, char ch)
  358. {
  359. if (__vsnprintf_space_remaining) {
  360. *bufptr++ = ch;
  361. --__vsnprintf_space_remaining;
  362. }
  363. }
  364. int vsnprintf(char* buffer, size_t size, const char* fmt, va_list ap)
  365. {
  366. __vsnprintf_space_remaining = size;
  367. int ret = printf_internal(sized_buffer_putch, buffer, fmt, ap);
  368. buffer[ret] = '\0';
  369. return ret;
  370. }
  371. int snprintf(char* buffer, size_t size, const char* fmt, ...)
  372. {
  373. va_list ap;
  374. va_start(ap, fmt);
  375. int ret = vsnprintf(buffer, size, fmt, ap);
  376. buffer[ret] = '\0';
  377. va_end(ap);
  378. return ret;
  379. }
  380. void perror(const char* s)
  381. {
  382. fprintf(stderr, "%s: %s\n", s, strerror(errno));
  383. }
  384. FILE* fopen(const char* pathname, const char* mode)
  385. {
  386. int flags = 0;
  387. if (!strcmp(mode, "r") || !strcmp(mode, "rb"))
  388. flags = O_RDONLY;
  389. else if (!strcmp(mode, "r+") || !strcmp(mode, "rb+"))
  390. flags = O_RDWR;
  391. else if (!strcmp(mode, "w") || !strcmp(mode, "wb"))
  392. flags = O_WRONLY | O_CREAT | O_TRUNC;
  393. else if (!strcmp(mode, "w+") || !strcmp(mode, "wb+"))
  394. flags = O_RDWR | O_CREAT | O_TRUNC;
  395. else {
  396. fprintf(stderr, "FIXME(LibC): fopen('%s', '%s')\n", pathname, mode);
  397. ASSERT_NOT_REACHED();
  398. }
  399. int fd = open(pathname, flags, 0666);
  400. if (fd < 0)
  401. return nullptr;
  402. return make_FILE(fd);
  403. }
  404. FILE* freopen(const char* pathname, const char* mode, FILE* stream)
  405. {
  406. (void)pathname;
  407. (void)mode;
  408. (void)stream;
  409. ASSERT_NOT_REACHED();
  410. }
  411. FILE* fdopen(int fd, const char* mode)
  412. {
  413. UNUSED_PARAM(mode);
  414. // FIXME: Verify that the mode matches how fd is already open.
  415. if (fd < 0)
  416. return nullptr;
  417. return make_FILE(fd);
  418. }
  419. int fclose(FILE* stream)
  420. {
  421. fflush(stream);
  422. int rc = close(stream->fd);
  423. if (stream != &__default_streams[0] && stream != &__default_streams[1] && stream != &__default_streams[2] && stream != &__default_streams[3])
  424. free(stream);
  425. return rc;
  426. }
  427. int rename(const char* oldpath, const char* newpath)
  428. {
  429. int rc = syscall(SC_rename, oldpath, newpath);
  430. __RETURN_WITH_ERRNO(rc, rc, -1);
  431. }
  432. void dbgputch(char ch)
  433. {
  434. syscall(SC_dbgputch, ch);
  435. }
  436. char* tmpnam(char*)
  437. {
  438. ASSERT_NOT_REACHED();
  439. }
  440. FILE* popen(const char* command, const char* type)
  441. {
  442. if (!type || (*type != 'r' && *type != 'w')) {
  443. errno = EINVAL;
  444. return nullptr;
  445. }
  446. int pipe_fds[2];
  447. int rc = pipe(pipe_fds);
  448. if (rc < 0) {
  449. ValueRestorer restorer(errno);
  450. perror("pipe");
  451. return nullptr;
  452. }
  453. pid_t child_pid = fork();
  454. if (!child_pid) {
  455. if (*type == 'r') {
  456. int rc = dup2(pipe_fds[1], STDOUT_FILENO);
  457. if (rc < 0) {
  458. perror("dup2");
  459. exit(1);
  460. }
  461. close(pipe_fds[0]);
  462. close(pipe_fds[1]);
  463. } else if (*type == 'w') {
  464. int rc = dup2(pipe_fds[0], STDIN_FILENO);
  465. if (rc < 0) {
  466. perror("dup2");
  467. exit(1);
  468. }
  469. close(pipe_fds[0]);
  470. close(pipe_fds[1]);
  471. }
  472. int rc = execl("/bin/sh", "sh", "-c", command, nullptr);
  473. if (rc < 0)
  474. perror("execl");
  475. exit(1);
  476. }
  477. FILE* fp = nullptr;
  478. if (*type == 'r') {
  479. fp = make_FILE(pipe_fds[0]);
  480. close(pipe_fds[1]);
  481. } else if (*type == 'w') {
  482. fp = make_FILE(pipe_fds[1]);
  483. close(pipe_fds[0]);
  484. }
  485. fp->popen_child = child_pid;
  486. return fp;
  487. }
  488. int pclose(FILE* fp)
  489. {
  490. ASSERT(fp);
  491. ASSERT(fp->popen_child != 0);
  492. int wstatus = 0;
  493. int rc = waitpid(fp->popen_child, &wstatus, 0);
  494. if (rc < 0)
  495. return rc;
  496. return wstatus;
  497. }
  498. int remove(const char* pathname)
  499. {
  500. int rc = unlink(pathname);
  501. if (rc < 0 && errno != EISDIR)
  502. return -1;
  503. return rmdir(pathname);
  504. }
  505. int scanf(const char* fmt, ...)
  506. {
  507. va_list ap;
  508. va_start(ap, fmt);
  509. int count = vfscanf(stdin, fmt, ap);
  510. va_end(ap);
  511. return count;
  512. }
  513. int fscanf(FILE* stream, const char* fmt, ...)
  514. {
  515. va_list ap;
  516. va_start(ap, fmt);
  517. int count = vfscanf(stream, fmt, ap);
  518. va_end(ap);
  519. return count;
  520. }
  521. int sscanf(const char* buffer, const char* fmt, ...)
  522. {
  523. va_list ap;
  524. va_start(ap, fmt);
  525. int count = vsscanf(buffer, fmt, ap);
  526. va_end(ap);
  527. return count;
  528. }
  529. int vfscanf(FILE* stream, const char* fmt, va_list ap)
  530. {
  531. char buffer[BUFSIZ];
  532. if (!fgets(buffer, sizeof(buffer) - 1, stream))
  533. return -1;
  534. return vsscanf(buffer, fmt, ap);
  535. }
  536. FILE* tmpfile()
  537. {
  538. dbgprintf("FIXME: Implement tmpfile()\n");
  539. ASSERT_NOT_REACHED();
  540. }
  541. }