stdio.cpp 6.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329
  1. #include <stdio.h>
  2. #include <stdarg.h>
  3. #include <sys/types.h>
  4. #include <string.h>
  5. #include <errno.h>
  6. #include <unistd.h>
  7. #include <assert.h>
  8. #include <stdlib.h>
  9. #include <unistd.h>
  10. #include <fcntl.h>
  11. #include <AK/printf.cpp>
  12. #include <Kernel/Syscall.h>
  13. extern "C" {
  14. static FILE __default_streams[3];
  15. FILE* stdin;
  16. FILE* stdout;
  17. FILE* stderr;
  18. void init_FILE(FILE& fp, int fd, int mode)
  19. {
  20. fp.fd = fd;
  21. fp.buffer = fp.default_buffer;
  22. fp.buffer_size = BUFSIZ;
  23. fp.mode = mode;
  24. }
  25. static FILE* make_FILE(int fd)
  26. {
  27. auto* fp = (FILE*)malloc(sizeof(FILE));
  28. memset(fp, 0, sizeof(FILE));
  29. init_FILE(*fp, fd, isatty(fd));
  30. return fp;
  31. }
  32. void __stdio_init()
  33. {
  34. stdin = &__default_streams[0];
  35. stdout = &__default_streams[1];
  36. stderr = &__default_streams[2];
  37. init_FILE(*stdin, 0, isatty(0) ? _IOLBF : _IOFBF);
  38. init_FILE(*stdout, 1, isatty(1) ? _IOLBF : _IOFBF);
  39. init_FILE(*stderr, 2, _IONBF);
  40. }
  41. int setvbuf(FILE* stream, char* buf, int mode, size_t size)
  42. {
  43. if (mode != _IONBF && mode != _IOLBF && mode != _IOFBF) {
  44. errno = EINVAL;
  45. return -1;
  46. }
  47. stream->mode = mode;
  48. if (buf) {
  49. stream->buffer = buf;
  50. stream->buffer_size = size;
  51. } else {
  52. stream->buffer = stream->default_buffer;
  53. stream->buffer_size = BUFSIZ;
  54. }
  55. stream->buffer_index = 0;
  56. return 0;
  57. }
  58. void setbuf(FILE* stream, char* buf)
  59. {
  60. setvbuf(stream, buf, buf ? _IOFBF : _IONBF, BUFSIZ);
  61. }
  62. void setlinebuf(FILE* stream)
  63. {
  64. setvbuf(stream, nullptr, _IOLBF, 0);
  65. }
  66. int fileno(FILE* stream)
  67. {
  68. assert(stream);
  69. return stream->fd;
  70. }
  71. int feof(FILE* stream)
  72. {
  73. assert(stream);
  74. return stream->eof;
  75. }
  76. int fflush(FILE* stream)
  77. {
  78. // FIXME: Implement buffered streams, duh.
  79. if (!stream)
  80. return -EBADF;
  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. return rc;
  86. }
  87. char* fgets(char* buffer, int size, FILE* stream)
  88. {
  89. assert(stream);
  90. ssize_t nread = 0;
  91. for (;;) {
  92. if (nread >= size)
  93. break;
  94. char ch = fgetc(stream);
  95. if (feof(stream))
  96. break;
  97. buffer[nread++] = ch;
  98. if (!ch || ch == '\n')
  99. break;
  100. }
  101. if (nread < size)
  102. buffer[nread] = '\0';
  103. return buffer;
  104. }
  105. int fgetc(FILE* stream)
  106. {
  107. assert(stream);
  108. char ch;
  109. fread(&ch, sizeof(char), 1, stream);
  110. return ch;
  111. }
  112. int getc(FILE* stream)
  113. {
  114. return fgetc(stream);
  115. }
  116. int getchar()
  117. {
  118. return getc(stdin);
  119. }
  120. int fputc(int ch, FILE* stream)
  121. {
  122. assert(stream);
  123. assert(stream->buffer_index < stream->buffer_size);
  124. stream->buffer[stream->buffer_index++] = ch;
  125. if (stream->buffer_index >= stream->buffer_size)
  126. fflush(stream);
  127. else if (stream->mode == _IONBF || (stream->mode == _IOLBF && ch == '\n'))
  128. fflush(stream);
  129. if (stream->eof)
  130. return EOF;
  131. return (byte)ch;
  132. }
  133. int putc(int ch, FILE* stream)
  134. {
  135. return fputc(ch, stream);
  136. }
  137. int putchar(int ch)
  138. {
  139. return putc(ch, stdout);
  140. }
  141. int fputs(const char* s, FILE* stream)
  142. {
  143. for (; *s; ++s) {
  144. int rc = putc(*s, stream);
  145. if (rc == EOF)
  146. return EOF;
  147. }
  148. return putc('\n', stream);
  149. }
  150. int puts(const char* s)
  151. {
  152. return fputs(s, stdout);
  153. }
  154. void clearerr(FILE* stream)
  155. {
  156. assert(stream);
  157. stream->eof = false;
  158. stream->error = false;
  159. }
  160. int ferror(FILE* stream)
  161. {
  162. return stream->error;
  163. }
  164. size_t fread(void* ptr, size_t size, size_t nmemb, FILE* stream)
  165. {
  166. assert(stream);
  167. ssize_t nread = read(stream->fd, ptr, nmemb * size);
  168. if (nread < 0)
  169. return 0;
  170. if (nread == 0)
  171. stream->eof = true;
  172. return nread;
  173. }
  174. size_t fwrite(const void* ptr, size_t size, size_t nmemb, FILE* stream)
  175. {
  176. assert(stream);
  177. fflush(stream);
  178. ssize_t nwritten = write(stream->fd, ptr, nmemb * size);
  179. if (nwritten < 0)
  180. return 0;
  181. return nwritten;
  182. }
  183. int fseek(FILE* stream, long offset, int whence)
  184. {
  185. assert(stream);
  186. off_t off = lseek(stream->fd, offset, whence);
  187. if (off < 0)
  188. return off;
  189. return 0;
  190. }
  191. long ftell(FILE* stream)
  192. {
  193. assert(stream);
  194. return lseek(stream->fd, 0, SEEK_CUR);
  195. }
  196. void rewind(FILE* stream)
  197. {
  198. fseek(stream, 0, SEEK_SET);
  199. }
  200. static void sys_putch(char*&, char ch)
  201. {
  202. syscall(SC_putch, ch);
  203. }
  204. int sys_printf(const char* fmt, ...)
  205. {
  206. va_list ap;
  207. va_start(ap, fmt);
  208. int ret = printfInternal(sys_putch, nullptr, fmt, ap);
  209. va_end(ap);
  210. return ret;
  211. }
  212. static void stdout_putch(char*&, char ch)
  213. {
  214. putchar(ch);
  215. }
  216. static FILE* __current_stream = nullptr;
  217. static void stream_putch(char*&, char ch)
  218. {
  219. fputc(ch, __current_stream);
  220. }
  221. int vfprintf(FILE* stream, const char* fmt, va_list ap)
  222. {
  223. __current_stream = stream;
  224. return printfInternal(stream_putch, nullptr, fmt, ap);
  225. }
  226. int fprintf(FILE* stream, const char* fmt, ...)
  227. {
  228. va_list ap;
  229. va_start(ap, fmt);
  230. int ret = vfprintf(stream, fmt, ap);
  231. va_end(ap);
  232. return ret;
  233. }
  234. int printf(const char* fmt, ...)
  235. {
  236. va_list ap;
  237. va_start(ap, fmt);
  238. int ret = printfInternal(stdout_putch, nullptr, fmt, ap);
  239. va_end(ap);
  240. return ret;
  241. }
  242. static void buffer_putch(char*& bufptr, char ch)
  243. {
  244. *bufptr++ = ch;
  245. }
  246. int vsprintf(char* buffer, const char* fmt, va_list ap)
  247. {
  248. int ret = printfInternal(buffer_putch, buffer, fmt, ap);
  249. buffer[ret] = '\0';
  250. return ret;
  251. }
  252. int sprintf(char* buffer, const char* fmt, ...)
  253. {
  254. va_list ap;
  255. va_start(ap, fmt);
  256. int ret = vsprintf(buffer, fmt, ap);
  257. buffer[ret] = '\0';
  258. va_end(ap);
  259. return ret;
  260. }
  261. void perror(const char* s)
  262. {
  263. fprintf(stderr, "%s: %s\n", s, strerror(errno));
  264. }
  265. FILE* fopen(const char* pathname, const char* mode)
  266. {
  267. assert(!strcmp(mode, "r") || !strcmp(mode, "rb"));
  268. int fd = open(pathname, O_RDONLY);
  269. if (fd < 0)
  270. return nullptr;
  271. return make_FILE(fd);
  272. }
  273. FILE* fdopen(int fd, const char* mode)
  274. {
  275. assert(!strcmp(mode, "r") || !strcmp(mode, "rb"));
  276. if (fd < 0)
  277. return nullptr;
  278. return make_FILE(fd);
  279. }
  280. int fclose(FILE* stream)
  281. {
  282. int rc = close(stream->fd);
  283. free(stream);
  284. return rc;
  285. }
  286. }