aacs.c 36.6 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 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434
static size_t _read_file(AACS *aacs, const char *file, void **data)
{
    AACS_FILE_H *fp = NULL;
    int64_t f_size;

    *data = NULL;

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

    file_seek(fp, 0, SEEK_END);
    f_size = file_tell(fp);
    file_seek(fp, 0, SEEK_SET);

    *data = malloc(f_size);
    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);

    return *data ? f_size : 0;
}

npzacs's avatar
npzacs committed
435 436
static MKB *_mkb_open(AACS *aacs)
{
npzacs's avatar
npzacs committed
437 438 439
    size_t  size;
    void   *data;
    MKB    *mkb;
npzacs's avatar
npzacs committed
440

npzacs's avatar
npzacs committed
441 442 443 444
    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
445 446 447
        return NULL;
    }

npzacs's avatar
npzacs committed
448 449 450 451
    mkb = mkb_init(data, size);
    if (!mkb) {
        X_FREE(data);
    }
npzacs's avatar
npzacs committed
452 453 454
    return mkb;
}

455
static int _calc_mk(AACS *aacs, uint8_t *mk, pk_list *pkl, dk_list *dkl)
cRTrn13's avatar
keyfile  
cRTrn13 committed
456 457 458 459
{
    int a, num_uvs = 0;
    size_t len;
    MKB *mkb = NULL;
460
    const uint8_t *rec, *uvs;
cRTrn13's avatar
keyfile  
cRTrn13 committed
461

462
    /* Skip if retrieved from config file */
463 464 465
    if (memcmp(mk, empty_key, 16)) {
        return AACS_SUCCESS;
    }
466

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

npzacs's avatar
npzacs committed
469
    if ((mkb = _mkb_open(aacs))) {
470

npzacs's avatar
npzacs committed
471
        aacs->mkb_version = mkb_version(mkb);
472
        _update_rl(mkb);
473 474 475

        /* try device keys first */
        if (dkl && _calc_pk_mk(mkb, dkl, mk) == AACS_SUCCESS) {
npzacs's avatar
npzacs committed
476
            memcpy(aacs->mk, mk, sizeof(aacs->mk));
477 478 479 480
            mkb_close(mkb);
            return AACS_SUCCESS;
        }

npzacs's avatar
npzacs committed
481
        BD_DEBUG(DBG_AACS, "Get UVS...\n");
482 483 484 485 486 487 488 489
        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
490

npzacs's avatar
npzacs committed
491
        BD_DEBUG(DBG_AACS, "Get cvalues...\n");
492
        rec = mkb_cvalues(mkb, &len);
493

npzacs's avatar
npzacs committed
494
        for (; pkl; pkl = pkl->next) {
npzacs's avatar
npzacs committed
495
                BD_DEBUG(DBG_AACS, "Trying processing key...\n");
496 497

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

502
                        char str[40];
npzacs's avatar
npzacs committed
503
                        BD_DEBUG(DBG_AACS, "Media key: %s\n", str_print_hex(str, mk, 16));
npzacs's avatar
npzacs committed
504
                        memcpy(aacs->mk, mk, sizeof(aacs->mk));
npzacs's avatar
npzacs committed
505
                        return AACS_SUCCESS;
506 507
                    }
                }
cRTrn13's avatar
keyfile  
cRTrn13 committed
508 509
            }

510
        mkb_close(mkb);
cRTrn13's avatar
keyfile  
cRTrn13 committed
511

npzacs's avatar
npzacs committed
512
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Error calculating media key. Missing right processing key ?\n");
npzacs's avatar
npzacs committed
513
        return AACS_ERROR_NO_PK;
npzacs's avatar
npzacs committed
514
    }
npzacs's avatar
npzacs committed
515

npzacs's avatar
npzacs committed
516
    return AACS_ERROR_CORRUPTED_DISC;
cRTrn13's avatar
keyfile  
cRTrn13 committed
517
}
518

npzacs's avatar
npzacs committed
519
static int _mmc_read_auth(AACS *aacs, cert_list *hcl, int type, uint8_t *p1, uint8_t *p2)
cRTrn13's avatar
openssl  
cRTrn13 committed
520
{
cRTrn13's avatar
cRTrn13 committed
521
    MMC* mmc = NULL;
npzacs's avatar
npzacs committed
522
    if (!(mmc = mmc_open(aacs->path))) {
npzacs's avatar
npzacs committed
523
        return AACS_ERROR_MMC_OPEN;
524 525
    }

npzacs's avatar
npzacs committed
526 527
    int error_code = AACS_ERROR_NO_CERT;

528
    const uint8_t *drive_cert = mmc_get_drive_cert(mmc);
529

npzacs's avatar
npzacs committed
530
    for (; hcl ; hcl = hcl->next) {
531 532 533

        char tmp_str[2*92+1];

npzacs's avatar
npzacs committed
534
        if (!crypto_aacs_verify_host_cert(hcl->host_cert)) {
npzacs's avatar
npzacs committed
535
            BD_DEBUG(DBG_AACS, "Not using invalid host certificate %s.\n",
npzacs's avatar
npzacs committed
536
                  str_print_hex(tmp_str, hcl->host_cert, 92));
npzacs's avatar
npzacs committed
537 538
            continue;
        }
539

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

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

npzacs's avatar
npzacs committed
549
        int mmc_result = mmc_read_auth(mmc, hcl->host_priv_key, hcl->host_cert, type, p1, p2);
npzacs's avatar
npzacs committed
550 551 552 553 554 555 556 557 558 559 560
        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;
561 562 563 564 565
        }
    }

    mmc_close(mmc);

npzacs's avatar
npzacs committed
566
    return error_code;
567
}
cRTrn13's avatar
openssl  
cRTrn13 committed
568

npzacs's avatar
npzacs committed
569
static int _read_vid(AACS *aacs, cert_list *hcl)
570
{
npzacs's avatar
npzacs committed
571 572 573
    /* Use VID given in config file if available */
    if (memcmp(aacs->vid, empty_key, 16)) {
        return AACS_SUCCESS;
574 575
    }

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

npzacs's avatar
npzacs committed
586
static int _read_read_data_key(AACS *aacs, cert_list *hcl)
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
587
{
npzacs's avatar
npzacs committed
588 589
    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
590
        BD_DEBUG(DBG_AACS, "Error reading data keys!\n");
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
591
    }
npzacs's avatar
npzacs committed
592 593
    return error_code;
}
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
594

npzacs's avatar
npzacs committed
595 596 597 598
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
599
        BD_DEBUG(DBG_AACS, "Error reading PMSN!\n");
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
600 601 602 603
    }
    return error_code;
}

604
static int _calc_vuk(AACS *aacs, uint8_t *mk, uint8_t *vuk, config_file *cf)
605
{
npzacs's avatar
npzacs committed
606 607
    int error_code;

608
    /* Skip if retrieved from config file */
609
    if (memcmp(vuk, empty_key, 16)) {
npzacs's avatar
npzacs committed
610
        BD_DEBUG(DBG_AACS, "Using VUK from config file\n");
npzacs's avatar
npzacs committed
611 612
        return AACS_SUCCESS;
    }
613

npzacs's avatar
npzacs committed
614
    /* get cached vuk */
615
    if (keycache_find("vuk", aacs->disc_id, vuk, 16)) {
npzacs's avatar
npzacs committed
616
        BD_DEBUG(DBG_AACS, "Using cached VUK\n");
npzacs's avatar
npzacs committed
617
        return AACS_SUCCESS;
npzacs's avatar
npzacs committed
618 619
    }

620 621 622 623
    if (!cf) {
        return AACS_ERROR_NO_CONFIG;
    }

624
    /* make sure we have media key */
625
    error_code = _calc_mk(aacs, mk, cf->pkl, cf->dkl);
npzacs's avatar
npzacs committed
626 627
    if (error_code != AACS_SUCCESS) {
        return error_code;
628 629
    }

npzacs's avatar
npzacs committed
630
    /* acquire VID */
631
    error_code = _read_vid(aacs, cf->host_cert_list);
npzacs's avatar
npzacs committed
632 633 634
    if (error_code != AACS_SUCCESS) {
        return error_code;
    }
635

npzacs's avatar
npzacs committed
636
    /* calculate VUK */
637

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

npzacs's avatar
npzacs committed
640
    int a;
npzacs's avatar
npzacs committed
641
    for (a = 0; a < 16; a++) {
642
        vuk[a] ^= aacs->vid[a];
npzacs's avatar
npzacs committed
643
    }
644

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

npzacs's avatar
npzacs committed
648
    /* cache vuk */
649
    keycache_save("vuk", aacs->disc_id, vuk, 16);
npzacs's avatar
npzacs committed
650

npzacs's avatar
npzacs committed
651
    return AACS_SUCCESS;
cRTrn13's avatar
openssl  
cRTrn13 committed
652 653
}

654 655
static uint16_t _read_u16(AACS_FILE_H *fp)
{
npzacs's avatar
npzacs committed
656
  uint8_t data[2] = {0, 0};
657 658 659 660 661 662 663 664 665 666 667

  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
668
    BD_DEBUG(DBG_AACS, "Assigning CPS units to titles ...\n");
669 670 671 672 673 674 675 676 677

    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
678 679
    BD_DEBUG(DBG_AACS, "Title FP : CPS unit %d\n", first_play);
    BD_DEBUG(DBG_AACS, "Title TM : CPS unit %d\n", top_menu);
680 681 682 683 684 685 686 687 688

    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
689
        BD_DEBUG(DBG_AACS, "Title %02d : CPS unit %d\n", i - 1, aacs->cps_units[i]);
690 691 692 693 694 695 696
    }

    /* 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
697
            BD_DEBUG(DBG_AACS, " *** Invalid CPS unit for title %d: %d !\n", (int) i - 1, aacs->cps_units[i]);
698 699 700 701 702
            aacs->cps_units[i] = 0;
        }
    }
}

npzacs's avatar
npzacs committed
703
/* Function that collects keys from keydb config entry */
704 705
static void _find_config_entry(AACS *aacs, title_entry_list *ce,
                               uint8_t *mk, uint8_t *vuk)
npzacs's avatar
npzacs committed
706 707 708 709 710 711 712
{
    char str[48];

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

        while (ce && ce->entry.discid) {
npzacs's avatar
npzacs committed
713
            if (!memcmp(aacs->disc_id, ce->entry.discid, 20)) {
npzacs's avatar
npzacs committed
714
                BD_DEBUG(DBG_AACS, "Found config entry for discid %s\n",
npzacs's avatar
npzacs committed
715
                      str_print_hex(str, ce->entry.discid, 20));
npzacs's avatar
npzacs committed
716 717 718 719 720 721 722 723 724 725
                break;
            }

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

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

npzacs's avatar
npzacs committed
728
            BD_DEBUG(DBG_AACS, "Found media key for %s: %s\n",
npzacs's avatar
npzacs committed
729
                  ce->entry.discid, str_print_hex(str, mk, 16));
npzacs's avatar
npzacs committed
730 731 732 733 734 735
        }

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

npzacs's avatar
npzacs committed
736
            BD_DEBUG(DBG_AACS, "Found volume id for %s: %s\n",
npzacs's avatar
npzacs committed
737
                  ce->entry.discid, str_print_hex(str, aacs->vid, 16));
npzacs's avatar
npzacs committed
738 739 740
        }

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

npzacs's avatar
npzacs committed
743
            BD_DEBUG(DBG_AACS, "Found volume unique key for %s: %s\n",
npzacs's avatar
npzacs committed
744
                  ce->entry.discid, str_print_hex(str, vuk, 16));
npzacs's avatar
npzacs committed
745 746 747
        }

        if (ce->entry.uk) {
npzacs's avatar
npzacs committed
748
            BD_DEBUG(DBG_AACS, "Acquire CPS unit keys from keydb config file...\n");
npzacs's avatar
npzacs committed
749 750 751 752 753 754 755 756 757

            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
758
                BD_DEBUG(DBG_AACS, "Unit key %d from keydb entry: %s\n",
npzacs's avatar
npzacs committed
759
                      aacs->num_uks,
npzacs's avatar
npzacs committed
760
                      str_print_hex(str, aacs->uks + (16 * (aacs->num_uks - 1)), 16));
npzacs's avatar
npzacs committed
761 762 763 764 765 766

                ukcursor = ukcursor->next;
            }
        }
}

767
static int _calc_uks(AACS *aacs, config_file *cf)
cRTrn13's avatar
openssl  
cRTrn13 committed
768
{
769
    AACS_FILE_H *fp = NULL;
770
    uint8_t  buf[16];
771
    uint64_t f_pos;
772
    unsigned int i;
npzacs's avatar
npzacs committed
773
    int error_code;
cRTrn13's avatar
openssl  
cRTrn13 committed
774

775 776
    uint8_t mk[16] = {0}, vuk[16] = {0};

777
    if (cf) {
npzacs's avatar
npzacs committed
778
        BD_DEBUG(DBG_AACS, "Searching for keydb config entry...\n");
779
        _find_config_entry(aacs, cf->list, mk, vuk);
780

781 782 783 784
        /* Skip if retrieved from config file */
        if (aacs->uks) {
            return AACS_SUCCESS;
        }
785
    }
786

787
    /* Make sure we have VUK */
788
    error_code = _calc_vuk(aacs, mk, vuk, cf);
npzacs's avatar
npzacs committed
789 790
    if (error_code != AACS_SUCCESS) {
        return error_code;
791
    }
792

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

npzacs's avatar
npzacs committed
795
    fp = _file_open(aacs, "AACS" DIR_SEP "Unit_Key_RO.inf");
npzacs's avatar
npzacs committed
796
    if (!fp) {
npzacs's avatar
npzacs committed
797
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Error opening unit key file (AACS/Unit_Key_RO.inf)\n");
npzacs's avatar
npzacs committed
798 799
        return AACS_ERROR_CORRUPTED_DISC;
    }
cRTrn13's avatar
openssl  
cRTrn13 committed
800

npzacs's avatar
npzacs committed
801 802
    if ((file_read(fp, buf, 4)) == 4) {
        f_pos = MKINT_BE32(buf);
npzacs's avatar
npzacs committed
803

npzacs's avatar
npzacs committed
804 805 806 807
        // 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
808

npzacs's avatar
npzacs committed
809 810
            X_FREE(aacs->uks);
            aacs->uks = calloc(aacs->num_uks, 16);
npzacs's avatar
npzacs committed
811

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

npzacs's avatar
npzacs committed
814 815
        } else {
            aacs->num_uks = 0;
npzacs's avatar
npzacs committed
816
            BD_DEBUG(DBG_AACS | DBG_CRIT, "Error reading number of unit keys\n");
npzacs's avatar
npzacs committed
817 818
            error_code = AACS_ERROR_CORRUPTED_DISC;
        }
cRTrn13's avatar
openssl  
cRTrn13 committed
819

npzacs's avatar
npzacs committed
820 821 822
        // Read keys
        for (i = 0; i < aacs->num_uks; i++) {
            f_pos += 48;
cRTrn13's avatar
openssl  
cRTrn13 committed
823

npzacs's avatar
npzacs committed
824 825
            file_seek(fp, f_pos, SEEK_SET);
            if ((file_read(fp, buf, 16)) != 16) {
npzacs's avatar
npzacs committed
826
                BD_DEBUG(DBG_AACS, "Unit key %d: read error\n", i);
npzacs's avatar
npzacs committed
827 828 829
                aacs->num_uks = i;
                error_code = AACS_ERROR_CORRUPTED_DISC;
                break;
npzacs's avatar
npzacs committed
830
            }
cRTrn13's avatar
openssl  
cRTrn13 committed
831

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

npzacs's avatar
npzacs committed
834
            char str[40];
npzacs's avatar
npzacs committed
835
            BD_DEBUG(DBG_AACS, "Unit key %d: %s\n", i,
npzacs's avatar
npzacs committed
836
                  str_print_hex(str, aacs->uks + 16*i, 16));
837 838
        }

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

842
        file_close(fp);
cRTrn13's avatar
openssl  
cRTrn13 committed
843

npzacs's avatar
npzacs committed
844 845 846 847 848
        return error_code;
    }

    file_close(fp);

npzacs's avatar
npzacs committed
849
    BD_DEBUG(DBG_AACS | DBG_CRIT, "Error reading unit keys\n");
npzacs's avatar
npzacs committed
850
    return AACS_ERROR_CORRUPTED_DISC;
cRTrn13's avatar
openssl  
cRTrn13 committed
851 852
}

npzacs's avatar
npzacs committed
853
static int _calc_title_hash(AACS *aacs)
854
{
npzacs's avatar
npzacs committed
855 856
    void    *data;
    size_t   size;
857
    char     str[48];
npzacs's avatar
npzacs committed
858
    int      result = AACS_SUCCESS;
859

npzacs's avatar
npzacs committed
860 861 862
    size = _read_file(aacs, "AACS" DIR_SEP "Unit_Key_RO.inf", &data);
    if (size) {
        crypto_aacs_title_hash(data, size, aacs->disc_id);
npzacs's avatar
npzacs committed
863
        BD_DEBUG(DBG_AACS, "Disc ID: %s\n", str_print_hex(str, aacs->disc_id, 20));
npzacs's avatar
npzacs committed
864
        X_FREE(data);
cRTrn13's avatar
cRTrn13 committed
865

npzacs's avatar
npzacs committed
866 867
    } else {
        result = AACS_ERROR_CORRUPTED_DISC;
npzacs's avatar
npzacs committed
868
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Failed to read %lu bytes from unit key file (AACS/Unit_Key_RO.inf)", (unsigned long)size);
869 870
    }

npzacs's avatar
npzacs committed
871
    return result;
872
}
cRTrn13's avatar
cRTrn13 committed
873

npzacs's avatar
npzacs committed
874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908
static CONTENT_CERT *_read_cc_any(AACS *aacs)
{
    CONTENT_CERT *cc = NULL;
    void   *data;
    size_t  size;

    size = _read_file(aacs, "AACS" DIR_SEP "Content000.cer", &data);
    if (!size) {
        size = _read_file(aacs, "AACS" DIR_SEP "Content001.cer", &data);
    }

    if (size) {
        cc = cc_parse(data, size);
        X_FREE(data);
    } else {
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Failed to read content certificate file\n");
    }

    return cc;
}

static int _get_bus_encryption_enabled(AACS *aacs)
{
    if (!aacs->cc) {
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Failed to read Bus Encryption Enabled flag from content certificate file\n");
        return 0;
    }

    if (aacs->cc->bus_encryption_enabled_flag) {
        BD_DEBUG(DBG_AACS, "Bus Encryption Enabled flag in content certificate: %d\n",
                 aacs->cc->bus_encryption_enabled_flag);
        return 1;
    }

    return 0;
909 910 911 912 913 914 915 916 917 918 919 920 921 922
}

static int _get_bus_encryption_capable(const char *path)
{
    MMC* mmc = NULL;
    uint8_t drive_cert[92];
    int bec = 0;

    if (!(mmc = mmc_open(path))) {
        return 0;
    }

    if (mmc_read_drive_cert(mmc, drive_cert) == MMC_SUCCESS) {
        bec = drive_cert[1