3be1d7e0c5bf60658d34eb6311d4e77c6803578cTom Gundersen

3be1d7e0c5bf60658d34eb6311d4e77c6803578cTom Gundersen

3be1d7e0c5bf60658d34eb6311d4e77c6803578cTom Gundersen#include <sys/socket.h>

3be1d7e0c5bf60658d34eb6311d4e77c6803578cTom Gundersen#include <sys/un.h>

aa9f11405829fd4755fef28602a7167dba3ddc89Tom Gundersen#include <errno.h>

aa9f11405829fd4755fef28602a7167dba3ddc89Tom Gundersen#include <stddef.h>

3be1d7e0c5bf60658d34eb6311d4e77c6803578cTom Gundersen#include <unistd.h>

3be1d7e0c5bf60658d34eb6311d4e77c6803578cTom Gundersen#include <fcntl.h>

aa9f11405829fd4755fef28602a7167dba3ddc89Tom Gundersen#include <printf.h>

aa9f11405829fd4755fef28602a7167dba3ddc89Tom Gundersen

3be1d7e0c5bf60658d34eb6311d4e77c6803578cTom Gundersen#define SD_JOURNAL_SUPPRESS_LOCATION

3be1d7e0c5bf60658d34eb6311d4e77c6803578cTom Gundersen

aa9f11405829fd4755fef28602a7167dba3ddc89Tom Gundersen#include "sd-journal.h"

aa9f11405829fd4755fef28602a7167dba3ddc89Tom Gundersen#include "util.h"

aa9f11405829fd4755fef28602a7167dba3ddc89Tom Gundersen#include "socket-util.h"

aa9f11405829fd4755fef28602a7167dba3ddc89Tom Gundersen#include "memfd-util.h"

85a8eeee36b57c1ab382b0225fa9a87525bbeee9Susant Sahani

85a8eeee36b57c1ab382b0225fa9a87525bbeee9Susant Sahani#define SNDBUF_SIZE (8*1024*1024)

aa9f11405829fd4755fef28602a7167dba3ddc89Tom Gundersen

85a8eeee36b57c1ab382b0225fa9a87525bbeee9Susant Sahani#define ALLOCA_CODE_FUNC(f, func) \

aa9f11405829fd4755fef28602a7167dba3ddc89Tom Gundersen do { \

aa9f11405829fd4755fef28602a7167dba3ddc89Tom Gundersen size_t _fl; \

85a8eeee36b57c1ab382b0225fa9a87525bbeee9Susant Sahani const char *_func = (func); \

85a8eeee36b57c1ab382b0225fa9a87525bbeee9Susant Sahani char **_f = &(f); \

85a8eeee36b57c1ab382b0225fa9a87525bbeee9Susant Sahani _fl = strlen(_func) + 1; \

aa9f11405829fd4755fef28602a7167dba3ddc89Tom Gundersen *_f = alloca(_fl + 10); \

85a8eeee36b57c1ab382b0225fa9a87525bbeee9Susant Sahani memcpy(*_f, "CODE_FUNC=", 10); \

85a8eeee36b57c1ab382b0225fa9a87525bbeee9Susant Sahani memcpy(*_f + 10, _func, _fl); \

85a8eeee36b57c1ab382b0225fa9a87525bbeee9Susant Sahani } while(false)

85a8eeee36b57c1ab382b0225fa9a87525bbeee9Susant Sahani

aa9f11405829fd4755fef28602a7167dba3ddc89Tom Gundersen

3be1d7e0c5bf60658d34eb6311d4e77c6803578cTom Gundersenstatic int journal_fd(void) {

a94d64d256d1a2b73c578116f341824eb5d0fab1Susant Sahani int fd;

a94d64d256d1a2b73c578116f341824eb5d0fab1Susant Sahani static int fd_plus_one = 0;

a94d64d256d1a2b73c578116f341824eb5d0fab1Susant Sahani

a94d64d256d1a2b73c578116f341824eb5d0fab1Susant Sahaniretry:

a94d64d256d1a2b73c578116f341824eb5d0fab1Susant Sahani if (fd_plus_one > 0)

a94d64d256d1a2b73c578116f341824eb5d0fab1Susant Sahani return fd_plus_one - 1;

a94d64d256d1a2b73c578116f341824eb5d0fab1Susant Sahani

a94d64d256d1a2b73c578116f341824eb5d0fab1Susant Sahani fd = socket(AF_UNIX, SOCK_DGRAM|SOCK_CLOEXEC, 0);

a94d64d256d1a2b73c578116f341824eb5d0fab1Susant Sahani if (fd < 0)

a94d64d256d1a2b73c578116f341824eb5d0fab1Susant Sahani return -errno;

a94d64d256d1a2b73c578116f341824eb5d0fab1Susant Sahani

fd_inc_sndbuf(fd, SNDBUF_SIZE);

if (!__sync_bool_compare_and_swap(&fd_plus_one, 0, fd+1)) {

safe_close(fd);

goto retry;

}

return fd;

}

_public_ int sd_journal_print(int priority, const char *format, ...) {

int r;

va_list ap;

va_start(ap, format);

r = sd_journal_printv(priority, format, ap);

va_end(ap);

return r;

}

_public_ int sd_journal_printv(int priority, const char *format, va_list ap) {

/* FIXME: Instead of limiting things to LINE_MAX we could do a

char buffer[8 + LINE_MAX], p[11]; struct iovec iov[2];

assert_return(priority >= 0, -EINVAL);

assert_return(priority <= 7, -EINVAL);

assert_return(format, -EINVAL);

snprintf(p, sizeof(p), "PRIORITY=%i", priority & LOG_PRIMASK);

char_array_0(p);

memcpy(buffer, "MESSAGE=", 8);

vsnprintf(buffer+8, sizeof(buffer) - 8, format, ap);

char_array_0(buffer);

zero(iov);

IOVEC_SET_STRING(iov[0], buffer);

IOVEC_SET_STRING(iov[1], p);

return sd_journal_sendv(iov, 2);

}

_printf_(1, 0) static int fill_iovec_sprintf(const char *format, va_list ap, int extra, struct iovec **_iov) {

PROTECT_ERRNO;

int r, n = 0, i = 0, j;

struct iovec *iov = NULL;

assert(_iov);

if (extra > 0) {

n = MAX(extra * 2, extra + 4);

iov = malloc0(n * sizeof(struct iovec));

if (!iov) {

r = -ENOMEM;

goto fail;

}

i = extra;

}

while (format) {

struct iovec *c;

char *buffer;

va_list aq;

if (i >= n) {

n = MAX(i*2, 4);

c = realloc(iov, n * sizeof(struct iovec));

if (!c) {

r = -ENOMEM;

goto fail;

}

iov = c;

}

va_copy(aq, ap);

if (vasprintf(&buffer, format, aq) < 0) {

va_end(aq);

r = -ENOMEM;

goto fail;

}

va_end(aq);

VA_FORMAT_ADVANCE(format, ap);

IOVEC_SET_STRING(iov[i++], buffer);

format = va_arg(ap, char *);

}

*_iov = iov;

return i;

fail:

for (j = 0; j < i; j++)

free(iov[j].iov_base);

free(iov);

return r;

}

_public_ int sd_journal_send(const char *format, ...) {

int r, i, j;

va_list ap;

struct iovec *iov = NULL;

va_start(ap, format);

i = fill_iovec_sprintf(format, ap, 0, &iov);

va_end(ap);

if (_unlikely_(i < 0)) {

r = i;

goto finish;

}

r = sd_journal_sendv(iov, i);

finish:

for (j = 0; j < i; j++)

free(iov[j].iov_base);

free(iov);

return r;

}

_public_ int sd_journal_sendv(const struct iovec *iov, int n) {

PROTECT_ERRNO;

int fd, r;

_cleanup_close_ int buffer_fd = -1;

struct iovec *w;

uint64_t *l;

int i, j = 0;

struct sockaddr_un sa = {

.sun_family = AF_UNIX,

.sun_path = "/run/systemd/journal/socket",

};

struct msghdr mh = {

.msg_name = &sa,

.msg_namelen = offsetof(struct sockaddr_un, sun_path) + strlen(sa.sun_path),

};

ssize_t k;

union {

struct cmsghdr cmsghdr;

uint8_t buf[CMSG_SPACE(sizeof(int))];

} control;

struct cmsghdr *cmsg;

bool have_syslog_identifier = false;

bool seal = true;

assert_return(iov, -EINVAL);

assert_return(n > 0, -EINVAL);

w = alloca(sizeof(struct iovec) * n * 5 + 3);

l = alloca(sizeof(uint64_t) * n);

for (i = 0; i < n; i++) {

char *c, *nl;

if (_unlikely_(!iov[i].iov_base || iov[i].iov_len <= 1))

return -EINVAL;

c = memchr(iov[i].iov_base, '=', iov[i].iov_len);

if (_unlikely_(!c || c == iov[i].iov_base))

return -EINVAL;

have_syslog_identifier = have_syslog_identifier ||

(c == (char *) iov[i].iov_base + 17 &&

startswith(iov[i].iov_base, "SYSLOG_IDENTIFIER"));

nl = memchr(iov[i].iov_base, '\n', iov[i].iov_len);

if (nl) {

if (_unlikely_(nl < c))

return -EINVAL;

/* Already includes a newline? Bummer, then

w[j].iov_base = iov[i].iov_base;

w[j].iov_len = c - (char*) iov[i].iov_base;

j++;

IOVEC_SET_STRING(w[j++], "\n");

l[i] = htole64(iov[i].iov_len - (c - (char*) iov[i].iov_base) - 1);

w[j].iov_base = &l[i];

w[j].iov_len = sizeof(uint64_t);

j++;

w[j].iov_base = c + 1;

w[j].iov_len = iov[i].iov_len - (c - (char*) iov[i].iov_base) - 1;

j++;

} else

/* Nothing special? Then just add the line and

w[j++] = iov[i];

IOVEC_SET_STRING(w[j++], "\n");

}

if (!have_syslog_identifier &&

string_is_safe(program_invocation_short_name)) {

/* Implicitly add program_invocation_short_name, if it

IOVEC_SET_STRING(w[j++], "SYSLOG_IDENTIFIER=");

IOVEC_SET_STRING(w[j++], program_invocation_short_name);

IOVEC_SET_STRING(w[j++], "\n");

}

fd = journal_fd();

if (_unlikely_(fd < 0))

return fd;

mh.msg_iov = w;

mh.msg_iovlen = j;

k = sendmsg(fd, &mh, MSG_NOSIGNAL);

if (k >= 0)

return 0;

/* Fail silently if the journal is not available */

if (errno == ENOENT)

return 0;

if (errno != EMSGSIZE && errno != ENOBUFS)

return -errno;

/* Message doesn't fit... Let's dump the data in a memfd or

buffer_fd = memfd_new(NULL);

if (buffer_fd < 0) {

if (buffer_fd == -ENOSYS) {

buffer_fd = open_tmpfile("/dev/shm", O_RDWR | O_CLOEXEC);

if (buffer_fd < 0)

return buffer_fd;

seal = false;

} else

return buffer_fd;

}

n = writev(buffer_fd, w, j);

if (n < 0)

return -errno;

if (seal) {

r = memfd_set_sealed(buffer_fd);

if (r < 0)

return r;

}

mh.msg_iov = NULL;

mh.msg_iovlen = 0;

zero(control);

mh.msg_control = &control;

mh.msg_controllen = sizeof(control);

cmsg = CMSG_FIRSTHDR(&mh);

cmsg->cmsg_level = SOL_SOCKET;

cmsg->cmsg_type = SCM_RIGHTS;

cmsg->cmsg_len = CMSG_LEN(sizeof(int));

memcpy(CMSG_DATA(cmsg), &buffer_fd, sizeof(int));

mh.msg_controllen = cmsg->cmsg_len;

k = sendmsg(fd, &mh, MSG_NOSIGNAL);

if (k < 0)

return -errno;

return 0;

}

static int fill_iovec_perror_and_send(const char *message, int skip, struct iovec iov[]) {

PROTECT_ERRNO;

size_t n, k;

k = isempty(message) ? 0 : strlen(message) + 2;

n = 8 + k + 256 + 1;

for (;;) {

char buffer[n];

char* j;

errno = 0;

j = strerror_r(_saved_errno_, buffer + 8 + k, n - 8 - k);

if (errno == 0) {

char error[6 + 10 + 1]; /* for a 32bit value */

if (j != buffer + 8 + k)

memmove(buffer + 8 + k, j, strlen(j)+1);

memcpy(buffer, "MESSAGE=", 8);

if (k > 0) {

memcpy(buffer + 8, message, k - 2);

memcpy(buffer + 8 + k - 2, ": ", 2);

}

snprintf(error, sizeof(error), "ERRNO=%u", _saved_errno_);

char_array_0(error);

IOVEC_SET_STRING(iov[skip+0], "PRIORITY=3");

IOVEC_SET_STRING(iov[skip+1], buffer);

IOVEC_SET_STRING(iov[skip+2], error);

return sd_journal_sendv(iov, skip + 3);

}

if (errno != ERANGE)

return -errno;

n *= 2;

}

}

_public_ int sd_journal_perror(const char *message) {

struct iovec iovec[3];

return fill_iovec_perror_and_send(message, 0, iovec);

}

_public_ int sd_journal_stream_fd(const char *identifier, int priority, int level_prefix) {

union sockaddr_union sa = {

.un.sun_family = AF_UNIX,

.un.sun_path = "/run/systemd/journal/stdout",

};

_cleanup_close_ int fd = -1;

char *header;

size_t l;

int r;

assert_return(priority >= 0, -EINVAL);

assert_return(priority <= 7, -EINVAL);

fd = socket(AF_UNIX, SOCK_STREAM|SOCK_CLOEXEC, 0);

if (fd < 0)

return -errno;

r = connect(fd, &sa.sa, offsetof(union sockaddr_union, un.sun_path) + strlen(sa.un.sun_path));

if (r < 0)

return -errno;

if (shutdown(fd, SHUT_RD) < 0)

return -errno;

fd_inc_sndbuf(fd, SNDBUF_SIZE);

if (!identifier)

identifier = "";

l = strlen(identifier);

header = alloca(l + 1 + 1 + 2 + 2 + 2 + 2 + 2);

memcpy(header, identifier, l);

header[l++] = '\n';

header[l++] = '\n'; /* unit id */

header[l++] = '0' + priority;

header[l++] = '\n';

header[l++] = '0' + !!level_prefix;

header[l++] = '\n';

header[l++] = '0';

header[l++] = '\n';

header[l++] = '0';

header[l++] = '\n';

header[l++] = '0';

header[l++] = '\n';

r = (int) loop_write(fd, header, l, false);

if (r < 0)

return r;

if ((size_t) r != l)

return -errno;

r = fd;

fd = -1;

return r;

}

_public_ int sd_journal_print_with_location(int priority, const char *file, const char *line, const char *func, const char *format, ...) {

int r;

va_list ap;

va_start(ap, format);

r = sd_journal_printv_with_location(priority, file, line, func, format, ap);

va_end(ap);

return r;

}

_public_ int sd_journal_printv_with_location(int priority, const char *file, const char *line, const char *func, const char *format, va_list ap) {

char buffer[8 + LINE_MAX], p[11];

struct iovec iov[5];

char *f;

assert_return(priority >= 0, -EINVAL);

assert_return(priority <= 7, -EINVAL);

assert_return(format, -EINVAL);

snprintf(p, sizeof(p), "PRIORITY=%i", priority & LOG_PRIMASK);

char_array_0(p);

memcpy(buffer, "MESSAGE=", 8);

vsnprintf(buffer+8, sizeof(buffer) - 8, format, ap);

char_array_0(buffer);

/* func is initialized from __func__ which is not a macro, but

ALLOCA_CODE_FUNC(f, func);

zero(iov);

IOVEC_SET_STRING(iov[0], buffer);

IOVEC_SET_STRING(iov[1], p);

IOVEC_SET_STRING(iov[2], file);

IOVEC_SET_STRING(iov[3], line);

IOVEC_SET_STRING(iov[4], f);

return sd_journal_sendv(iov, ELEMENTSOF(iov));

}

_public_ int sd_journal_send_with_location(const char *file, const char *line, const char *func, const char *format, ...) {

int r, i, j;

va_list ap;

struct iovec *iov = NULL;

char *f;

va_start(ap, format);

i = fill_iovec_sprintf(format, ap, 3, &iov);

va_end(ap);

if (_unlikely_(i < 0)) {

r = i;

goto finish;

}

ALLOCA_CODE_FUNC(f, func);

IOVEC_SET_STRING(iov[0], file);

IOVEC_SET_STRING(iov[1], line);

IOVEC_SET_STRING(iov[2], f);

r = sd_journal_sendv(iov, i);

finish:

for (j = 3; j < i; j++)

free(iov[j].iov_base);

free(iov);

return r;

}

_public_ int sd_journal_sendv_with_location(

const char *file, const char *line,

const char *func,

const struct iovec *iov, int n) {

struct iovec *niov;

char *f;

assert_return(iov, -EINVAL);

assert_return(n > 0, -EINVAL);

niov = alloca(sizeof(struct iovec) * (n + 3));

memcpy(niov, iov, sizeof(struct iovec) * n);

ALLOCA_CODE_FUNC(f, func);

IOVEC_SET_STRING(niov[n++], file);

IOVEC_SET_STRING(niov[n++], line);

IOVEC_SET_STRING(niov[n++], f);

return sd_journal_sendv(niov, n);

}

_public_ int sd_journal_perror_with_location(

const char *file, const char *line,

const char *func,

const char *message) {

struct iovec iov[6];

char *f;

ALLOCA_CODE_FUNC(f, func);

IOVEC_SET_STRING(iov[0], file);

IOVEC_SET_STRING(iov[1], line);

IOVEC_SET_STRING(iov[2], f);

return fill_iovec_perror_and_send(message, 3, iov);

}