]>
Commit | Line | Data |
---|---|---|
db9ecf05 | 1 | /* SPDX-License-Identifier: LGPL-2.1-or-later */ |
0b7964b8 | 2 | |
cf0fbc49 | 3 | #include <ctype.h> |
0b7964b8 | 4 | #include <errno.h> |
cf0fbc49 | 5 | #include <stdio.h> |
0b7964b8 | 6 | #include <sys/epoll.h> |
ca78ad1d ZJS |
7 | #include <sys/stat.h> |
8 | #include <sys/types.h> | |
cf0fbc49 | 9 | #include <unistd.h> |
0b7964b8 | 10 | |
b75b4db0 | 11 | #include "sd-bus.h" |
3ffd4af2 | 12 | #include "sd-daemon.h" |
0b7964b8 | 13 | |
b5efdb8a | 14 | #include "alloc-util.h" |
b75b4db0 | 15 | #include "bus-error.h" |
3ffd4af2 | 16 | #include "bus-util.h" |
cc090ca7 | 17 | #include "daemon-util.h" |
ef9eb0a8 | 18 | #include "def.h" |
3ffd4af2 | 19 | #include "fd-util.h" |
f97b34a6 | 20 | #include "format-util.h" |
3ffd4af2 LP |
21 | #include "initreq.h" |
22 | #include "list.h" | |
23 | #include "log.h" | |
cc090ca7 | 24 | #include "main-func.h" |
0a970718 | 25 | #include "memory-util.h" |
dccca82b | 26 | #include "process-util.h" |
0a970718 | 27 | #include "special.h" |
0b7964b8 | 28 | |
0b7964b8 | 29 | #define SERVER_FD_MAX 16 |
ef9eb0a8 | 30 | #define TIMEOUT_MSEC ((int) (DEFAULT_EXIT_USEC/USEC_PER_MSEC)) |
0b7964b8 LP |
31 | |
32 | typedef struct Fifo Fifo; | |
33 | ||
34 | typedef struct Server { | |
35 | int epoll_fd; | |
36 | ||
37 | LIST_HEAD(Fifo, fifos); | |
38 | unsigned n_fifos; | |
39 | ||
b75b4db0 | 40 | sd_bus *bus; |
f632a663 LP |
41 | |
42 | bool quit; | |
0b7964b8 LP |
43 | } Server; |
44 | ||
45 | struct Fifo { | |
46 | Server *server; | |
47 | ||
48 | int fd; | |
49 | ||
50 | struct init_request buffer; | |
51 | size_t bytes_read; | |
52 | ||
53 | LIST_FIELDS(Fifo, fifo); | |
54 | }; | |
55 | ||
ac83842a | 56 | static const char *translate_runlevel(int runlevel, bool *isolate) { |
6542952f LP |
57 | static const struct { |
58 | const int runlevel; | |
59 | const char *special; | |
ac83842a | 60 | bool isolate; |
6542952f | 61 | } table[] = { |
d5d8429a LP |
62 | { '0', SPECIAL_POWEROFF_TARGET, false }, |
63 | { '1', SPECIAL_RESCUE_TARGET, true }, | |
64 | { 's', SPECIAL_RESCUE_TARGET, true }, | |
65 | { 'S', SPECIAL_RESCUE_TARGET, true }, | |
66 | { '2', SPECIAL_MULTI_USER_TARGET, true }, | |
67 | { '3', SPECIAL_MULTI_USER_TARGET, true }, | |
68 | { '4', SPECIAL_MULTI_USER_TARGET, true }, | |
69 | { '5', SPECIAL_GRAPHICAL_TARGET, true }, | |
70 | { '6', SPECIAL_REBOOT_TARGET, false }, | |
6542952f LP |
71 | }; |
72 | ||
ac83842a LP |
73 | assert(isolate); |
74 | ||
e9d9d50c | 75 | for (size_t i = 0; i < ELEMENTSOF(table); i++) |
ac83842a LP |
76 | if (table[i].runlevel == runlevel) { |
77 | *isolate = table[i].isolate; | |
65457142 FC |
78 | if (runlevel == '6' && kexec_loaded()) |
79 | return SPECIAL_KEXEC_TARGET; | |
6542952f | 80 | return table[i].special; |
ac83842a | 81 | } |
6542952f LP |
82 | |
83 | return NULL; | |
0b7964b8 LP |
84 | } |
85 | ||
73e47c42 | 86 | static int change_runlevel(Server *s, int runlevel) { |
0b7964b8 | 87 | const char *target; |
4afd3348 | 88 | _cleanup_(sd_bus_error_free) sd_bus_error error = SD_BUS_ERROR_NULL; |
ac83842a LP |
89 | const char *mode; |
90 | bool isolate = false; | |
b75b4db0 | 91 | int r; |
0b7964b8 LP |
92 | |
93 | assert(s); | |
94 | ||
b75b4db0 | 95 | target = translate_runlevel(runlevel, &isolate); |
f168c273 | 96 | if (!target) { |
0b7964b8 | 97 | log_warning("Got request for unknown runlevel %c, ignoring.", runlevel); |
73e47c42 | 98 | return 0; |
0b7964b8 LP |
99 | } |
100 | ||
ac83842a LP |
101 | if (isolate) |
102 | mode = "isolate"; | |
103 | else | |
4c10771c | 104 | mode = "replace-irreversibly"; |
ac83842a | 105 | |
6f0d624e | 106 | log_debug("Running request %s/start/%s", target, mode); |
0b7964b8 | 107 | |
b75b4db0 TG |
108 | r = sd_bus_call_method( |
109 | s->bus, | |
110 | "org.freedesktop.systemd1", | |
111 | "/org/freedesktop/systemd1", | |
112 | "org.freedesktop.systemd1.Manager", | |
113 | "StartUnit", | |
114 | &error, | |
115 | NULL, | |
116 | "ss", target, mode); | |
73e47c42 | 117 | if (r < 0) |
2a03b9ed | 118 | return log_error_errno(r, "Failed to change runlevel: %s", bus_error_message(&error, r)); |
73e47c42 YW |
119 | |
120 | return 0; | |
0b7964b8 LP |
121 | } |
122 | ||
123 | static void request_process(Server *s, const struct init_request *req) { | |
124 | assert(s); | |
125 | assert(req); | |
126 | ||
127 | if (req->magic != INIT_MAGIC) { | |
128 | log_error("Got initctl request with invalid magic. Ignoring."); | |
129 | return; | |
130 | } | |
131 | ||
132 | switch (req->cmd) { | |
133 | ||
134 | case INIT_CMD_RUNLVL: | |
135 | if (!isprint(req->runlevel)) | |
136 | log_error("Got invalid runlevel. Ignoring."); | |
137 | else | |
46e964c5 TG |
138 | switch (req->runlevel) { |
139 | ||
140 | /* we are async anyway, so just use kill for reexec/reload */ | |
141 | case 'u': | |
142 | case 'U': | |
143 | if (kill(1, SIGTERM) < 0) | |
56f64d95 | 144 | log_error_errno(errno, "kill() failed: %m"); |
f632a663 LP |
145 | |
146 | /* The bus connection will be | |
147 | * terminated if PID 1 is reexecuted, | |
148 | * hence let's just exit here, and | |
149 | * rely on that we'll be restarted on | |
150 | * the next request */ | |
151 | s->quit = true; | |
46e964c5 TG |
152 | break; |
153 | ||
154 | case 'q': | |
155 | case 'Q': | |
156 | if (kill(1, SIGHUP) < 0) | |
56f64d95 | 157 | log_error_errno(errno, "kill() failed: %m"); |
46e964c5 TG |
158 | break; |
159 | ||
160 | default: | |
73e47c42 | 161 | (void) change_runlevel(s, req->runlevel); |
46e964c5 | 162 | } |
0b7964b8 LP |
163 | return; |
164 | ||
165 | case INIT_CMD_POWERFAIL: | |
166 | case INIT_CMD_POWERFAILNOW: | |
167 | case INIT_CMD_POWEROK: | |
168 | log_warning("Received UPS/power initctl request. This is not implemented in systemd. Upgrade your UPS daemon!"); | |
169 | return; | |
170 | ||
171 | case INIT_CMD_CHANGECONS: | |
172 | log_warning("Received console change initctl request. This is not implemented in systemd."); | |
173 | return; | |
174 | ||
175 | case INIT_CMD_SETENV: | |
176 | case INIT_CMD_UNSETENV: | |
177 | log_warning("Received environment initctl request. This is not implemented in systemd."); | |
178 | return; | |
179 | ||
180 | default: | |
181 | log_warning("Received unknown initctl request. Ignoring."); | |
182 | return; | |
183 | } | |
184 | } | |
185 | ||
186 | static int fifo_process(Fifo *f) { | |
187 | ssize_t l; | |
188 | ||
189 | assert(f); | |
190 | ||
191 | errno = EIO; | |
289f910e ZJS |
192 | l = read(f->fd, |
193 | ((uint8_t*) &f->buffer) + f->bytes_read, | |
194 | sizeof(f->buffer) - f->bytes_read); | |
195 | if (l <= 0) { | |
0b7964b8 LP |
196 | if (errno == EAGAIN) |
197 | return 0; | |
198 | ||
e1427b13 | 199 | return log_warning_errno(errno, "Failed to read from fifo: %m"); |
0b7964b8 LP |
200 | } |
201 | ||
202 | f->bytes_read += l; | |
203 | assert(f->bytes_read <= sizeof(f->buffer)); | |
204 | ||
205 | if (f->bytes_read == sizeof(f->buffer)) { | |
206 | request_process(f->server, &f->buffer); | |
207 | f->bytes_read = 0; | |
208 | } | |
209 | ||
210 | return 0; | |
211 | } | |
212 | ||
213 | static void fifo_free(Fifo *f) { | |
214 | assert(f); | |
215 | ||
216 | if (f->server) { | |
217 | assert(f->server->n_fifos > 0); | |
218 | f->server->n_fifos--; | |
71fda00f | 219 | LIST_REMOVE(fifo, f->server->fifos, f); |
0b7964b8 LP |
220 | } |
221 | ||
222 | if (f->fd >= 0) { | |
223 | if (f->server) | |
0e05be84 | 224 | (void) epoll_ctl(f->server->epoll_fd, EPOLL_CTL_DEL, f->fd, NULL); |
0b7964b8 | 225 | |
03e334a1 | 226 | safe_close(f->fd); |
0b7964b8 LP |
227 | } |
228 | ||
229 | free(f); | |
230 | } | |
cc090ca7 | 231 | DEFINE_TRIVIAL_CLEANUP_FUNC(Fifo*, fifo_free); |
0b7964b8 | 232 | |
0b7964b8 LP |
233 | static void server_done(Server *s) { |
234 | assert(s); | |
235 | ||
236 | while (s->fifos) | |
237 | fifo_free(s->fifos); | |
238 | ||
aae82d1a LP |
239 | s->epoll_fd = safe_close(s->epoll_fd); |
240 | s->bus = sd_bus_flush_close_unref(s->bus); | |
0b7964b8 LP |
241 | } |
242 | ||
243 | static int server_init(Server *s, unsigned n_sockets) { | |
244 | int r; | |
0b7964b8 | 245 | |
cc090ca7 ZJS |
246 | /* This function will leave s partially initialized on failure. Caller needs to clean up. */ |
247 | ||
0b7964b8 LP |
248 | assert(s); |
249 | assert(n_sockets > 0); | |
250 | ||
cc090ca7 ZJS |
251 | s->epoll_fd = epoll_create1(EPOLL_CLOEXEC); |
252 | if (s->epoll_fd < 0) | |
253 | return log_error_errno(errno, "Failed to create epoll object: %m"); | |
0b7964b8 | 254 | |
e9d9d50c | 255 | for (unsigned i = 0; i < n_sockets; i++) { |
cc090ca7 ZJS |
256 | _cleanup_(fifo_freep) Fifo *f = NULL; |
257 | int fd = SD_LISTEN_FDS_START + i; | |
7c394faa | 258 | |
3143987f | 259 | r = sd_is_fifo(fd, NULL); |
cc090ca7 ZJS |
260 | if (r < 0) |
261 | return log_error_errno(r, "Failed to determine file descriptor type: %m"); | |
262 | if (!r) | |
263 | return log_error_errno(SYNTHETIC_ERRNO(EINVAL), "Wrong file descriptor type."); | |
0b7964b8 | 264 | |
3143987f | 265 | f = new0(Fifo, 1); |
cc090ca7 ZJS |
266 | if (!f) |
267 | return log_oom(); | |
0b7964b8 | 268 | |
41ab8c67 LP |
269 | struct epoll_event ev = { |
270 | .events = EPOLLIN, | |
271 | .data.ptr = f, | |
272 | }; | |
273 | ||
cc090ca7 ZJS |
274 | if (epoll_ctl(s->epoll_fd, EPOLL_CTL_ADD, fd, &ev) < 0) |
275 | return log_error_errno(errno, "Failed to add fifo fd to epoll object: %m"); | |
0b7964b8 | 276 | |
63983207 | 277 | f->fd = fd; |
0b7964b8 | 278 | f->server = s; |
cc090ca7 | 279 | LIST_PREPEND(fifo, s->fifos, TAKE_PTR(f)); |
313cefa1 | 280 | s->n_fifos++; |
0b7964b8 LP |
281 | } |
282 | ||
266f3e26 | 283 | r = bus_connect_system_systemd(&s->bus); |
cc090ca7 ZJS |
284 | if (r < 0) |
285 | return log_error_errno(r, "Failed to get D-Bus connection: %m"); | |
0b7964b8 LP |
286 | |
287 | return 0; | |
0b7964b8 LP |
288 | } |
289 | ||
290 | static int process_event(Server *s, struct epoll_event *ev) { | |
291 | int r; | |
292 | Fifo *f; | |
293 | ||
294 | assert(s); | |
295 | ||
baaa35ad ZJS |
296 | if (!(ev->events & EPOLLIN)) |
297 | return log_info_errno(SYNTHETIC_ERRNO(EIO), | |
298 | "Got invalid event from epoll. (3)"); | |
0b7964b8 LP |
299 | |
300 | f = (Fifo*) ev->data.ptr; | |
289f910e ZJS |
301 | r = fifo_process(f); |
302 | if (r < 0) { | |
da927ba9 | 303 | log_info_errno(r, "Got error on fifo: %m"); |
0b7964b8 LP |
304 | fifo_free(f); |
305 | return r; | |
306 | } | |
307 | ||
308 | return 0; | |
309 | } | |
310 | ||
cc090ca7 ZJS |
311 | static int run(int argc, char *argv[]) { |
312 | _cleanup_(server_done) Server server = { .epoll_fd = -1 }; | |
313 | _cleanup_(notify_on_cleanup) const char *notify_stop = NULL; | |
314 | int r, n; | |
8bfcc8ea | 315 | |
cc090ca7 ZJS |
316 | if (argc > 1) |
317 | return log_error_errno(SYNTHETIC_ERRNO(EINVAL), | |
318 | "This program does not take arguments."); | |
0ca3f374 | 319 | |
6bf3c61c | 320 | log_setup_service(); |
0b7964b8 | 321 | |
4c12626c LP |
322 | umask(0022); |
323 | ||
82d25240 | 324 | n = sd_listen_fds(true); |
cc090ca7 ZJS |
325 | if (n < 0) |
326 | return log_error_errno(errno, | |
327 | "Failed to read listening file descriptors from environment: %m"); | |
8bfcc8ea | 328 | |
cc090ca7 ZJS |
329 | if (n <= 0 || n > SERVER_FD_MAX) |
330 | return log_error_errno(SYNTHETIC_ERRNO(EINVAL), | |
331 | "No or too many file descriptors passed."); | |
0b7964b8 | 332 | |
cc090ca7 ZJS |
333 | r = server_init(&server, (unsigned) n); |
334 | if (r < 0) | |
335 | return r; | |
cd6d0a45 | 336 | |
cc090ca7 | 337 | notify_stop = notify_start(NOTIFY_READY, NOTIFY_STOPPING); |
8c47c732 | 338 | |
f632a663 | 339 | while (!server.quit) { |
0b7964b8 LP |
340 | struct epoll_event event; |
341 | int k; | |
342 | ||
3cc2aff1 LP |
343 | k = epoll_wait(server.epoll_fd, &event, 1, TIMEOUT_MSEC); |
344 | if (k < 0) { | |
0b7964b8 LP |
345 | if (errno == EINTR) |
346 | continue; | |
cc090ca7 | 347 | return log_error_errno(errno, "epoll_wait() failed: %m"); |
0b7964b8 | 348 | } |
cc090ca7 | 349 | if (k == 0) |
0b7964b8 LP |
350 | break; |
351 | ||
cc090ca7 ZJS |
352 | r = process_event(&server, &event); |
353 | if (r < 0) | |
354 | return r; | |
0b7964b8 | 355 | } |
cd6d0a45 | 356 | |
cc090ca7 | 357 | return 0; |
0b7964b8 | 358 | } |
cc090ca7 ZJS |
359 | |
360 | DEFINE_MAIN_FUNCTION(run); |