00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00036 #include <libc.h>
00037 #include <str.h>
00038 #include <sys/types.h>
00039 #include <unistd.h>
00040 #include <errno.h>
00041 #include <io/klog.h>
00042 #include <io/printf_core.h>
00043
00044 size_t klog_write(const void *buf, size_t size)
00045 {
00046 ssize_t ret = (ssize_t) __SYSCALL3(SYS_KLOG, 1, (sysarg_t) buf, size);
00047
00048 if (ret >= 0)
00049 return (size_t) ret;
00050
00051 return 0;
00052 }
00053
00054 void klog_update(void)
00055 {
00056 (void) __SYSCALL3(SYS_KLOG, 1, (uintptr_t) NULL, 0);
00057 }
00058
00066 int klog_printf(const char *fmt, ...)
00067 {
00068 va_list args;
00069 va_start(args, fmt);
00070
00071 int ret = klog_vprintf(fmt, args);
00072
00073 va_end(args);
00074
00075 return ret;
00076 }
00077
00078 static int klog_vprintf_str_write(const char *str, size_t size, void *data)
00079 {
00080 size_t wr = klog_write(str, size);
00081 return str_nlength(str, wr);
00082 }
00083
00084 static int klog_vprintf_wstr_write(const wchar_t *str, size_t size, void *data)
00085 {
00086 size_t offset = 0;
00087 size_t chars = 0;
00088
00089 while (offset < size) {
00090 char buf[STR_BOUNDS(1)];
00091 size_t sz = 0;
00092
00093 if (chr_encode(str[chars], buf, &sz, STR_BOUNDS(1)) == EOK)
00094 klog_write(buf, sz);
00095
00096 chars++;
00097 offset += sizeof(wchar_t);
00098 }
00099
00100 return chars;
00101 }
00102
00111 int klog_vprintf(const char *fmt, va_list ap)
00112 {
00113 printf_spec_t ps = {
00114 klog_vprintf_str_write,
00115 klog_vprintf_wstr_write,
00116 NULL
00117 };
00118
00119 return printf_core(fmt, &ps, ap);
00120 }
00121