aboutsummaryrefslogtreecommitdiff
path: root/lib/src/io.c
blob: b5e0dc50d57cbb9f43399e3990ff2a442ca88546 (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
// Copyright (c) 2020 Johannes Stoelp

#include <io.h>
#include <fmt.h>
#include <syscall.h>

#include <asm/unistd.h>

// `pfmt` uses fixed-size buffer on the stack for formating the message
// (for simplicity and since we don't impl buffered I/O).
//
// NOTE: This allows to specify a large buffer on the stack, but for
// the purpose of this study that's fine, we are cautious.
#define MAX_PRINTF_LEN 128

#define FD_STDOUT 1
#define FD_STDERR 2

static int vdfmt(int fd, const char* fmt, va_list ap) {
    char buf[MAX_PRINTF_LEN];
    int ret = vfmt(buf, sizeof(buf), fmt, ap);

    if (ret > MAX_PRINTF_LEN - 1) {
        syscall3(__NR_write, fd, buf, MAX_PRINTF_LEN - 1);

        static const char warn[] = "\npfmt: Message truncated, max length can be configured by defining MAX_PRINTF_LEN\n";
        syscall3(__NR_write, FD_STDERR, warn, sizeof(warn));
        return MAX_PRINTF_LEN - 1;
    }

    syscall3(__NR_write, fd, buf, ret);
    return ret;
}

int pfmt(const char* fmt, ...) {
    va_list ap;
    va_start(ap, fmt);
    int ret = vdfmt(FD_STDOUT, fmt, ap);
    va_end(ap);
    return ret;
}

int efmt(const char* fmt, ...) {
    va_list ap;
    va_start(ap, fmt);
    int ret = vdfmt(FD_STDERR, fmt, ap);
    va_end(ap);
    return ret;
}