123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329 |
- #include <stdio.h>
- #include <stdarg.h>
- #include <sys/types.h>
- #include <string.h>
- #include <errno.h>
- #include <unistd.h>
- #include <assert.h>
- #include <stdlib.h>
- #include <unistd.h>
- #include <fcntl.h>
- #include <AK/printf.cpp>
- #include <Kernel/Syscall.h>
- extern "C" {
- static FILE __default_streams[3];
- FILE* stdin;
- FILE* stdout;
- FILE* stderr;
- void init_FILE(FILE& fp, int fd, int mode)
- {
- fp.fd = fd;
- fp.buffer = fp.default_buffer;
- fp.buffer_size = BUFSIZ;
- fp.mode = mode;
- }
- static FILE* make_FILE(int fd)
- {
- auto* fp = (FILE*)malloc(sizeof(FILE));
- memset(fp, 0, sizeof(FILE));
- init_FILE(*fp, fd, isatty(fd));
- return fp;
- }
- void __stdio_init()
- {
- stdin = &__default_streams[0];
- stdout = &__default_streams[1];
- stderr = &__default_streams[2];
- init_FILE(*stdin, 0, isatty(0) ? _IOLBF : _IOFBF);
- init_FILE(*stdout, 1, isatty(1) ? _IOLBF : _IOFBF);
- init_FILE(*stderr, 2, _IONBF);
- }
- int setvbuf(FILE* stream, char* buf, int mode, size_t size)
- {
- if (mode != _IONBF && mode != _IOLBF && mode != _IOFBF) {
- errno = EINVAL;
- return -1;
- }
- stream->mode = mode;
- if (buf) {
- stream->buffer = buf;
- stream->buffer_size = size;
- } else {
- stream->buffer = stream->default_buffer;
- stream->buffer_size = BUFSIZ;
- }
- stream->buffer_index = 0;
- return 0;
- }
- void setbuf(FILE* stream, char* buf)
- {
- setvbuf(stream, buf, buf ? _IOFBF : _IONBF, BUFSIZ);
- }
- void setlinebuf(FILE* stream)
- {
- setvbuf(stream, nullptr, _IOLBF, 0);
- }
- int fileno(FILE* stream)
- {
- assert(stream);
- return stream->fd;
- }
- int feof(FILE* stream)
- {
- assert(stream);
- return stream->eof;
- }
- int fflush(FILE* stream)
- {
- // FIXME: Implement buffered streams, duh.
- if (!stream)
- return -EBADF;
- if (!stream->buffer_index)
- return 0;
- int rc = write(stream->fd, stream->buffer, stream->buffer_index);
- stream->buffer_index = 0;
- return rc;
- }
- char* fgets(char* buffer, int size, FILE* stream)
- {
- assert(stream);
- ssize_t nread = 0;
- for (;;) {
- if (nread >= size)
- break;
- char ch = fgetc(stream);
- if (feof(stream))
- break;
- buffer[nread++] = ch;
- if (!ch || ch == '\n')
- break;
- }
- if (nread < size)
- buffer[nread] = '\0';
- return buffer;
- }
- int fgetc(FILE* stream)
- {
- assert(stream);
- char ch;
- fread(&ch, sizeof(char), 1, stream);
- return ch;
- }
- int getc(FILE* stream)
- {
- return fgetc(stream);
- }
- int getchar()
- {
- return getc(stdin);
- }
- int fputc(int ch, FILE* stream)
- {
- assert(stream);
- assert(stream->buffer_index < stream->buffer_size);
- stream->buffer[stream->buffer_index++] = ch;
- if (stream->buffer_index >= stream->buffer_size)
- fflush(stream);
- else if (stream->mode == _IONBF || (stream->mode == _IOLBF && ch == '\n'))
- fflush(stream);
- if (stream->eof)
- return EOF;
- return (byte)ch;
- }
- int putc(int ch, FILE* stream)
- {
- return fputc(ch, stream);
- }
- int putchar(int ch)
- {
- return putc(ch, stdout);
- }
- int fputs(const char* s, FILE* stream)
- {
- for (; *s; ++s) {
- int rc = putc(*s, stream);
- if (rc == EOF)
- return EOF;
- }
- return putc('\n', stream);
- }
- int puts(const char* s)
- {
- return fputs(s, stdout);
- }
- void clearerr(FILE* stream)
- {
- assert(stream);
- stream->eof = false;
- stream->error = false;
- }
- int ferror(FILE* stream)
- {
- return stream->error;
- }
- size_t fread(void* ptr, size_t size, size_t nmemb, FILE* stream)
- {
- assert(stream);
- ssize_t nread = read(stream->fd, ptr, nmemb * size);
- if (nread < 0)
- return 0;
- if (nread == 0)
- stream->eof = true;
- return nread;
- }
- size_t fwrite(const void* ptr, size_t size, size_t nmemb, FILE* stream)
- {
- assert(stream);
- fflush(stream);
- ssize_t nwritten = write(stream->fd, ptr, nmemb * size);
- if (nwritten < 0)
- return 0;
- return nwritten;
- }
- int fseek(FILE* stream, long offset, int whence)
- {
- assert(stream);
- off_t off = lseek(stream->fd, offset, whence);
- if (off < 0)
- return off;
- return 0;
- }
- long ftell(FILE* stream)
- {
- assert(stream);
- return lseek(stream->fd, 0, SEEK_CUR);
- }
- void rewind(FILE* stream)
- {
- fseek(stream, 0, SEEK_SET);
- }
- static void sys_putch(char*&, char ch)
- {
- syscall(SC_putch, ch);
- }
- int sys_printf(const char* fmt, ...)
- {
- va_list ap;
- va_start(ap, fmt);
- int ret = printfInternal(sys_putch, nullptr, fmt, ap);
- va_end(ap);
- return ret;
- }
- static void stdout_putch(char*&, char ch)
- {
- putchar(ch);
- }
- static FILE* __current_stream = nullptr;
- static void stream_putch(char*&, char ch)
- {
- fputc(ch, __current_stream);
- }
- int vfprintf(FILE* stream, const char* fmt, va_list ap)
- {
- __current_stream = stream;
- return printfInternal(stream_putch, nullptr, fmt, ap);
- }
- int fprintf(FILE* stream, const char* fmt, ...)
- {
- va_list ap;
- va_start(ap, fmt);
- int ret = vfprintf(stream, fmt, ap);
- va_end(ap);
- return ret;
- }
- int printf(const char* fmt, ...)
- {
- va_list ap;
- va_start(ap, fmt);
- int ret = printfInternal(stdout_putch, nullptr, fmt, ap);
- va_end(ap);
- return ret;
- }
- static void buffer_putch(char*& bufptr, char ch)
- {
- *bufptr++ = ch;
- }
- int vsprintf(char* buffer, const char* fmt, va_list ap)
- {
- int ret = printfInternal(buffer_putch, buffer, fmt, ap);
- buffer[ret] = '\0';
- return ret;
- }
- int sprintf(char* buffer, const char* fmt, ...)
- {
- va_list ap;
- va_start(ap, fmt);
- int ret = vsprintf(buffer, fmt, ap);
- buffer[ret] = '\0';
- va_end(ap);
- return ret;
- }
- void perror(const char* s)
- {
- fprintf(stderr, "%s: %s\n", s, strerror(errno));
- }
- FILE* fopen(const char* pathname, const char* mode)
- {
- assert(!strcmp(mode, "r") || !strcmp(mode, "rb"));
- int fd = open(pathname, O_RDONLY);
- if (fd < 0)
- return nullptr;
- return make_FILE(fd);
- }
- FILE* fdopen(int fd, const char* mode)
- {
- assert(!strcmp(mode, "r") || !strcmp(mode, "rb"));
- if (fd < 0)
- return nullptr;
- return make_FILE(fd);
- }
- int fclose(FILE* stream)
- {
- int rc = close(stream->fd);
- free(stream);
- return rc;
- }
- }
|