src/libsystemd-bus/bus-kernel.c

   1 /*-*- Mode: C; c-basic-offset: 8; indent-tabs-mode: nil -*-*/
   2
   3 /***
   4   This file is part of systemd.
   5
   6   Copyright 2013 Lennart Poettering
   7
   8   systemd is free software; you can redistribute it and/or modify it
   9   under the terms of the GNU Lesser General Public License as published by
  10   the Free Software Foundation; either version 2.1 of the License, or
  11   (at your option) any later version.
  12
  13   systemd is distributed in the hope that it will be useful, but
  14   WITHOUT ANY WARRANTY; without even the implied warranty of
  15   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  16   Lesser General Public License for more details.
  17
  18   You should have received a copy of the GNU Lesser General Public License
  19   along with systemd; If not, see <http://www.gnu.org/licenses/>.
  20 ***/
  21
  22 #ifdef HAVE_VALGRIND_MEMCHECK_H
  23 #include <valgrind/memcheck.h>
  24 #endif
  25
  26 #include <fcntl.h>
  27 #include <malloc.h>
  28 #include <sys/mman.h>
  29
  30 #include "util.h"
  31 #include "strv.h"
  32
  33 #include "bus-internal.h"
  34 #include "bus-message.h"
  35 #include "bus-kernel.h"
  36 #include "bus-bloom.h"
  37 #include "bus-util.h"
  38
  39 #define UNIQUE_NAME_MAX (3+DECIMAL_STR_MAX(uint64_t))
  40
  41 int bus_kernel_parse_unique_name(const char *s, uint64_t *id) {
  42         int r;
  43
  44         assert(s);
  45         assert(id);
  46
  47         if (!startswith(s, ":1."))
  48                 return 0;
  49
  50         r = safe_atou64(s + 3, id);
  51         if (r < 0)
  52                 return r;
  53
  54         return 1;
  55 }
  56
  57 static void append_payload_vec(struct kdbus_item **d, const void *p, size_t sz) {
  58         assert(d);
  59         assert(sz > 0);
  60
  61         *d = ALIGN8_PTR(*d);
  62
  63         /* Note that p can be NULL, which encodes a region full of
  64          * zeroes, which is useful to optimize certain padding
  65          * conditions */
  66
  67         (*d)->size = offsetof(struct kdbus_item, vec) + sizeof(struct kdbus_vec);
  68         (*d)->type = KDBUS_ITEM_PAYLOAD_VEC;
  69         (*d)->vec.address = PTR_TO_UINT64(p);
  70         (*d)->vec.size = sz;
  71
  72         *d = (struct kdbus_item *) ((uint8_t*) *d + (*d)->size);
  73 }
  74
  75 static void append_payload_memfd(struct kdbus_item **d, int memfd, size_t sz) {
  76         assert(d);
  77         assert(memfd >= 0);
  78         assert(sz > 0);
  79
  80         *d = ALIGN8_PTR(*d);
  81         (*d)->size = offsetof(struct kdbus_item, memfd) + sizeof(struct kdbus_memfd);
  82         (*d)->type = KDBUS_ITEM_PAYLOAD_MEMFD;
  83         (*d)->memfd.fd = memfd;
  84         (*d)->memfd.size = sz;
  85
  86         *d = (struct kdbus_item *) ((uint8_t*) *d + (*d)->size);
  87 }
  88
  89 static void append_destination(struct kdbus_item **d, const char *s, size_t length) {
  90         assert(d);
  91         assert(s);
  92
  93         *d = ALIGN8_PTR(*d);
  94
  95         (*d)->size = offsetof(struct kdbus_item, str) + length + 1;
  96         (*d)->type = KDBUS_ITEM_DST_NAME;
  97         memcpy((*d)->str, s, length + 1);
  98
  99         *d = (struct kdbus_item *) ((uint8_t*) *d + (*d)->size);
 100 }
 101
 102 static void* append_bloom(struct kdbus_item **d, size_t length) {
 103         void *r;
 104
 105         assert(d);
 106
 107         *d = ALIGN8_PTR(*d);
 108
 109         (*d)->size = offsetof(struct kdbus_item, data) + length;
 110         (*d)->type = KDBUS_ITEM_BLOOM;
 111         r = (*d)->data;
 112
 113         *d = (struct kdbus_item *) ((uint8_t*) *d + (*d)->size);
 114
 115         return r;
 116 }
 117
 118 static void append_fds(struct kdbus_item **d, const int fds[], unsigned n_fds) {
 119         assert(d);
 120         assert(fds);
 121         assert(n_fds > 0);
 122
 123         *d = ALIGN8_PTR(*d);
 124         (*d)->size = offsetof(struct kdbus_item, fds) + sizeof(int) * n_fds;
 125         (*d)->type = KDBUS_ITEM_FDS;
 126         memcpy((*d)->fds, fds, sizeof(int) * n_fds);
 127
 128         *d = (struct kdbus_item *) ((uint8_t*) *d + (*d)->size);
 129 }
 130
 131 static int bus_message_setup_bloom(sd_bus_message *m, void *bloom) {
 132         unsigned i;
 133         int r;
 134
 135         assert(m);
 136         assert(bloom);
 137
 138         memset(bloom, 0, BLOOM_SIZE);
 139
 140         bloom_add_pair(bloom, "message-type", bus_message_type_to_string(m->header->type));
 141
 142         if (m->interface)
 143                 bloom_add_pair(bloom, "interface", m->interface);
 144         if (m->member)
 145                 bloom_add_pair(bloom, "member", m->member);
 146         if (m->path) {
 147                 bloom_add_pair(bloom, "path", m->path);
 148                 bloom_add_pair(bloom, "path-slash-prefix", m->path);
 149                 bloom_add_prefixes(bloom, "path-slash-prefix", m->path, '/');
 150         }
 151
 152         r = sd_bus_message_rewind(m, true);
 153         if (r < 0)
 154                 return r;
 155
 156         for (i = 0; i < 64; i++) {
 157                 char type;
 158                 const char *t;
 159                 char buf[sizeof("arg")-1 + 2 + sizeof("-slash-prefix")];
 160                 char *e;
 161
 162                 r = sd_bus_message_peek_type(m, &type, NULL);
 163                 if (r < 0)
 164                         return r;
 165
 166                 if (type != SD_BUS_TYPE_STRING &&
 167                     type != SD_BUS_TYPE_OBJECT_PATH &&
 168                     type != SD_BUS_TYPE_SIGNATURE)
 169                         break;
 170
 171                 r = sd_bus_message_read_basic(m, type, &t);
 172                 if (r < 0)
 173                         return r;
 174
 175                 e = stpcpy(buf, "arg");
 176                 if (i < 10)
 177                         *(e++) = '0' + i;
 178                 else {
 179                         *(e++) = '0' + (i / 10);
 180                         *(e++) = '0' + (i % 10);
 181                 }
 182
 183                 *e = 0;
 184                 bloom_add_pair(bloom, buf, t);
 185
 186                 strcpy(e, "-dot-prefix");
 187                 bloom_add_prefixes(bloom, buf, t, '.');
 188                 strcpy(e, "-slash-prefix");
 189                 bloom_add_prefixes(bloom, buf, t, '/');
 190         }
 191
 192         return 0;
 193 }
 194
 195 static int bus_message_setup_kmsg(sd_bus *b, sd_bus_message *m) {
 196         struct bus_body_part *part;
 197         struct kdbus_item *d;
 198         bool well_known;
 199         uint64_t unique;
 200         size_t sz, dl;
 201         unsigned i;
 202         int r;
 203
 204         assert(b);
 205         assert(m);
 206         assert(m->sealed);
 207
 208         if (m->kdbus)
 209                 return 0;
 210
 211         if (m->destination) {
 212                 r = bus_kernel_parse_unique_name(m->destination, &unique);
 213                 if (r < 0)
 214                         return r;
 215
 216                 well_known = r == 0;
 217         } else
 218                 well_known = false;
 219
 220         sz = offsetof(struct kdbus_msg, items);
 221
 222         assert_cc(ALIGN8(offsetof(struct kdbus_item, vec) + sizeof(struct kdbus_vec)) ==
 223                   ALIGN8(offsetof(struct kdbus_item, memfd) + sizeof(struct kdbus_memfd)));
 224
 225         /* Add in fixed header, fields header and payload */
 226         sz += (1 + m->n_body_parts) *
 227                 ALIGN8(offsetof(struct kdbus_item, vec) + sizeof(struct kdbus_vec));
 228
 229         /* Add space for bloom filter */
 230         sz += ALIGN8(offsetof(struct kdbus_item, data) + BLOOM_SIZE);
 231
 232         /* Add in well-known destination header */
 233         if (well_known) {
 234                 dl = strlen(m->destination);
 235                 sz += ALIGN8(offsetof(struct kdbus_item, str) + dl + 1);
 236         }
 237
 238         /* Add space for unix fds */
 239         if (m->n_fds > 0)
 240                 sz += ALIGN8(offsetof(struct kdbus_item, fds) + sizeof(int)*m->n_fds);
 241
 242         m->kdbus = memalign(8, sz);
 243         if (!m->kdbus) {
 244                 r = -ENOMEM;
 245                 goto fail;
 246         }
 247
 248         m->free_kdbus = true;
 249         memset(m->kdbus, 0, sz);
 250
 251         m->kdbus->flags =
 252                 ((m->header->flags & BUS_MESSAGE_NO_REPLY_EXPECTED) ? 0 : KDBUS_MSG_FLAGS_EXPECT_REPLY) |
 253                 ((m->header->flags & BUS_MESSAGE_NO_AUTO_START) ? KDBUS_MSG_FLAGS_NO_AUTO_START : 0);
 254         m->kdbus->dst_id =
 255                 well_known ? 0 :
 256                 m->destination ? unique : KDBUS_DST_ID_BROADCAST;
 257         m->kdbus->payload_type = KDBUS_PAYLOAD_DBUS;
 258         m->kdbus->cookie = m->header->serial;
 259
 260         m->kdbus->timeout_ns = m->timeout * NSEC_PER_USEC;
 261
 262         d = m->kdbus->items;
 263
 264         if (well_known)
 265                 append_destination(&d, m->destination, dl);
 266
 267         append_payload_vec(&d, m->header, BUS_MESSAGE_BODY_BEGIN(m));
 268
 269         MESSAGE_FOREACH_PART(part, i, m) {
 270                 if (part->is_zero) {
 271                         /* If this is padding then simply send a
 272                          * vector with a NULL data pointer which the
 273                          * kernel will just pass through. This is the
 274                          * most efficient way to encode zeroes */
 275
 276                         append_payload_vec(&d, NULL, part->size);
 277                         continue;
 278                 }
 279
 280                 if (part->memfd >= 0 && part->sealed && m->destination) {
 281                         /* Try to send a memfd, if the part is
 282                          * sealed and this is not a broadcast. Since we can only  */
 283
 284                         append_payload_memfd(&d, part->memfd, part->size);
 285                         continue;
 286                 }
 287
 288                 /* Otherwise let's send a vector to the actual data,
 289                  * for that we need to map it first. */
 290                 r = bus_body_part_map(part);
 291                 if (r < 0)
 292                         goto fail;
 293
 294                 append_payload_vec(&d, part->data, part->size);
 295         }
 296
 297         if (m->kdbus->dst_id == KDBUS_DST_ID_BROADCAST) {
 298                 void *p;
 299
 300                 p = append_bloom(&d, BLOOM_SIZE);
 301                 r = bus_message_setup_bloom(m, p);
 302                 if (r < 0)
 303                         goto fail;
 304         }
 305
 306         if (m->n_fds > 0)
 307                 append_fds(&d, m->fds, m->n_fds);
 308
 309         m->kdbus->size = (uint8_t*) d - (uint8_t*) m->kdbus;
 310         assert(m->kdbus->size <= sz);
 311
 312         return 0;
 313
 314 fail:
 315         m->poisoned = true;
 316         return r;
 317 }
 318
 319 int bus_kernel_take_fd(sd_bus *b) {
 320         struct kdbus_cmd_hello *hello;
 321         struct kdbus_item *item;
 322         size_t l, sz;
 323         int r;
 324
 325         assert(b);
 326
 327         if (b->is_server)
 328                 return -EINVAL;
 329
 330         b->use_memfd = 1;
 331
 332         sz = ALIGN8(offsetof(struct kdbus_cmd_hello, items));
 333
 334         if (b->fake_creds_valid)
 335                 sz += ALIGN8(offsetof(struct kdbus_item, creds));
 336
 337         if (b->fake_label) {
 338                 l = strlen(b->fake_label);
 339                 sz += ALIGN8(offsetof(struct kdbus_item, str) + l + 1);
 340         }
 341
 342         hello = alloca0(sz);
 343         hello->size = sz;
 344         hello->conn_flags = b->hello_flags;
 345         hello->attach_flags = b->attach_flags;
 346         hello->pool_size = KDBUS_POOL_SIZE;
 347
 348         item = hello->items;
 349
 350         if (b->fake_creds_valid) {
 351                 item->size = offsetof(struct kdbus_item, creds) + sizeof(struct kdbus_creds);
 352                 item->type = KDBUS_ITEM_CREDS;
 353                 item->creds = b->fake_creds;
 354
 355                 item = KDBUS_ITEM_NEXT(item);
 356         }
 357
 358         if (b->fake_label) {
 359                 item->size = offsetof(struct kdbus_item, str) + l + 1;
 360                 memcpy(item->str, b->fake_label, l+1);
 361         }
 362
 363         r = ioctl(b->input_fd, KDBUS_CMD_HELLO, hello);
 364         if (r < 0)
 365                 return -errno;
 366
 367         if (!b->kdbus_buffer) {
 368                 b->kdbus_buffer = mmap(NULL, KDBUS_POOL_SIZE, PROT_READ, MAP_SHARED, b->input_fd, 0);
 369                 if (b->kdbus_buffer == MAP_FAILED) {
 370                         b->kdbus_buffer = NULL;
 371                         return -errno;
 372                 }
 373         }
 374
 375         /* The higher 32bit of both flags fields are considered
 376          * 'incompatible flags'. Refuse them all for now. */
 377         if (hello->bus_flags > 0xFFFFFFFFULL ||
 378             hello->conn_flags > 0xFFFFFFFFULL)
 379                 return -ENOTSUP;
 380
 381         if (hello->bloom_size != BLOOM_SIZE)
 382                 return -ENOTSUP;
 383
 384         if (asprintf(&b->unique_name, ":1.%llu", (unsigned long long) hello->id) < 0)
 385                 return -ENOMEM;
 386
 387         b->unique_id = hello->id;
 388
 389         b->is_kernel = true;
 390         b->bus_client = true;
 391         b->can_fds = !!(hello->conn_flags & KDBUS_HELLO_ACCEPT_FD);
 392         b->message_version = 2;
 393         b->message_endian = BUS_NATIVE_ENDIAN;
 394
 395         /* the kernel told us the UUID of the underlying bus */
 396         memcpy(b->server_id.bytes, hello->id128, sizeof(b->server_id.bytes));
 397
 398         return bus_start_running(b);
 399 }
 400
 401 int bus_kernel_connect(sd_bus *b) {
 402         assert(b);
 403         assert(b->input_fd < 0);
 404         assert(b->output_fd < 0);
 405         assert(b->kernel);
 406
 407         if (b->is_server)
 408                 return -EINVAL;
 409
 410         b->input_fd = open(b->kernel, O_RDWR|O_NOCTTY|O_CLOEXEC);
 411         if (b->input_fd < 0)
 412                 return -errno;
 413
 414         b->output_fd = b->input_fd;
 415
 416         return bus_kernel_take_fd(b);
 417 }
 418
 419 int bus_kernel_write_message(sd_bus *bus, sd_bus_message *m) {
 420         int r;
 421
 422         assert(bus);
 423         assert(m);
 424         assert(bus->state == BUS_RUNNING);
 425
 426         /* If we can't deliver, we want room for the error message */
 427         r = bus_rqueue_make_room(bus);
 428         if (r < 0)
 429                 return r;
 430
 431         r = bus_message_setup_kmsg(bus, m);
 432         if (r < 0)
 433                 return r;
 434
 435         r = ioctl(bus->output_fd, KDBUS_CMD_MSG_SEND, m->kdbus);
 436         if (r < 0) {
 437                 _cleanup_bus_error_free_ sd_bus_error error = SD_BUS_ERROR_NULL;
 438                 sd_bus_message *reply;
 439
 440                 if (errno == EAGAIN || errno == EINTR)
 441                         return 0;
 442                 else if (errno == ENXIO || errno == ESRCH) {
 443
 444                         /* ENXIO: unique name not known
 445                          * ESRCH: well-known name not known */
 446
 447                         if (m->header->type == SD_BUS_MESSAGE_METHOD_CALL)
 448                                 sd_bus_error_setf(&error, SD_BUS_ERROR_SERVICE_UNKNOWN, "Destination %s not known", m->destination);
 449                         else {
 450                                 log_debug("Could not deliver message to %s as destination is not known. Ignoring.", m->destination);
 451                                 return 0;
 452                         }
 453
 454                 } else if (errno == EADDRNOTAVAIL) {
 455
 456                         /* EADDRNOTAVAIL: activation is possible, but turned off in request flags */
 457
 458                         if (m->header->type == SD_BUS_MESSAGE_METHOD_CALL)
 459                                 sd_bus_error_setf(&error, SD_BUS_ERROR_SERVICE_UNKNOWN, "Activation of %s not requested", m->destination);
 460                         else {
 461                                 log_debug("Could not deliver message to %s as destination is not activated. Ignoring.", m->destination);
 462                                 return 0;
 463                         }
 464                 } else
 465                         return -errno;
 466
 467                 r = bus_message_new_synthetic_error(
 468                                 bus,
 469                                 BUS_MESSAGE_SERIAL(m),
 470                                 &error,
 471                                 &reply);
 472
 473                 if (r < 0)
 474                         return r;
 475
 476                 r = bus_seal_synthetic_message(bus, reply);
 477                 if (r < 0)
 478                         return r;
 479
 480                 bus->rqueue[bus->rqueue_size++] = reply;
 481
 482                 return 0;
 483         }
 484
 485         return 1;
 486 }
 487
 488 static void close_kdbus_msg(sd_bus *bus, struct kdbus_msg *k) {
 489         uint64_t off;
 490         struct kdbus_item *d;
 491
 492         assert(bus);
 493         assert(k);
 494
 495         off = (uint8_t *)k - (uint8_t *)bus->kdbus_buffer;
 496         ioctl(bus->input_fd, KDBUS_CMD_FREE, &off);
 497
 498         KDBUS_ITEM_FOREACH(d, k, items) {
 499
 500                 if (d->type == KDBUS_ITEM_FDS)
 501                         close_many(d->fds, (d->size - offsetof(struct kdbus_item, fds)) / sizeof(int));
 502                 else if (d->type == KDBUS_ITEM_PAYLOAD_MEMFD)
 503                         close_nointr_nofail(d->memfd.fd);
 504         }
 505 }
 506
 507 static int push_name_owner_changed(sd_bus *bus, const char *name, const char *old_owner, const char *new_owner) {
 508         _cleanup_bus_message_unref_ sd_bus_message *m = NULL;
 509         int r;
 510
 511         assert(bus);
 512
 513         r = sd_bus_message_new_signal(
 514                         bus,
 515                         "/org/freedesktop/DBus",
 516                         "org.freedesktop.DBus",
 517                         "NameOwnerChanged",
 518                         &m);
 519         if (r < 0)
 520                 return r;
 521
 522         r = sd_bus_message_append(m, "sss", name, old_owner, new_owner);
 523         if (r < 0)
 524                 return r;
 525
 526         m->sender = "org.freedesktop.DBus";
 527
 528         r = bus_seal_synthetic_message(bus, m);
 529         if (r < 0)
 530                 return r;
 531
 532         bus->rqueue[bus->rqueue_size++] = m;
 533         m = NULL;
 534
 535         return 1;
 536 }
 537
 538 static int translate_name_change(sd_bus *bus, struct kdbus_msg *k, struct kdbus_item *d) {
 539         char new_owner[UNIQUE_NAME_MAX], old_owner[UNIQUE_NAME_MAX];
 540
 541         assert(bus);
 542         assert(k);
 543         assert(d);
 544
 545         if (d->type == KDBUS_ITEM_NAME_ADD || (d->name_change.old.flags & (KDBUS_NAME_IN_QUEUE|KDBUS_NAME_ACTIVATOR)))
 546                 old_owner[0] = 0;
 547         else
 548                 sprintf(old_owner, ":1.%llu", (unsigned long long) d->name_change.old.id);
 549
 550         if (d->type == KDBUS_ITEM_NAME_REMOVE || (d->name_change.new.flags & (KDBUS_NAME_IN_QUEUE|KDBUS_NAME_ACTIVATOR))) {
 551
 552                 if (isempty(old_owner))
 553                         return 0;
 554
 555                 new_owner[0] = 0;
 556         } else
 557                 sprintf(new_owner, ":1.%llu", (unsigned long long) d->name_change.new.id);
 558
 559         return push_name_owner_changed(bus, d->name_change.name, old_owner, new_owner);
 560 }
 561
 562 static int translate_id_change(sd_bus *bus, struct kdbus_msg *k, struct kdbus_item *d) {
 563         char owner[UNIQUE_NAME_MAX];
 564
 565         assert(bus);
 566         assert(k);
 567         assert(d);
 568
 569         sprintf(owner, ":1.%llu", d->id_change.id);
 570
 571         return push_name_owner_changed(
 572                         bus, owner,
 573                         d->type == KDBUS_ITEM_ID_ADD ? NULL : owner,
 574                         d->type == KDBUS_ITEM_ID_ADD ? owner : NULL);
 575 }
 576
 577 static int translate_reply(sd_bus *bus, struct kdbus_msg *k, struct kdbus_item *d) {
 578         _cleanup_bus_message_unref_ sd_bus_message *m = NULL;
 579         int r;
 580
 581         assert(bus);
 582         assert(k);
 583         assert(d);
 584
 585         r = bus_message_new_synthetic_error(
 586                         bus,
 587                         k->cookie_reply,
 588                         d->type == KDBUS_ITEM_REPLY_TIMEOUT ?
 589                         &SD_BUS_ERROR_MAKE_CONST(SD_BUS_ERROR_NO_REPLY, "Method call timed out") :
 590                         &SD_BUS_ERROR_MAKE_CONST(SD_BUS_ERROR_NO_REPLY, "Method call peer died"),
 591                         &m);
 592         if (r < 0)
 593                 return r;
 594
 595         m->sender = "org.freedesktop.DBus";
 596
 597         r = bus_seal_synthetic_message(bus, m);
 598         if (r < 0)
 599                 return r;
 600
 601         bus->rqueue[bus->rqueue_size++] = m;
 602         m = NULL;
 603
 604         return 1;
 605 }
 606
 607 static int bus_kernel_translate_message(sd_bus *bus, struct kdbus_msg *k) {
 608         struct kdbus_item *d, *found = NULL;
 609
 610         static int (* const translate[])(sd_bus *bus, struct kdbus_msg *k, struct kdbus_item *d) = {
 611                 [KDBUS_ITEM_NAME_ADD - _KDBUS_ITEM_KERNEL_BASE] = translate_name_change,
 612                 [KDBUS_ITEM_NAME_REMOVE - _KDBUS_ITEM_KERNEL_BASE] = translate_name_change,
 613                 [KDBUS_ITEM_NAME_CHANGE - _KDBUS_ITEM_KERNEL_BASE] = translate_name_change,
 614
 615                 [KDBUS_ITEM_ID_ADD - _KDBUS_ITEM_KERNEL_BASE] = translate_id_change,
 616                 [KDBUS_ITEM_ID_REMOVE - _KDBUS_ITEM_KERNEL_BASE] = translate_id_change,
 617
 618                 [KDBUS_ITEM_REPLY_TIMEOUT - _KDBUS_ITEM_KERNEL_BASE] = translate_reply,
 619                 [KDBUS_ITEM_REPLY_DEAD - _KDBUS_ITEM_KERNEL_BASE] = translate_reply,
 620         };
 621
 622         assert(bus);
 623         assert(k);
 624         assert(k->payload_type == KDBUS_PAYLOAD_KERNEL);
 625
 626         KDBUS_ITEM_FOREACH(d, k, items) {
 627                 if (d->type >= _KDBUS_ITEM_KERNEL_BASE && d->type < _KDBUS_ITEM_KERNEL_BASE + ELEMENTSOF(translate)) {
 628                         if (found)
 629                                 return -EBADMSG;
 630                         found = d;
 631                 } else
 632                         log_debug("Got unknown field from kernel %llu", d->type);
 633         }
 634
 635         if (!found) {
 636                 log_debug("Didn't find a kernel message to translate.");
 637                 return 0;
 638         }
 639
 640         return translate[found->type - _KDBUS_ITEM_KERNEL_BASE](bus, k, found);
 641 }
 642
 643 static int bus_kernel_make_message(sd_bus *bus, struct kdbus_msg *k) {
 644         sd_bus_message *m = NULL;
 645         struct kdbus_item *d;
 646         unsigned n_fds = 0;
 647         _cleanup_free_ int *fds = NULL;
 648         struct bus_header *h = NULL;
 649         size_t total, n_bytes = 0, idx = 0;
 650         const char *destination = NULL, *seclabel = NULL;
 651         int r;
 652
 653         assert(bus);
 654         assert(k);
 655         assert(k->payload_type == KDBUS_PAYLOAD_DBUS);
 656
 657         KDBUS_ITEM_FOREACH(d, k, items) {
 658                 size_t l;
 659
 660                 l = d->size - offsetof(struct kdbus_item, data);
 661
 662                 switch (d->type) {
 663
 664                 case KDBUS_ITEM_PAYLOAD_OFF:
 665                         if (!h) {
 666                                 h = (struct bus_header *)((uint8_t *)k + d->vec.offset);
 667
 668                                 if (!bus_header_is_complete(h, d->vec.size))
 669                                         return -EBADMSG;
 670                         }
 671
 672                         n_bytes += d->vec.size;
 673                         break;
 674
 675                 case KDBUS_ITEM_PAYLOAD_MEMFD:
 676                         if (!h)
 677                                 return -EBADMSG;
 678
 679                         n_bytes += d->memfd.size;
 680                         break;
 681
 682                 case KDBUS_ITEM_FDS: {
 683                         int *f;
 684                         unsigned j;
 685
 686                         j = l / sizeof(int);
 687                         f = realloc(fds, sizeof(int) * (n_fds + j));
 688                         if (!f)
 689                                 return -ENOMEM;
 690
 691                         fds = f;
 692                         memcpy(fds + n_fds, d->fds, sizeof(int) * j);
 693                         n_fds += j;
 694                         break;
 695                 }
 696
 697                 case KDBUS_ITEM_SECLABEL:
 698                         seclabel = d->str;
 699                         break;
 700                 }
 701         }
 702
 703         if (!h)
 704                 return -EBADMSG;
 705
 706         r = bus_header_message_size(h, &total);
 707         if (r < 0)
 708                 return r;
 709
 710         if (n_bytes != total)
 711                 return -EBADMSG;
 712
 713         /* on kdbus we only speak native endian gvariant, never dbus1
 714          * marshalling or reverse endian */
 715         if (h->version != 2 ||
 716             h->endian != BUS_NATIVE_ENDIAN)
 717                 return -EPROTOTYPE;
 718
 719         r = bus_message_from_header(bus, h, sizeof(struct bus_header), fds, n_fds, NULL, seclabel, 0, &m);
 720         if (r < 0)
 721                 return r;
 722
 723         /* The well-known names list is different from the other
 724         credentials. If we asked for it, but nothing is there, this
 725         means that the list of well-known names is simply empty, not
 726         that we lack any data */
 727
 728         m->creds.mask |= (SD_BUS_CREDS_UNIQUE_NAME|SD_BUS_CREDS_WELL_KNOWN_NAMES) & bus->creds_mask;
 729
 730         KDBUS_ITEM_FOREACH(d, k, items) {
 731                 size_t l;
 732
 733                 l = d->size - offsetof(struct kdbus_item, data);
 734
 735                 switch (d->type) {
 736
 737                 case KDBUS_ITEM_PAYLOAD_OFF: {
 738                         size_t begin_body;
 739
 740                         begin_body = BUS_MESSAGE_BODY_BEGIN(m);
 741
 742                         if (idx + d->vec.size > begin_body) {
 743                                 struct bus_body_part *part;
 744
 745                                 /* Contains body material */
 746
 747                                 part = message_append_part(m);
 748                                 if (!part) {
 749                                         r = -ENOMEM;
 750                                         goto fail;
 751                                 }
 752
 753                                 /* A -1 offset is NUL padding. */
 754                                 part->is_zero = d->vec.offset == ~0ULL;
 755
 756                                 if (idx >= begin_body) {
 757                                         if (!part->is_zero)
 758                                                 part->data = (uint8_t *)k + d->vec.offset;
 759                                         part->size = d->vec.size;
 760                                 } else {
 761                                         if (!part->is_zero)
 762                                                 part->data = (uint8_t *)k + d->vec.offset + (begin_body - idx);
 763                                         part->size = d->vec.size - (begin_body - idx);
 764                                 }
 765
 766                                 part->sealed = true;
 767                         }
 768
 769                         idx += d->vec.size;
 770                         break;
 771                 }
 772
 773                 case KDBUS_ITEM_PAYLOAD_MEMFD: {
 774                         struct bus_body_part *part;
 775
 776                         if (idx < BUS_MESSAGE_BODY_BEGIN(m)) {
 777                                 r = -EBADMSG;
 778                                 goto fail;
 779                         }
 780
 781                         part = message_append_part(m);
 782                         if (!part) {
 783                                 r = -ENOMEM;
 784                                 goto fail;
 785                         }
 786
 787                         part->memfd = d->memfd.fd;
 788                         part->size = d->memfd.size;
 789                         part->sealed = true;
 790
 791                         idx += d->memfd.size;
 792                         break;
 793                 }
 794
 795                 case KDBUS_ITEM_CREDS:
 796                         m->creds.pid_starttime = d->creds.starttime / NSEC_PER_USEC;
 797                         m->creds.uid = d->creds.uid;
 798                         m->creds.gid = d->creds.gid;
 799                         m->creds.pid = d->creds.pid;
 800                         m->creds.tid = d->creds.tid;
 801                         m->creds.mask |= (SD_BUS_CREDS_UID|SD_BUS_CREDS_GID|SD_BUS_CREDS_PID|SD_BUS_CREDS_PID_STARTTIME|SD_BUS_CREDS_TID) & bus->creds_mask;
 802                         break;
 803
 804                 case KDBUS_ITEM_TIMESTAMP:
 805                         m->realtime = d->timestamp.realtime_ns / NSEC_PER_USEC;
 806                         m->monotonic = d->timestamp.monotonic_ns / NSEC_PER_USEC;
 807                         break;
 808
 809                 case KDBUS_ITEM_PID_COMM:
 810                         m->creds.comm = d->str;
 811                         m->creds.mask |= SD_BUS_CREDS_COMM & bus->creds_mask;
 812                         break;
 813
 814                 case KDBUS_ITEM_TID_COMM:
 815                         m->creds.tid_comm = d->str;
 816                         m->creds.mask |= SD_BUS_CREDS_TID_COMM & bus->creds_mask;
 817                         break;
 818
 819                 case KDBUS_ITEM_EXE:
 820                         m->creds.exe = d->str;
 821                         m->creds.mask |= SD_BUS_CREDS_EXE & bus->creds_mask;
 822                         break;
 823
 824                 case KDBUS_ITEM_CMDLINE:
 825                         m->creds.cmdline = d->str;
 826                         m->creds.cmdline_size = l;
 827                         m->creds.mask |= SD_BUS_CREDS_CMDLINE & bus->creds_mask;
 828                         break;
 829
 830                 case KDBUS_ITEM_CGROUP:
 831                         m->creds.cgroup = d->str;
 832                         m->creds.mask |= (SD_BUS_CREDS_CGROUP|SD_BUS_CREDS_UNIT|SD_BUS_CREDS_USER_UNIT|SD_BUS_CREDS_SLICE|SD_BUS_CREDS_SESSION|SD_BUS_CREDS_OWNER_UID) & bus->creds_mask;
 833                         break;
 834
 835                 case KDBUS_ITEM_AUDIT:
 836                         m->creds.audit_session_id = d->audit.sessionid;
 837                         m->creds.audit_login_uid = d->audit.loginuid;
 838                         m->creds.mask |= (SD_BUS_CREDS_AUDIT_SESSION_ID|SD_BUS_CREDS_AUDIT_LOGIN_UID) & bus->creds_mask;
 839                         break;
 840
 841                 case KDBUS_ITEM_CAPS:
 842                         m->creds.capability = d->data;
 843                         m->creds.capability_size = l;
 844                         m->creds.mask |= (SD_BUS_CREDS_EFFECTIVE_CAPS|SD_BUS_CREDS_PERMITTED_CAPS|SD_BUS_CREDS_INHERITABLE_CAPS|SD_BUS_CREDS_BOUNDING_CAPS) & bus->creds_mask;
 845                         break;
 846
 847                 case KDBUS_ITEM_DST_NAME:
 848                         destination = d->str;
 849                         break;
 850
 851                 case KDBUS_ITEM_NAME:
 852                         r = strv_extend(&m->creds.well_known_names, d->name.name);
 853                         if (r < 0)
 854                                 goto fail;
 855                         break;
 856
 857                 case KDBUS_ITEM_FDS:
 858                 case KDBUS_ITEM_SECLABEL:
 859                         break;
 860
 861                 default:
 862                         log_debug("Got unknown field from kernel %llu", d->type);
 863                 }
 864         }
 865
 866         r = bus_message_parse_fields(m);
 867         if (r < 0)
 868                 goto fail;
 869
 870         /* Override information from the user header with data from the kernel */
 871         if (k->src_id == KDBUS_SRC_ID_KERNEL)
 872                 m->sender = m->creds.unique_name = (char*) "org.freedesktop.DBus";
 873         else {
 874                 snprintf(m->sender_buffer, sizeof(m->sender_buffer), ":1.%llu", (unsigned long long) k->src_id);
 875                 m->sender = m->creds.unique_name = m->sender_buffer;
 876         }
 877
 878         if (destination)
 879                 m->destination = destination;
 880         else if (k->dst_id == KDBUS_DST_ID_BROADCAST)
 881                 m->destination = NULL;
 882         else if (k->dst_id == KDBUS_DST_ID_NAME)
 883                 m->destination = bus->unique_name; /* fill in unique name if the well-known name is missing */
 884         else {
 885                 snprintf(m->destination_buffer, sizeof(m->destination_buffer), ":1.%llu", (unsigned long long) k->dst_id);
 886                 m->destination = m->destination_buffer;
 887         }
 888
 889         /* We take possession of the kmsg struct now */
 890         m->kdbus = k;
 891         m->release_kdbus = true;
 892         m->free_fds = true;
 893         fds = NULL;
 894
 895         bus->rqueue[bus->rqueue_size++] = m;
 896
 897         return 1;
 898
 899 fail:
 900         if (m) {
 901                 struct bus_body_part *part;
 902                 unsigned i;
 903
 904                 /* Make sure the memfds are not freed twice */
 905                 MESSAGE_FOREACH_PART(part, i, m)
 906                         if (part->memfd >= 0)
 907                                 part->memfd = -1;
 908
 909                 sd_bus_message_unref(m);
 910         }
 911
 912         return r;
 913 }
 914
 915 int bus_kernel_read_message(sd_bus *bus) {
 916         struct kdbus_msg *k;
 917         uint64_t off;
 918         int r;
 919
 920         assert(bus);
 921
 922         r = bus_rqueue_make_room(bus);
 923         if (r < 0)
 924                 return r;
 925
 926         r = ioctl(bus->input_fd, KDBUS_CMD_MSG_RECV, &off);
 927         if (r < 0) {
 928                 if (errno == EAGAIN)
 929                         return 0;
 930
 931                 return -errno;
 932         }
 933         k = (struct kdbus_msg *)((uint8_t *)bus->kdbus_buffer + off);
 934
 935         if (k->payload_type == KDBUS_PAYLOAD_DBUS) {
 936                 r = bus_kernel_make_message(bus, k);
 937
 938                 /* Anybody can send us invalid messages, let's just drop them. */
 939                 if (r == -EBADMSG || r == -EPROTOTYPE) {
 940                         log_debug("Ignoring invalid message: %s", strerror(-r));
 941                         r = 0;
 942                 }
 943
 944         } else if (k->payload_type == KDBUS_PAYLOAD_KERNEL)
 945                 r = bus_kernel_translate_message(bus, k);
 946         else
 947                 r = 0;
 948
 949         if (r <= 0)
 950                 close_kdbus_msg(bus, k);
 951
 952         return r < 0 ? r : 1;
 953 }
 954
 955 int bus_kernel_pop_memfd(sd_bus *bus, void **address, size_t *mapped, size_t *allocated) {
 956         struct memfd_cache *c;
 957         int fd;
 958
 959         assert(address);
 960         assert(mapped);
 961         assert(allocated);
 962
 963         if (!bus || !bus->is_kernel)
 964                 return -ENOTSUP;
 965
 966         assert_se(pthread_mutex_lock(&bus->memfd_cache_mutex) >= 0);
 967
 968         if (bus->n_memfd_cache <= 0) {
 969                 int r;
 970
 971                 assert_se(pthread_mutex_unlock(&bus->memfd_cache_mutex) >= 0);
 972
 973                 r = ioctl(bus->input_fd, KDBUS_CMD_MEMFD_NEW, &fd);
 974                 if (r < 0)
 975                         return -errno;
 976
 977                 *address = NULL;
 978                 *mapped = 0;
 979                 *allocated = 0;
 980                 return fd;
 981         }
 982
 983         c = &bus->memfd_cache[--bus->n_memfd_cache];
 984
 985         assert(c->fd >= 0);
 986         assert(c->mapped == 0 || c->address);
 987
 988         *address = c->address;
 989         *mapped = c->mapped;
 990         *allocated = c->allocated;
 991         fd = c->fd;
 992
 993         assert_se(pthread_mutex_unlock(&bus->memfd_cache_mutex) >= 0);
 994
 995         return fd;
 996 }
 997
 998 static void close_and_munmap(int fd, void *address, size_t size) {
 999         if (size > 0)
1000                 assert_se(munmap(address, PAGE_ALIGN(size)) >= 0);
1001
1002         close_nointr_nofail(fd);
1003 }
1004
1005 void bus_kernel_push_memfd(sd_bus *bus, int fd, void *address, size_t mapped, size_t allocated) {
1006         struct memfd_cache *c;
1007         uint64_t max_mapped = PAGE_ALIGN(MEMFD_CACHE_ITEM_SIZE_MAX);
1008
1009         assert(fd >= 0);
1010         assert(mapped == 0 || address);
1011
1012         if (!bus || !bus->is_kernel) {
1013                 close_and_munmap(fd, address, mapped);
1014                 return;
1015         }
1016
1017         assert_se(pthread_mutex_lock(&bus->memfd_cache_mutex) >= 0);
1018
1019         if (bus->n_memfd_cache >= ELEMENTSOF(bus->memfd_cache)) {
1020                 assert_se(pthread_mutex_unlock(&bus->memfd_cache_mutex) >= 0);
1021
1022                 close_and_munmap(fd, address, mapped);
1023                 return;
1024         }
1025
1026         c = &bus->memfd_cache[bus->n_memfd_cache++];
1027         c->fd = fd;
1028         c->address = address;
1029
1030         /* If overly long, let's return a bit to the OS */
1031         if (mapped > max_mapped) {
1032                 assert_se(ioctl(fd, KDBUS_CMD_MEMFD_SIZE_SET, &max_mapped) >= 0);
1033                 assert_se(munmap((uint8_t*) address + max_mapped, PAGE_ALIGN(mapped - max_mapped)) >= 0);
1034                 c->mapped = c->allocated = max_mapped;
1035         } else {
1036                 c->mapped = mapped;
1037                 c->allocated = allocated;
1038         }
1039
1040         assert_se(pthread_mutex_unlock(&bus->memfd_cache_mutex) >= 0);
1041 }
1042
1043 void bus_kernel_flush_memfd(sd_bus *b) {
1044         unsigned i;
1045
1046         assert(b);
1047
1048         for (i = 0; i < b->n_memfd_cache; i++)
1049                 close_and_munmap(b->memfd_cache[i].fd, b->memfd_cache[i].address, b->memfd_cache[i].mapped);
1050 }
1051
1052 int kdbus_translate_request_name_flags(uint64_t flags, uint64_t *kdbus_flags) {
1053         uint64_t f = 0;
1054
1055         assert(kdbus_flags);
1056
1057         if (flags & SD_BUS_NAME_ALLOW_REPLACEMENT)
1058                 f |= KDBUS_NAME_ALLOW_REPLACEMENT;
1059
1060         if (flags & SD_BUS_NAME_REPLACE_EXISTING)
1061                 f |= KDBUS_NAME_REPLACE_EXISTING;
1062
1063         if (flags & SD_BUS_NAME_QUEUE)
1064                 f |= KDBUS_NAME_QUEUE;
1065
1066         *kdbus_flags = f;
1067         return 0;
1068 }
1069
1070 int kdbus_translate_attach_flags(uint64_t mask, uint64_t *kdbus_mask) {
1071         uint64_t m = 0;
1072
1073         assert(kdbus_mask);
1074
1075         if (mask & (SD_BUS_CREDS_UID|SD_BUS_CREDS_GID|SD_BUS_CREDS_PID|SD_BUS_CREDS_PID_STARTTIME|SD_BUS_CREDS_TID))
1076                 m |= KDBUS_ATTACH_CREDS;
1077
1078         if (mask & (SD_BUS_CREDS_COMM|SD_BUS_CREDS_TID_COMM))
1079                 m |= KDBUS_ATTACH_COMM;
1080
1081         if (mask & SD_BUS_CREDS_EXE)
1082                 m |= KDBUS_ATTACH_EXE;
1083
1084         if (mask & SD_BUS_CREDS_CMDLINE)
1085                 m |= KDBUS_ATTACH_CMDLINE;
1086
1087         if (mask & (SD_BUS_CREDS_CGROUP|SD_BUS_CREDS_UNIT|SD_BUS_CREDS_USER_UNIT|SD_BUS_CREDS_SLICE|SD_BUS_CREDS_SESSION|SD_BUS_CREDS_OWNER_UID))
1088                 m |= KDBUS_ATTACH_CGROUP;
1089
1090         if (mask & (SD_BUS_CREDS_EFFECTIVE_CAPS|SD_BUS_CREDS_PERMITTED_CAPS|SD_BUS_CREDS_INHERITABLE_CAPS|SD_BUS_CREDS_BOUNDING_CAPS))
1091                 m |= KDBUS_ATTACH_CAPS;
1092
1093         if (mask & SD_BUS_CREDS_SELINUX_CONTEXT)
1094                 m |= KDBUS_ATTACH_SECLABEL;
1095
1096         if (mask & (SD_BUS_CREDS_AUDIT_SESSION_ID|SD_BUS_CREDS_AUDIT_LOGIN_UID))
1097                 m |= KDBUS_ATTACH_AUDIT;
1098
1099         if (mask & SD_BUS_CREDS_WELL_KNOWN_NAMES)
1100                 m |= KDBUS_ATTACH_NAMES;
1101
1102         *kdbus_mask = m;
1103         return 0;
1104 }
1105
1106 int bus_kernel_create_bus(const char *name, char **s) {
1107         struct kdbus_cmd_make *make;
1108         struct kdbus_item *n;
1109         int fd;
1110
1111         assert(name);
1112         assert(s);
1113
1114         fd = open("/dev/kdbus/control", O_RDWR|O_NOCTTY|O_CLOEXEC);
1115         if (fd < 0)
1116                 return -errno;
1117
1118         make = alloca0(ALIGN8(offsetof(struct kdbus_cmd_make, items) +
1119                               offsetof(struct kdbus_item, data64) + sizeof(uint64_t) +
1120                               offsetof(struct kdbus_item, str) +
1121                               DECIMAL_STR_MAX(uid_t) + 1 + strlen(name) + 1));
1122
1123         make->size = offsetof(struct kdbus_cmd_make, items);
1124
1125         n = make->items;
1126         n->size = offsetof(struct kdbus_item, data64) + sizeof(uint64_t);
1127         n->type = KDBUS_ITEM_BLOOM_SIZE;
1128         n->data64[0] = BLOOM_SIZE;
1129         assert_cc(BLOOM_SIZE % 8 == 0);
1130         make->size += ALIGN8(n->size);
1131
1132         n = KDBUS_ITEM_NEXT(n);
1133         sprintf(n->str, "%lu-%s", (unsigned long) getuid(), name);
1134         n->size = offsetof(struct kdbus_item, str) + strlen(n->str) + 1;
1135         n->type = KDBUS_ITEM_MAKE_NAME;
1136         make->size += ALIGN8(n->size);
1137
1138         make->flags = KDBUS_MAKE_POLICY_OPEN;
1139
1140         if (ioctl(fd, KDBUS_CMD_BUS_MAKE, make) < 0) {
1141                 close_nointr_nofail(fd);
1142                 return -errno;
1143         }
1144
1145         /* The higher 32bit of the flags field are considered
1146          * 'incompatible flags'. Refuse them all for now. */
1147         if (make->flags > 0xFFFFFFFFULL) {
1148                 close_nointr_nofail(fd);
1149                 return -ENOTSUP;
1150         }
1151
1152         if (s) {
1153                 char *p;
1154
1155                 p = strjoin("/dev/kdbus/", n->str, "/bus", NULL);
1156                 if (!p) {
1157                         close_nointr_nofail(fd);
1158                         return -ENOMEM;
1159                 }
1160
1161                 *s = p;
1162         }
1163
1164         return fd;
1165 }
1166
1167 int bus_kernel_create_starter(const char *bus, const char *name) {
1168         struct kdbus_cmd_hello *hello;
1169         struct kdbus_item *n;
1170         char *p;
1171         int fd;
1172
1173         assert(bus);
1174         assert(name);
1175
1176         p = alloca(sizeof("/dev/kdbus/") - 1 + DECIMAL_STR_MAX(uid_t) + 1 + strlen(bus) + sizeof("/bus"));
1177         sprintf(p, "/dev/kdbus/%lu-%s/bus", (unsigned long) getuid(), bus);
1178
1179         fd = open(p, O_RDWR|O_NOCTTY|O_CLOEXEC);
1180         if (fd < 0)
1181                 return -errno;
1182
1183         hello = alloca0(ALIGN8(offsetof(struct kdbus_cmd_hello, items) +
1184                                offsetof(struct kdbus_item, str) +
1185                                strlen(name) + 1));
1186
1187         n = hello->items;
1188         strcpy(n->str, name);
1189         n->size = offsetof(struct kdbus_item, str) + strlen(n->str) + 1;
1190         n->type = KDBUS_ITEM_NAME;
1191
1192         hello->size = ALIGN8(offsetof(struct kdbus_cmd_hello, items) + n->size);
1193         hello->conn_flags = KDBUS_HELLO_ACTIVATOR;
1194         hello->pool_size = KDBUS_POOL_SIZE;
1195
1196         if (ioctl(fd, KDBUS_CMD_HELLO, hello) < 0) {
1197                 close_nointr_nofail(fd);
1198                 return -errno;
1199         }
1200
1201         /* The higher 32bit of both flags fields are considered
1202          * 'incompatible flags'. Refuse them all for now. */
1203         if (hello->bus_flags > 0xFFFFFFFFULL ||
1204             hello->conn_flags > 0xFFFFFFFFULL) {
1205                 close_nointr_nofail(fd);
1206                 return -ENOTSUP;
1207         }
1208
1209         if (hello->bloom_size != BLOOM_SIZE) {
1210                 close_nointr_nofail(fd);
1211                 return -ENOTSUP;
1212         }
1213
1214         return fd;
1215 }
1216
1217 int bus_kernel_create_namespace(const char *name, char **s) {
1218         struct kdbus_cmd_make *make;
1219         struct kdbus_item *n;
1220         int fd;
1221
1222         assert(name);
1223         assert(s);
1224
1225         fd = open("/dev/kdbus/control", O_RDWR|O_NOCTTY|O_CLOEXEC);
1226         if (fd < 0)
1227                 return -errno;
1228
1229         make = alloca0(ALIGN8(offsetof(struct kdbus_cmd_make, items) +
1230                               offsetof(struct kdbus_item, str) +
1231                               strlen(name) + 1));
1232
1233         n = make->items;
1234         strcpy(n->str, name);
1235         n->size = offsetof(struct kdbus_item, str) + strlen(n->str) + 1;
1236         n->type = KDBUS_ITEM_MAKE_NAME;
1237
1238         make->size = ALIGN8(offsetof(struct kdbus_cmd_make, items) + n->size);
1239         make->flags = KDBUS_MAKE_POLICY_OPEN | KDBUS_MAKE_ACCESS_WORLD;
1240
1241         if (ioctl(fd, KDBUS_CMD_NS_MAKE, make) < 0) {
1242                 close_nointr_nofail(fd);
1243                 return -errno;
1244         }
1245
1246         /* The higher 32bit of the flags field are considered
1247          * 'incompatible flags'. Refuse them all for now. */
1248         if (make->flags > 0xFFFFFFFFULL) {
1249                 close_nointr_nofail(fd);
1250                 return -ENOTSUP;
1251         }
1252
1253         if (s) {
1254                 char *p;
1255
1256                 p = strappend("/dev/kdbus/ns/", name);
1257                 if (!p) {
1258                         close_nointr_nofail(fd);
1259                         return -ENOMEM;
1260                 }
1261
1262                 *s = p;
1263         }
1264
1265         return fd;
1266 }
1267
1268 int bus_kernel_create_monitor(const char *bus) {
1269         struct kdbus_cmd_hello *hello;
1270         char *p;
1271         int fd;
1272
1273         assert(bus);
1274
1275         p = alloca(sizeof("/dev/kdbus/") - 1 + DECIMAL_STR_MAX(uid_t) + 1 + strlen(bus) + sizeof("/bus"));
1276         sprintf(p, "/dev/kdbus/%lu-%s/bus", (unsigned long) getuid(), bus);
1277
1278         fd = open(p, O_RDWR|O_NOCTTY|O_CLOEXEC);
1279         if (fd < 0)
1280                 return -errno;
1281
1282         hello = alloca0(sizeof(struct kdbus_cmd_hello));
1283         hello->size = sizeof(struct kdbus_cmd_hello);
1284         hello->conn_flags = KDBUS_HELLO_ACTIVATOR;
1285         hello->pool_size = KDBUS_POOL_SIZE;
1286
1287         if (ioctl(fd, KDBUS_CMD_HELLO, hello) < 0) {
1288                 close_nointr_nofail(fd);
1289                 return -errno;
1290         }
1291
1292         /* The higher 32bit of both flags fields are considered
1293          * 'incompatible flags'. Refuse them all for now. */
1294         if (hello->bus_flags > 0xFFFFFFFFULL ||
1295             hello->conn_flags > 0xFFFFFFFFULL) {
1296                 close_nointr_nofail(fd);
1297                 return -ENOTSUP;
1298         }
1299
1300         return fd;
1301 }
1302
1303 int bus_kernel_try_close(sd_bus *bus) {
1304         assert(bus);
1305         assert(bus->is_kernel);
1306
1307         if (ioctl(bus->input_fd, KDBUS_CMD_BYEBYE) < 0)
1308                 return -errno;
1309
1310         return 0;
1311 }