WebSVN – HelenOS – Diff – /branches/dd/uspace/lib/libc/generic/io/io.c

 /** @addtogroup libc
  * @{
  */
 /** @file
  */
-#include <libc.h>
-#include <unistd.h>
 #include <stdio.h>
+#include <unistd.h>
-#include <io/io.h>
+#include <fcntl.h>
 #include <string.h>
 #include <errno.h>
-#include <console.h>
+#include <bool.h>
+#include <malloc.h>
+#include <io/klog.h>
+#include <vfs/vfs.h>
+#include <ipc/devmap.h>
+#include <adt/list.h>
+static FILE stdin_null = {
+    .fd = -1,
+    .error = true,
+    .eof = true,
+    .klog = false,
+    .phone = -1
+};
+static FILE stdout_klog = {
+    .fd = -1,
+    .error = false,
+    .eof = false,
+    .klog = true,
+    .phone = -1
+};
+static FILE stderr_klog = {
+    .fd = -1,
+    .error = false,
+    .eof = false,
+    .klog = true,
+    .phone = -1
+};
+FILE *stdin = NULL;
+FILE *stdout = NULL;
+FILE *stderr = NULL;
-const static char nl = '\n';
+static LIST_INITIALIZE(files);
-int puts(const char *str)
+void stdio_init(int filc, fdi_node_t *filv[])
+{
+    if (filc > 0) {
+        stdin = fopen_node(filv[0], "r");
+    } else {
-    size_t count;
+        stdin = &stdin_null;
+        list_append(&stdin->link, &files);
+    }
-    if (str == NULL)
+    if (filc > 1) {
-        return putnchars("(NULL)", 6);
+        stdout = fopen_node(filv[1], "w");
+    } else {
+        stdout = &stdout_klog;
+        list_append(&stdout->link, &files);
+    }
+    if (filc > 2) {
-    for (count = 0; str[count] != 0; count++);
+        stderr = fopen_node(filv[2], "w");
+    } else {
+        stderr = &stderr_klog;
+        list_append(&stderr->link, &files);
+    }
+}
+void stdio_done(void)
+{
+    link_t *link = files.next;
+    while (link != &files) {
+        FILE *file = list_get_instance(link, FILE, link);
+        fclose(file);
+        link = files.next;
+    }
+}
-    if (console_write((void *) str, count) == count) {
+static bool parse_mode(const char *mode, int *flags)
+{
+    /* Parse mode except first character. */
-        if (console_write(&nl, 1) == 1)
+    const char *mp = mode;
+    if (*mp++ == 0) {
+        errno = EINVAL;
-            return 0;
+        return false;
+    }
+    if ((*mp == 'b') || (*mp == 't'))
+        mp++;
+    bool plus;
+    if (*mp == '+') {
+        mp++;
+        plus = true;
+    } else
+        plus = false;
+    if (*mp != 0) {
+        errno = EINVAL;
+        return false;
+    }
+    /* Parse first character of mode and determine flags for open(). */
+    switch (mode[0]) {
+    case 'r':
+        *flags = plus ? O_RDWR : O_RDONLY;
+        break;
+    case 'w':
+        *flags = (O_TRUNC | O_CREAT) | (plus ? O_RDWR : O_WRONLY);
+        break;
+    case 'a':
+        /* TODO: a+ must read from beginning, append to the end. */
+        if (plus) {
+            errno = ENOTSUP;
+            return false;
+        }
+        *flags = (O_APPEND | O_CREAT) | (plus ? O_RDWR : O_WRONLY);
+    default:
+        errno = EINVAL;
+        return false;
+    }
-    return EOF;
+    return true;
+}
-/** Put count chars from buffer to stdout without adding newline
+/** Open a stream.
+ *
- * @param buf Buffer with size at least count bytes - NULL pointer NOT allowed!
+ * @param path Path of the file to open.
- * @param count
- * @return 0 on succes, EOF on fail
+ * @param mode Mode string, (r|w|a)[b|t][+].
+ *
  */
-int putnchars(const char *buf, size_t count)
+FILE *fopen(const char *path, const char *mode)
+{
+    int flags;
-    if (console_write((void *) buf, count) == count)
+    if (!parse_mode(mode, &flags))
-        return 0;
+        return NULL;
+    /* Open file. */
+    FILE *stream = malloc(sizeof(FILE));
+    if (stream == NULL) {
+        errno = ENOMEM;
+        return NULL;
+    }
+    stream->fd = open(path, flags, 0666);
+    if (stream->fd < 0) {
+        /* errno was set by open() */
+        free(stream);
+        return NULL;
+    }
+    stream->error = false;
+    stream->eof = false;
+    stream->klog = false;
+    stream->phone = -1;
+    list_append(&stream->link, &files);
+    return stream;
+}
+FILE *fdopen(int fd, const char *mode)
+{
+    /* Open file. */
+    FILE *stream = malloc(sizeof(FILE));
+    if (stream == NULL) {
+        errno = ENOMEM;
+        return NULL;
+    }
+    stream->fd = fd;
+    stream->error = false;
+    stream->eof = false;
+    stream->klog = false;
+    stream->phone = -1;
+    list_append(&stream->link, &files);
+    return stream;
+}
+FILE *fopen_node(fdi_node_t *node, const char *mode)
+{
+    int flags;
+    if (!parse_mode(mode, &flags))
+        return NULL;
+    /* Open file. */
+    FILE *stream = malloc(sizeof(FILE));
+    if (stream == NULL) {
+        errno = ENOMEM;
+        return NULL;
+    }
+    stream->fd = open_node(node, flags);
+    if (stream->fd < 0) {
+        /* errno was set by open_node() */
+        free(stream);
+        return NULL;
+    }
+    stream->error = false;
+    stream->eof = false;
+    stream->klog = false;
+    stream->phone = -1;
+    list_append(&stream->link, &files);
+    return stream;
+}
+int fclose(FILE *stream)
+{
+    int rc = 0;
+    fflush(stream);
+    if (stream->phone >= 0)
+        ipc_hangup(stream->phone);
+    if (stream->fd >= 0)
+        rc = close(stream->fd);
+    list_remove(&stream->link);
+    if ((stream != &stdin_null)
+        && (stream != &stdout_klog)
+        && (stream != &stderr_klog))
+        free(stream);
+    stream = NULL;
+    if (rc != 0) {
+        /* errno was set by close() */
-    return EOF;
+        return EOF;
+    }
+    return 0;
+}
+/** Read from a stream.
+ *
+ * @param buf    Destination buffer.
+ * @param size   Size of each record.
-/** Same as puts, but does not print newline at end
+ * @param nmemb  Number of records to read.
+ * @param stream Pointer to the stream.
+ *
  */
-int putstr(const char *str)
+size_t fread(void *buf, size_t size, size_t nmemb, FILE *stream)
+{
+    size_t left = size * nmemb;
-    size_t count;
+    size_t done = 0;
+    while ((left > 0) && (!stream->error) && (!stream->eof)) {
+        ssize_t rd = read(stream->fd, buf + done, left);
+        if (rd < 0)
+            stream->error = true;
+        else if (rd == 0)
+            stream->eof = true;
+        else {
+            left -= rd;
+            done += rd;
+        }
+    }
-    if (str == NULL)
-        return putnchars("(NULL)", 6);
+    return (done / size);
+}
+/** Write to a stream.
+ *
+ * @param buf    Source buffer.
+ * @param size   Size of each record.
+ * @param nmemb  Number of records to write.
-    for (count = 0; str[count] != 0; count++);
+ * @param stream Pointer to the stream.
+ *
+ */
-    if (console_write((void *) str, count) == count)
+size_t fwrite(const void *buf, size_t size, size_t nmemb, FILE *stream)
+{
+    size_t left = size * nmemb;
-        return 0;
+    size_t done = 0;
+    while ((left > 0) && (!stream->error)) {
+        ssize_t wr;
+        if (stream->klog)
+            wr = klog_write(buf + done, left);
+        else
+            wr = write(stream->fd, buf + done, left);
+        if (wr <= 0)
+            stream->error = true;
+        else {
-    return EOF;
+            left -= wr;
+            done += wr;
+        }
+    }
+    return (done / size);
+}
-int putchar(int c)
+int fputc(wchar_t c, FILE *stream)
+{
     char buf[STR_BOUNDS(1)];
-    size_t offs;
+    size_t sz = 0;
+    if (chr_encode(c, buf, &sz, STR_BOUNDS(1)) == EOK) {
+        size_t wr = fwrite(buf, sz, 1, stream);
+        if (wr < sz)
+            return EOF;
+        return (int) c;
+    }
+    return EOF;
+}
-    offs = 0;
-    if (chr_encode(c, buf, &offs, STR_BOUNDS(1)) != EOK)
+int putchar(wchar_t c)
+{
-        return EOF;
+    return fputc(c, stdout);
+}
-    if (console_write((void *) buf, offs) == offs)
+int fputs(const char *str, FILE *stream)
+{
-        return c;
+    return fwrite(str, str_size(str), 1, stream);
+}
+int puts(const char *str)
+{
+    return fputs(str, stdout);
+}
+int fgetc(FILE *stream)
+{
+    char c;
+    /* This could be made faster by only flushing when needed. */
+    if (stdout)
+        fflush(stdout);
+    if (stderr)
+        fflush(stderr);
+    if (fread(&c, sizeof(char), 1, stream) < sizeof(char))
-    return EOF;
+        return EOF;
+    return (int) c;
+}
 int getchar(void)
+{
-    unsigned char c;
+    return fgetc(stdin);
+}
+int fseek(FILE *stream, long offset, int origin)
+{
+    off_t rc = lseek(stream->fd, offset, origin);
+    if (rc == (off_t) (-1)) {
+        /* errno has been set by lseek. */
+        return -1;
+    }
-    console_flush();
+    stream->eof = false;
-    if (read_stdin((void *) &c, 1) == 1)
-        return c;
-    return EOF;
+    return 0;
+}
-int fflush(FILE *f)
+void rewind(FILE *stream)
+{
+    (void) fseek(stream, 0, SEEK_SET);
+}
+int fflush(FILE *stream)
+{
-    /* Dummy implementation */
+    if (stream->klog) {
+        klog_update();
-    (void) f;
+        return EOK;
+    }
+    if (stream->fd >= 0)
+        return fsync(stream->fd);
+    return ENOENT;
+}
+int feof(FILE *stream)
+{
+    return stream->eof;
+}
+int ferror(FILE *stream)
+{
+    return stream->error;
+}
+int fphone(FILE *stream)
+{
+    if (stream->fd >= 0) {
+        if (stream->phone < 0)
+            stream->phone = fd_phone(stream->fd);
-    console_flush();
+        return stream->phone;
+    }
-    return 0;
+    return -1;
+}
+int fnode(FILE *stream, fdi_node_t *node)
+{
+    if (stream->fd >= 0)
+        return fd_node(stream->fd, node);
+    return ENOENT;
+}
 /** @}
  */

Subversion Repositories HelenOS

(root)/branches/dd/uspace/lib/libc/generic/io/io.c – Rev 4420 → 4537