src/util.c

   1 /*-*- Mode: C; c-basic-offset: 8; indent-tabs-mode: nil -*-*/
   2
   3 /***
   4   This file is part of systemd.
   5
   6   Copyright 2010 Lennart Poettering
   7
   8   systemd is free software; you can redistribute it and/or modify it
   9   under the terms of the GNU General Public License as published by
  10   the Free Software Foundation; either version 2 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   General Public License for more details.
  17
  18   You should have received a copy of the GNU General Public License
  19   along with systemd; If not, see <http://www.gnu.org/licenses/>.
  20 ***/
  21
  22 #include <assert.h>
  23 #include <string.h>
  24 #include <unistd.h>
  25 #include <errno.h>
  26 #include <stdlib.h>
  27 #include <signal.h>
  28 #include <stdio.h>
  29 #include <syslog.h>
  30 #include <sched.h>
  31 #include <sys/resource.h>
  32 #include <linux/sched.h>
  33 #include <sys/types.h>
  34 #include <sys/stat.h>
  35 #include <fcntl.h>
  36 #include <dirent.h>
  37 #include <sys/ioctl.h>
  38 #include <linux/vt.h>
  39 #include <linux/tiocl.h>
  40 #include <termios.h>
  41 #include <stdarg.h>
  42 #include <sys/inotify.h>
  43 #include <sys/poll.h>
  44 #include <libgen.h>
  45 #include <ctype.h>
  46 #include <sys/prctl.h>
  47 #include <sys/utsname.h>
  48 #include <pwd.h>
  49 #include <netinet/ip.h>
  50 #include <linux/kd.h>
  51 #include <dlfcn.h>
  52 #include <sys/wait.h>
  53 #include <sys/capability.h>
  54 #include <sys/time.h>
  55 #include <linux/rtc.h>
  56 #include <glob.h>
  57 #include <grp.h>
  58
  59 #include "macro.h"
  60 #include "util.h"
  61 #include "ioprio.h"
  62 #include "missing.h"
  63 #include "log.h"
  64 #include "strv.h"
  65 #include "label.h"
  66 #include "exit-status.h"
  67 #include "hashmap.h"
  68
  69 int saved_argc = 0;
  70 char **saved_argv = NULL;
  71
  72 size_t page_size(void) {
  73         static __thread size_t pgsz = 0;
  74         long r;
  75
  76         if (_likely_(pgsz))
  77                 return pgsz;
  78
  79         assert_se((r = sysconf(_SC_PAGESIZE)) > 0);
  80
  81         pgsz = (size_t) r;
  82
  83         return pgsz;
  84 }
  85
  86 bool streq_ptr(const char *a, const char *b) {
  87
  88         /* Like streq(), but tries to make sense of NULL pointers */
  89
  90         if (a && b)
  91                 return streq(a, b);
  92
  93         if (!a && !b)
  94                 return true;
  95
  96         return false;
  97 }
  98
  99 usec_t now(clockid_t clock_id) {
 100         struct timespec ts;
 101
 102         assert_se(clock_gettime(clock_id, &ts) == 0);
 103
 104         return timespec_load(&ts);
 105 }
 106
 107 dual_timestamp* dual_timestamp_get(dual_timestamp *ts) {
 108         assert(ts);
 109
 110         ts->realtime = now(CLOCK_REALTIME);
 111         ts->monotonic = now(CLOCK_MONOTONIC);
 112
 113         return ts;
 114 }
 115
 116 dual_timestamp* dual_timestamp_from_realtime(dual_timestamp *ts, usec_t u) {
 117         int64_t delta;
 118         assert(ts);
 119
 120         ts->realtime = u;
 121
 122         if (u == 0)
 123                 ts->monotonic = 0;
 124         else {
 125                 delta = (int64_t) now(CLOCK_REALTIME) - (int64_t) u;
 126
 127                 ts->monotonic = now(CLOCK_MONOTONIC);
 128
 129                 if ((int64_t) ts->monotonic > delta)
 130                         ts->monotonic -= delta;
 131                 else
 132                         ts->monotonic = 0;
 133         }
 134
 135         return ts;
 136 }
 137
 138 usec_t timespec_load(const struct timespec *ts) {
 139         assert(ts);
 140
 141         return
 142                 (usec_t) ts->tv_sec * USEC_PER_SEC +
 143                 (usec_t) ts->tv_nsec / NSEC_PER_USEC;
 144 }
 145
 146 struct timespec *timespec_store(struct timespec *ts, usec_t u)  {
 147         assert(ts);
 148
 149         ts->tv_sec = (time_t) (u / USEC_PER_SEC);
 150         ts->tv_nsec = (long int) ((u % USEC_PER_SEC) * NSEC_PER_USEC);
 151
 152         return ts;
 153 }
 154
 155 usec_t timeval_load(const struct timeval *tv) {
 156         assert(tv);
 157
 158         return
 159                 (usec_t) tv->tv_sec * USEC_PER_SEC +
 160                 (usec_t) tv->tv_usec;
 161 }
 162
 163 struct timeval *timeval_store(struct timeval *tv, usec_t u) {
 164         assert(tv);
 165
 166         tv->tv_sec = (time_t) (u / USEC_PER_SEC);
 167         tv->tv_usec = (suseconds_t) (u % USEC_PER_SEC);
 168
 169         return tv;
 170 }
 171
 172 bool endswith(const char *s, const char *postfix) {
 173         size_t sl, pl;
 174
 175         assert(s);
 176         assert(postfix);
 177
 178         sl = strlen(s);
 179         pl = strlen(postfix);
 180
 181         if (pl == 0)
 182                 return true;
 183
 184         if (sl < pl)
 185                 return false;
 186
 187         return memcmp(s + sl - pl, postfix, pl) == 0;
 188 }
 189
 190 bool startswith(const char *s, const char *prefix) {
 191         size_t sl, pl;
 192
 193         assert(s);
 194         assert(prefix);
 195
 196         sl = strlen(s);
 197         pl = strlen(prefix);
 198
 199         if (pl == 0)
 200                 return true;
 201
 202         if (sl < pl)
 203                 return false;
 204
 205         return memcmp(s, prefix, pl) == 0;
 206 }
 207
 208 bool startswith_no_case(const char *s, const char *prefix) {
 209         size_t sl, pl;
 210         unsigned i;
 211
 212         assert(s);
 213         assert(prefix);
 214
 215         sl = strlen(s);
 216         pl = strlen(prefix);
 217
 218         if (pl == 0)
 219                 return true;
 220
 221         if (sl < pl)
 222                 return false;
 223
 224         for(i = 0; i < pl; ++i) {
 225                 if (tolower(s[i]) != tolower(prefix[i]))
 226                         return false;
 227         }
 228
 229         return true;
 230 }
 231
 232 bool first_word(const char *s, const char *word) {
 233         size_t sl, wl;
 234
 235         assert(s);
 236         assert(word);
 237
 238         sl = strlen(s);
 239         wl = strlen(word);
 240
 241         if (sl < wl)
 242                 return false;
 243
 244         if (wl == 0)
 245                 return true;
 246
 247         if (memcmp(s, word, wl) != 0)
 248                 return false;
 249
 250         return s[wl] == 0 ||
 251                 strchr(WHITESPACE, s[wl]);
 252 }
 253
 254 int close_nointr(int fd) {
 255         assert(fd >= 0);
 256
 257         for (;;) {
 258                 int r;
 259
 260                 r = close(fd);
 261                 if (r >= 0)
 262                         return r;
 263
 264                 if (errno != EINTR)
 265                         return -errno;
 266         }
 267 }
 268
 269 void close_nointr_nofail(int fd) {
 270         int saved_errno = errno;
 271
 272         /* like close_nointr() but cannot fail, and guarantees errno
 273          * is unchanged */
 274
 275         assert_se(close_nointr(fd) == 0);
 276
 277         errno = saved_errno;
 278 }
 279
 280 void close_many(const int fds[], unsigned n_fd) {
 281         unsigned i;
 282
 283         for (i = 0; i < n_fd; i++)
 284                 close_nointr_nofail(fds[i]);
 285 }
 286
 287 int parse_boolean(const char *v) {
 288         assert(v);
 289
 290         if (streq(v, "1") || v[0] == 'y' || v[0] == 'Y' || v[0] == 't' || v[0] == 'T' || !strcasecmp(v, "on"))
 291                 return 1;
 292         else if (streq(v, "0") || v[0] == 'n' || v[0] == 'N' || v[0] == 'f' || v[0] == 'F' || !strcasecmp(v, "off"))
 293                 return 0;
 294
 295         return -EINVAL;
 296 }
 297
 298 int parse_pid(const char *s, pid_t* ret_pid) {
 299         unsigned long ul = 0;
 300         pid_t pid;
 301         int r;
 302
 303         assert(s);
 304         assert(ret_pid);
 305
 306         if ((r = safe_atolu(s, &ul)) < 0)
 307                 return r;
 308
 309         pid = (pid_t) ul;
 310
 311         if ((unsigned long) pid != ul)
 312                 return -ERANGE;
 313
 314         if (pid <= 0)
 315                 return -ERANGE;
 316
 317         *ret_pid = pid;
 318         return 0;
 319 }
 320
 321 int parse_uid(const char *s, uid_t* ret_uid) {
 322         unsigned long ul = 0;
 323         uid_t uid;
 324         int r;
 325
 326         assert(s);
 327         assert(ret_uid);
 328
 329         if ((r = safe_atolu(s, &ul)) < 0)
 330                 return r;
 331
 332         uid = (uid_t) ul;
 333
 334         if ((unsigned long) uid != ul)
 335                 return -ERANGE;
 336
 337         *ret_uid = uid;
 338         return 0;
 339 }
 340
 341 int safe_atou(const char *s, unsigned *ret_u) {
 342         char *x = NULL;
 343         unsigned long l;
 344
 345         assert(s);
 346         assert(ret_u);
 347
 348         errno = 0;
 349         l = strtoul(s, &x, 0);
 350
 351         if (!x || *x || errno)
 352                 return errno ? -errno : -EINVAL;
 353
 354         if ((unsigned long) (unsigned) l != l)
 355                 return -ERANGE;
 356
 357         *ret_u = (unsigned) l;
 358         return 0;
 359 }
 360
 361 int safe_atoi(const char *s, int *ret_i) {
 362         char *x = NULL;
 363         long l;
 364
 365         assert(s);
 366         assert(ret_i);
 367
 368         errno = 0;
 369         l = strtol(s, &x, 0);
 370
 371         if (!x || *x || errno)
 372                 return errno ? -errno : -EINVAL;
 373
 374         if ((long) (int) l != l)
 375                 return -ERANGE;
 376
 377         *ret_i = (int) l;
 378         return 0;
 379 }
 380
 381 int safe_atollu(const char *s, long long unsigned *ret_llu) {
 382         char *x = NULL;
 383         unsigned long long l;
 384
 385         assert(s);
 386         assert(ret_llu);
 387
 388         errno = 0;
 389         l = strtoull(s, &x, 0);
 390
 391         if (!x || *x || errno)
 392                 return errno ? -errno : -EINVAL;
 393
 394         *ret_llu = l;
 395         return 0;
 396 }
 397
 398 int safe_atolli(const char *s, long long int *ret_lli) {
 399         char *x = NULL;
 400         long long l;
 401
 402         assert(s);
 403         assert(ret_lli);
 404
 405         errno = 0;
 406         l = strtoll(s, &x, 0);
 407
 408         if (!x || *x || errno)
 409                 return errno ? -errno : -EINVAL;
 410
 411         *ret_lli = l;
 412         return 0;
 413 }
 414
 415 /* Split a string into words. */
 416 char *split(const char *c, size_t *l, const char *separator, char **state) {
 417         char *current;
 418
 419         current = *state ? *state : (char*) c;
 420
 421         if (!*current || *c == 0)
 422                 return NULL;
 423
 424         current += strspn(current, separator);
 425         *l = strcspn(current, separator);
 426         *state = current+*l;
 427
 428         return (char*) current;
 429 }
 430
 431 /* Split a string into words, but consider strings enclosed in '' and
 432  * "" as words even if they include spaces. */
 433 char *split_quoted(const char *c, size_t *l, char **state) {
 434         char *current, *e;
 435         bool escaped = false;
 436
 437         current = *state ? *state : (char*) c;
 438
 439         if (!*current || *c == 0)
 440                 return NULL;
 441
 442         current += strspn(current, WHITESPACE);
 443
 444         if (*current == '\'') {
 445                 current ++;
 446
 447                 for (e = current; *e; e++) {
 448                         if (escaped)
 449                                 escaped = false;
 450                         else if (*e == '\\')
 451                                 escaped = true;
 452                         else if (*e == '\'')
 453                                 break;
 454                 }
 455
 456                 *l = e-current;
 457                 *state = *e == 0 ? e : e+1;
 458         } else if (*current == '\"') {
 459                 current ++;
 460
 461                 for (e = current; *e; e++) {
 462                         if (escaped)
 463                                 escaped = false;
 464                         else if (*e == '\\')
 465                                 escaped = true;
 466                         else if (*e == '\"')
 467                                 break;
 468                 }
 469
 470                 *l = e-current;
 471                 *state = *e == 0 ? e : e+1;
 472         } else {
 473                 for (e = current; *e; e++) {
 474                         if (escaped)
 475                                 escaped = false;
 476                         else if (*e == '\\')
 477                                 escaped = true;
 478                         else if (strchr(WHITESPACE, *e))
 479                                 break;
 480                 }
 481                 *l = e-current;
 482                 *state = e;
 483         }
 484
 485         return (char*) current;
 486 }
 487
 488 char **split_path_and_make_absolute(const char *p) {
 489         char **l;
 490         assert(p);
 491
 492         if (!(l = strv_split(p, ":")))
 493                 return NULL;
 494
 495         if (!strv_path_make_absolute_cwd(l)) {
 496                 strv_free(l);
 497                 return NULL;
 498         }
 499
 500         return l;
 501 }
 502
 503 int get_parent_of_pid(pid_t pid, pid_t *_ppid) {
 504         int r;
 505         FILE *f;
 506         char fn[PATH_MAX], line[LINE_MAX], *p;
 507         long unsigned ppid;
 508
 509         assert(pid > 0);
 510         assert(_ppid);
 511
 512         assert_se(snprintf(fn, sizeof(fn)-1, "/proc/%lu/stat", (unsigned long) pid) < (int) (sizeof(fn)-1));
 513         char_array_0(fn);
 514
 515         if (!(f = fopen(fn, "re")))
 516                 return -errno;
 517
 518         if (!(fgets(line, sizeof(line), f))) {
 519                 r = -errno;
 520                 fclose(f);
 521                 return r;
 522         }
 523
 524         fclose(f);
 525
 526         /* Let's skip the pid and comm fields. The latter is enclosed
 527          * in () but does not escape any () in its value, so let's
 528          * skip over it manually */
 529
 530         if (!(p = strrchr(line, ')')))
 531                 return -EIO;
 532
 533         p++;
 534
 535         if (sscanf(p, " "
 536                    "%*c "  /* state */
 537                    "%lu ", /* ppid */
 538                    &ppid) != 1)
 539                 return -EIO;
 540
 541         if ((long unsigned) (pid_t) ppid != ppid)
 542                 return -ERANGE;
 543
 544         *_ppid = (pid_t) ppid;
 545
 546         return 0;
 547 }
 548
 549 int get_starttime_of_pid(pid_t pid, unsigned long long *st) {
 550         int r;
 551         FILE *f;
 552         char fn[PATH_MAX], line[LINE_MAX], *p;
 553
 554         assert(pid > 0);
 555         assert(st);
 556
 557         assert_se(snprintf(fn, sizeof(fn)-1, "/proc/%lu/stat", (unsigned long) pid) < (int) (sizeof(fn)-1));
 558         char_array_0(fn);
 559
 560         if (!(f = fopen(fn, "re")))
 561                 return -errno;
 562
 563         if (!(fgets(line, sizeof(line), f))) {
 564                 r = -errno;
 565                 fclose(f);
 566                 return r;
 567         }
 568
 569         fclose(f);
 570
 571         /* Let's skip the pid and comm fields. The latter is enclosed
 572          * in () but does not escape any () in its value, so let's
 573          * skip over it manually */
 574
 575         if (!(p = strrchr(line, ')')))
 576                 return -EIO;
 577
 578         p++;
 579
 580         if (sscanf(p, " "
 581                    "%*c "  /* state */
 582                    "%*d "  /* ppid */
 583                    "%*d "  /* pgrp */
 584                    "%*d "  /* session */
 585                    "%*d "  /* tty_nr */
 586                    "%*d "  /* tpgid */
 587                    "%*u "  /* flags */
 588                    "%*u "  /* minflt */
 589                    "%*u "  /* cminflt */
 590                    "%*u "  /* majflt */
 591                    "%*u "  /* cmajflt */
 592                    "%*u "  /* utime */
 593                    "%*u "  /* stime */
 594                    "%*d "  /* cutime */
 595                    "%*d "  /* cstime */
 596                    "%*d "  /* priority */
 597                    "%*d "  /* nice */
 598                    "%*d "  /* num_threads */
 599                    "%*d "  /* itrealvalue */
 600                    "%llu "  /* starttime */,
 601                    st) != 1)
 602                 return -EIO;
 603
 604         return 0;
 605 }
 606
 607 int write_one_line_file(const char *fn, const char *line) {
 608         FILE *f;
 609         int r;
 610
 611         assert(fn);
 612         assert(line);
 613
 614         if (!(f = fopen(fn, "we")))
 615                 return -errno;
 616
 617         errno = 0;
 618         if (fputs(line, f) < 0) {
 619                 r = -errno;
 620                 goto finish;
 621         }
 622
 623         if (!endswith(line, "\n"))
 624                 fputc('\n', f);
 625
 626         fflush(f);
 627
 628         if (ferror(f)) {
 629                 if (errno != 0)
 630                         r = -errno;
 631                 else
 632                         r = -EIO;
 633         } else
 634                 r = 0;
 635
 636 finish:
 637         fclose(f);
 638         return r;
 639 }
 640
 641 int fchmod_umask(int fd, mode_t m) {
 642         mode_t u;
 643         int r;
 644
 645         u = umask(0777);
 646         r = fchmod(fd, m & (~u)) < 0 ? -errno : 0;
 647         umask(u);
 648
 649         return r;
 650 }
 651
 652 int write_one_line_file_atomic(const char *fn, const char *line) {
 653         FILE *f;
 654         int r;
 655         char *p;
 656
 657         assert(fn);
 658         assert(line);
 659
 660         r = fopen_temporary(fn, &f, &p);
 661         if (r < 0)
 662                 return r;
 663
 664         fchmod_umask(fileno(f), 0644);
 665
 666         errno = 0;
 667         if (fputs(line, f) < 0) {
 668                 r = -errno;
 669                 goto finish;
 670         }
 671
 672         if (!endswith(line, "\n"))
 673                 fputc('\n', f);
 674
 675         fflush(f);
 676
 677         if (ferror(f)) {
 678                 if (errno != 0)
 679                         r = -errno;
 680                 else
 681                         r = -EIO;
 682         } else {
 683                 if (rename(p, fn) < 0)
 684                         r = -errno;
 685                 else
 686                         r = 0;
 687         }
 688
 689 finish:
 690         if (r < 0)
 691                 unlink(p);
 692
 693         fclose(f);
 694         free(p);
 695
 696         return r;
 697 }
 698
 699 int read_one_line_file(const char *fn, char **line) {
 700         FILE *f;
 701         int r;
 702         char t[LINE_MAX], *c;
 703
 704         assert(fn);
 705         assert(line);
 706
 707         if (!(f = fopen(fn, "re")))
 708                 return -errno;
 709
 710         if (!(fgets(t, sizeof(t), f))) {
 711                 r = -errno;
 712                 goto finish;
 713         }
 714
 715         if (!(c = strdup(t))) {
 716                 r = -ENOMEM;
 717                 goto finish;
 718         }
 719
 720         truncate_nl(c);
 721
 722         *line = c;
 723         r = 0;
 724
 725 finish:
 726         fclose(f);
 727         return r;
 728 }
 729
 730 int read_full_file(const char *fn, char **contents, size_t *size) {
 731         FILE *f;
 732         int r;
 733         size_t n, l;
 734         char *buf = NULL;
 735         struct stat st;
 736
 737         if (!(f = fopen(fn, "re")))
 738                 return -errno;
 739
 740         if (fstat(fileno(f), &st) < 0) {
 741                 r = -errno;
 742                 goto finish;
 743         }
 744
 745         /* Safety check */
 746         if (st.st_size > 4*1024*1024) {
 747                 r = -E2BIG;
 748                 goto finish;
 749         }
 750
 751         n = st.st_size > 0 ? st.st_size : LINE_MAX;
 752         l = 0;
 753
 754         for (;;) {
 755                 char *t;
 756                 size_t k;
 757
 758                 if (!(t = realloc(buf, n+1))) {
 759                         r = -ENOMEM;
 760                         goto finish;
 761                 }
 762
 763                 buf = t;
 764                 k = fread(buf + l, 1, n - l, f);
 765
 766                 if (k <= 0) {
 767                         if (ferror(f)) {
 768                                 r = -errno;
 769                                 goto finish;
 770                         }
 771
 772                         break;
 773                 }
 774
 775                 l += k;
 776                 n *= 2;
 777
 778                 /* Safety check */
 779                 if (n > 4*1024*1024) {
 780                         r = -E2BIG;
 781                         goto finish;
 782                 }
 783         }
 784
 785         if (buf)
 786                 buf[l] = 0;
 787         else if (!(buf = calloc(1, 1))) {
 788                 r = -errno;
 789                 goto finish;
 790         }
 791
 792         *contents = buf;
 793         buf = NULL;
 794
 795         if (size)
 796                 *size = l;
 797
 798         r = 0;
 799
 800 finish:
 801         fclose(f);
 802         free(buf);
 803
 804         return r;
 805 }
 806
 807 int parse_env_file(
 808                 const char *fname,
 809                 const char *separator, ...) {
 810
 811         int r = 0;
 812         char *contents = NULL, *p;
 813
 814         assert(fname);
 815         assert(separator);
 816
 817         if ((r = read_full_file(fname, &contents, NULL)) < 0)
 818                 return r;
 819
 820         p = contents;
 821         for (;;) {
 822                 const char *key = NULL;
 823
 824                 p += strspn(p, separator);
 825                 p += strspn(p, WHITESPACE);
 826
 827                 if (!*p)
 828                         break;
 829
 830                 if (!strchr(COMMENTS, *p)) {
 831                         va_list ap;
 832                         char **value;
 833
 834                         va_start(ap, separator);
 835                         while ((key = va_arg(ap, char *))) {
 836                                 size_t n;
 837                                 char *v;
 838
 839                                 value = va_arg(ap, char **);
 840
 841                                 n = strlen(key);
 842                                 if (strncmp(p, key, n) != 0 ||
 843                                     p[n] != '=')
 844                                         continue;
 845
 846                                 p += n + 1;
 847                                 n = strcspn(p, separator);
 848
 849                                 if (n >= 2 &&
 850                                     strchr(QUOTES, p[0]) &&
 851                                     p[n-1] == p[0])
 852                                         v = strndup(p+1, n-2);
 853                                 else
 854                                         v = strndup(p, n);
 855
 856                                 if (!v) {
 857                                         r = -ENOMEM;
 858                                         va_end(ap);
 859                                         goto fail;
 860                                 }
 861
 862                                 if (v[0] == '\0') {
 863                                         /* return empty value strings as NULL */
 864                                         free(v);
 865                                         v = NULL;
 866                                 }
 867
 868                                 free(*value);
 869                                 *value = v;
 870
 871                                 p += n;
 872
 873                                 r ++;
 874                                 break;
 875                         }
 876                         va_end(ap);
 877                 }
 878
 879                 if (!key)
 880                         p += strcspn(p, separator);
 881         }
 882
 883 fail:
 884         free(contents);
 885         return r;
 886 }
 887
 888 int load_env_file(
 889                 const char *fname,
 890                 char ***rl) {
 891
 892         FILE *f;
 893         char **m = 0;
 894         int r;
 895
 896         assert(fname);
 897         assert(rl);
 898
 899         if (!(f = fopen(fname, "re")))
 900                 return -errno;
 901
 902         while (!feof(f)) {
 903                 char l[LINE_MAX], *p, *u;
 904                 char **t;
 905
 906                 if (!fgets(l, sizeof(l), f)) {
 907                         if (feof(f))
 908                                 break;
 909
 910                         r = -errno;
 911                         goto finish;
 912                 }
 913
 914                 p = strstrip(l);
 915
 916                 if (!*p)
 917                         continue;
 918
 919                 if (strchr(COMMENTS, *p))
 920                         continue;
 921
 922                 if (!(u = normalize_env_assignment(p))) {
 923                         log_error("Out of memory");
 924                         r = -ENOMEM;
 925                         goto finish;
 926                 }
 927
 928                 t = strv_append(m, u);
 929                 free(u);
 930
 931                 if (!t) {
 932                         log_error("Out of memory");
 933                         r = -ENOMEM;
 934                         goto finish;
 935                 }
 936
 937                 strv_free(m);
 938                 m = t;
 939         }
 940
 941         r = 0;
 942
 943         *rl = m;
 944         m = NULL;
 945
 946 finish:
 947         if (f)
 948                 fclose(f);
 949
 950         strv_free(m);
 951
 952         return r;
 953 }
 954
 955 int write_env_file(const char *fname, char **l) {
 956         char **i, *p;
 957         FILE *f;
 958         int r;
 959
 960         r = fopen_temporary(fname, &f, &p);
 961         if (r < 0)
 962                 return r;
 963
 964         fchmod_umask(fileno(f), 0644);
 965
 966         errno = 0;
 967         STRV_FOREACH(i, l) {
 968                 fputs(*i, f);
 969                 fputc('\n', f);
 970         }
 971
 972         fflush(f);
 973
 974         if (ferror(f)) {
 975                 if (errno != 0)
 976                         r = -errno;
 977                 else
 978                         r = -EIO;
 979         } else {
 980                 if (rename(p, fname) < 0)
 981                         r = -errno;
 982                 else
 983                         r = 0;
 984         }
 985
 986         if (r < 0)
 987                 unlink(p);
 988
 989         fclose(f);
 990         free(p);
 991
 992         return r;
 993 }
 994
 995 char *truncate_nl(char *s) {
 996         assert(s);
 997
 998         s[strcspn(s, NEWLINE)] = 0;
 999         return s;
1000 }
1001
1002 int get_process_name(pid_t pid, char **name) {
1003         char *p;
1004         int r;
1005
1006         assert(pid >= 1);
1007         assert(name);
1008
1009         if (asprintf(&p, "/proc/%lu/comm", (unsigned long) pid) < 0)
1010                 return -ENOMEM;
1011
1012         r = read_one_line_file(p, name);
1013         free(p);
1014
1015         if (r < 0)
1016                 return r;
1017
1018         return 0;
1019 }
1020
1021 int get_process_cmdline(pid_t pid, size_t max_length, char **line) {
1022         char *p, *r, *k;
1023         int c;
1024         bool space = false;
1025         size_t left;
1026         FILE *f;
1027
1028         assert(pid >= 1);
1029         assert(max_length > 0);
1030         assert(line);
1031
1032         if (asprintf(&p, "/proc/%lu/cmdline", (unsigned long) pid) < 0)
1033                 return -ENOMEM;
1034
1035         f = fopen(p, "re");
1036         free(p);
1037
1038         if (!f)
1039                 return -errno;
1040
1041         if (!(r = new(char, max_length))) {
1042                 fclose(f);
1043                 return -ENOMEM;
1044         }
1045
1046         k = r;
1047         left = max_length;
1048         while ((c = getc(f)) != EOF) {
1049
1050                 if (isprint(c)) {
1051                         if (space) {
1052                                 if (left <= 4)
1053                                         break;
1054
1055                                 *(k++) = ' ';
1056                                 left--;
1057                                 space = false;
1058                         }
1059
1060                         if (left <= 4)
1061                                 break;
1062
1063                         *(k++) = (char) c;
1064                         left--;
1065                 }  else
1066                         space = true;
1067         }
1068
1069         if (left <= 4) {
1070                 size_t n = MIN(left-1, 3U);
1071                 memcpy(k, "...", n);
1072                 k[n] = 0;
1073         } else
1074                 *k = 0;
1075
1076         fclose(f);
1077
1078         /* Kernel threads have no argv[] */
1079         if (r[0] == 0) {
1080                 char *t;
1081                 int h;
1082
1083                 free(r);
1084
1085                 if ((h = get_process_name(pid, &t)) < 0)
1086                         return h;
1087
1088                 h = asprintf(&r, "[%s]", t);
1089                 free(t);
1090
1091                 if (h < 0)
1092                         return -ENOMEM;
1093         }
1094
1095         *line = r;
1096         return 0;
1097 }
1098
1099 char *strnappend(const char *s, const char *suffix, size_t b) {
1100         size_t a;
1101         char *r;
1102
1103         if (!s && !suffix)
1104                 return strdup("");
1105
1106         if (!s)
1107                 return strndup(suffix, b);
1108
1109         if (!suffix)
1110                 return strdup(s);
1111
1112         assert(s);
1113         assert(suffix);
1114
1115         a = strlen(s);
1116
1117         if (!(r = new(char, a+b+1)))
1118                 return NULL;
1119
1120         memcpy(r, s, a);
1121         memcpy(r+a, suffix, b);
1122         r[a+b] = 0;
1123
1124         return r;
1125 }
1126
1127 char *strappend(const char *s, const char *suffix) {
1128         return strnappend(s, suffix, suffix ? strlen(suffix) : 0);
1129 }
1130
1131 int readlink_malloc(const char *p, char **r) {
1132         size_t l = 100;
1133
1134         assert(p);
1135         assert(r);
1136
1137         for (;;) {
1138                 char *c;
1139                 ssize_t n;
1140
1141                 if (!(c = new(char, l)))
1142                         return -ENOMEM;
1143
1144                 if ((n = readlink(p, c, l-1)) < 0) {
1145                         int ret = -errno;
1146                         free(c);
1147                         return ret;
1148                 }
1149
1150                 if ((size_t) n < l-1) {
1151                         c[n] = 0;
1152                         *r = c;
1153                         return 0;
1154                 }
1155
1156                 free(c);
1157                 l *= 2;
1158         }
1159 }
1160
1161 int readlink_and_make_absolute(const char *p, char **r) {
1162         char *target, *k;
1163         int j;
1164
1165         assert(p);
1166         assert(r);
1167
1168         if ((j = readlink_malloc(p, &target)) < 0)
1169                 return j;
1170
1171         k = file_in_same_dir(p, target);
1172         free(target);
1173
1174         if (!k)
1175                 return -ENOMEM;
1176
1177         *r = k;
1178         return 0;
1179 }
1180
1181 int readlink_and_canonicalize(const char *p, char **r) {
1182         char *t, *s;
1183         int j;
1184
1185         assert(p);
1186         assert(r);
1187
1188         j = readlink_and_make_absolute(p, &t);
1189         if (j < 0)
1190                 return j;
1191
1192         s = canonicalize_file_name(t);
1193         if (s) {
1194                 free(t);
1195                 *r = s;
1196         } else
1197                 *r = t;
1198
1199         path_kill_slashes(*r);
1200
1201         return 0;
1202 }
1203
1204 int parent_of_path(const char *path, char **_r) {
1205         const char *e, *a = NULL, *b = NULL, *p;
1206         char *r;
1207         bool slash = false;
1208
1209         assert(path);
1210         assert(_r);
1211
1212         if (!*path)
1213                 return -EINVAL;
1214
1215         for (e = path; *e; e++) {
1216
1217                 if (!slash && *e == '/') {
1218                         a = b;
1219                         b = e;
1220                         slash = true;
1221                 } else if (slash && *e != '/')
1222                         slash = false;
1223         }
1224
1225         if (*(e-1) == '/')
1226                 p = a;
1227         else
1228                 p = b;
1229
1230         if (!p)
1231                 return -EINVAL;
1232
1233         if (p == path)
1234                 r = strdup("/");
1235         else
1236                 r = strndup(path, p-path);
1237
1238         if (!r)
1239                 return -ENOMEM;
1240
1241         *_r = r;
1242         return 0;
1243 }
1244
1245
1246 char *file_name_from_path(const char *p) {
1247         char *r;
1248
1249         assert(p);
1250
1251         if ((r = strrchr(p, '/')))
1252                 return r + 1;
1253
1254         return (char*) p;
1255 }
1256
1257 bool path_is_absolute(const char *p) {
1258         assert(p);
1259
1260         return p[0] == '/';
1261 }
1262
1263 bool is_path(const char *p) {
1264
1265         return !!strchr(p, '/');
1266 }
1267
1268 char *path_make_absolute(const char *p, const char *prefix) {
1269         assert(p);
1270
1271         /* Makes every item in the list an absolute path by prepending
1272          * the prefix, if specified and necessary */
1273
1274         if (path_is_absolute(p) || !prefix)
1275                 return strdup(p);
1276
1277         return join(prefix, "/", p, NULL);
1278 }
1279
1280 char *path_make_absolute_cwd(const char *p) {
1281         char *cwd, *r;
1282
1283         assert(p);
1284
1285         /* Similar to path_make_absolute(), but prefixes with the
1286          * current working directory. */
1287
1288         if (path_is_absolute(p))
1289                 return strdup(p);
1290
1291         if (!(cwd = get_current_dir_name()))
1292                 return NULL;
1293
1294         r = path_make_absolute(p, cwd);
1295         free(cwd);
1296
1297         return r;
1298 }
1299
1300 char **strv_path_make_absolute_cwd(char **l) {
1301         char **s;
1302
1303         /* Goes through every item in the string list and makes it
1304          * absolute. This works in place and won't rollback any
1305          * changes on failure. */
1306
1307         STRV_FOREACH(s, l) {
1308                 char *t;
1309
1310                 if (!(t = path_make_absolute_cwd(*s)))
1311                         return NULL;
1312
1313                 free(*s);
1314                 *s = t;
1315         }
1316
1317         return l;
1318 }
1319
1320 char **strv_path_canonicalize(char **l) {
1321         char **s;
1322         unsigned k = 0;
1323         bool enomem = false;
1324
1325         if (strv_isempty(l))
1326                 return l;
1327
1328         /* Goes through every item in the string list and canonicalize
1329          * the path. This works in place and won't rollback any
1330          * changes on failure. */
1331
1332         STRV_FOREACH(s, l) {
1333                 char *t, *u;
1334
1335                 t = path_make_absolute_cwd(*s);
1336                 free(*s);
1337
1338                 if (!t) {
1339                         enomem = true;
1340                         continue;
1341                 }
1342
1343                 errno = 0;
1344                 u = canonicalize_file_name(t);
1345                 free(t);
1346
1347                 if (!u) {
1348                         if (errno == ENOMEM || !errno)
1349                                 enomem = true;
1350
1351                         continue;
1352                 }
1353
1354                 l[k++] = u;
1355         }
1356
1357         l[k] = NULL;
1358
1359         if (enomem)
1360                 return NULL;
1361
1362         return l;
1363 }
1364
1365 char **strv_path_remove_empty(char **l) {
1366         char **f, **t;
1367
1368         if (!l)
1369                 return NULL;
1370
1371         for (f = t = l; *f; f++) {
1372
1373                 if (dir_is_empty(*f) > 0) {
1374                         free(*f);
1375                         continue;
1376                 }
1377
1378                 *(t++) = *f;
1379         }
1380
1381         *t = NULL;
1382         return l;
1383 }
1384
1385 int reset_all_signal_handlers(void) {
1386         int sig;
1387
1388         for (sig = 1; sig < _NSIG; sig++) {
1389                 struct sigaction sa;
1390
1391                 if (sig == SIGKILL || sig == SIGSTOP)
1392                         continue;
1393
1394                 zero(sa);
1395                 sa.sa_handler = SIG_DFL;
1396                 sa.sa_flags = SA_RESTART;
1397
1398                 /* On Linux the first two RT signals are reserved by
1399                  * glibc, and sigaction() will return EINVAL for them. */
1400                 if ((sigaction(sig, &sa, NULL) < 0))
1401                         if (errno != EINVAL)
1402                                 return -errno;
1403         }
1404
1405         return 0;
1406 }
1407
1408 char *strstrip(char *s) {
1409         char *e;
1410
1411         /* Drops trailing whitespace. Modifies the string in
1412          * place. Returns pointer to first non-space character */
1413
1414         s += strspn(s, WHITESPACE);
1415
1416         for (e = strchr(s, 0); e > s; e --)
1417                 if (!strchr(WHITESPACE, e[-1]))
1418                         break;
1419
1420         *e = 0;
1421
1422         return s;
1423 }
1424
1425 char *delete_chars(char *s, const char *bad) {
1426         char *f, *t;
1427
1428         /* Drops all whitespace, regardless where in the string */
1429
1430         for (f = s, t = s; *f; f++) {
1431                 if (strchr(bad, *f))
1432                         continue;
1433
1434                 *(t++) = *f;
1435         }
1436
1437         *t = 0;
1438
1439         return s;
1440 }
1441
1442 bool in_charset(const char *s, const char* charset) {
1443         const char *i;
1444
1445         assert(s);
1446         assert(charset);
1447
1448         for (i = s; *i; i++)
1449                 if (!strchr(charset, *i))
1450                         return false;
1451
1452         return true;
1453 }
1454
1455 char *file_in_same_dir(const char *path, const char *filename) {
1456         char *e, *r;
1457         size_t k;
1458
1459         assert(path);
1460         assert(filename);
1461
1462         /* This removes the last component of path and appends
1463          * filename, unless the latter is absolute anyway or the
1464          * former isn't */
1465
1466         if (path_is_absolute(filename))
1467                 return strdup(filename);
1468
1469         if (!(e = strrchr(path, '/')))
1470                 return strdup(filename);
1471
1472         k = strlen(filename);
1473         if (!(r = new(char, e-path+1+k+1)))
1474                 return NULL;
1475
1476         memcpy(r, path, e-path+1);
1477         memcpy(r+(e-path)+1, filename, k+1);
1478
1479         return r;
1480 }
1481
1482 int safe_mkdir(const char *path, mode_t mode, uid_t uid, gid_t gid) {
1483         struct stat st;
1484
1485         if (label_mkdir(path, mode) >= 0)
1486                 if (chmod_and_chown(path, mode, uid, gid) < 0)
1487                         return -errno;
1488
1489         if (lstat(path, &st) < 0)
1490                 return -errno;
1491
1492         if ((st.st_mode & 0777) != mode ||
1493             st.st_uid != uid ||
1494             st.st_gid != gid ||
1495             !S_ISDIR(st.st_mode)) {
1496                 errno = EEXIST;
1497                 return -errno;
1498         }
1499
1500         return 0;
1501 }
1502
1503
1504 int mkdir_parents(const char *path, mode_t mode) {
1505         const char *p, *e;
1506
1507         assert(path);
1508
1509         /* Creates every parent directory in the path except the last
1510          * component. */
1511
1512         p = path + strspn(path, "/");
1513         for (;;) {
1514                 int r;
1515                 char *t;
1516
1517                 e = p + strcspn(p, "/");
1518                 p = e + strspn(e, "/");
1519
1520                 /* Is this the last component? If so, then we're
1521                  * done */
1522                 if (*p == 0)
1523                         return 0;
1524
1525                 if (!(t = strndup(path, e - path)))
1526                         return -ENOMEM;
1527
1528                 r = label_mkdir(t, mode);
1529                 free(t);
1530
1531                 if (r < 0 && errno != EEXIST)
1532                         return -errno;
1533         }
1534 }
1535
1536 int mkdir_p(const char *path, mode_t mode) {
1537         int r;
1538
1539         /* Like mkdir -p */
1540
1541         if ((r = mkdir_parents(path, mode)) < 0)
1542                 return r;
1543
1544         if (label_mkdir(path, mode) < 0 && errno != EEXIST)
1545                 return -errno;
1546
1547         return 0;
1548 }
1549
1550 int rmdir_parents(const char *path, const char *stop) {
1551         size_t l;
1552         int r = 0;
1553
1554         assert(path);
1555         assert(stop);
1556
1557         l = strlen(path);
1558
1559         /* Skip trailing slashes */
1560         while (l > 0 && path[l-1] == '/')
1561                 l--;
1562
1563         while (l > 0) {
1564                 char *t;
1565
1566                 /* Skip last component */
1567                 while (l > 0 && path[l-1] != '/')
1568                         l--;
1569
1570                 /* Skip trailing slashes */
1571                 while (l > 0 && path[l-1] == '/')
1572                         l--;
1573
1574                 if (l <= 0)
1575                         break;
1576
1577                 if (!(t = strndup(path, l)))
1578                         return -ENOMEM;
1579
1580                 if (path_startswith(stop, t)) {
1581                         free(t);
1582                         return 0;
1583                 }
1584
1585                 r = rmdir(t);
1586                 free(t);
1587
1588                 if (r < 0)
1589                         if (errno != ENOENT)
1590                                 return -errno;
1591         }
1592
1593         return 0;
1594 }
1595
1596
1597 char hexchar(int x) {
1598         static const char table[16] = "0123456789abcdef";
1599
1600         return table[x & 15];
1601 }
1602
1603 int unhexchar(char c) {
1604
1605         if (c >= '0' && c <= '9')
1606                 return c - '0';
1607
1608         if (c >= 'a' && c <= 'f')
1609                 return c - 'a' + 10;
1610
1611         if (c >= 'A' && c <= 'F')
1612                 return c - 'A' + 10;
1613
1614         return -1;
1615 }
1616
1617 char octchar(int x) {
1618         return '0' + (x & 7);
1619 }
1620
1621 int unoctchar(char c) {
1622
1623         if (c >= '0' && c <= '7')
1624                 return c - '0';
1625
1626         return -1;
1627 }
1628
1629 char decchar(int x) {
1630         return '0' + (x % 10);
1631 }
1632
1633 int undecchar(char c) {
1634
1635         if (c >= '0' && c <= '9')
1636                 return c - '0';
1637
1638         return -1;
1639 }
1640
1641 char *cescape(const char *s) {
1642         char *r, *t;
1643         const char *f;
1644
1645         assert(s);
1646
1647         /* Does C style string escaping. */
1648
1649         if (!(r = new(char, strlen(s)*4 + 1)))
1650                 return NULL;
1651
1652         for (f = s, t = r; *f; f++)
1653
1654                 switch (*f) {
1655
1656                 case '\a':
1657                         *(t++) = '\\';
1658                         *(t++) = 'a';
1659                         break;
1660                 case '\b':
1661                         *(t++) = '\\';
1662                         *(t++) = 'b';
1663                         break;
1664                 case '\f':
1665                         *(t++) = '\\';
1666                         *(t++) = 'f';
1667                         break;
1668                 case '\n':
1669                         *(t++) = '\\';
1670                         *(t++) = 'n';
1671                         break;
1672                 case '\r':
1673                         *(t++) = '\\';
1674                         *(t++) = 'r';
1675                         break;
1676                 case '\t':
1677                         *(t++) = '\\';
1678                         *(t++) = 't';
1679                         break;
1680                 case '\v':
1681                         *(t++) = '\\';
1682                         *(t++) = 'v';
1683                         break;
1684                 case '\\':
1685                         *(t++) = '\\';
1686                         *(t++) = '\\';
1687                         break;
1688                 case '"':
1689                         *(t++) = '\\';
1690                         *(t++) = '"';
1691                         break;
1692                 case '\'':
1693                         *(t++) = '\\';
1694                         *(t++) = '\'';
1695                         break;
1696
1697                 default:
1698                         /* For special chars we prefer octal over
1699                          * hexadecimal encoding, simply because glib's
1700                          * g_strescape() does the same */
1701                         if ((*f < ' ') || (*f >= 127)) {
1702                                 *(t++) = '\\';
1703                                 *(t++) = octchar((unsigned char) *f >> 6);
1704                                 *(t++) = octchar((unsigned char) *f >> 3);
1705                                 *(t++) = octchar((unsigned char) *f);
1706                         } else
1707                                 *(t++) = *f;
1708                         break;
1709                 }
1710
1711         *t = 0;
1712
1713         return r;
1714 }
1715
1716 char *cunescape_length(const char *s, size_t length) {
1717         char *r, *t;
1718         const char *f;
1719
1720         assert(s);
1721
1722         /* Undoes C style string escaping */
1723
1724         if (!(r = new(char, length+1)))
1725                 return r;
1726
1727         for (f = s, t = r; f < s + length; f++) {
1728
1729                 if (*f != '\\') {
1730                         *(t++) = *f;
1731                         continue;
1732                 }
1733
1734                 f++;
1735
1736                 switch (*f) {
1737
1738                 case 'a':
1739                         *(t++) = '\a';
1740                         break;
1741                 case 'b':
1742                         *(t++) = '\b';
1743                         break;
1744                 case 'f':
1745                         *(t++) = '\f';
1746                         break;
1747                 case 'n':
1748                         *(t++) = '\n';
1749                         break;
1750                 case 'r':
1751                         *(t++) = '\r';
1752                         break;
1753                 case 't':
1754                         *(t++) = '\t';
1755                         break;
1756                 case 'v':
1757                         *(t++) = '\v';
1758                         break;
1759                 case '\\':
1760                         *(t++) = '\\';
1761                         break;
1762                 case '"':
1763                         *(t++) = '"';
1764                         break;
1765                 case '\'':
1766                         *(t++) = '\'';
1767                         break;
1768
1769                 case 's':
1770                         /* This is an extension of the XDG syntax files */
1771                         *(t++) = ' ';
1772                         break;
1773
1774                 case 'x': {
1775                         /* hexadecimal encoding */
1776                         int a, b;
1777
1778                         if ((a = unhexchar(f[1])) < 0 ||
1779                             (b = unhexchar(f[2])) < 0) {
1780                                 /* Invalid escape code, let's take it literal then */
1781                                 *(t++) = '\\';
1782                                 *(t++) = 'x';
1783                         } else {
1784                                 *(t++) = (char) ((a << 4) | b);
1785                                 f += 2;
1786                         }
1787
1788                         break;
1789                 }
1790
1791                 case '0':
1792                 case '1':
1793                 case '2':
1794                 case '3':
1795                 case '4':
1796                 case '5':
1797                 case '6':
1798                 case '7': {
1799                         /* octal encoding */
1800                         int a, b, c;
1801
1802                         if ((a = unoctchar(f[0])) < 0 ||
1803                             (b = unoctchar(f[1])) < 0 ||
1804                             (c = unoctchar(f[2])) < 0) {
1805                                 /* Invalid escape code, let's take it literal then */
1806                                 *(t++) = '\\';
1807                                 *(t++) = f[0];
1808                         } else {
1809                                 *(t++) = (char) ((a << 6) | (b << 3) | c);
1810                                 f += 2;
1811                         }
1812
1813                         break;
1814                 }
1815
1816                 case 0:
1817                         /* premature end of string.*/
1818                         *(t++) = '\\';
1819                         goto finish;
1820
1821                 default:
1822                         /* Invalid escape code, let's take it literal then */
1823                         *(t++) = '\\';
1824                         *(t++) = *f;
1825                         break;
1826                 }
1827         }
1828
1829 finish:
1830         *t = 0;
1831         return r;
1832 }
1833
1834 char *cunescape(const char *s) {
1835         return cunescape_length(s, strlen(s));
1836 }
1837
1838 char *xescape(const char *s, const char *bad) {
1839         char *r, *t;
1840         const char *f;
1841
1842         /* Escapes all chars in bad, in addition to \ and all special
1843          * chars, in \xFF style escaping. May be reversed with
1844          * cunescape. */
1845
1846         if (!(r = new(char, strlen(s)*4+1)))
1847                 return NULL;
1848
1849         for (f = s, t = r; *f; f++) {
1850
1851                 if ((*f < ' ') || (*f >= 127) ||
1852                     (*f == '\\') || strchr(bad, *f)) {
1853                         *(t++) = '\\';
1854                         *(t++) = 'x';
1855                         *(t++) = hexchar(*f >> 4);
1856                         *(t++) = hexchar(*f);
1857                 } else
1858                         *(t++) = *f;
1859         }
1860
1861         *t = 0;
1862
1863         return r;
1864 }
1865
1866 char *bus_path_escape(const char *s) {
1867         char *r, *t;
1868         const char *f;
1869
1870         assert(s);
1871
1872         /* Escapes all chars that D-Bus' object path cannot deal
1873          * with. Can be reverse with bus_path_unescape() */
1874
1875         if (!(r = new(char, strlen(s)*3+1)))
1876                 return NULL;
1877
1878         for (f = s, t = r; *f; f++) {
1879
1880                 if (!(*f >= 'A' && *f <= 'Z') &&
1881                     !(*f >= 'a' && *f <= 'z') &&
1882                     !(*f >= '0' && *f <= '9')) {
1883                         *(t++) = '_';
1884                         *(t++) = hexchar(*f >> 4);
1885                         *(t++) = hexchar(*f);
1886                 } else
1887                         *(t++) = *f;
1888         }
1889
1890         *t = 0;
1891
1892         return r;
1893 }
1894
1895 char *bus_path_unescape(const char *f) {
1896         char *r, *t;
1897
1898         assert(f);
1899
1900         if (!(r = strdup(f)))
1901                 return NULL;
1902
1903         for (t = r; *f; f++) {
1904
1905                 if (*f == '_') {
1906                         int a, b;
1907
1908                         if ((a = unhexchar(f[1])) < 0 ||
1909                             (b = unhexchar(f[2])) < 0) {
1910                                 /* Invalid escape code, let's take it literal then */
1911                                 *(t++) = '_';
1912                         } else {
1913                                 *(t++) = (char) ((a << 4) | b);
1914                                 f += 2;
1915                         }
1916                 } else
1917                         *(t++) = *f;
1918         }
1919
1920         *t = 0;
1921
1922         return r;
1923 }
1924
1925 char *path_kill_slashes(char *path) {
1926         char *f, *t;
1927         bool slash = false;
1928
1929         /* Removes redundant inner and trailing slashes. Modifies the
1930          * passed string in-place.
1931          *
1932          * ///foo///bar/ becomes /foo/bar
1933          */
1934
1935         for (f = path, t = path; *f; f++) {
1936
1937                 if (*f == '/') {
1938                         slash = true;
1939                         continue;
1940                 }
1941
1942                 if (slash) {
1943                         slash = false;
1944                         *(t++) = '/';
1945                 }
1946
1947                 *(t++) = *f;
1948         }
1949
1950         /* Special rule, if we are talking of the root directory, a
1951         trailing slash is good */
1952
1953         if (t == path && slash)
1954                 *(t++) = '/';
1955
1956         *t = 0;
1957         return path;
1958 }
1959
1960 bool path_startswith(const char *path, const char *prefix) {
1961         assert(path);
1962         assert(prefix);
1963
1964         if ((path[0] == '/') != (prefix[0] == '/'))
1965                 return false;
1966
1967         for (;;) {
1968                 size_t a, b;
1969
1970                 path += strspn(path, "/");
1971                 prefix += strspn(prefix, "/");
1972
1973                 if (*prefix == 0)
1974                         return true;
1975
1976                 if (*path == 0)
1977                         return false;
1978
1979                 a = strcspn(path, "/");
1980                 b = strcspn(prefix, "/");
1981
1982                 if (a != b)
1983                         return false;
1984
1985                 if (memcmp(path, prefix, a) != 0)
1986                         return false;
1987
1988                 path += a;
1989                 prefix += b;
1990         }
1991 }
1992
1993 bool path_equal(const char *a, const char *b) {
1994         assert(a);
1995         assert(b);
1996
1997         if ((a[0] == '/') != (b[0] == '/'))
1998                 return false;
1999
2000         for (;;) {
2001                 size_t j, k;
2002
2003                 a += strspn(a, "/");
2004                 b += strspn(b, "/");
2005
2006                 if (*a == 0 && *b == 0)
2007                         return true;
2008
2009                 if (*a == 0 || *b == 0)
2010                         return false;
2011
2012                 j = strcspn(a, "/");
2013                 k = strcspn(b, "/");
2014
2015                 if (j != k)
2016                         return false;
2017
2018                 if (memcmp(a, b, j) != 0)
2019                         return false;
2020
2021                 a += j;
2022                 b += k;
2023         }
2024 }
2025
2026 char *ascii_strlower(char *t) {
2027         char *p;
2028
2029         assert(t);
2030
2031         for (p = t; *p; p++)
2032                 if (*p >= 'A' && *p <= 'Z')
2033                         *p = *p - 'A' + 'a';
2034
2035         return t;
2036 }
2037
2038 bool ignore_file(const char *filename) {
2039         assert(filename);
2040
2041         return
2042                 filename[0] == '.' ||
2043                 streq(filename, "lost+found") ||
2044                 streq(filename, "aquota.user") ||
2045                 streq(filename, "aquota.group") ||
2046                 endswith(filename, "~") ||
2047                 endswith(filename, ".rpmnew") ||
2048                 endswith(filename, ".rpmsave") ||
2049                 endswith(filename, ".rpmorig") ||
2050                 endswith(filename, ".dpkg-old") ||
2051                 endswith(filename, ".dpkg-new") ||
2052                 endswith(filename, ".swp");
2053 }
2054
2055 int fd_nonblock(int fd, bool nonblock) {
2056         int flags;
2057
2058         assert(fd >= 0);
2059
2060         if ((flags = fcntl(fd, F_GETFL, 0)) < 0)
2061                 return -errno;
2062
2063         if (nonblock)
2064                 flags |= O_NONBLOCK;
2065         else
2066                 flags &= ~O_NONBLOCK;
2067
2068         if (fcntl(fd, F_SETFL, flags) < 0)
2069                 return -errno;
2070
2071         return 0;
2072 }
2073
2074 int fd_cloexec(int fd, bool cloexec) {
2075         int flags;
2076
2077         assert(fd >= 0);
2078
2079         if ((flags = fcntl(fd, F_GETFD, 0)) < 0)
2080                 return -errno;
2081
2082         if (cloexec)
2083                 flags |= FD_CLOEXEC;
2084         else
2085                 flags &= ~FD_CLOEXEC;
2086
2087         if (fcntl(fd, F_SETFD, flags) < 0)
2088                 return -errno;
2089
2090         return 0;
2091 }
2092
2093 int close_all_fds(const int except[], unsigned n_except) {
2094         DIR *d;
2095         struct dirent *de;
2096         int r = 0;
2097
2098         if (!(d = opendir("/proc/self/fd")))
2099                 return -errno;
2100
2101         while ((de = readdir(d))) {
2102                 int fd = -1;
2103
2104                 if (ignore_file(de->d_name))
2105                         continue;
2106
2107                 if (safe_atoi(de->d_name, &fd) < 0)
2108                         /* Let's better ignore this, just in case */
2109                         continue;
2110
2111                 if (fd < 3)
2112                         continue;
2113
2114                 if (fd == dirfd(d))
2115                         continue;
2116
2117                 if (except) {
2118                         bool found;
2119                         unsigned i;
2120
2121                         found = false;
2122                         for (i = 0; i < n_except; i++)
2123                                 if (except[i] == fd) {
2124                                         found = true;
2125                                         break;
2126                                 }
2127
2128                         if (found)
2129                                 continue;
2130                 }
2131
2132                 if (close_nointr(fd) < 0) {
2133                         /* Valgrind has its own FD and doesn't want to have it closed */
2134                         if (errno != EBADF && r == 0)
2135                                 r = -errno;
2136                 }
2137         }
2138
2139         closedir(d);
2140         return r;
2141 }
2142
2143 bool chars_intersect(const char *a, const char *b) {
2144         const char *p;
2145
2146         /* Returns true if any of the chars in a are in b. */
2147         for (p = a; *p; p++)
2148                 if (strchr(b, *p))
2149                         return true;
2150
2151         return false;
2152 }
2153
2154 char *format_timestamp(char *buf, size_t l, usec_t t) {
2155         struct tm tm;
2156         time_t sec;
2157
2158         assert(buf);
2159         assert(l > 0);
2160
2161         if (t <= 0)
2162                 return NULL;
2163
2164         sec = (time_t) (t / USEC_PER_SEC);
2165
2166         if (strftime(buf, l, "%a, %d %b %Y %H:%M:%S %z", localtime_r(&sec, &tm)) <= 0)
2167                 return NULL;
2168
2169         return buf;
2170 }
2171
2172 char *format_timestamp_pretty(char *buf, size_t l, usec_t t) {
2173         usec_t n, d;
2174
2175         n = now(CLOCK_REALTIME);
2176
2177         if (t <= 0 || t > n || t + USEC_PER_DAY*7 <= t)
2178                 return NULL;
2179
2180         d = n - t;
2181
2182         if (d >= USEC_PER_YEAR)
2183                 snprintf(buf, l, "%llu years and %llu months ago",
2184                          (unsigned long long) (d / USEC_PER_YEAR),
2185                          (unsigned long long) ((d % USEC_PER_YEAR) / USEC_PER_MONTH));
2186         else if (d >= USEC_PER_MONTH)
2187                 snprintf(buf, l, "%llu months and %llu days ago",
2188                          (unsigned long long) (d / USEC_PER_MONTH),
2189                          (unsigned long long) ((d % USEC_PER_MONTH) / USEC_PER_DAY));
2190         else if (d >= USEC_PER_WEEK)
2191                 snprintf(buf, l, "%llu weeks and %llu days ago",
2192                          (unsigned long long) (d / USEC_PER_WEEK),
2193                          (unsigned long long) ((d % USEC_PER_WEEK) / USEC_PER_DAY));
2194         else if (d >= 2*USEC_PER_DAY)
2195                 snprintf(buf, l, "%llu days ago", (unsigned long long) (d / USEC_PER_DAY));
2196         else if (d >= 25*USEC_PER_HOUR)
2197                 snprintf(buf, l, "1 day and %lluh ago",
2198                          (unsigned long long) ((d - USEC_PER_DAY) / USEC_PER_HOUR));
2199         else if (d >= 6*USEC_PER_HOUR)
2200                 snprintf(buf, l, "%lluh ago",
2201                          (unsigned long long) (d / USEC_PER_HOUR));
2202         else if (d >= USEC_PER_HOUR)
2203                 snprintf(buf, l, "%lluh %llumin ago",
2204                          (unsigned long long) (d / USEC_PER_HOUR),
2205                          (unsigned long long) ((d % USEC_PER_HOUR) / USEC_PER_MINUTE));
2206         else if (d >= 5*USEC_PER_MINUTE)
2207                 snprintf(buf, l, "%llumin ago",
2208                          (unsigned long long) (d / USEC_PER_MINUTE));
2209         else if (d >= USEC_PER_MINUTE)
2210                 snprintf(buf, l, "%llumin %llus ago",
2211                          (unsigned long long) (d / USEC_PER_MINUTE),
2212                          (unsigned long long) ((d % USEC_PER_MINUTE) / USEC_PER_SEC));
2213         else if (d >= USEC_PER_SEC)
2214                 snprintf(buf, l, "%llus ago",
2215                          (unsigned long long) (d / USEC_PER_SEC));
2216         else if (d >= USEC_PER_MSEC)
2217                 snprintf(buf, l, "%llums ago",
2218                          (unsigned long long) (d / USEC_PER_MSEC));
2219         else if (d > 0)
2220                 snprintf(buf, l, "%lluus ago",
2221                          (unsigned long long) d);
2222         else
2223                 snprintf(buf, l, "now");
2224
2225         buf[l-1] = 0;
2226         return buf;
2227 }
2228
2229 char *format_timespan(char *buf, size_t l, usec_t t) {
2230         static const struct {
2231                 const char *suffix;
2232                 usec_t usec;
2233         } table[] = {
2234                 { "w", USEC_PER_WEEK },
2235                 { "d", USEC_PER_DAY },
2236                 { "h", USEC_PER_HOUR },
2237                 { "min", USEC_PER_MINUTE },
2238                 { "s", USEC_PER_SEC },
2239                 { "ms", USEC_PER_MSEC },
2240                 { "us", 1 },
2241         };
2242
2243         unsigned i;
2244         char *p = buf;
2245
2246         assert(buf);
2247         assert(l > 0);
2248
2249         if (t == (usec_t) -1)
2250                 return NULL;
2251
2252         if (t == 0) {
2253                 snprintf(p, l, "0");
2254                 p[l-1] = 0;
2255                 return p;
2256         }
2257
2258         /* The result of this function can be parsed with parse_usec */
2259
2260         for (i = 0; i < ELEMENTSOF(table); i++) {
2261                 int k;
2262                 size_t n;
2263
2264                 if (t < table[i].usec)
2265                         continue;
2266
2267                 if (l <= 1)
2268                         break;
2269
2270                 k = snprintf(p, l, "%s%llu%s", p > buf ? " " : "", (unsigned long long) (t / table[i].usec), table[i].suffix);
2271                 n = MIN((size_t) k, l);
2272
2273                 l -= n;
2274                 p += n;
2275
2276                 t %= table[i].usec;
2277         }
2278
2279         *p = 0;
2280
2281         return buf;
2282 }
2283
2284 bool fstype_is_network(const char *fstype) {
2285         static const char * const table[] = {
2286                 "cifs",
2287                 "smbfs",
2288                 "ncpfs",
2289                 "nfs",
2290                 "nfs4",
2291                 "gfs",
2292                 "gfs2"
2293         };
2294
2295         unsigned i;
2296
2297         for (i = 0; i < ELEMENTSOF(table); i++)
2298                 if (streq(table[i], fstype))
2299                         return true;
2300
2301         return false;
2302 }
2303
2304 int chvt(int vt) {
2305         int fd, r = 0;
2306
2307         if ((fd = open_terminal("/dev/tty0", O_RDWR|O_NOCTTY|O_CLOEXEC)) < 0)
2308                 return -errno;
2309
2310         if (vt < 0) {
2311                 int tiocl[2] = {
2312                         TIOCL_GETKMSGREDIRECT,
2313                         0
2314                 };
2315
2316                 if (ioctl(fd, TIOCLINUX, tiocl) < 0)
2317                         return -errno;
2318
2319                 vt = tiocl[0] <= 0 ? 1 : tiocl[0];
2320         }
2321
2322         if (ioctl(fd, VT_ACTIVATE, vt) < 0)
2323                 r = -errno;
2324
2325         close_nointr_nofail(r);
2326         return r;
2327 }
2328
2329 int read_one_char(FILE *f, char *ret, bool *need_nl) {
2330         struct termios old_termios, new_termios;
2331         char c;
2332         char line[LINE_MAX];
2333
2334         assert(f);
2335         assert(ret);
2336
2337         if (tcgetattr(fileno(f), &old_termios) >= 0) {
2338                 new_termios = old_termios;
2339
2340                 new_termios.c_lflag &= ~ICANON;
2341                 new_termios.c_cc[VMIN] = 1;
2342                 new_termios.c_cc[VTIME] = 0;
2343
2344                 if (tcsetattr(fileno(f), TCSADRAIN, &new_termios) >= 0) {
2345                         size_t k;
2346
2347                         k = fread(&c, 1, 1, f);
2348
2349                         tcsetattr(fileno(f), TCSADRAIN, &old_termios);
2350
2351                         if (k <= 0)
2352                                 return -EIO;
2353
2354                         if (need_nl)
2355                                 *need_nl = c != '\n';
2356
2357                         *ret = c;
2358                         return 0;
2359                 }
2360         }
2361
2362         if (!(fgets(line, sizeof(line), f)))
2363                 return -EIO;
2364
2365         truncate_nl(line);
2366
2367         if (strlen(line) != 1)
2368                 return -EBADMSG;
2369
2370         if (need_nl)
2371                 *need_nl = false;
2372
2373         *ret = line[0];
2374         return 0;
2375 }
2376
2377 int ask(char *ret, const char *replies, const char *text, ...) {
2378         bool on_tty;
2379
2380         assert(ret);
2381         assert(replies);
2382         assert(text);
2383
2384         on_tty = isatty(STDOUT_FILENO);
2385
2386         for (;;) {
2387                 va_list ap;
2388                 char c;
2389                 int r;
2390                 bool need_nl = true;
2391
2392                 if (on_tty)
2393                         fputs("\x1B[1m", stdout);
2394
2395                 va_start(ap, text);
2396                 vprintf(text, ap);
2397                 va_end(ap);
2398
2399                 if (on_tty)
2400                         fputs("\x1B[0m", stdout);
2401
2402                 fflush(stdout);
2403
2404                 if ((r = read_one_char(stdin, &c, &need_nl)) < 0) {
2405
2406                         if (r == -EBADMSG) {
2407                                 puts("Bad input, please try again.");
2408                                 continue;
2409                         }
2410
2411                         putchar('\n');
2412                         return r;
2413                 }
2414
2415                 if (need_nl)
2416                         putchar('\n');
2417
2418                 if (strchr(replies, c)) {
2419                         *ret = c;
2420                         return 0;
2421                 }
2422
2423                 puts("Read unexpected character, please try again.");
2424         }
2425 }
2426
2427 int reset_terminal_fd(int fd) {
2428         struct termios termios;
2429         int r = 0;
2430         long arg;
2431
2432         /* Set terminal to some sane defaults */
2433
2434         assert(fd >= 0);
2435
2436         /* We leave locked terminal attributes untouched, so that
2437          * Plymouth may set whatever it wants to set, and we don't
2438          * interfere with that. */
2439
2440         /* Disable exclusive mode, just in case */
2441         ioctl(fd, TIOCNXCL);
2442
2443         /* Enable console unicode mode */
2444         arg = K_UNICODE;
2445         ioctl(fd, KDSKBMODE, &arg);
2446
2447         if (tcgetattr(fd, &termios) < 0) {
2448                 r = -errno;
2449                 goto finish;
2450         }
2451
2452         /* We only reset the stuff that matters to the software. How
2453          * hardware is set up we don't touch assuming that somebody
2454          * else will do that for us */
2455
2456         termios.c_iflag &= ~(IGNBRK | BRKINT | ISTRIP | INLCR | IGNCR | IUCLC);
2457         termios.c_iflag |= ICRNL | IMAXBEL | IUTF8;
2458         termios.c_oflag |= ONLCR;
2459         termios.c_cflag |= CREAD;
2460         termios.c_lflag = ISIG | ICANON | IEXTEN | ECHO | ECHOE | ECHOK | ECHOCTL | ECHOPRT | ECHOKE;
2461
2462         termios.c_cc[VINTR]    =   03;  /* ^C */
2463         termios.c_cc[VQUIT]    =  034;  /* ^\ */
2464         termios.c_cc[VERASE]   = 0177;
2465         termios.c_cc[VKILL]    =  025;  /* ^X */
2466         termios.c_cc[VEOF]     =   04;  /* ^D */
2467         termios.c_cc[VSTART]   =  021;  /* ^Q */
2468         termios.c_cc[VSTOP]    =  023;  /* ^S */
2469         termios.c_cc[VSUSP]    =  032;  /* ^Z */
2470         termios.c_cc[VLNEXT]   =  026;  /* ^V */
2471         termios.c_cc[VWERASE]  =  027;  /* ^W */
2472         termios.c_cc[VREPRINT] =  022;  /* ^R */
2473         termios.c_cc[VEOL]     =    0;
2474         termios.c_cc[VEOL2]    =    0;
2475
2476         termios.c_cc[VTIME]  = 0;
2477         termios.c_cc[VMIN]   = 1;
2478
2479         if (tcsetattr(fd, TCSANOW, &termios) < 0)
2480                 r = -errno;
2481
2482 finish:
2483         /* Just in case, flush all crap out */
2484         tcflush(fd, TCIOFLUSH);
2485
2486         return r;
2487 }
2488
2489 int reset_terminal(const char *name) {
2490         int fd, r;
2491
2492         fd = open_terminal(name, O_RDWR|O_NOCTTY|O_CLOEXEC);
2493         if (fd < 0)
2494                 return fd;
2495
2496         r = reset_terminal_fd(fd);
2497         close_nointr_nofail(fd);
2498
2499         return r;
2500 }
2501
2502 int open_terminal(const char *name, int mode) {
2503         int fd, r;
2504         unsigned c = 0;
2505
2506         /*
2507          * If a TTY is in the process of being closed opening it might
2508          * cause EIO. This is horribly awful, but unlikely to be
2509          * changed in the kernel. Hence we work around this problem by
2510          * retrying a couple of times.
2511          *
2512          * https://bugs.launchpad.net/ubuntu/+source/linux/+bug/554172/comments/245
2513          */
2514
2515         for (;;) {
2516                 if ((fd = open(name, mode)) >= 0)
2517                         break;
2518
2519                 if (errno != EIO)
2520                         return -errno;
2521
2522                 if (c >= 20)
2523                         return -errno;
2524
2525                 usleep(50 * USEC_PER_MSEC);
2526                 c++;
2527         }
2528
2529         if (fd < 0)
2530                 return -errno;
2531
2532         if ((r = isatty(fd)) < 0) {
2533                 close_nointr_nofail(fd);
2534                 return -errno;
2535         }
2536
2537         if (!r) {
2538                 close_nointr_nofail(fd);
2539                 return -ENOTTY;
2540         }
2541
2542         return fd;
2543 }
2544
2545 int flush_fd(int fd) {
2546         struct pollfd pollfd;
2547
2548         zero(pollfd);
2549         pollfd.fd = fd;
2550         pollfd.events = POLLIN;
2551
2552         for (;;) {
2553                 char buf[LINE_MAX];
2554                 ssize_t l;
2555                 int r;
2556
2557                 if ((r = poll(&pollfd, 1, 0)) < 0) {
2558
2559                         if (errno == EINTR)
2560                                 continue;
2561
2562                         return -errno;
2563                 }
2564
2565                 if (r == 0)
2566                         return 0;
2567
2568                 if ((l = read(fd, buf, sizeof(buf))) < 0) {
2569
2570                         if (errno == EINTR)
2571                                 continue;
2572
2573                         if (errno == EAGAIN)
2574                                 return 0;
2575
2576                         return -errno;
2577                 }
2578
2579                 if (l <= 0)
2580                         return 0;
2581         }
2582 }
2583
2584 int acquire_terminal(const char *name, bool fail, bool force, bool ignore_tiocstty_eperm) {
2585         int fd = -1, notify = -1, r, wd = -1;
2586
2587         assert(name);
2588
2589         /* We use inotify to be notified when the tty is closed. We
2590          * create the watch before checking if we can actually acquire
2591          * it, so that we don't lose any event.
2592          *
2593          * Note: strictly speaking this actually watches for the
2594          * device being closed, it does *not* really watch whether a
2595          * tty loses its controlling process. However, unless some
2596          * rogue process uses TIOCNOTTY on /dev/tty *after* closing
2597          * its tty otherwise this will not become a problem. As long
2598          * as the administrator makes sure not configure any service
2599          * on the same tty as an untrusted user this should not be a
2600          * problem. (Which he probably should not do anyway.) */
2601
2602         if (!fail && !force) {
2603                 if ((notify = inotify_init1(IN_CLOEXEC)) < 0) {
2604                         r = -errno;
2605                         goto fail;
2606                 }
2607
2608                 if ((wd = inotify_add_watch(notify, name, IN_CLOSE)) < 0) {
2609                         r = -errno;
2610                         goto fail;
2611                 }
2612         }
2613
2614         for (;;) {
2615                 if (notify >= 0)
2616                         if ((r = flush_fd(notify)) < 0)
2617                                 goto fail;
2618
2619                 /* We pass here O_NOCTTY only so that we can check the return
2620                  * value TIOCSCTTY and have a reliable way to figure out if we
2621                  * successfully became the controlling process of the tty */
2622                 if ((fd = open_terminal(name, O_RDWR|O_NOCTTY|O_CLOEXEC)) < 0)
2623                         return fd;
2624
2625                 /* First, try to get the tty */
2626                 r = ioctl(fd, TIOCSCTTY, force);
2627
2628                 /* Sometimes it makes sense to ignore TIOCSCTTY
2629                  * returning EPERM, i.e. when very likely we already
2630                  * are have this controlling terminal. */
2631                 if (r < 0 && errno == EPERM && ignore_tiocstty_eperm)
2632                         r = 0;
2633
2634                 if (r < 0 && (force || fail || errno != EPERM)) {
2635                         r = -errno;
2636                         goto fail;
2637                 }
2638
2639                 if (r >= 0)
2640                         break;
2641
2642                 assert(!fail);
2643                 assert(!force);
2644                 assert(notify >= 0);
2645
2646                 for (;;) {
2647                         uint8_t inotify_buffer[sizeof(struct inotify_event) + FILENAME_MAX];
2648                         ssize_t l;
2649                         struct inotify_event *e;
2650
2651                         if ((l = read(notify, &inotify_buffer, sizeof(inotify_buffer))) < 0) {
2652
2653                                 if (errno == EINTR)
2654                                         continue;
2655
2656                                 r = -errno;
2657                                 goto fail;
2658                         }
2659
2660                         e = (struct inotify_event*) inotify_buffer;
2661
2662                         while (l > 0) {
2663                                 size_t step;
2664
2665                                 if (e->wd != wd || !(e->mask & IN_CLOSE)) {
2666                                         r = -EIO;
2667                                         goto fail;
2668                                 }
2669
2670                                 step = sizeof(struct inotify_event) + e->len;
2671                                 assert(step <= (size_t) l);
2672
2673                                 e = (struct inotify_event*) ((uint8_t*) e + step);
2674                                 l -= step;
2675                         }
2676
2677                         break;
2678                 }
2679
2680                 /* We close the tty fd here since if the old session
2681                  * ended our handle will be dead. It's important that
2682                  * we do this after sleeping, so that we don't enter
2683                  * an endless loop. */
2684                 close_nointr_nofail(fd);
2685         }
2686
2687         if (notify >= 0)
2688                 close_nointr_nofail(notify);
2689
2690         if ((r = reset_terminal_fd(fd)) < 0)
2691                 log_warning("Failed to reset terminal: %s", strerror(-r));
2692
2693         return fd;
2694
2695 fail:
2696         if (fd >= 0)
2697                 close_nointr_nofail(fd);
2698
2699         if (notify >= 0)
2700                 close_nointr_nofail(notify);
2701
2702         return r;
2703 }
2704
2705 int release_terminal(void) {
2706         int r = 0, fd;
2707         struct sigaction sa_old, sa_new;
2708
2709         if ((fd = open("/dev/tty", O_RDWR|O_NOCTTY|O_NDELAY|O_CLOEXEC)) < 0)
2710                 return -errno;
2711
2712         /* Temporarily ignore SIGHUP, so that we don't get SIGHUP'ed
2713          * by our own TIOCNOTTY */
2714
2715         zero(sa_new);
2716         sa_new.sa_handler = SIG_IGN;
2717         sa_new.sa_flags = SA_RESTART;
2718         assert_se(sigaction(SIGHUP, &sa_new, &sa_old) == 0);
2719
2720         if (ioctl(fd, TIOCNOTTY) < 0)
2721                 r = -errno;
2722
2723         assert_se(sigaction(SIGHUP, &sa_old, NULL) == 0);
2724
2725         close_nointr_nofail(fd);
2726         return r;
2727 }
2728
2729 int sigaction_many(const struct sigaction *sa, ...) {
2730         va_list ap;
2731         int r = 0, sig;
2732
2733         va_start(ap, sa);
2734         while ((sig = va_arg(ap, int)) > 0)
2735                 if (sigaction(sig, sa, NULL) < 0)
2736                         r = -errno;
2737         va_end(ap);
2738
2739         return r;
2740 }
2741
2742 int ignore_signals(int sig, ...) {
2743         struct sigaction sa;
2744         va_list ap;
2745         int r = 0;
2746
2747         zero(sa);
2748         sa.sa_handler = SIG_IGN;
2749         sa.sa_flags = SA_RESTART;
2750
2751         if (sigaction(sig, &sa, NULL) < 0)
2752                 r = -errno;
2753
2754         va_start(ap, sig);
2755         while ((sig = va_arg(ap, int)) > 0)
2756                 if (sigaction(sig, &sa, NULL) < 0)
2757                         r = -errno;
2758         va_end(ap);
2759
2760         return r;
2761 }
2762
2763 int default_signals(int sig, ...) {
2764         struct sigaction sa;
2765         va_list ap;
2766         int r = 0;
2767
2768         zero(sa);
2769         sa.sa_handler = SIG_DFL;
2770         sa.sa_flags = SA_RESTART;
2771
2772         if (sigaction(sig, &sa, NULL) < 0)
2773                 r = -errno;
2774
2775         va_start(ap, sig);
2776         while ((sig = va_arg(ap, int)) > 0)
2777                 if (sigaction(sig, &sa, NULL) < 0)
2778                         r = -errno;
2779         va_end(ap);
2780
2781         return r;
2782 }
2783
2784 int close_pipe(int p[]) {
2785         int a = 0, b = 0;
2786
2787         assert(p);
2788
2789         if (p[0] >= 0) {
2790                 a = close_nointr(p[0]);
2791                 p[0] = -1;
2792         }
2793
2794         if (p[1] >= 0) {
2795                 b = close_nointr(p[1]);
2796                 p[1] = -1;
2797         }
2798
2799         return a < 0 ? a : b;
2800 }
2801
2802 ssize_t loop_read(int fd, void *buf, size_t nbytes, bool do_poll) {
2803         uint8_t *p;
2804         ssize_t n = 0;
2805
2806         assert(fd >= 0);
2807         assert(buf);
2808
2809         p = buf;
2810
2811         while (nbytes > 0) {
2812                 ssize_t k;
2813
2814                 if ((k = read(fd, p, nbytes)) <= 0) {
2815
2816                         if (k < 0 && errno == EINTR)
2817                                 continue;
2818
2819                         if (k < 0 && errno == EAGAIN && do_poll) {
2820                                 struct pollfd pollfd;
2821
2822                                 zero(pollfd);
2823                                 pollfd.fd = fd;
2824                                 pollfd.events = POLLIN;
2825
2826                                 if (poll(&pollfd, 1, -1) < 0) {
2827                                         if (errno == EINTR)
2828                                                 continue;
2829
2830                                         return n > 0 ? n : -errno;
2831                                 }
2832
2833                                 if (pollfd.revents != POLLIN)
2834                                         return n > 0 ? n : -EIO;
2835
2836                                 continue;
2837                         }
2838
2839                         return n > 0 ? n : (k < 0 ? -errno : 0);
2840                 }
2841
2842                 p += k;
2843                 nbytes -= k;
2844                 n += k;
2845         }
2846
2847         return n;
2848 }
2849
2850 ssize_t loop_write(int fd, const void *buf, size_t nbytes, bool do_poll) {
2851         const uint8_t *p;
2852         ssize_t n = 0;
2853
2854         assert(fd >= 0);
2855         assert(buf);
2856
2857         p = buf;
2858
2859         while (nbytes > 0) {
2860                 ssize_t k;
2861
2862                 if ((k = write(fd, p, nbytes)) <= 0) {
2863
2864                         if (k < 0 && errno == EINTR)
2865                                 continue;
2866
2867                         if (k < 0 && errno == EAGAIN && do_poll) {
2868                                 struct pollfd pollfd;
2869
2870                                 zero(pollfd);
2871                                 pollfd.fd = fd;
2872                                 pollfd.events = POLLOUT;
2873
2874                                 if (poll(&pollfd, 1, -1) < 0) {
2875                                         if (errno == EINTR)
2876                                                 continue;
2877
2878                                         return n > 0 ? n : -errno;
2879                                 }
2880
2881                                 if (pollfd.revents != POLLOUT)
2882                                         return n > 0 ? n : -EIO;
2883
2884                                 continue;
2885                         }
2886
2887                         return n > 0 ? n : (k < 0 ? -errno : 0);
2888                 }
2889
2890                 p += k;
2891                 nbytes -= k;
2892                 n += k;
2893         }
2894
2895         return n;
2896 }
2897
2898 int path_is_mount_point(const char *t) {
2899         struct stat a, b;
2900         char *parent;
2901         int r;
2902
2903         if (lstat(t, &a) < 0) {
2904                 if (errno == ENOENT)
2905                         return 0;
2906
2907                 return -errno;
2908         }
2909
2910         if ((r = parent_of_path(t, &parent)) < 0)
2911                 return r;
2912
2913         r = lstat(parent, &b);
2914         free(parent);
2915
2916         if (r < 0)
2917                 return -errno;
2918
2919         return a.st_dev != b.st_dev;
2920 }
2921
2922 int parse_usec(const char *t, usec_t *usec) {
2923         static const struct {
2924                 const char *suffix;
2925                 usec_t usec;
2926         } table[] = {
2927                 { "sec", USEC_PER_SEC },
2928                 { "s", USEC_PER_SEC },
2929                 { "min", USEC_PER_MINUTE },
2930                 { "hr", USEC_PER_HOUR },
2931                 { "h", USEC_PER_HOUR },
2932                 { "d", USEC_PER_DAY },
2933                 { "w", USEC_PER_WEEK },
2934                 { "msec", USEC_PER_MSEC },
2935                 { "ms", USEC_PER_MSEC },
2936                 { "m", USEC_PER_MINUTE },
2937                 { "usec", 1ULL },
2938                 { "us", 1ULL },
2939                 { "", USEC_PER_SEC },
2940         };
2941
2942         const char *p;
2943         usec_t r = 0;
2944
2945         assert(t);
2946         assert(usec);
2947
2948         p = t;
2949         do {
2950                 long long l;
2951                 char *e;
2952                 unsigned i;
2953
2954                 errno = 0;
2955                 l = strtoll(p, &e, 10);
2956
2957                 if (errno != 0)
2958                         return -errno;
2959
2960                 if (l < 0)
2961                         return -ERANGE;
2962
2963                 if (e == p)
2964                         return -EINVAL;
2965
2966                 e += strspn(e, WHITESPACE);
2967
2968                 for (i = 0; i < ELEMENTSOF(table); i++)
2969                         if (startswith(e, table[i].suffix)) {
2970                                 r += (usec_t) l * table[i].usec;
2971                                 p = e + strlen(table[i].suffix);
2972                                 break;
2973                         }
2974
2975                 if (i >= ELEMENTSOF(table))
2976                         return -EINVAL;
2977
2978         } while (*p != 0);
2979
2980         *usec = r;
2981
2982         return 0;
2983 }
2984
2985 int parse_bytes(const char *t, off_t *bytes) {
2986         static const struct {
2987                 const char *suffix;
2988                 off_t factor;
2989         } table[] = {
2990                 { "B", 1 },
2991                 { "K", 1024ULL },
2992                 { "M", 1024ULL*1024ULL },
2993                 { "G", 1024ULL*1024ULL*1024ULL },
2994                 { "T", 1024ULL*1024ULL*1024ULL*1024ULL },
2995                 { "", 1 },
2996         };
2997
2998         const char *p;
2999         off_t r = 0;
3000
3001         assert(t);
3002         assert(bytes);
3003
3004         p = t;
3005         do {
3006                 long long l;
3007                 char *e;
3008                 unsigned i;
3009
3010                 errno = 0;
3011                 l = strtoll(p, &e, 10);
3012
3013                 if (errno != 0)
3014                         return -errno;
3015
3016                 if (l < 0)
3017                         return -ERANGE;
3018
3019                 if (e == p)
3020                         return -EINVAL;
3021
3022                 e += strspn(e, WHITESPACE);
3023
3024                 for (i = 0; i < ELEMENTSOF(table); i++)
3025                         if (startswith(e, table[i].suffix)) {
3026                                 r += (off_t) l * table[i].factor;
3027                                 p = e + strlen(table[i].suffix);
3028                                 break;
3029                         }
3030
3031                 if (i >= ELEMENTSOF(table))
3032                         return -EINVAL;
3033
3034         } while (*p != 0);
3035
3036         *bytes = r;
3037
3038         return 0;
3039 }
3040
3041 int make_stdio(int fd) {
3042         int r, s, t;
3043
3044         assert(fd >= 0);
3045
3046         r = dup2(fd, STDIN_FILENO);
3047         s = dup2(fd, STDOUT_FILENO);
3048         t = dup2(fd, STDERR_FILENO);
3049
3050         if (fd >= 3)
3051                 close_nointr_nofail(fd);
3052
3053         if (r < 0 || s < 0 || t < 0)
3054                 return -errno;
3055
3056         fd_cloexec(STDIN_FILENO, false);
3057         fd_cloexec(STDOUT_FILENO, false);
3058         fd_cloexec(STDERR_FILENO, false);
3059
3060         return 0;
3061 }
3062
3063 int make_null_stdio(void) {
3064         int null_fd;
3065
3066         if ((null_fd = open("/dev/null", O_RDWR|O_NOCTTY)) < 0)
3067                 return -errno;
3068
3069         return make_stdio(null_fd);
3070 }
3071
3072 bool is_device_path(const char *path) {
3073
3074         /* Returns true on paths that refer to a device, either in
3075          * sysfs or in /dev */
3076
3077         return
3078                 path_startswith(path, "/dev/") ||
3079                 path_startswith(path, "/sys/");
3080 }
3081
3082 int dir_is_empty(const char *path) {
3083         DIR *d;
3084         int r;
3085         struct dirent buf, *de;
3086
3087         if (!(d = opendir(path)))
3088                 return -errno;
3089
3090         for (;;) {
3091                 if ((r = readdir_r(d, &buf, &de)) > 0) {
3092                         r = -r;
3093                         break;
3094                 }
3095
3096                 if (!de) {
3097                         r = 1;
3098                         break;
3099                 }
3100
3101                 if (!ignore_file(de->d_name)) {
3102                         r = 0;
3103                         break;
3104                 }
3105         }
3106
3107         closedir(d);
3108         return r;
3109 }
3110
3111 unsigned long long random_ull(void) {
3112         int fd;
3113         uint64_t ull;
3114         ssize_t r;
3115
3116         if ((fd = open("/dev/urandom", O_RDONLY|O_CLOEXEC|O_NOCTTY)) < 0)
3117                 goto fallback;
3118
3119         r = loop_read(fd, &ull, sizeof(ull), true);
3120         close_nointr_nofail(fd);
3121
3122         if (r != sizeof(ull))
3123                 goto fallback;
3124
3125         return ull;
3126
3127 fallback:
3128         return random() * RAND_MAX + random();
3129 }
3130
3131 void rename_process(const char name[8]) {
3132         assert(name);
3133
3134         prctl(PR_SET_NAME, name);
3135
3136         /* This is a like a poor man's setproctitle(). The string
3137          * passed should fit in 7 chars (i.e. the length of
3138          * "systemd") */
3139
3140         if (program_invocation_name)
3141                 strncpy(program_invocation_name, name, strlen(program_invocation_name));
3142
3143         if (saved_argc > 0) {
3144                 int i;
3145
3146                 if (saved_argv[0])
3147                         strncpy(saved_argv[0], name, strlen(saved_argv[0]));
3148
3149                 for (i = 1; i < saved_argc; i++) {
3150                         if (!saved_argv[i])
3151                                 break;
3152
3153                         memset(saved_argv[i], 0, strlen(saved_argv[i]));
3154                 }
3155         }
3156 }
3157
3158 void sigset_add_many(sigset_t *ss, ...) {
3159         va_list ap;
3160         int sig;
3161
3162         assert(ss);
3163
3164         va_start(ap, ss);
3165         while ((sig = va_arg(ap, int)) > 0)
3166                 assert_se(sigaddset(ss, sig) == 0);
3167         va_end(ap);
3168 }
3169
3170 char* gethostname_malloc(void) {
3171         struct utsname u;
3172
3173         assert_se(uname(&u) >= 0);
3174
3175         if (u.nodename[0])
3176                 return strdup(u.nodename);
3177
3178         return strdup(u.sysname);
3179 }
3180
3181 char* getlogname_malloc(void) {
3182         uid_t uid;
3183         long bufsize;
3184         char *buf, *name;
3185         struct passwd pwbuf, *pw = NULL;
3186         struct stat st;
3187
3188         if (isatty(STDIN_FILENO) && fstat(STDIN_FILENO, &st) >= 0)
3189                 uid = st.st_uid;
3190         else
3191                 uid = getuid();
3192
3193         /* Shortcut things to avoid NSS lookups */
3194         if (uid == 0)
3195                 return strdup("root");
3196
3197         if ((bufsize = sysconf(_SC_GETPW_R_SIZE_MAX)) <= 0)
3198                 bufsize = 4096;
3199
3200         if (!(buf = malloc(bufsize)))
3201                 return NULL;
3202
3203         if (getpwuid_r(uid, &pwbuf, buf, bufsize, &pw) == 0 && pw) {
3204                 name = strdup(pw->pw_name);
3205                 free(buf);
3206                 return name;
3207         }
3208
3209         free(buf);
3210
3211         if (asprintf(&name, "%lu", (unsigned long) uid) < 0)
3212                 return NULL;
3213
3214         return name;
3215 }
3216
3217 int getttyname_malloc(int fd, char **r) {
3218         char path[PATH_MAX], *c;
3219         int k;
3220
3221         assert(r);
3222
3223         if ((k = ttyname_r(fd, path, sizeof(path))) != 0)
3224                 return -k;
3225
3226         char_array_0(path);
3227
3228         if (!(c = strdup(startswith(path, "/dev/") ? path + 5 : path)))
3229                 return -ENOMEM;
3230
3231         *r = c;
3232         return 0;
3233 }
3234
3235 int getttyname_harder(int fd, char **r) {
3236         int k;
3237         char *s;
3238
3239         if ((k = getttyname_malloc(fd, &s)) < 0)
3240                 return k;
3241
3242         if (streq(s, "tty")) {
3243                 free(s);
3244                 return get_ctty(0, NULL, r);
3245         }
3246
3247         *r = s;
3248         return 0;
3249 }
3250
3251 int get_ctty_devnr(pid_t pid, dev_t *d) {
3252         int k;
3253         char line[LINE_MAX], *p, *fn;
3254         unsigned long ttynr;
3255         FILE *f;
3256
3257         if (asprintf(&fn, "/proc/%lu/stat", (unsigned long) (pid <= 0 ? getpid() : pid)) < 0)
3258                 return -ENOMEM;
3259
3260         f = fopen(fn, "re");
3261         free(fn);
3262         if (!f)
3263                 return -errno;
3264
3265         if (!fgets(line, sizeof(line), f)) {
3266                 k = -errno;
3267                 fclose(f);
3268                 return k;
3269         }
3270
3271         fclose(f);
3272
3273         p = strrchr(line, ')');
3274         if (!p)
3275                 return -EIO;
3276
3277         p++;
3278
3279         if (sscanf(p, " "
3280                    "%*c "  /* state */
3281                    "%*d "  /* ppid */
3282                    "%*d "  /* pgrp */
3283                    "%*d "  /* session */
3284                    "%lu ", /* ttynr */
3285                    &ttynr) != 1)
3286                 return -EIO;
3287
3288         *d = (dev_t) ttynr;
3289         return 0;
3290 }
3291
3292 int get_ctty(pid_t pid, dev_t *_devnr, char **r) {
3293         int k;
3294         char fn[PATH_MAX], *s, *b, *p;
3295         dev_t devnr;
3296
3297         assert(r);
3298
3299         k = get_ctty_devnr(pid, &devnr);
3300         if (k < 0)
3301                 return k;
3302
3303         snprintf(fn, sizeof(fn), "/dev/char/%u:%u", major(devnr), minor(devnr));
3304         char_array_0(fn);
3305
3306         if ((k = readlink_malloc(fn, &s)) < 0) {
3307
3308                 if (k != -ENOENT)
3309                         return k;
3310
3311                 /* This is an ugly hack */
3312                 if (major(devnr) == 136) {
3313                         if (asprintf(&b, "pts/%lu", (unsigned long) minor(devnr)) < 0)
3314                                 return -ENOMEM;
3315
3316                         *r = b;
3317                         if (_devnr)
3318                                 *_devnr = devnr;
3319
3320                         return 0;
3321                 }
3322
3323                 /* Probably something like the ptys which have no
3324                  * symlink in /dev/char. Let's return something
3325                  * vaguely useful. */
3326
3327                 if (!(b = strdup(fn + 5)))
3328                         return -ENOMEM;
3329
3330                 *r = b;
3331                 if (_devnr)
3332                         *_devnr = devnr;
3333
3334                 return 0;
3335         }
3336
3337         if (startswith(s, "/dev/"))
3338                 p = s + 5;
3339         else if (startswith(s, "../"))
3340                 p = s + 3;
3341         else
3342                 p = s;
3343
3344         b = strdup(p);
3345         free(s);
3346
3347         if (!b)
3348                 return -ENOMEM;
3349
3350         *r = b;
3351         if (_devnr)
3352                 *_devnr = devnr;
3353
3354         return 0;
3355 }
3356
3357 static int rm_rf_children(int fd, bool only_dirs) {
3358         DIR *d;
3359         int ret = 0;
3360
3361         assert(fd >= 0);
3362
3363         /* This returns the first error we run into, but nevertheless
3364          * tries to go on */
3365
3366         if (!(d = fdopendir(fd))) {
3367                 close_nointr_nofail(fd);
3368
3369                 return errno == ENOENT ? 0 : -errno;
3370         }
3371
3372         for (;;) {
3373                 struct dirent buf, *de;
3374                 bool is_dir;
3375                 int r;
3376
3377                 if ((r = readdir_r(d, &buf, &de)) != 0) {
3378                         if (ret == 0)
3379                                 ret = -r;
3380                         break;
3381                 }
3382
3383                 if (!de)
3384                         break;
3385
3386                 if (streq(de->d_name, ".") || streq(de->d_name, ".."))
3387                         continue;
3388
3389                 if (de->d_type == DT_UNKNOWN) {
3390                         struct stat st;
3391
3392                         if (fstatat(fd, de->d_name, &st, AT_SYMLINK_NOFOLLOW) < 0) {
3393                                 if (ret == 0 && errno != ENOENT)
3394                                         ret = -errno;
3395                                 continue;
3396                         }
3397
3398                         is_dir = S_ISDIR(st.st_mode);
3399                 } else
3400                         is_dir = de->d_type == DT_DIR;
3401
3402                 if (is_dir) {
3403                         int subdir_fd;
3404
3405                         if ((subdir_fd = openat(fd, de->d_name, O_RDONLY|O_NONBLOCK|O_DIRECTORY|O_CLOEXEC)) < 0) {
3406                                 if (ret == 0 && errno != ENOENT)
3407                                         ret = -errno;
3408                                 continue;
3409                         }
3410
3411                         if ((r = rm_rf_children(subdir_fd, only_dirs)) < 0) {
3412                                 if (ret == 0)
3413                                         ret = r;
3414                         }
3415
3416                         if (unlinkat(fd, de->d_name, AT_REMOVEDIR) < 0) {
3417                                 if (ret == 0 && errno != ENOENT)
3418                                         ret = -errno;
3419                         }
3420                 } else  if (!only_dirs) {
3421
3422                         if (unlinkat(fd, de->d_name, 0) < 0) {
3423                                 if (ret == 0 && errno != ENOENT)
3424                                         ret = -errno;
3425                         }
3426                 }
3427         }
3428
3429         closedir(d);
3430
3431         return ret;
3432 }
3433
3434 int rm_rf(const char *path, bool only_dirs, bool delete_root) {
3435         int fd;
3436         int r;
3437
3438         assert(path);
3439
3440         if ((fd = open(path, O_RDONLY|O_NONBLOCK|O_DIRECTORY|O_CLOEXEC)) < 0) {
3441
3442                 if (errno != ENOTDIR)
3443                         return -errno;
3444
3445                 if (delete_root && !only_dirs)
3446                         if (unlink(path) < 0)
3447                                 return -errno;
3448
3449                 return 0;
3450         }
3451
3452         r = rm_rf_children(fd, only_dirs);
3453
3454         if (delete_root)
3455                 if (rmdir(path) < 0) {
3456                         if (r == 0)
3457                                 r = -errno;
3458                 }
3459
3460         return r;
3461 }
3462
3463 int chmod_and_chown(const char *path, mode_t mode, uid_t uid, gid_t gid) {
3464         assert(path);
3465
3466         /* Under the assumption that we are running privileged we
3467          * first change the access mode and only then hand out
3468          * ownership to avoid a window where access is too open. */
3469
3470         if (chmod(path, mode) < 0)
3471                 return -errno;
3472
3473         if (chown(path, uid, gid) < 0)
3474                 return -errno;
3475
3476         return 0;
3477 }
3478
3479 cpu_set_t* cpu_set_malloc(unsigned *ncpus) {
3480         cpu_set_t *r;
3481         unsigned n = 1024;
3482
3483         /* Allocates the cpuset in the right size */
3484
3485         for (;;) {
3486                 if (!(r = CPU_ALLOC(n)))
3487                         return NULL;
3488
3489                 if (sched_getaffinity(0, CPU_ALLOC_SIZE(n), r) >= 0) {
3490                         CPU_ZERO_S(CPU_ALLOC_SIZE(n), r);
3491
3492                         if (ncpus)
3493                                 *ncpus = n;
3494
3495                         return r;
3496                 }
3497
3498                 CPU_FREE(r);
3499
3500                 if (errno != EINVAL)
3501                         return NULL;
3502
3503                 n *= 2;
3504         }
3505 }
3506
3507 void status_vprintf(const char *format, va_list ap) {
3508         char *s = NULL;
3509         int fd = -1;
3510
3511         assert(format);
3512
3513         /* This independent of logging, as status messages are
3514          * optional