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