/mandos/trunk

To get this branch, use:
bzr branch http://bzr.recompile.se/loggerhead/mandos/trunk

« back to all changes in this revision

Viewing changes to plugins.d/usplash.c

merge

Show diffs side-by-side

added added

removed removed

Lines of Context:
plugins.d/usplash.c
1
1
#define _GNU_SOURCE             /* asprintf() */
2
2
#include <signal.h>             /* sig_atomic_t, struct sigaction,
3
 
                                   sigemptyset(), sigaddset(),
4
 
                                   sigaction, SIGINT, SIG_IGN, SIGHUP,
5
 
                                   SIGTERM, kill(), SIGKILL */
 
3
                                   sigemptyset(), sigaddset(), SIGINT,
 
4
                                   SIGHUP, SIGTERM, sigaction(),
 
5
                                   SIG_IGN, kill(), SIGKILL */
 
6
#include <stdbool.h>            /* bool, false, true */
 
7
#include <fcntl.h>              /* open(), O_WRONLY, O_RDONLY */
 
8
#include <errno.h>              /* errno, EINTR */
 
9
#include <sys/types.h>          /* size_t, ssize_t, pid_t, DIR,
 
10
                                   struct dirent */
6
11
#include <stddef.h>             /* NULL */
 
12
#include <string.h>             /* strlen(), memcmp() */
 
13
#include <stdio.h>              /* asprintf(), perror() */
 
14
#include <unistd.h>             /* close(), write(), readlink(),
 
15
                                   read(), STDOUT_FILENO, sleep(),
 
16
                                   fork(), setuid(), geteuid(),
 
17
                                   setsid(), chdir(), dup2(),
 
18
                                   STDERR_FILENO, execv() */
 
19
#include <stdlib.h>             /* free(), EXIT_FAILURE, strtoul(),
 
20
                                   realloc(), EXIT_SUCCESS, malloc(),
 
21
                                   _exit() */
7
22
#include <stdlib.h>             /* getenv() */
8
 
#include <stdio.h>              /* asprintf(), perror() */
9
 
#include <stdlib.h>             /* EXIT_FAILURE, EXIT_SUCCESS,
10
 
                                   strtoul(), free() */
11
 
#include <sys/types.h>          /* pid_t, DIR, struct dirent,
12
 
                                   ssize_t */
13
23
#include <dirent.h>             /* opendir(), readdir(), closedir() */
14
 
#include <unistd.h>             /* readlink(), fork(), execl(),
15
 
                                   _exit */
16
 
#include <string.h>             /* memcmp() */
 
24
 
 
25
 
 
26
 
17
27
#include <iso646.h>             /* and */
18
 
#include <stdbool.h>            /* bool, false, true */
19
 
#include <errno.h>              /* errno */
20
28
#include <sys/wait.h>           /* waitpid(), WIFEXITED(),
21
29
                                   WEXITSTATUS() */
22
 
#include <fcntl.h>              /* open(), O_RDONLY */
23
30
 
24
31
sig_atomic_t interrupted_by_signal = 0;
25
32
 
27
34
  interrupted_by_signal = 1;
28
35
}
29
36
 
 
37
static bool usplash_write(const char *cmd, const char *arg){
 
38
  /* 
 
39
   * usplash_write("TIMEOUT", "15"); -> "TIMEOUT 15\0"
 
40
   * usplash_write("PULSATE", NULL); -> "PULSATE\0"
 
41
   * SEE ALSO
 
42
   *         usplash_write(8)
 
43
   */
 
44
  int ret;
 
45
  int fifo_fd;
 
46
  do{
 
47
    fifo_fd = open("/dev/.initramfs/usplash_fifo", O_WRONLY);
 
48
    if(fifo_fd == -1 and (errno != EINTR or interrupted_by_signal)){
 
49
      return false;
 
50
    }
 
51
  }while(fifo_fd == -1);
 
52
  
 
53
  const char *cmd_line;
 
54
  size_t cmd_line_len;
 
55
  char *cmd_line_alloc = NULL;
 
56
  if(arg == NULL){
 
57
    cmd_line = cmd;
 
58
    cmd_line_len = strlen(cmd);
 
59
  }else{
 
60
    do{
 
61
      ret = asprintf(&cmd_line_alloc, "%s %s", cmd, arg);
 
62
      if(ret == -1 and (errno != EINTR or interrupted_by_signal)){
 
63
        int e = errno;
 
64
        close(fifo_fd);
 
65
        errno = e;
 
66
        return false;
 
67
      }
 
68
    }while(ret == -1);
 
69
    cmd_line = cmd_line_alloc;
 
70
    cmd_line_len = (size_t)ret + 1;
 
71
  }
 
72
  
 
73
  size_t written = 0;
 
74
  while(not interrupted_by_signal and written < cmd_line_len){
 
75
    ret = write(fifo_fd, cmd_line + written,
 
76
                cmd_line_len - written);
 
77
    if(ret == -1){
 
78
      if(errno != EINTR or interrupted_by_signal){
 
79
        int e = errno;
 
80
        close(fifo_fd);
 
81
        free(cmd_line_alloc);
 
82
        errno = e;
 
83
        return false;
 
84
      } else {
 
85
        continue;
 
86
      }
 
87
    }
 
88
    written += (size_t)ret;
 
89
  }
 
90
  free(cmd_line_alloc);
 
91
  do{
 
92
    ret = close(fifo_fd);
 
93
    if(ret == -1 and (errno != EINTR or interrupted_by_signal)){
 
94
      return false;
 
95
    }
 
96
  }while(ret == -1);
 
97
  if(interrupted_by_signal){
 
98
    return false;
 
99
  }
 
100
  return true;
 
101
}
 
102
 
30
103
int main(__attribute__((unused))int argc,
31
104
         __attribute__((unused))char **argv){
32
105
  int ret = 0;
38
111
  {
39
112
    const char *const cryptsource = getenv("cryptsource");
40
113
    const char *const crypttarget = getenv("crypttarget");
41
 
    const char *const prompt_start = "Enter passphrase to unlock the disk";
 
114
    const char prompt_start[] = "Enter passphrase to unlock the disk";
42
115
    
43
116
    if(cryptsource == NULL){
44
117
      if(crypttarget == NULL){
64
137
  pid_t usplash_pid = 0;
65
138
  char *cmdline = NULL;
66
139
  size_t cmdline_len = 0;
 
140
  const char usplash_name[] = "/sbin/usplash";
67
141
  {
68
 
    const char usplash_name[] = "/sbin/usplash";
69
142
    DIR *proc_dir = opendir("/proc");
70
143
    if(proc_dir == NULL){
71
144
      free(prompt);
94
167
        }
95
168
        sret = readlink(exe_link, exe_target, sizeof(exe_target));
96
169
        free(exe_link);
 
170
        if(sret == -1){
 
171
          continue;
 
172
        }
97
173
      }
98
174
      if((sret == ((ssize_t)sizeof(exe_target)-1))
99
175
         and (memcmp(usplash_name, exe_target,
217
293
  
218
294
  /* Write command to FIFO */
219
295
  if(not interrupted_by_signal){
220
 
    int fifo_fd = open("/dev/.initramfs/usplash_fifo", O_WRONLY);
221
 
    if(fifo_fd == -1){
222
 
      perror("open");
223
 
      free(prompt);
224
 
      return EXIT_FAILURE;
225
 
    }
226
 
    char *command;
227
 
    ret = asprintf(&command, "INPUTQUIET %s", prompt);
228
 
    if(ret == -1){
229
 
      perror("asprintf");
230
 
      free(prompt);
231
 
      return EXIT_FAILURE;
232
 
    }
233
 
    free(prompt);
234
 
    
235
 
    size_t command_len = (size_t)ret + 1;
236
 
    size_t written = 0;
237
 
    while(not interrupted_by_signal and written < command_len){
238
 
      ret = write(fifo_fd, command + written, command_len - written);
239
 
      if(ret == -1){
240
 
        if(interrupted_by_signal){
241
 
          break;
242
 
        }
243
 
        perror("write");
244
 
        if(written == 0){
245
 
          free(command);
246
 
          return EXIT_FAILURE;
247
 
        }
248
 
        an_error_occured = true;
249
 
        break;
250
 
      }
251
 
      written += (size_t)ret;
252
 
    }
253
 
    ret = close(fifo_fd);
254
 
    if(ret == -1 and not interrupted_by_signal){
255
 
      an_error_occured = true;
256
 
    }
257
 
    free(command);
258
 
  }else{
259
 
    free(prompt);
260
 
  }
 
296
    if(not usplash_write("TIMEOUT", "0")
 
297
       and (errno != EINTR)){
 
298
      perror("usplash_write");
 
299
      an_error_occured = true;
 
300
    }
 
301
  }
 
302
  if(not interrupted_by_signal and not an_error_occured){
 
303
    if(not usplash_write("INPUTQUIET", prompt)
 
304
       and (errno != EINTR)){
 
305
      perror("usplash_write");
 
306
      an_error_occured = true;
 
307
    }
 
308
  }
 
309
  free(prompt);
261
310
  
262
 
  {
 
311
  /* This is not really a loop; while() is used to be able to "break"
 
312
     out of it; those breaks are marked "Big" */
 
313
  while(not interrupted_by_signal and not an_error_occured){
263
314
    char *buf = NULL;
264
315
    size_t buf_len = 0;
265
316
    
 
317
    /* Open FIFO */
 
318
    int fifo_fd;
 
319
    do{
 
320
      fifo_fd = open("/dev/.initramfs/usplash_outfifo", O_RDONLY);
 
321
      if(fifo_fd == -1){
 
322
        if(errno != EINTR){
 
323
          perror("open");
 
324
          an_error_occured = true;
 
325
          break;
 
326
        }
 
327
        if(interrupted_by_signal){
 
328
          break;
 
329
        }
 
330
      }
 
331
    }while(fifo_fd == -1);
 
332
    if(interrupted_by_signal or an_error_occured){
 
333
      break;                    /* Big */
 
334
    }
 
335
    
266
336
    /* Read from FIFO */
267
 
    if(not interrupted_by_signal and not an_error_occured){
268
 
      int fifo_fd = open("/dev/.initramfs/usplash_outfifo", O_RDONLY);
269
 
      if(fifo_fd == -1 and not interrupted_by_signal){
270
 
        perror("open");
271
 
        return EXIT_FAILURE;
 
337
    size_t buf_allocated = 0;
 
338
    const size_t blocksize = 1024;
 
339
    do{
 
340
      if(buf_len + blocksize > buf_allocated){
 
341
        char *tmp = realloc(buf, buf_allocated + blocksize);
 
342
        if(tmp == NULL){
 
343
          perror("realloc");
 
344
          an_error_occured = true;
 
345
          break;
 
346
        }
 
347
        buf = tmp;
 
348
        buf_allocated += blocksize;
272
349
      }
273
 
      size_t buf_allocated = 0;
274
 
      const int blocksize = 1024;
275
350
      do{
276
 
        if(buf_len + blocksize > buf_allocated){
277
 
          char *tmp = realloc(buf, buf_allocated + blocksize);
278
 
          if(tmp == NULL){
279
 
            perror("realloc");
280
 
            an_error_occured = true;
281
 
            break;
282
 
          }
283
 
          buf = tmp;
284
 
          buf_allocated += blocksize;
285
 
        }
286
351
        sret = read(fifo_fd, buf + buf_len, buf_allocated - buf_len);
287
352
        if(sret == -1){
288
 
          perror("read");
289
 
          an_error_occured = true;
290
 
          break;
 
353
          if(errno != EINTR){
 
354
            perror("read");
 
355
            an_error_occured = true;
 
356
            break;
 
357
          }
 
358
          if(interrupted_by_signal){
 
359
            break;
 
360
          }
291
361
        }
292
 
        buf_len += (size_t)sret;
293
 
      }while(not interrupted_by_signal and sret != 0);
294
 
      close(fifo_fd);
295
 
    }
296
 
  
 
362
      }while(sret == -1);
 
363
      if(interrupted_by_signal or an_error_occured){
 
364
        break;
 
365
      }
 
366
      
 
367
      buf_len += (size_t)sret;
 
368
    }while(sret != 0);
 
369
    close(fifo_fd);
 
370
    if(interrupted_by_signal or an_error_occured){
 
371
      break;                    /* Big */
 
372
    }
 
373
    
 
374
    if(not usplash_write("TIMEOUT", "15")
 
375
       and (errno != EINTR)){
 
376
        perror("usplash_write");
 
377
        an_error_occured = true;
 
378
    }
 
379
    if(interrupted_by_signal or an_error_occured){
 
380
      break;                    /* Big */
 
381
    }
 
382
    
297
383
    /* Print password to stdout */
298
 
    if(not interrupted_by_signal and not an_error_occured){
299
 
      size_t written = 0;
 
384
    size_t written = 0;
 
385
    while(written < buf_len){
300
386
      do{
301
387
        sret = write(STDOUT_FILENO, buf + written, buf_len - written);
302
 
        if(sret == -1 and not interrupted_by_signal){
303
 
          perror("write");
304
 
          an_error_occured = true;
305
 
          break;
 
388
        if(sret == -1){
 
389
          if(errno != EINTR){
 
390
            perror("write");
 
391
            an_error_occured = true;
 
392
            break;
 
393
          }
 
394
          if(interrupted_by_signal){
 
395
            break;
 
396
          }
306
397
        }
307
 
        written += (size_t)sret;
308
 
      }while(written < buf_len);
309
 
      if(not interrupted_by_signal and not an_error_occured){
310
 
        return EXIT_SUCCESS;
 
398
      }while(sret == -1);
 
399
      if(interrupted_by_signal or an_error_occured){
 
400
        break;
311
401
      }
312
 
    }
 
402
      written += (size_t)sret;
 
403
    }
 
404
    free(buf);
 
405
    if(not interrupted_by_signal and not an_error_occured){
 
406
      free(cmdline);
 
407
      return EXIT_SUCCESS;
 
408
    }
 
409
    break;                      /* Big */
313
410
  }
314
411
  
315
 
  kill(usplash_pid, SIGTERM);
 
412
  /* If we got here, an error or interrupt must have happened */
316
413
  
317
414
  int cmdline_argc = 0;
318
415
  char **cmdline_argv = malloc(sizeof(char *));
319
416
  /* Create argv and argc for new usplash*/
320
417
  {
321
 
    ptrdiff_t position = 0;
322
 
    while((size_t)position < cmdline_len){
 
418
    size_t position = 0;
 
419
    while(position < cmdline_len){
323
420
      char **tmp = realloc(cmdline_argv,
324
 
                           (sizeof(char *) * (size_t)(cmdline_argc + 2)));
 
421
                           (sizeof(char *)
 
422
                            * (size_t)(cmdline_argc + 2)));
325
423
      if(tmp == NULL){
326
424
        perror("realloc");
327
425
        free(cmdline_argv);
330
428
      cmdline_argv = tmp;
331
429
      cmdline_argv[cmdline_argc] = cmdline + position;
332
430
      cmdline_argc++;
333
 
      position = (char *)rawmemchr(cmdline + position, '\0')
334
 
        - cmdline + 1;
 
431
      position += strlen(cmdline + position) + 1;
335
432
    }
336
433
    cmdline_argv[cmdline_argc] = NULL;
 
434
    free(cmdline);
 
435
  }
 
436
  /* Kill old usplash */
 
437
    kill(usplash_pid, SIGTERM);
 
438
    sleep(2);
 
439
  while(kill(usplash_pid, 0) == 0){
 
440
    kill(usplash_pid, SIGKILL);
 
441
    sleep(1);
337
442
  }
338
443
  pid_t new_usplash_pid = fork();
339
444
  if(new_usplash_pid == 0){
340
445
    /* Child; will become new usplash process */
341
 
    while(kill(usplash_pid, 0)){
342
 
      sleep(2);
343
 
      kill(usplash_pid, SIGKILL);
344
 
      sleep(1);
 
446
    
 
447
    /* Make the effective user ID (root) the only user ID instead of
 
448
       the real user ID (mandos) */
 
449
    ret = setuid(geteuid());
 
450
    if (ret == -1){
 
451
      perror("setuid");
345
452
    }
 
453
    
 
454
    setsid();
 
455
    ret = chdir("/");
 
456
/*     if(fork() != 0){ */
 
457
/*       _exit(EXIT_SUCCESS); */
 
458
/*     } */
346
459
    ret = dup2(STDERR_FILENO, STDOUT_FILENO); /* replace our stdout */
347
460
    if(ret == -1){
348
461
      perror("dup2");
349
462
      _exit(EXIT_FAILURE);
350
463
    }
351
 
    execv("/sbin/usplash", cmdline_argv);
 
464
    
 
465
    execv(usplash_name, cmdline_argv);
 
466
    perror("execv");
 
467
    free(cmdline_argv);
 
468
    _exit(EXIT_FAILURE);
 
469
  }
 
470
  free(cmdline_argv);
 
471
  sleep(2);
 
472
  if(not usplash_write("PULSATE", NULL)
 
473
     and (errno != EINTR)){
 
474
    perror("usplash_write");
352
475
  }
353
476
  
354
477
  return EXIT_FAILURE;