aacs.c 37 KB
Newer Older
1 2
/*
 * This file is part of libaacs
3
 * Copyright (C) 2009-2010  Obliter0n
4
 * Copyright (C) 2009-2013  npzacs
5
 *
gates's avatar
gates committed
6 7 8 9
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2.1 of the License, or (at your option) any later version.
10
 *
gates's avatar
gates committed
11
 * This library is distributed in the hope that it will be useful,
12
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
gates's avatar
gates committed
13 14
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
15
 *
gates's avatar
gates committed
16 17 18
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library. If not, see
 * <http://www.gnu.org/licenses/>.
19 20
 */

npzacs's avatar
npzacs committed
21 22 23 24
#if HAVE_CONFIG_H
#include "config.h"
#endif

npzacs's avatar
npzacs committed
25
#include "util/attributes.h"
npzacs's avatar
npzacs committed
26

npzacs's avatar
npzacs committed
27
#include "aacs-version.h"
cRTrn13's avatar
cRTrn13 committed
28
#include "aacs.h"
npzacs's avatar
npzacs committed
29
#include "content_cert.h"
30
#include "crypto.h"
cRTrn13's avatar
cRTrn13 committed
31
#include "mmc.h"
32
#include "mkb.h"
gates's avatar
gates committed
33
#include "file/file.h"
gates's avatar
gates committed
34
#include "file/keydbcfg.h"
35 36
#include "util/macro.h"
#include "util/logging.h"
37
#include "util/strutl.h"
cRTrn13's avatar
cRTrn13 committed
38

39
#include <inttypes.h>
40
#include <string.h>
41
#include <stdio.h>
npzacs's avatar
npzacs committed
42 43 44
#ifdef HAVE_SYS_SELECT_H
#include <sys/select.h>
#endif
45
#include <gcrypt.h>
46

npzacs's avatar
npzacs committed
47

npzacs's avatar
npzacs committed
48 49 50 51
#define SECTOR_LEN       2048  /* bus encryption block size */
#define ALIGNED_UNIT_LEN 6144  /* aacs block size */


npzacs's avatar
npzacs committed
52
struct aacs {
npzacs's avatar
npzacs committed
53 54 55
    void           *fopen_handle;
    AACS_FILE_OPEN2 fopen;

npzacs's avatar
npzacs committed
56 57 58 59 60
    /* current disc */
    char     *path;
    int       mkb_version;
    uint8_t   disc_id[20];

61 62
    /* VID is cached for BD-J */
    uint8_t   vid[16];
63 64
    /* PMSN is cached for BD-J */
    uint8_t   pmsn[16];
npzacs's avatar
npzacs committed
65 66
    /* Media key is cached for BD+ */
    uint8_t   mk[16];
npzacs's avatar
npzacs committed
67 68 69 70

    /* unit key for each CPS unit */
    uint32_t  num_uks;
    uint8_t  *uks;
npzacs's avatar
npzacs committed
71

npzacs's avatar
npzacs committed
72 73
    /* CPS unit of currently selected title */
    uint16_t  current_cps_unit;
74
    uint8_t   cps_unit_selected;
npzacs's avatar
npzacs committed
75 76 77 78

    /* title -> CPS unit mappings */
    uint32_t  num_titles;
    uint16_t *cps_units;  /* [0] = first play ; [1] = top menu ; [2] = title 1 ... */
79 80 81 82

    /* bus encryption */
    int       bee;        /* bus encryption enabled flag in content certificate */
    int       bec;        /* bus encryption capable flag in drive certificate */
83
    uint8_t   read_data_key[16];
84

npzacs's avatar
npzacs committed
85 86 87
    /* content certificate */
    CONTENT_CERT *cc;

88 89 90
    /* AACS Online (BD-J) */
    uint8_t   device_nonce[16];
    uint8_t   device_binding_id[16];
npzacs's avatar
npzacs committed
91 92
};

93 94 95 96
static const uint8_t empty_key[16] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
                                       0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
static const uint8_t aacs_iv[16]   = { 0x0b, 0xa0, 0xf8, 0xdd, 0xfe, 0xa6, 0x1f, 0xb3,
                                       0xd8, 0xdf, 0x9f, 0x56, 0x6a, 0x05, 0x0f, 0x78 };
97

98 99
static int _validate_pk(const uint8_t *pk,
                        const uint8_t *cvalue, const uint8_t *uv, const uint8_t *vd,
npzacs's avatar
npzacs committed
100
                        uint8_t *mk)
cRTrn13's avatar
cRTrn13 committed
101
{
102
    gcry_cipher_hd_t gcry_h;
npzacs's avatar
npzacs committed
103
    int a;
cRTrn13's avatar
cRTrn13 committed
104
    uint8_t dec_vd[16];
105
    char str[40];
cRTrn13's avatar
cRTrn13 committed
106

npzacs's avatar
npzacs committed
107
    BD_DEBUG(DBG_AACS, "Validate processing key %s...\n", str_print_hex(str, pk, 16));
npzacs's avatar
npzacs committed
108
    BD_DEBUG(DBG_AACS, " Using:\n");
npzacs's avatar
npzacs committed
109 110 111
    BD_DEBUG(DBG_AACS, "   UV: %s\n", str_print_hex(str, uv, 4));
    BD_DEBUG(DBG_AACS, "   cvalue: %s\n", str_print_hex(str, cvalue, 16));
    BD_DEBUG(DBG_AACS, "   Verification data: %s\n", str_print_hex(str, vd, 16));
112

113 114 115
    gcry_cipher_open(&gcry_h, GCRY_CIPHER_AES, GCRY_CIPHER_MODE_ECB, 0);
    gcry_cipher_setkey(gcry_h, pk, 16);
    gcry_cipher_decrypt(gcry_h, mk, 16, cvalue, 16);
116

cRTrn13's avatar
cRTrn13 committed
117 118 119 120
    for (a = 0; a < 4; a++) {
        mk[a + 12] ^= uv[a];
    }

121 122 123
    gcry_cipher_setkey(gcry_h, mk, 16);
    gcry_cipher_decrypt (gcry_h, dec_vd, 16, vd, 16);
    gcry_cipher_close(gcry_h);
124

cRTrn13's avatar
cRTrn13 committed
125
    if (!memcmp(dec_vd, "\x01\x23\x45\x67\x89\xAB\xCD\xEF", 8)) {
npzacs's avatar
npzacs committed
126
        BD_DEBUG(DBG_AACS, "Processing key %s is valid!\n", str_print_hex(str, pk, 16));
npzacs's avatar
npzacs committed
127
        return AACS_SUCCESS;
cRTrn13's avatar
cRTrn13 committed
128 129
    }

npzacs's avatar
npzacs committed
130
    return AACS_ERROR_NO_PK;
cRTrn13's avatar
cRTrn13 committed
131
}
132

133 134 135 136 137 138
static int _rl_verify_signature(const uint8_t *rl, size_t size)
{
    int    entries = MKINT_BE32(rl + 12 + 8);
    size_t len     = 12 + 12 + 8 * entries; /* type_and_version_rec=12, rl_header=12, rl=entries*8 */

    if (len + 40 > size) {
npzacs's avatar
npzacs committed
139
        BD_DEBUG(DBG_AACS, "revocation list size mismatch\n");
140 141 142 143 144 145
        return 0;
    }

    return crypto_aacs_verify_aacsla(rl + len, rl, len);
}

146 147 148 149 150 151
static void _save_rl(const char *name, uint32_t version, const uint8_t *version_rec,
                     const uint8_t *rl_rec, size_t rl_len)
{
    int len     = MKINT_BE24(rl_rec - 3);
    int entries = MKINT_BE32(rl_rec + 4); /* entries in first signature block */
    if (len < 4 || !entries) {
npzacs's avatar
npzacs committed
152
        BD_DEBUG(DBG_AACS | DBG_CRIT, "ignoring empty %s\n", name);
153 154 155 156 157 158 159 160 161 162 163
        return;
    }

    if (rl_rec && version_rec) {
        rl_rec -= 4;
        rl_len += 4;

        uint8_t *data = malloc(12 + rl_len);
        memcpy(data,      version_rec, 12);
        memcpy(data + 12, rl_rec,      rl_len);
        if (!_rl_verify_signature(data, rl_len + 12)) {
npzacs's avatar
npzacs committed
164
          BD_DEBUG(DBG_AACS | DBG_CRIT, "invalid %s signature, not using it\n", name);
165 166 167 168 169 170 171 172
        } else {
          cache_save(name, version, data, rl_len + 12);
        }
        X_FREE(data);
    }
}

static void _update_rl(MKB *mkb)
173 174 175
{
    uint32_t version = mkb_version(mkb);
    uint32_t cache_version;
176
    size_t   rl_len;
177 178

    if (!cache_get("drl", &cache_version, NULL, NULL) || cache_version < version) {
179 180 181 182 183 184 185 186 187 188 189
        const uint8_t *version_rec = mkb_type_and_version_record(mkb);
        const uint8_t *drl_rec     = mkb_drive_revokation_entries(mkb, &rl_len);
        if (drl_rec && rl_len > 8) {
            _save_rl("drl", version, version_rec, drl_rec, rl_len);
        }
    }
    if (!cache_get("hrl", &cache_version, NULL, NULL) || cache_version < version) {
        const uint8_t *version_rec = mkb_type_and_version_record(mkb);
        const uint8_t *hrl_rec     = mkb_host_revokation_entries(mkb, &rl_len);
        if (hrl_rec && rl_len > 8) {
            _save_rl("hrl", version, version_rec, hrl_rec, rl_len);
190 191 192 193
        }
    }
}

194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232
static uint32_t _calc_v_mask(uint32_t uv)
{
    uint32_t v_mask = 0xffffffff;

    while (!(uv & ~v_mask)) {
        v_mask <<= 1;
    }

    return v_mask;
}

static void _calc_pk(const uint8_t *dk, uint8_t *pk, uint32_t uv, uint32_t v_mask, uint32_t dev_key_v_mask)
{
    unsigned char left_child[16], right_child[16];

    crypto_aesg3(dk, left_child, right_child, pk);

    while (dev_key_v_mask != v_mask) {

        int i;
        for (i = 31; i >= 0; i--) {
            if (!(dev_key_v_mask & (1ul << i))) {
                break;
            }
        }

        uint8_t curr_key[16];
        if (!(uv & (1ul << i))) {
            memcpy(curr_key, left_child, 16);
        } else {
            memcpy(curr_key, right_child, 16);
        }

        crypto_aesg3(curr_key, left_child, right_child, pk);

        dev_key_v_mask = ((int) dev_key_v_mask) >> 1;
    }

    char str[40];
npzacs's avatar
npzacs committed
233
    BD_DEBUG(DBG_AACS, "Processing key: %s\n",  str_print_hex(str, pk, 16));
234 235 236 237 238 239 240 241 242 243 244 245 246
}

static dk_list *_find_dk(dk_list *dkl, uint32_t *p_dev_key_v_mask, uint32_t uv, uint32_t u_mask)
{
    uint32_t device_number = dkl->node;
    uint32_t dev_key_uv, dev_key_u_mask, dev_key_v_mask;
    unsigned key_idx = 0;

    for (; dkl; dkl = dkl->next) {
        if (device_number != dkl->node) {
            /* wrong device */
            continue;
        }
npzacs's avatar
npzacs committed
247 248 249
        if (!dkl->uv) {
            continue;
        }
250 251 252 253 254 255 256 257 258 259 260 261
        key_idx++;
        dev_key_uv     = dkl->uv;
        dev_key_u_mask = 0xffffffff << dkl->u_mask_shift;
        dev_key_v_mask = _calc_v_mask(dev_key_uv);

        if ((u_mask == dev_key_u_mask) &&
            ((uv & dev_key_v_mask) == (dev_key_uv & dev_key_v_mask))) {
            break;
        }
    }

    if (!dkl) {
npzacs's avatar
npzacs committed
262
        BD_DEBUG(DBG_AACS | DBG_CRIT, "could not find applying device key (device 0x%x)\n", device_number);
263 264
    } else {
        char str[128];
npzacs's avatar
npzacs committed
265
        BD_DEBUG(DBG_AACS, "Applying device key is #%d %s\n", key_idx, str_print_hex(str, dkl->key, 16));
npzacs's avatar
npzacs committed
266
        BD_DEBUG(DBG_AACS, "  UV: 0x%08x  U mask: 0x%08x  V mask: 0x%08x\n", dev_key_uv, dev_key_u_mask, dev_key_v_mask);
267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303
        *p_dev_key_v_mask = dev_key_v_mask;
    }

    return dkl;
}

static int _calc_pk_mk(MKB *mkb, dk_list *dkl, uint8_t *mk)
{
    /* calculate processing key and media key using device keys */

    const uint8_t *uvs, *cvalues;
    unsigned num_uvs;
    size_t len;
    char str[128];

    /* get mkb data */

    uvs     = mkb_subdiff_records(mkb, &len);
    cvalues = mkb_cvalues(mkb, &len);
    num_uvs = len / 5;

    if (num_uvs < 1) {
        return AACS_ERROR_CORRUPTED_DISC;
    }

    /* loop over all known devices */

    dk_list *dk_num;
    uint32_t device_number = (uint32_t)-1;

    for (dk_num = dkl; dk_num; dk_num = dk_num->next) {

        /* find next device */

        if (device_number == dk_num->node) {
            continue;
        }
304
        device_number = dk_num->node;
305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320

        /* find applying subset difference */

        unsigned uvs_idx;
        uint32_t u_mask, v_mask, uv;

        for (uvs_idx = 0; uvs_idx < num_uvs; uvs_idx++) {
            const uint8_t *p_uv = uvs + 1 + 5 * uvs_idx;
            uint8_t u_mask_shift = p_uv[-1];

            uv = MKINT_BE32(p_uv);
            if (!uv) {
                continue;
            }

            if (u_mask_shift & 0xc0) {
npzacs's avatar
npzacs committed
321
                BD_DEBUG(DBG_AACS | DBG_CRIT, "device 0x%x is revoked\n", device_number);
322 323 324 325 326 327 328 329 330 331 332 333 334 335
                uvs_idx = num_uvs;

            } else {

                u_mask = 0xffffffff << u_mask_shift;
                v_mask = _calc_v_mask(uv);

                if (((device_number & u_mask) == (uv & u_mask)) && ((device_number & v_mask) != (uv & v_mask))) {
                    break;
                }
            }
        }

        if (uvs_idx >= num_uvs) {
npzacs's avatar
npzacs committed
336
            BD_DEBUG(DBG_AACS | DBG_CRIT, "could not find applying subset-difference for device 0x%x\n", device_number);
337 338 339 340
            /* try next device */
            continue;
        }

npzacs's avatar
npzacs committed
341 342
        BD_DEBUG(DBG_AACS, "Applying subset-difference for device 0x%x is #%d:\n", device_number, uvs_idx);
        BD_DEBUG(DBG_AACS,"  UV: 0x%08x  U mask: 0x%08x  V mask: 0x%08x\n", uv, u_mask, v_mask);
343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368

        /* find applying device key */

        uint32_t dev_key_v_mask = 0;
        dk_list *dk;

        dk = _find_dk(dk_num, &dev_key_v_mask, uv, u_mask);
        if (!dk) {
            /* try next device */
            continue;
        }

        /* calculate processing key */

        uint8_t pk[16];
        _calc_pk(dk->key, pk, uv, v_mask, dev_key_v_mask);

        /* calculate and verify media key */

        if ( _validate_pk(pk,
                          cvalues + uvs_idx * 16,
                          uvs + 1 + uvs_idx * 5,
                          mkb_mk_dv(mkb),
                          mk)
             == AACS_SUCCESS) {

npzacs's avatar
npzacs committed
369
            BD_DEBUG(DBG_AACS, "Media key: %s\n", str_print_hex(str, mk, 16));
370 371 372
            return AACS_SUCCESS;
        }

npzacs's avatar
npzacs committed
373
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Processing key %s is invalid!\n", str_print_hex(str, pk, 16));
374 375 376 377 378 379 380

        /* try next device */
    }

    return AACS_ERROR_NO_DK;
}

npzacs's avatar
npzacs committed
381 382 383 384 385
static AACS_FILE_H *_file_open(AACS *aacs, const char *file)
{
    AACS_FILE_H *fp;
    char        *f_name;

npzacs's avatar
npzacs committed
386 387 388
    if (aacs->fopen) {
        return aacs->fopen(aacs->fopen_handle, file);
    }
npzacs's avatar
npzacs committed
389 390 391
    if (!aacs->path) {
        return NULL;
    }
npzacs's avatar
npzacs committed
392

npzacs's avatar
npzacs committed
393
    f_name = str_printf("%s" DIR_SEP "%s", aacs->path, file);
npzacs's avatar
npzacs committed
394 395 396
    if (!f_name) {
        return NULL;
    }
npzacs's avatar
npzacs committed
397 398 399 400 401 402
    fp = file_open(f_name, "rb");
    X_FREE(f_name);

    return fp;
}

npzacs's avatar
npzacs committed
403 404 405 406
static size_t _read_file(AACS *aacs, const char *file, void **data)
{
    AACS_FILE_H *fp = NULL;
    int64_t f_size;
npzacs's avatar
npzacs committed
407
    size_t size;
npzacs's avatar
npzacs committed
408 409 410 411 412 413 414 415 416

    *data = NULL;

    fp = _file_open(aacs, file);
    if (!fp) {
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Unable to open %s\n", file);
        return 0;
    }

npzacs's avatar
npzacs committed
417
    f_size = file_size(fp);
npzacs's avatar
npzacs committed
418 419 420
    size = f_size;
    if (f_size <= 0 || f_size != (int64_t)size) {
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Invalid size %"PRId64" for %s\n", f_size, file);
npzacs's avatar
npzacs committed
421 422 423
        file_close(fp);
        return 0;
    }
npzacs's avatar
npzacs committed
424

npzacs's avatar
npzacs committed
425
    *data = malloc(size);
npzacs's avatar
npzacs committed
426 427 428 429 430 431 432 433 434 435 436
    if (*data) {
        if (file_read(fp, *data, f_size) != f_size) {
            BD_DEBUG(DBG_AACS | DBG_CRIT, "Failed reading %s\n", file);
            X_FREE(*data);
        }
    } else {
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Out of memory\n");
    }

    file_close(fp);

npzacs's avatar
npzacs committed
437
    return *data ? size : 0;
npzacs's avatar
npzacs committed
438 439
}

npzacs's avatar
npzacs committed
440 441
static MKB *_mkb_open(AACS *aacs)
{
npzacs's avatar
npzacs committed
442 443 444
    size_t  size;
    void   *data;
    MKB    *mkb;
npzacs's avatar
npzacs committed
445

npzacs's avatar
npzacs committed
446 447 448 449
    size = _read_file(aacs, "AACS" DIR_SEP "MKB_RO.inf", &data);
    if (size < 4) {
        X_FREE(data);
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Error reading MKB file (AACS/MKB_RO.inf)\n");
npzacs's avatar
npzacs committed
450 451 452
        return NULL;
    }

npzacs's avatar
npzacs committed
453 454 455 456
    mkb = mkb_init(data, size);
    if (!mkb) {
        X_FREE(data);
    }
npzacs's avatar
npzacs committed
457 458 459
    return mkb;
}

460
static int _calc_mk(AACS *aacs, uint8_t *mk, pk_list *pkl, dk_list *dkl)
cRTrn13's avatar
keyfile  
cRTrn13 committed
461 462 463 464
{
    int a, num_uvs = 0;
    size_t len;
    MKB *mkb = NULL;
465
    const uint8_t *rec, *uvs;
cRTrn13's avatar
keyfile  
cRTrn13 committed
466

467
    /* Skip if retrieved from config file */
468 469 470
    if (memcmp(mk, empty_key, 16)) {
        return AACS_SUCCESS;
    }
471

npzacs's avatar
npzacs committed
472
    BD_DEBUG(DBG_AACS, "Calculate media key...\n");
cRTrn13's avatar
cRTrn13 committed
473

npzacs's avatar
npzacs committed
474
    if ((mkb = _mkb_open(aacs))) {
475

npzacs's avatar
npzacs committed
476
        aacs->mkb_version = mkb_version(mkb);
477
        _update_rl(mkb);
478 479 480

        /* try device keys first */
        if (dkl && _calc_pk_mk(mkb, dkl, mk) == AACS_SUCCESS) {
npzacs's avatar
npzacs committed
481
            memcpy(aacs->mk, mk, sizeof(aacs->mk));
482 483 484 485
            mkb_close(mkb);
            return AACS_SUCCESS;
        }

npzacs's avatar
npzacs committed
486
        BD_DEBUG(DBG_AACS, "Get UVS...\n");
487 488 489 490 491 492 493 494
        uvs = mkb_subdiff_records(mkb, &len);
        rec = uvs;
        while (rec < uvs + len) {
            if (rec[0] & 0xc0)
                break;
            rec += 5;
            num_uvs++;
        }
cRTrn13's avatar
keyfile  
cRTrn13 committed
495

npzacs's avatar
npzacs committed
496
        BD_DEBUG(DBG_AACS, "Get cvalues...\n");
497
        rec = mkb_cvalues(mkb, &len);
498

npzacs's avatar
npzacs committed
499
        for (; pkl; pkl = pkl->next) {
npzacs's avatar
npzacs committed
500
                BD_DEBUG(DBG_AACS, "Trying processing key...\n");
501 502

                for (a = 0; a < num_uvs; a++) {
npzacs's avatar
npzacs committed
503
                    if (AACS_SUCCESS == _validate_pk(pkl->key, rec + a * 16, uvs + 1 + a * 5,
504
                      mkb_mk_dv(mkb), mk)) {
505
                        mkb_close(mkb);
506

507
                        char str[40];
npzacs's avatar
npzacs committed
508
                        BD_DEBUG(DBG_AACS, "Media key: %s\n", str_print_hex(str, mk, 16));
npzacs's avatar
npzacs committed
509
                        memcpy(aacs->mk, mk, sizeof(aacs->mk));
npzacs's avatar
npzacs committed
510
                        return AACS_SUCCESS;
511 512
                    }
                }
cRTrn13's avatar
keyfile  
cRTrn13 committed
513 514
            }

515
        mkb_close(mkb);
cRTrn13's avatar
keyfile  
cRTrn13 committed
516

npzacs's avatar
npzacs committed
517
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Error calculating media key. Missing right processing key ?\n");
npzacs's avatar
npzacs committed
518
        return AACS_ERROR_NO_PK;
npzacs's avatar
npzacs committed
519
    }
npzacs's avatar
npzacs committed
520

npzacs's avatar
npzacs committed
521
    return AACS_ERROR_CORRUPTED_DISC;
cRTrn13's avatar
keyfile  
cRTrn13 committed
522
}
523

npzacs's avatar
npzacs committed
524
static int _mmc_read_auth(AACS *aacs, cert_list *hcl, int type, uint8_t *p1, uint8_t *p2)
cRTrn13's avatar
openssl  
cRTrn13 committed
525
{
cRTrn13's avatar
cRTrn13 committed
526
    MMC* mmc = NULL;
npzacs's avatar
npzacs committed
527
    if (!(mmc = mmc_open(aacs->path))) {
npzacs's avatar
npzacs committed
528
        return AACS_ERROR_MMC_OPEN;
529 530
    }

npzacs's avatar
npzacs committed
531 532
    int error_code = AACS_ERROR_NO_CERT;

533
    const uint8_t *drive_cert = mmc_get_drive_cert(mmc);
534

npzacs's avatar
npzacs committed
535
    for (; hcl ; hcl = hcl->next) {
536 537 538

        char tmp_str[2*92+1];

npzacs's avatar
npzacs committed
539
        if (!crypto_aacs_verify_host_cert(hcl->host_cert)) {
npzacs's avatar
npzacs committed
540
            BD_DEBUG(DBG_AACS, "Not using invalid host certificate %s.\n",
npzacs's avatar
npzacs committed
541
                  str_print_hex(tmp_str, hcl->host_cert, 92));
npzacs's avatar
npzacs committed
542 543
            continue;
        }
544

npzacs's avatar
npzacs committed
545
        if (drive_cert && (drive_cert[1] & 0x01) && !(hcl->host_cert[1] & 0x01)) {
npzacs's avatar
npzacs committed
546
            BD_DEBUG(DBG_AACS, "Certificate (id 0x%s) does not support bus encryption\n",
npzacs's avatar
npzacs committed
547
                  str_print_hex(tmp_str, hcl->host_cert + 4, 6));
548 549 550
            //continue;
        }

npzacs's avatar
npzacs committed
551
        BD_DEBUG(DBG_AACS, "Trying host certificate (id 0x%s)...\n",
npzacs's avatar
npzacs committed
552
              str_print_hex(tmp_str, hcl->host_cert + 4, 6));
553

npzacs's avatar
npzacs committed
554
        int mmc_result = mmc_read_auth(mmc, hcl->host_priv_key, hcl->host_cert, type, p1, p2);
npzacs's avatar
npzacs committed
555 556 557 558 559 560 561 562 563 564 565
        switch (mmc_result) {
            case MMC_SUCCESS:
                mmc_close(mmc);
                return AACS_SUCCESS;
            case MMC_ERROR_CERT_REVOKED:
                error_code = AACS_ERROR_CERT_REVOKED;
                break;
            case MMC_ERROR:
            default:
                error_code = AACS_ERROR_MMC_FAILURE;
                break;
566 567 568 569 570
        }
    }

    mmc_close(mmc);

npzacs's avatar
npzacs committed
571
    return error_code;
572
}
cRTrn13's avatar
openssl  
cRTrn13 committed
573

npzacs's avatar
npzacs committed
574
static int _read_vid(AACS *aacs, cert_list *hcl)
575
{
npzacs's avatar
npzacs committed
576 577 578
    /* Use VID given in config file if available */
    if (memcmp(aacs->vid, empty_key, 16)) {
        return AACS_SUCCESS;
579 580
    }

npzacs's avatar
npzacs committed
581 582
    int error_code = _mmc_read_auth(aacs, hcl, MMC_READ_VID, aacs->vid, NULL);
    if (error_code != AACS_SUCCESS) {
npzacs's avatar
npzacs committed
583
        BD_DEBUG(DBG_AACS, "Error reading VID!\n");
npzacs's avatar
npzacs committed
584 585 586
    } else {
        /* cache vid */
        keycache_save("vid", aacs->disc_id, aacs->vid, 16);
587 588 589 590
    }
    return error_code;
}

npzacs's avatar
npzacs committed
591
static int _read_read_data_key(AACS *aacs, cert_list *hcl)
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
592
{
npzacs's avatar
npzacs committed
593 594
    int error_code = _mmc_read_auth(aacs, hcl, MMC_READ_DATA_KEYS, aacs->read_data_key, NULL);
    if (error_code != AACS_SUCCESS) {
npzacs's avatar
npzacs committed
595
        BD_DEBUG(DBG_AACS, "Error reading data keys!\n");
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
596
    }
npzacs's avatar
npzacs committed
597 598
    return error_code;
}
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
599

npzacs's avatar
npzacs committed
600 601 602 603
static int _read_pmsn(AACS *aacs, cert_list *hcl)
{
    int error_code = _mmc_read_auth(aacs, hcl, MMC_READ_PMSN, aacs->pmsn, NULL);
    if (error_code != AACS_SUCCESS) {
npzacs's avatar
npzacs committed
604
        BD_DEBUG(DBG_AACS, "Error reading PMSN!\n");
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
605 606 607 608
    }
    return error_code;
}

609
static int _calc_vuk(AACS *aacs, uint8_t *mk, uint8_t *vuk, config_file *cf)
610
{
npzacs's avatar
npzacs committed
611 612
    int error_code;

613
    /* Skip if retrieved from config file */
614
    if (memcmp(vuk, empty_key, 16)) {
npzacs's avatar
npzacs committed
615
        BD_DEBUG(DBG_AACS, "Using VUK from config file\n");
npzacs's avatar
npzacs committed
616 617
        return AACS_SUCCESS;
    }
618

npzacs's avatar
npzacs committed
619
    /* get cached vuk */
620
    if (keycache_find("vuk", aacs->disc_id, vuk, 16)) {
npzacs's avatar
npzacs committed
621
        BD_DEBUG(DBG_AACS, "Using cached VUK\n");
npzacs's avatar
npzacs committed
622
        return AACS_SUCCESS;
npzacs's avatar
npzacs committed
623 624
    }

625 626 627 628
    if (!cf) {
        return AACS_ERROR_NO_CONFIG;
    }

629
    /* make sure we have media key */
630
    error_code = _calc_mk(aacs, mk, cf->pkl, cf->dkl);
npzacs's avatar
npzacs committed
631 632
    if (error_code != AACS_SUCCESS) {
        return error_code;
633 634
    }

npzacs's avatar
npzacs committed
635
    /* acquire VID */
636
    error_code = _read_vid(aacs, cf->host_cert_list);
npzacs's avatar
npzacs committed
637 638 639
    if (error_code != AACS_SUCCESS) {
        return error_code;
    }
640

npzacs's avatar
npzacs committed
641
    /* calculate VUK */
642

npzacs's avatar
npzacs committed
643
    crypto_aes128d(mk, aacs->vid, vuk);
644

npzacs's avatar
npzacs committed
645
    int a;
npzacs's avatar
npzacs committed
646
    for (a = 0; a < 16; a++) {
647
        vuk[a] ^= aacs->vid[a];
npzacs's avatar
npzacs committed
648
    }
649

npzacs's avatar
npzacs committed
650
    char str[40];
npzacs's avatar
npzacs committed
651
    BD_DEBUG(DBG_AACS, "Volume unique key: %s\n", str_print_hex(str, vuk, 16));
652

npzacs's avatar
npzacs committed
653
    /* cache vuk */
654
    keycache_save("vuk", aacs->disc_id, vuk, 16);
npzacs's avatar
npzacs committed
655

npzacs's avatar
npzacs committed
656
    return AACS_SUCCESS;
cRTrn13's avatar
openssl  
cRTrn13 committed
657 658
}

659 660
static uint16_t _read_u16(AACS_FILE_H *fp)
{
npzacs's avatar
npzacs committed
661
  uint8_t data[2] = {0, 0};
662 663 664 665 666 667 668 669 670 671 672

  file_read(fp, data, sizeof(uint16_t));

  return MKINT_BE16(data);
}

static void _read_uks_map(AACS *aacs, AACS_FILE_H *fp)
{
    uint16_t first_play, top_menu;
    unsigned i;

npzacs's avatar
npzacs committed
673
    BD_DEBUG(DBG_AACS, "Assigning CPS units to titles ...\n");
674 675 676 677 678 679 680 681 682

    X_FREE(aacs->cps_units);
    aacs->current_cps_unit = 0;

    file_seek(fp, 16 + 4, SEEK_SET);

    first_play = _read_u16(fp);
    top_menu   = _read_u16(fp);

npzacs's avatar
npzacs committed
683 684
    BD_DEBUG(DBG_AACS, "Title FP : CPS unit %d\n", first_play);
    BD_DEBUG(DBG_AACS, "Title TM : CPS unit %d\n", top_menu);
685 686 687 688 689 690 691 692 693

    aacs->num_titles   = _read_u16(fp);
    aacs->cps_units    = calloc(sizeof(uint16_t), aacs->num_titles + 2);
    aacs->cps_units[0] = first_play;
    aacs->cps_units[1] = top_menu;

    for (i = 2; i < aacs->num_titles + 2; i++) {
        _read_u16(fp); /* reserved */
        aacs->cps_units[i] = _read_u16(fp);
npzacs's avatar
npzacs committed
694
        BD_DEBUG(DBG_AACS, "Title %02d : CPS unit %d\n", i - 1, aacs->cps_units[i]);
695 696 697 698 699 700 701
    }

    /* validate */
    for (i = 0; i < aacs->num_titles + 2; i++) {
        if (aacs->cps_units[i])
            aacs->cps_units[i]--; /* number [1...N] --> index [0...N-1] */
        if (aacs->cps_units[i] >= aacs->num_uks) {
npzacs's avatar
npzacs committed
702
            BD_DEBUG(DBG_AACS, " *** Invalid CPS unit for title %d: %d !\n", (int) i - 1, aacs->cps_units[i]);
703 704 705 706 707
            aacs->cps_units[i] = 0;
        }
    }
}

npzacs's avatar
npzacs committed
708
/* Function that collects keys from keydb config entry */
709 710
static void _find_config_entry(AACS *aacs, title_entry_list *ce,
                               uint8_t *mk, uint8_t *vuk)
npzacs's avatar
npzacs committed
711 712
{
    char str[48];
713
    char str2[48];
npzacs's avatar
npzacs committed
714 715 716 717 718

    aacs->uks = NULL;
    aacs->num_uks = 0;

        while (ce && ce->entry.discid) {
npzacs's avatar
npzacs committed
719
            if (!memcmp(aacs->disc_id, ce->entry.discid, 20)) {
npzacs's avatar
npzacs committed
720
                BD_DEBUG(DBG_AACS, "Found config entry for discid %s\n",
npzacs's avatar
npzacs committed
721
                      str_print_hex(str, ce->entry.discid, 20));
npzacs's avatar
npzacs committed
722 723 724 725 726 727 728 729 730 731
                break;
            }

            ce = ce->next;
        }
        if (!ce) {
            return;
        }

        if (ce->entry.mek) {
732
            hexstring_to_hex_array(mk, 16, ce->entry.mek);
npzacs's avatar
npzacs committed
733

npzacs's avatar
npzacs committed
734
            BD_DEBUG(DBG_AACS, "Found media key for %s: %s\n",
735
                  str_print_hex(str2, ce->entry.discid, 20), str_print_hex(str, mk, 16));
npzacs's avatar
npzacs committed
736 737 738 739 740 741
        }

        if (ce->entry.vid) {
            hexstring_to_hex_array(aacs->vid, sizeof(aacs->vid),
                                    ce->entry.vid);

npzacs's avatar
npzacs committed
742
            BD_DEBUG(DBG_AACS, "Found volume id for %s: %s\n",
743
                  str_print_hex(str2, ce->entry.discid, 20), str_print_hex(str, aacs->vid, 16));
npzacs's avatar
npzacs committed
744 745 746
        }

        if (ce->entry.vuk) {
747
            hexstring_to_hex_array(vuk, 16, ce->entry.vuk);
npzacs's avatar
npzacs committed
748

npzacs's avatar
npzacs committed
749
            BD_DEBUG(DBG_AACS, "Found volume unique key for %s: %s\n",
750
                  str_print_hex(str2, ce->entry.discid, 20), str_print_hex(str, vuk, 16));
npzacs's avatar
npzacs committed
751 752 753
        }

        if (ce->entry.uk) {
npzacs's avatar
npzacs committed
754
            BD_DEBUG(DBG_AACS, "Acquire CPS unit keys from keydb config file...\n");
npzacs's avatar
npzacs committed
755 756 757 758 759 760 761 762 763

            digit_key_pair_list *ukcursor = ce->entry.uk;
            while (ukcursor && ukcursor->key_pair.key) {
                aacs->num_uks++;

                aacs->uks = (uint8_t*)realloc(aacs->uks, 16 * aacs->num_uks);
                hexstring_to_hex_array(aacs->uks + (16 * (aacs->num_uks - 1)), 16,
                                      ukcursor->key_pair.key);

npzacs's avatar
npzacs committed
764
                BD_DEBUG(DBG_AACS, "Unit key %d from keydb entry: %s\n",
npzacs's avatar
npzacs committed
765
                      aacs->num_uks,
npzacs's avatar
npzacs committed
766
                      str_print_hex(str, aacs->uks + (16 * (aacs->num_uks - 1)), 16));
npzacs's avatar
npzacs committed
767 768 769 770 771 772

                ukcursor = ukcursor->next;
            }
        }
}

773
static int _calc_uks(AACS *aacs, config_file *cf)
cRTrn13's avatar
openssl  
cRTrn13 committed
774
{
775
    AACS_FILE_H *fp = NULL;
776
    uint8_t  buf[16];
777
    uint64_t f_pos;
778
    unsigned int i;
npzacs's avatar
npzacs committed
779
    int error_code;
cRTrn13's avatar
openssl  
cRTrn13 committed
780

781 782
    uint8_t mk[16] = {0}, vuk[16] = {0};

783
    if (cf) {
npzacs's avatar
npzacs committed
784
        BD_DEBUG(DBG_AACS, "Searching for keydb config entry...\n");
785
        _find_config_entry(aacs, cf->list, mk, vuk);
786

787 788 789 790
        /* Skip if retrieved from config file */
        if (aacs->uks) {
            return AACS_SUCCESS;
        }
791
    }
792

793
    /* Make sure we have VUK */
794
    error_code = _calc_vuk(aacs, mk, vuk, cf);
npzacs's avatar
npzacs committed
795 796
    if (error_code != AACS_SUCCESS) {
        return error_code;
797
    }
798

npzacs's avatar
npzacs committed
799
    BD_DEBUG(DBG_AACS, "Calculate CPS unit keys...\n");
800

npzacs's avatar
npzacs committed
801
    fp = _file_open(aacs, "AACS" DIR_SEP "Unit_Key_RO.inf");
npzacs's avatar
npzacs committed
802
    if (!fp) {
npzacs's avatar
npzacs committed
803
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Error opening unit key file (AACS/Unit_Key_RO.inf)\n");
npzacs's avatar
npzacs committed
804 805
        return AACS_ERROR_CORRUPTED_DISC;
    }
cRTrn13's avatar
openssl  
cRTrn13 committed
806

npzacs's avatar
npzacs committed
807 808
    if ((file_read(fp, buf, 4)) == 4) {
        f_pos = MKINT_BE32(buf);
npzacs's avatar
npzacs committed
809

npzacs's avatar
npzacs committed
810 811 812 813
        // Read number of keys
        file_seek(fp, f_pos, SEEK_SET);
        if ((file_read(fp, buf, 2)) == 2) {
            aacs->num_uks = MKINT_BE16(buf);
npzacs's avatar
npzacs committed
814

npzacs's avatar
npzacs committed
815 816
            X_FREE(aacs->uks);
            aacs->uks = calloc(aacs->num_uks, 16);
npzacs's avatar
npzacs committed
817

npzacs's avatar
npzacs committed
818
            BD_DEBUG(DBG_AACS, "%d CPS unit keys\n", aacs->num_uks);
npzacs's avatar
npzacs committed
819

npzacs's avatar
npzacs committed
820 821
        } else {
            aacs->num_uks = 0;
npzacs's avatar
npzacs committed
822
            BD_DEBUG(DBG_AACS | DBG_CRIT, "Error reading number of unit keys\n");
npzacs's avatar
npzacs committed
823 824
            error_code = AACS_ERROR_CORRUPTED_DISC;
        }
cRTrn13's avatar
openssl  
cRTrn13 committed
825

npzacs's avatar
npzacs committed
826 827 828
        // Read keys
        for (i = 0; i < aacs->num_uks; i++) {
            f_pos += 48;
cRTrn13's avatar
openssl  
cRTrn13 committed
829

npzacs's avatar
npzacs committed
830 831
            file_seek(fp, f_pos, SEEK_SET);
            if ((file_read(fp, buf, 16)) != 16) {
npzacs's avatar
npzacs committed
832
                BD_DEBUG(DBG_AACS, "Unit key %d: read error\n", i);
npzacs's avatar
npzacs committed
833 834 835
                aacs->num_uks = i;
                error_code = AACS_ERROR_CORRUPTED_DISC;
                break;
npzacs's avatar
npzacs committed
836
            }
cRTrn13's avatar
openssl  
cRTrn13 committed
837

npzacs's avatar
npzacs committed
838
            crypto_aes128d(vuk, buf, aacs->uks + 16*i);
cRTrn13's avatar
openssl  
cRTrn13 committed
839

npzacs's avatar
npzacs committed
840
            char str[40];
npzacs's avatar
npzacs committed
841
            BD_DEBUG(DBG_AACS, "Unit key %d: %s\n", i,
npzacs's avatar
npzacs committed
842
                  str_print_hex(str, aacs->uks + 16*i, 16));
843 844
        }

npzacs's avatar
npzacs committed
845 846 847
        /* failing next is not fatal, it just slows down things */
        _read_uks_map(aacs, fp);

848
        file_close(fp);
cRTrn13's avatar
openssl  
cRTrn13 committed
849

npzacs's avatar
npzacs committed
850 851 852 853 854
        return error_code;
    }

    file_close(fp);

npzacs's avatar
npzacs committed
855
    BD_DEBUG(DBG_AACS | DBG_CRIT, "Error reading unit keys\n");
npzacs's avatar
npzacs committed
856
    return AACS_ERROR_CORRUPTED_DISC;
cRTrn13's avatar
openssl  
cRTrn13 committed
857 858
}

npzacs's avatar
npzacs committed
859
static int _calc_title_hash(AACS *aacs)
860
{
npzacs's avatar
npzacs committed
861 862
    void    *data;
    size_t   size;
863
    char     str[48];
npzacs's avatar
npzacs committed
864
    int      result = AACS_SUCCESS;
865

npzacs's avatar
npzacs committed
866
    size = _read_file(aacs, "AACS" DIR_SEP "Unit_Key_RO.inf", &data);
867 868 869 870
    if (!size) {
        size = _read_file(aacs, "AACS" DIR_SEP "DUPLICATE" DIR_SEP "Unit_Key_RO.inf", &data);
    }

npzacs's avatar
npzacs committed
871 872
    if (size) {
        crypto_aacs_title_hash(data, size, aacs->disc_id);
npzacs's avatar
npzacs committed
873
        BD_DEBUG(DBG_AACS, "Disc ID: %s\n", str_print_hex(str, aacs->disc_id, 20));
npzacs's avatar
npzacs committed
874
        X_FREE(data);
cRTrn13's avatar
cRTrn13 committed
875

npzacs's avatar
npzacs committed
876 877
    } else {
        result = AACS_ERROR_CORRUPTED_DISC;
npzacs's avatar
npzacs committed
878
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Failed to read %lu bytes from unit key file (AACS/Unit_Key_RO.inf)", (unsigned long)size);
879 880
    }

npzacs's avatar
npzacs committed
881
    return result;
882
}
cRTrn13's avatar
cRTrn13 committed