stdio.cpp 13 KB

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