Check if requested hash is supported before writing LUKS header.
[platform/upstream/cryptsetup.git] / luks / keymanage.c
1 /*
2  * LUKS - Linux Unified Key Setup 
3  *
4  * Copyright (C) 2004-2006, Clemens Fruhwirth <clemens@endorphin.org>
5  *
6  * This program is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU General Public License
8  * version 2 as published by the Free Software Foundation.
9  *
10  * This program is distributed in the hope that it will be useful,
11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  * GNU General Public License for more details.
14  *
15  * You should have received a copy of the GNU General Public License
16  * along with this program; if not, write to the Free Software
17  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
18  */
19
20 #include <sys/types.h>
21 #include <sys/stat.h>
22 #include <sys/ioctl.h>
23 #include <linux/fs.h>
24 #include <netinet/in.h>
25 #include <fcntl.h>
26 #include <errno.h>
27 #include <unistd.h>
28 #include <stdio.h>
29 #include <stdlib.h>
30 #include <string.h>
31 #include <ctype.h>
32
33 #include "luks.h"
34 #include "af.h"
35 #include "pbkdf.h"
36 #include "random.h"
37 #include <uuid/uuid.h>
38 #include <../lib/internal.h>
39
40 #define div_round_up(a,b) ({           \
41         typeof(a) __a = (a);          \
42         typeof(b) __b = (b);          \
43         (__a - 1) / __b + 1;        \
44 })
45
46 static inline int round_up_modulo(int x, int m) {
47         return div_round_up(x, m) * m;
48 }
49
50 struct luks_masterkey *LUKS_alloc_masterkey(int keylength, const char *key)
51
52         struct luks_masterkey *mk=malloc(sizeof(*mk) + keylength);
53         if(NULL == mk) return NULL;
54         mk->keyLength=keylength;
55         if (key)
56                 memcpy(&mk->key, key, keylength);
57         return mk;
58 }
59
60 void LUKS_dealloc_masterkey(struct luks_masterkey *mk)
61 {
62         if(NULL != mk) {
63                 memset(mk->key,0,mk->keyLength);
64                 mk->keyLength=0;
65                 free(mk);
66         }
67 }
68
69 struct luks_masterkey *LUKS_generate_masterkey(int keylength)
70 {
71         struct luks_masterkey *mk=LUKS_alloc_masterkey(keylength, NULL);
72         if(NULL == mk) return NULL;
73
74         int r = getRandom(mk->key,keylength);
75         if(r < 0) {
76                 LUKS_dealloc_masterkey(mk);
77                 return NULL;
78         }
79         return mk;
80 }
81
82 int LUKS_hdr_backup(
83         const char *backup_file,
84         const char *device,
85         struct luks_phdr *hdr,
86         struct crypt_device *ctx)
87 {
88         int r = 0, devfd = -1;
89         size_t buffer_size;
90         char *buffer = NULL;
91         struct stat st;
92
93         if(stat(backup_file, &st) == 0) {
94                 log_err(ctx, _("Requested file %s already exist.\n"), backup_file);
95                 return -EINVAL;
96         }
97
98         r = LUKS_read_phdr(device, hdr, 1, ctx);
99         if (r)
100                 return r;
101
102         buffer_size = hdr->payloadOffset << SECTOR_SHIFT;
103         buffer = safe_alloc(buffer_size);
104         if (!buffer || buffer_size < LUKS_ALIGN_KEYSLOTS) {
105                 r = -ENOMEM;
106                 goto out;
107         }
108
109         log_dbg("Storing backup of header (%u bytes) and keyslot area (%u bytes).",
110                 sizeof(*hdr), buffer_size - LUKS_ALIGN_KEYSLOTS);
111
112         devfd = open(device, O_RDONLY | O_DIRECT | O_SYNC);
113         if(devfd == -1) {
114                 log_err(ctx, _("Device %s is not a valid LUKS device.\n"), device);
115                 r = -EINVAL;
116                 goto out;
117         }
118
119         if(read_blockwise(devfd, buffer, buffer_size) < buffer_size) {
120                 r = -EIO;
121                 goto out;
122         }
123         close(devfd);
124
125         /* Wipe unused area, so backup cannot contain old signatures */
126         memset(buffer + sizeof(*hdr), 0, LUKS_ALIGN_KEYSLOTS - sizeof(*hdr));
127
128         devfd = creat(backup_file, S_IRUSR);
129         if(devfd == -1) {
130                 r = -EINVAL;
131                 goto out;
132         }
133         if(write(devfd, buffer, buffer_size) < buffer_size) {
134                 log_err(ctx, _("Cannot write header backup file %s.\n"), backup_file);
135                 r = -EIO;
136                 goto out;
137         }
138         close(devfd);
139
140         r = 0;
141 out:
142         if (devfd != -1)
143                 close(devfd);
144         safe_free(buffer);
145         return r;
146 }
147
148 int LUKS_hdr_restore(
149         const char *backup_file,
150         const char *device,
151         struct luks_phdr *hdr,
152         struct crypt_device *ctx)
153 {
154         int r = 0, devfd = -1, diff_uuid = 0;
155         size_t buffer_size;
156         char *buffer = NULL, msg[200];
157         struct stat st;
158         struct luks_phdr hdr_file;
159
160         if(stat(backup_file, &st) < 0) {
161                 log_err(ctx, _("Backup file %s doesn't exist.\n"), backup_file);
162                 return -EINVAL;
163         }
164
165         r = LUKS_read_phdr_backup(backup_file, device, &hdr_file, 0, ctx);
166         buffer_size = hdr_file.payloadOffset << SECTOR_SHIFT;
167
168         if (r || buffer_size < LUKS_ALIGN_KEYSLOTS) {
169                 log_err(ctx, _("Backup file do not contain valid LUKS header.\n"));
170                 r = -EINVAL;
171                 goto out;
172         }
173
174         buffer = safe_alloc(buffer_size);
175         if (!buffer) {
176                 r = -ENOMEM;
177                 goto out;
178         }
179
180         devfd = open(backup_file, O_RDONLY);
181         if(devfd == -1) {
182                 log_err(ctx, _("Cannot open header backup file %s.\n"), backup_file);
183                 r = -EINVAL;
184                 goto out;
185         }
186
187         if(read(devfd, buffer, buffer_size) < buffer_size) {
188                 log_err(ctx, _("Cannot read header backup file %s.\n"), backup_file);
189                 r = -EIO;
190                 goto out;
191         }
192         close(devfd);
193
194         r = LUKS_read_phdr(device, hdr, 0, ctx);
195         if (r == 0) {
196                 log_dbg("Device %s already contains LUKS header, checking UUID and offset.", device);
197                 if(hdr->payloadOffset != hdr_file.payloadOffset ||
198                    hdr->keyBytes != hdr_file.keyBytes) {
199                         log_err(ctx, _("Data offset or key size differs on device and backup, restore failed.\n"));
200                         r = -EINVAL;
201                         goto out;
202                 }
203                 if (memcmp(hdr->uuid, hdr_file.uuid, UUID_STRING_L))
204                         diff_uuid = 1;
205         }
206
207         if (snprintf(msg, sizeof(msg), _("Device %s %s%s"), device,
208                  r ? _("does not contain LUKS header. Replacing header can destroy data on that device.") :
209                      _("already contains LUKS header. Replacing header will destroy existing keyslots."),
210                      diff_uuid ? _("\nWARNING: real device header has different UUID than backup!") : "") < 0) {
211                 r = -ENOMEM;
212                 goto out;
213         }
214
215         if (!crypt_confirm(ctx, msg)) {
216                 r = -EINVAL;
217                 goto out;
218         }
219
220         log_dbg("Storing backup of header (%u bytes) and keyslot area (%u bytes) to device %s.",
221                 sizeof(*hdr), buffer_size - LUKS_ALIGN_KEYSLOTS, device);
222
223         devfd = open(device, O_WRONLY | O_DIRECT | O_SYNC);
224         if(devfd == -1) {
225                 log_err(ctx, _("Cannot open device %s.\n"), device);
226                 r = -EINVAL;
227                 goto out;
228         }
229
230         if(write_blockwise(devfd, buffer, buffer_size) < buffer_size) {
231                 r = -EIO;
232                 goto out;
233         }
234         close(devfd);
235
236         /* Be sure to reload new data */
237         r = LUKS_read_phdr(device, hdr, 0, ctx);
238 out:
239         if (devfd != -1)
240                 close(devfd);
241         safe_free(buffer);
242         return r;
243 }
244
245 static int _check_and_convert_hdr(const char *device,
246                                   struct luks_phdr *hdr,
247                                   int require_luks_device,
248                                   struct crypt_device *ctx)
249 {
250         int r = 0;
251         unsigned int i;
252         char luksMagic[] = LUKS_MAGIC;
253
254         if(memcmp(hdr->magic, luksMagic, LUKS_MAGIC_L)) { /* Check magic */
255                 log_dbg("LUKS header not detected.");
256                 if (require_luks_device)
257                         log_err(ctx, _("Device %s is not a valid LUKS device.\n"), device);
258                 else
259                         set_error(_("Device %s is not a valid LUKS device."), device);
260                 r = -EINVAL;
261         } else if((hdr->version = ntohs(hdr->version)) != 1) {  /* Convert every uint16/32_t item from network byte order */
262                 log_err(ctx, _("Unsupported LUKS version %d.\n"), hdr->version);
263                 r = -EINVAL;
264         } else if (PBKDF2_HMAC_ready(hdr->hashSpec) < 0) {
265                 log_err(ctx, _("Requested LUKS hash %s is not supported.\n"), hdr->hashSpec);
266                 r = -EINVAL;
267         } else {
268                 hdr->payloadOffset      = ntohl(hdr->payloadOffset);
269                 hdr->keyBytes           = ntohl(hdr->keyBytes);
270                 hdr->mkDigestIterations = ntohl(hdr->mkDigestIterations);
271
272                 for(i = 0; i < LUKS_NUMKEYS; ++i) {
273                         hdr->keyblock[i].active             = ntohl(hdr->keyblock[i].active);
274                         hdr->keyblock[i].passwordIterations = ntohl(hdr->keyblock[i].passwordIterations);
275                         hdr->keyblock[i].keyMaterialOffset  = ntohl(hdr->keyblock[i].keyMaterialOffset);
276                         hdr->keyblock[i].stripes            = ntohl(hdr->keyblock[i].stripes);
277                 }
278         }
279
280         return r;
281 }
282
283 static void _to_lower(char *str, unsigned max_len)
284 {
285         for(; *str && max_len; str++, max_len--)
286                 if (isupper(*str))
287                         *str = tolower(*str);
288 }
289
290 static void LUKS_fix_header_compatible(struct luks_phdr *header)
291 {
292         /* Old cryptsetup expects "sha1", gcrypt allows case insensistive names,
293          * so always convert hash to lower case in header */
294         _to_lower(header->hashSpec, LUKS_HASHSPEC_L);
295 }
296
297 int LUKS_read_phdr_backup(const char *backup_file,
298                           const char *device,
299                           struct luks_phdr *hdr,
300                           int require_luks_device,
301                           struct crypt_device *ctx)
302 {
303         int devfd = 0, r = 0;
304
305         log_dbg("Reading LUKS header of size %d from backup file %s",
306                 sizeof(struct luks_phdr), backup_file);
307
308         devfd = open(backup_file, O_RDONLY);
309         if(-1 == devfd) {
310                 log_err(ctx, _("Cannot open file %s.\n"), device);
311                 return -EINVAL;
312         }
313
314         if(read(devfd, hdr, sizeof(struct luks_phdr)) < sizeof(struct luks_phdr))
315                 r = -EIO;
316         else {
317                 LUKS_fix_header_compatible(hdr);
318                 r = _check_and_convert_hdr(backup_file, hdr, require_luks_device, ctx);
319         }
320
321         close(devfd);
322         return r;
323 }
324
325 int LUKS_read_phdr(const char *device,
326                    struct luks_phdr *hdr,
327                    int require_luks_device,
328                    struct crypt_device *ctx)
329 {
330         int devfd = 0, r = 0;
331         uint64_t size;
332
333         log_dbg("Reading LUKS header of size %d from device %s",
334                 sizeof(struct luks_phdr), device);
335
336         devfd = open(device,O_RDONLY | O_DIRECT | O_SYNC);
337         if(-1 == devfd) {
338                 log_err(ctx, _("Cannot open device %s.\n"), device);
339                 return -EINVAL;
340         }
341
342         if(read_blockwise(devfd, hdr, sizeof(struct luks_phdr)) < sizeof(struct luks_phdr))
343                 r = -EIO;
344         else
345                 r = _check_and_convert_hdr(device, hdr, require_luks_device, ctx);
346
347 #ifdef BLKGETSIZE64
348         if (r == 0 && (ioctl(devfd, BLKGETSIZE64, &size) < 0 ||
349             size < (uint64_t)hdr->payloadOffset)) {
350                 log_err(ctx, _("LUKS header detected but device %s is too small.\n"), device);
351                 r = -EINVAL;
352         }
353 #endif
354         close(devfd);
355
356         return r;
357 }
358
359 int LUKS_write_phdr(const char *device,
360                     struct luks_phdr *hdr,
361                     struct crypt_device *ctx)
362 {
363         int devfd = 0; 
364         unsigned int i; 
365         struct luks_phdr convHdr;
366         int r;
367
368         log_dbg("Updating LUKS header of size %d on device %s",
369                 sizeof(struct luks_phdr), device);
370
371         devfd = open(device,O_RDWR | O_DIRECT | O_SYNC);
372         if(-1 == devfd) { 
373                 log_err(ctx, _("Cannot open device %s.\n"), device);
374                 return -EINVAL;
375         }
376
377         memcpy(&convHdr, hdr, sizeof(struct luks_phdr));
378         memset(&convHdr._padding, 0, sizeof(convHdr._padding));
379
380         /* Convert every uint16/32_t item to network byte order */
381         convHdr.version            = htons(hdr->version);
382         convHdr.payloadOffset      = htonl(hdr->payloadOffset);
383         convHdr.keyBytes           = htonl(hdr->keyBytes);
384         convHdr.mkDigestIterations = htonl(hdr->mkDigestIterations);
385         for(i = 0; i < LUKS_NUMKEYS; ++i) {
386                 convHdr.keyblock[i].active             = htonl(hdr->keyblock[i].active);
387                 convHdr.keyblock[i].passwordIterations = htonl(hdr->keyblock[i].passwordIterations);
388                 convHdr.keyblock[i].keyMaterialOffset  = htonl(hdr->keyblock[i].keyMaterialOffset);
389                 convHdr.keyblock[i].stripes            = htonl(hdr->keyblock[i].stripes);
390         }
391
392         r = write_blockwise(devfd, &convHdr, sizeof(struct luks_phdr)) < sizeof(struct luks_phdr) ? -EIO : 0;
393         if (r)
394                 log_err(ctx, _("Error during update of LUKS header on device %s.\n"), device);
395         close(devfd);
396
397         /* Re-read header from disk to be sure that in-memory and on-disk data are the same. */
398         if (!r) {
399                 r = LUKS_read_phdr(device, hdr, 1, ctx);
400                 if (r)
401                         log_err(ctx, _("Error re-reading LUKS header after update on device %s.\n"), device);
402         }
403
404         return r;
405 }
406
407 static int LUKS_PBKDF2_performance_check(const char *hashSpec,
408                                          uint64_t *PBKDF2_per_sec,
409                                          struct crypt_device *ctx)
410 {
411         if (!*PBKDF2_per_sec) {
412                 if (PBKDF2_performance_check(hashSpec, PBKDF2_per_sec) < 0) {
413                         log_err(ctx, _("Not compatible PBKDF2 options (using hash algorithm %s).\n"), hashSpec);
414                         return -EINVAL;
415                 }
416                 log_dbg("PBKDF2: %" PRIu64 " iterations per second using hash %s.", *PBKDF2_per_sec, hashSpec);
417         }
418
419         return 0;
420 }
421
422 int LUKS_generate_phdr(struct luks_phdr *header,
423                        const struct luks_masterkey *mk,
424                        const char *cipherName, const char *cipherMode, const char *hashSpec,
425                        const char *uuid, unsigned int stripes,
426                        unsigned int alignPayload,
427                        unsigned int alignOffset,
428                        uint32_t iteration_time_ms,
429                        uint64_t *PBKDF2_per_sec,
430                        struct crypt_device *ctx)
431 {
432         unsigned int i=0;
433         unsigned int blocksPerStripeSet = div_round_up(mk->keyLength*stripes,SECTOR_SIZE);
434         int r;
435         char luksMagic[] = LUKS_MAGIC;
436         uuid_t partitionUuid;
437         int currentSector;
438
439         if (alignPayload == 0)
440                 alignPayload = DEFAULT_DISK_ALIGNMENT / SECTOR_SIZE;
441
442         if (PBKDF2_HMAC_ready(hashSpec) < 0) {
443                 log_err(ctx, _("Requested LUKS hash %s is not supported.\n"), hashSpec);
444                 return -EINVAL;
445         }
446
447         memset(header,0,sizeof(struct luks_phdr));
448
449         /* Set Magic */
450         memcpy(header->magic,luksMagic,LUKS_MAGIC_L);
451         header->version=1;
452         strncpy(header->cipherName,cipherName,LUKS_CIPHERNAME_L);
453         strncpy(header->cipherMode,cipherMode,LUKS_CIPHERMODE_L);
454         strncpy(header->hashSpec,hashSpec,LUKS_HASHSPEC_L);
455
456         header->keyBytes=mk->keyLength;
457
458         LUKS_fix_header_compatible(header);
459
460         log_dbg("Generating LUKS header version %d using hash %s, %s, %s, MK %d bytes",
461                 header->version, header->hashSpec ,header->cipherName, header->cipherMode,
462                 header->keyBytes);
463
464         r = getRandom(header->mkDigestSalt,LUKS_SALTSIZE);
465         if(r < 0) {
466                 log_err(ctx,  _("Cannot create LUKS header: reading random salt failed.\n"));
467                 return r;
468         }
469
470         if ((r = LUKS_PBKDF2_performance_check(header->hashSpec, PBKDF2_per_sec, ctx)))
471                 return r;
472
473         /* Compute master key digest */
474         iteration_time_ms /= 8;
475         header->mkDigestIterations = at_least((uint32_t)(*PBKDF2_per_sec/1024) * iteration_time_ms,
476                                               LUKS_MKD_ITERATIONS_MIN);
477
478         r = PBKDF2_HMAC(header->hashSpec,mk->key,mk->keyLength,
479                         header->mkDigestSalt,LUKS_SALTSIZE,
480                         header->mkDigestIterations,
481                         header->mkDigest,LUKS_DIGESTSIZE);
482         if(r < 0) {
483                 log_err(ctx,  _("Cannot create LUKS header: header digest failed (using hash %s).\n"),
484                         header->hashSpec);
485                 return r;
486         }
487
488         currentSector = round_up_modulo(LUKS_PHDR_SIZE, LUKS_ALIGN_KEYSLOTS / SECTOR_SIZE);
489         for(i = 0; i < LUKS_NUMKEYS; ++i) {
490                 header->keyblock[i].active = LUKS_KEY_DISABLED;
491                 header->keyblock[i].keyMaterialOffset = currentSector;
492                 header->keyblock[i].stripes = stripes;
493                 currentSector = round_up_modulo(currentSector + blocksPerStripeSet,
494                                                 LUKS_ALIGN_KEYSLOTS / SECTOR_SIZE);
495         }
496         currentSector = round_up_modulo(currentSector, alignPayload);
497
498         /* alignOffset - offset from natural device alignment provided by topology info */
499         header->payloadOffset = currentSector + alignOffset;
500
501         if (uuid && !uuid_parse(uuid, partitionUuid)) {
502                 log_err(ctx, _("Wrong UUID format provided, generating new one.\n"));
503                 uuid = NULL;
504         }
505         if (!uuid)
506                 uuid_generate(partitionUuid);
507         uuid_unparse(partitionUuid, header->uuid);
508
509         log_dbg("Data offset %d, UUID %s, digest iterations %" PRIu32,
510                 header->payloadOffset, header->uuid, header->mkDigestIterations);
511
512         return 0;
513 }
514
515 int LUKS_set_key(const char *device, unsigned int keyIndex,
516                  const char *password, size_t passwordLen,
517                  struct luks_phdr *hdr, struct luks_masterkey *mk,
518                  uint32_t iteration_time_ms,
519                  uint64_t *PBKDF2_per_sec,
520                  struct crypt_device *ctx)
521 {
522         char derivedKey[hdr->keyBytes];
523         char *AfKey;
524         unsigned int AFEKSize;
525         uint64_t PBKDF2_temp;
526         int r;
527
528         if(hdr->keyblock[keyIndex].active != LUKS_KEY_DISABLED) {
529                 log_err(ctx,  _("Key slot %d active, purge first.\n"), keyIndex);
530                 return -EINVAL;
531         }
532
533         if(hdr->keyblock[keyIndex].stripes < LUKS_STRIPES) {
534                 log_err(ctx, _("Key slot %d material includes too few stripes. Header manipulation?\n"),
535                         keyIndex);
536                  return -EINVAL;
537         }
538
539         log_dbg("Calculating data for key slot %d", keyIndex);
540
541         if ((r = LUKS_PBKDF2_performance_check(hdr->hashSpec, PBKDF2_per_sec, ctx)))
542                 return r;
543
544         /*
545          * Avoid floating point operation
546          * Final iteration count is at least LUKS_SLOT_ITERATIONS_MIN
547          */
548         PBKDF2_temp = (*PBKDF2_per_sec / 2) * (uint64_t)iteration_time_ms;
549         PBKDF2_temp /= 1024;
550         if (PBKDF2_temp > UINT32_MAX)
551                 PBKDF2_temp = UINT32_MAX;
552         hdr->keyblock[keyIndex].passwordIterations = at_least((uint32_t)PBKDF2_temp,
553                                                               LUKS_SLOT_ITERATIONS_MIN);
554
555         log_dbg("Key slot %d use %d password iterations.", keyIndex, hdr->keyblock[keyIndex].passwordIterations);
556
557         r = getRandom(hdr->keyblock[keyIndex].passwordSalt, LUKS_SALTSIZE);
558         if(r < 0) return r;
559
560 //      assert((mk->keyLength % TWOFISH_BLOCKSIZE) == 0); FIXME
561
562         r = PBKDF2_HMAC(hdr->hashSpec, password,passwordLen,
563                         hdr->keyblock[keyIndex].passwordSalt,LUKS_SALTSIZE,
564                         hdr->keyblock[keyIndex].passwordIterations,
565                         derivedKey, hdr->keyBytes);
566         if(r < 0) return r;
567
568         /*
569          * AF splitting, the masterkey stored in mk->key is splitted to AfMK
570          */
571         AFEKSize = hdr->keyblock[keyIndex].stripes*mk->keyLength;
572         AfKey = (char *)malloc(AFEKSize);
573         if(AfKey == NULL) return -ENOMEM;
574
575         log_dbg("Using hash %s for AF in key slot %d, %d stripes",
576                 hdr->hashSpec, keyIndex, hdr->keyblock[keyIndex].stripes);
577         r = AF_split(mk->key,AfKey,mk->keyLength,hdr->keyblock[keyIndex].stripes,hdr->hashSpec);
578         if(r < 0) goto out;
579
580         log_dbg("Updating key slot %d [0x%04x] area on device %s.", keyIndex,
581                 hdr->keyblock[keyIndex].keyMaterialOffset << 9, device);
582         /* Encryption via dm */
583         r = LUKS_encrypt_to_storage(AfKey,
584                                     AFEKSize,
585                                     hdr,
586                                     derivedKey,
587                                     hdr->keyBytes,
588                                     device,
589                                     hdr->keyblock[keyIndex].keyMaterialOffset,
590                                     ctx);
591         if(r < 0) {
592                 if(!get_error())
593                         log_err(ctx, _("Failed to write to key storage.\n"));
594                 goto out;
595         }
596
597         /* Mark the key as active in phdr */
598         r = LUKS_keyslot_set(hdr, (int)keyIndex, 1);
599         if(r < 0) goto out;
600
601         r = LUKS_write_phdr(device, hdr, ctx);
602         if(r < 0) goto out;
603
604         r = 0;
605 out:
606         free(AfKey);
607         return r;
608 }
609
610 /* Check whether a master key is invalid. */
611 int LUKS_verify_master_key(const struct luks_phdr *hdr,
612                            const struct luks_masterkey *mk)
613 {
614         char checkHashBuf[LUKS_DIGESTSIZE];
615
616         if (PBKDF2_HMAC(hdr->hashSpec, mk->key, mk->keyLength,
617                         hdr->mkDigestSalt, LUKS_SALTSIZE,
618                         hdr->mkDigestIterations, checkHashBuf,
619                         LUKS_DIGESTSIZE) < 0)
620                 return -EINVAL;
621
622         if (memcmp(checkHashBuf, hdr->mkDigest, LUKS_DIGESTSIZE))
623                 return -EPERM;
624
625         return 0;
626 }
627
628 /* Try to open a particular key slot */
629 static int LUKS_open_key(const char *device,
630                   unsigned int keyIndex,
631                   const char *password,
632                   size_t passwordLen,
633                   struct luks_phdr *hdr,
634                   struct luks_masterkey *mk,
635                   struct crypt_device *ctx)
636 {
637         crypt_keyslot_info ki = LUKS_keyslot_info(hdr, keyIndex);
638         char derivedKey[hdr->keyBytes];
639         char *AfKey;
640         size_t AFEKSize;
641         int r;
642
643         log_dbg("Trying to open key slot %d [%d].", keyIndex, (int)ki);
644
645         if (ki < CRYPT_SLOT_ACTIVE)
646                 return -ENOENT;
647
648         // assert((mk->keyLength % TWOFISH_BLOCKSIZE) == 0); FIXME
649
650         AFEKSize = hdr->keyblock[keyIndex].stripes*mk->keyLength;
651         AfKey = (char *)malloc(AFEKSize);
652         if(AfKey == NULL) return -ENOMEM;
653
654         r = PBKDF2_HMAC(hdr->hashSpec, password,passwordLen,
655                         hdr->keyblock[keyIndex].passwordSalt,LUKS_SALTSIZE,
656                         hdr->keyblock[keyIndex].passwordIterations,
657                         derivedKey, hdr->keyBytes);
658         if(r < 0) goto out;
659
660         log_dbg("Reading key slot %d area.", keyIndex);
661         r = LUKS_decrypt_from_storage(AfKey,
662                                       AFEKSize,
663                                       hdr,
664                                       derivedKey,
665                                       hdr->keyBytes,
666                                       device,
667                                       hdr->keyblock[keyIndex].keyMaterialOffset,
668                                       ctx);
669         if(r < 0) {
670                 log_err(ctx, _("Failed to read from key storage.\n"));
671                 goto out;
672         }
673
674         r = AF_merge(AfKey,mk->key,mk->keyLength,hdr->keyblock[keyIndex].stripes,hdr->hashSpec);
675         if(r < 0) goto out;
676
677         r = LUKS_verify_master_key(hdr, mk);
678         if (r >= 0)
679                 log_verbose(ctx, _("Key slot %d unlocked.\n"), keyIndex);
680 out:
681         free(AfKey);
682         return r;
683 }
684
685 int LUKS_open_key_with_hdr(const char *device,
686                            int keyIndex,
687                            const char *password,
688                            size_t passwordLen,
689                            struct luks_phdr *hdr,
690                            struct luks_masterkey **mk,
691                            struct crypt_device *ctx)
692 {
693         unsigned int i;
694         int r;
695
696         *mk = LUKS_alloc_masterkey(hdr->keyBytes, NULL);
697
698         if (keyIndex >= 0)
699                 return LUKS_open_key(device, keyIndex, password, passwordLen, hdr, *mk, ctx);
700
701         for(i = 0; i < LUKS_NUMKEYS; i++) {
702                 r = LUKS_open_key(device, i, password, passwordLen, hdr, *mk, ctx);
703                 if(r == 0)
704                         return i;
705
706                 /* Do not retry for errors that are no -EPERM or -ENOENT,
707                    former meaning password wrong, latter key slot inactive */
708                 if ((r != -EPERM) && (r != -ENOENT)) 
709                         return r;
710         }
711         /* Warning, early returns above */
712         log_err(ctx, _("No key available with this passphrase.\n"));
713         return -EPERM;
714 }
715
716 /*
717  * Wipe patterns according to Gutmann's Paper
718  */
719
720 static void wipeSpecial(char *buffer, size_t buffer_size, unsigned int turn)
721 {
722         unsigned int i;
723
724         unsigned char write_modes[][3] = {
725                 {"\x55\x55\x55"}, {"\xaa\xaa\xaa"}, {"\x92\x49\x24"},
726                 {"\x49\x24\x92"}, {"\x24\x92\x49"}, {"\x00\x00\x00"},
727                 {"\x11\x11\x11"}, {"\x22\x22\x22"}, {"\x33\x33\x33"},
728                 {"\x44\x44\x44"}, {"\x55\x55\x55"}, {"\x66\x66\x66"},
729                 {"\x77\x77\x77"}, {"\x88\x88\x88"}, {"\x99\x99\x99"},
730                 {"\xaa\xaa\xaa"}, {"\xbb\xbb\xbb"}, {"\xcc\xcc\xcc"},
731                 {"\xdd\xdd\xdd"}, {"\xee\xee\xee"}, {"\xff\xff\xff"},
732                 {"\x92\x49\x24"}, {"\x49\x24\x92"}, {"\x24\x92\x49"},
733                 {"\x6d\xb6\xdb"}, {"\xb6\xdb\x6d"}, {"\xdb\x6d\xb6"}
734         };
735
736         for(i = 0; i < buffer_size / 3; ++i) {
737                 memcpy(buffer, write_modes[turn], 3);
738                 buffer += 3;
739         }
740 }
741
742 static int wipe(const char *device, unsigned int from, unsigned int to)
743 {
744         int devfd;
745         char *buffer;
746         unsigned int i;
747         unsigned int bufLen = (to - from) * SECTOR_SIZE;
748         int r = 0;
749
750         devfd = open(device, O_RDWR | O_DIRECT | O_SYNC);
751         if(devfd == -1)
752                 return -EINVAL;
753
754         buffer = (char *) malloc(bufLen);
755         if(!buffer) return -ENOMEM;
756
757         for(i = 0; i < 39; ++i) {
758                 if     (i >=  0 && i <  5) getRandom(buffer, bufLen);
759                 else if(i >=  5 && i < 32) wipeSpecial(buffer, bufLen, i - 5);
760                 else if(i >= 32 && i < 38) getRandom(buffer, bufLen);
761                 else if(i >= 38 && i < 39) memset(buffer, 0xFF, bufLen);
762
763                 if(write_lseek_blockwise(devfd, buffer, bufLen, from * SECTOR_SIZE) < 0) {
764                         r = -EIO;
765                         break;
766                 }
767         }
768
769         free(buffer);
770         close(devfd);
771
772         return r;
773 }
774
775 int LUKS_del_key(const char *device,
776                  unsigned int keyIndex,
777                  struct luks_phdr *hdr,
778                  struct crypt_device *ctx)
779 {
780         unsigned int startOffset, endOffset, stripesLen;
781         int r;
782
783         r = LUKS_read_phdr(device, hdr, 1, ctx);
784         if (r)
785                 return r;
786
787         r = LUKS_keyslot_set(hdr, keyIndex, 0);
788         if (r) {
789                 log_err(ctx, _("Key slot %d is invalid, please select keyslot between 0 and %d.\n"),
790                         keyIndex, LUKS_NUMKEYS - 1);
791                 return r;
792         }
793
794         /* secure deletion of key material */
795         startOffset = hdr->keyblock[keyIndex].keyMaterialOffset;
796         stripesLen = hdr->keyBytes * hdr->keyblock[keyIndex].stripes;
797         endOffset = startOffset + div_round_up(stripesLen, SECTOR_SIZE);
798
799         r = wipe(device, startOffset, endOffset);
800         if (r) {
801                 log_err(ctx, _("Cannot wipe device %s.\n"), device);
802                 return r;
803         }
804
805         /* Wipe keyslot info */
806         memset(&hdr->keyblock[keyIndex].passwordSalt, 0, LUKS_SALTSIZE);
807         hdr->keyblock[keyIndex].passwordIterations = 0;
808
809         r = LUKS_write_phdr(device, hdr, ctx);
810
811         return r;
812 }
813
814 crypt_keyslot_info LUKS_keyslot_info(struct luks_phdr *hdr, int keyslot)
815 {
816         int i;
817
818         if(keyslot >= LUKS_NUMKEYS || keyslot < 0)
819                 return CRYPT_SLOT_INVALID;
820
821         if (hdr->keyblock[keyslot].active == LUKS_KEY_DISABLED)
822                 return CRYPT_SLOT_INACTIVE;
823
824         if (hdr->keyblock[keyslot].active != LUKS_KEY_ENABLED)
825                 return CRYPT_SLOT_INVALID;
826
827         for(i = 0; i < LUKS_NUMKEYS; i++)
828                 if(i != keyslot && hdr->keyblock[i].active == LUKS_KEY_ENABLED)
829                         return CRYPT_SLOT_ACTIVE;
830
831         return CRYPT_SLOT_ACTIVE_LAST;
832 }
833
834 int LUKS_keyslot_find_empty(struct luks_phdr *hdr)
835 {
836         int i;
837
838         for (i = 0; i < LUKS_NUMKEYS; i++)
839                 if(hdr->keyblock[i].active == LUKS_KEY_DISABLED)
840                         break;
841
842         if (i == LUKS_NUMKEYS)
843                 return -EINVAL;
844
845         return i;
846 }
847
848 int LUKS_keyslot_active_count(struct luks_phdr *hdr)
849 {
850         int i, num = 0;
851
852         for (i = 0; i < LUKS_NUMKEYS; i++)
853                 if(hdr->keyblock[i].active == LUKS_KEY_ENABLED)
854                         num++;
855
856         return num;
857 }
858
859 int LUKS_keyslot_set(struct luks_phdr *hdr, int keyslot, int enable)
860 {
861         crypt_keyslot_info ki = LUKS_keyslot_info(hdr, keyslot);
862
863         if (ki == CRYPT_SLOT_INVALID)
864                 return -EINVAL;
865
866         hdr->keyblock[keyslot].active = enable ? LUKS_KEY_ENABLED : LUKS_KEY_DISABLED;
867         log_dbg("Key slot %d was %s in LUKS header.", keyslot, enable ? "enabled" : "disabled");
868         return 0;
869 }