aacs.c 37.2 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, 0) || cache_version < version) {
179 180 181 182 183 184
        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);
        }
    }
185
    if (!cache_get("hrl", &cache_version, NULL, NULL, 0) || cache_version < version) {
186 187 188 189
        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
        *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) {
289
        BD_DEBUG(DBG_AACS | DBG_CRIT, "No UVS detected - corrupted disc\n");
290 291 292 293 294 295 296 297 298 299 300 301 302 303 304
        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;
        }
305
        device_number = dk_num->node;
306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321

        /* 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
322
                BD_DEBUG(DBG_AACS | DBG_CRIT, "device 0x%x is revoked\n", device_number);
323 324 325 326 327 328 329 330 331 332 333 334 335 336
                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
337
            BD_DEBUG(DBG_AACS | DBG_CRIT, "could not find applying subset-difference for device 0x%x\n", device_number);
338 339 340 341
            /* try next device */
            continue;
        }

npzacs's avatar
npzacs committed
342 343
        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);
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 369

        /* 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
370
            BD_DEBUG(DBG_AACS, "Media key: %s\n", str_print_hex(str, mk, 16));
371 372 373
            return AACS_SUCCESS;
        }

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

        /* try next device */
    }

    return AACS_ERROR_NO_DK;
}

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

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

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

    return fp;
}

npzacs's avatar
npzacs committed
404 405 406 407
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
408
    size_t size;
npzacs's avatar
npzacs committed
409 410 411 412 413 414 415 416 417

    *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
418
    f_size = file_size(fp);
npzacs's avatar
npzacs committed
419 420 421
    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
422 423 424
        file_close(fp);
        return 0;
    }
npzacs's avatar
npzacs committed
425

npzacs's avatar
npzacs committed
426
    *data = malloc(size);
npzacs's avatar
npzacs committed
427 428 429 430 431 432 433 434 435 436 437
    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
438
    return *data ? size : 0;
npzacs's avatar
npzacs committed
439 440
}

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

npzacs's avatar
npzacs committed
447 448 449 450
    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
451 452 453
        return NULL;
    }

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

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

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

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

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

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

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

npzacs's avatar
npzacs committed
487
        BD_DEBUG(DBG_AACS, "Get UVS...\n");
488 489 490 491 492 493 494 495
        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
496

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

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

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

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

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

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

522
    BD_DEBUG(DBG_AACS | DBG_CRIT, "Error calculating media key - corrupted disc\n");
npzacs's avatar
npzacs committed
523
    return AACS_ERROR_CORRUPTED_DISC;
cRTrn13's avatar
keyfile  
cRTrn13 committed
524
}
525

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

npzacs's avatar
npzacs committed
533 534
    int error_code = AACS_ERROR_NO_CERT;

535
    const uint8_t *drive_cert = mmc_get_drive_cert(mmc);
536

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

        char tmp_str[2*92+1];

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

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

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

npzacs's avatar
npzacs committed
556
        int mmc_result = mmc_read_auth(mmc, hcl->host_priv_key, hcl->host_cert, type, p1, p2);
npzacs's avatar
npzacs committed
557 558 559 560 561 562 563 564 565 566 567
        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;
568 569 570 571 572
        }
    }

    mmc_close(mmc);

npzacs's avatar
npzacs committed
573
    return error_code;
574
}
cRTrn13's avatar
openssl  
cRTrn13 committed
575

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

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

npzacs's avatar
npzacs committed
593
static int _read_read_data_key(AACS *aacs, cert_list *hcl)
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
594
{
npzacs's avatar
npzacs committed
595 596
    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
597
        BD_DEBUG(DBG_AACS, "Error reading data keys!\n");
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
598
    }
npzacs's avatar
npzacs committed
599 600
    return error_code;
}
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
601

npzacs's avatar
npzacs committed
602 603 604 605
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
606
        BD_DEBUG(DBG_AACS, "Error reading PMSN!\n");
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
607 608 609 610
    }
    return error_code;
}

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

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

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

627 628 629 630
    if (!cf) {
        return AACS_ERROR_NO_CONFIG;
    }

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

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

npzacs's avatar
npzacs committed
643
    /* calculate VUK */
644

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

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

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

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

npzacs's avatar
npzacs committed
658
    return AACS_SUCCESS;
cRTrn13's avatar
openssl  
cRTrn13 committed
659 660
}

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

  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
675
    BD_DEBUG(DBG_AACS, "Assigning CPS units to titles ...\n");
676 677 678 679 680 681 682 683 684

    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
685 686
    BD_DEBUG(DBG_AACS, "Title FP : CPS unit %d\n", first_play);
    BD_DEBUG(DBG_AACS, "Title TM : CPS unit %d\n", top_menu);
687 688 689 690 691 692 693 694 695

    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
696
        BD_DEBUG(DBG_AACS, "Title %02d : CPS unit %d\n", i - 1, aacs->cps_units[i]);
697 698 699 700 701 702 703
    }

    /* 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
704
            BD_DEBUG(DBG_AACS, " *** Invalid CPS unit for title %d: %d !\n", (int) i - 1, aacs->cps_units[i]);
705 706 707 708 709
            aacs->cps_units[i] = 0;
        }
    }
}

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

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

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

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

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

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

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

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

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

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

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

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

                ukcursor = ukcursor->next;
            }
        }
}

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

783 784
    uint8_t mk[16] = {0}, vuk[16] = {0};

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

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

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

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

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

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

npzacs's avatar
npzacs committed
812 813 814 815
        // 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
816

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

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

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

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

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

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

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

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

850
        file_close(fp);
cRTrn13's avatar
openssl  
cRTrn13 committed
851

npzacs's avatar
npzacs committed
852 853 854 855 856
        return error_code;
    }

    file_close(fp);

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

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

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

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

npzacs's avatar
npzacs committed