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