aacs.c 36.9 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 397 398 399
    fp = file_open(f_name, "rb");
    X_FREE(f_name);

    return fp;
}

npzacs's avatar
npzacs committed
400 401 402 403 404
static MKB *_mkb_open(AACS *aacs)
{
    AACS_FILE_H *fp;
    MKB         *mkb;

npzacs's avatar
npzacs committed
405
    fp = _file_open(aacs, "AACS" DIR_SEP "MKB_RO.inf");
npzacs's avatar
npzacs committed
406
    if (!fp) {
npzacs's avatar
npzacs committed
407
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Error opening MKB file (AACS/MKB_RO.inf)\n");
npzacs's avatar
npzacs committed
408 409 410 411 412 413 414 415 416
        return NULL;
    }

    mkb = mkb_read(fp);
    file_close(fp);

    return mkb;
}

417
static int _calc_mk(AACS *aacs, uint8_t *mk, pk_list *pkl, dk_list *dkl)
cRTrn13's avatar
keyfile  
cRTrn13 committed
418 419 420 421
{
    int a, num_uvs = 0;
    size_t len;
    MKB *mkb = NULL;
422
    const uint8_t *rec, *uvs;
cRTrn13's avatar
keyfile  
cRTrn13 committed
423

424
    /* Skip if retrieved from config file */
425 426 427
    if (memcmp(mk, empty_key, 16)) {
        return AACS_SUCCESS;
    }
428

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

npzacs's avatar
npzacs committed
431
    if ((mkb = _mkb_open(aacs))) {
432

npzacs's avatar
npzacs committed
433
        aacs->mkb_version = mkb_version(mkb);
434
        _update_rl(mkb);
435 436 437

        /* try device keys first */
        if (dkl && _calc_pk_mk(mkb, dkl, mk) == AACS_SUCCESS) {
npzacs's avatar
npzacs committed
438
            memcpy(aacs->mk, mk, sizeof(aacs->mk));
439 440 441 442
            mkb_close(mkb);
            return AACS_SUCCESS;
        }

npzacs's avatar
npzacs committed
443
        BD_DEBUG(DBG_AACS, "Get UVS...\n");
444 445 446 447 448 449 450 451
        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
452

npzacs's avatar
npzacs committed
453
        BD_DEBUG(DBG_AACS, "Get cvalues...\n");
454
        rec = mkb_cvalues(mkb, &len);
455

npzacs's avatar
npzacs committed
456
        for (; pkl; pkl = pkl->next) {
npzacs's avatar
npzacs committed
457
                BD_DEBUG(DBG_AACS, "Trying processing key...\n");
458 459

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

464
                        char str[40];
npzacs's avatar
npzacs committed
465
                        BD_DEBUG(DBG_AACS, "Media key: %s\n", str_print_hex(str, mk, 16));
npzacs's avatar
npzacs committed
466
                        memcpy(aacs->mk, mk, sizeof(aacs->mk));
npzacs's avatar
npzacs committed
467
                        return AACS_SUCCESS;
468 469
                    }
                }
cRTrn13's avatar
keyfile  
cRTrn13 committed
470 471
            }

472
        mkb_close(mkb);
cRTrn13's avatar
keyfile  
cRTrn13 committed
473

npzacs's avatar
npzacs committed
474
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Error calculating media key. Missing right processing key ?\n");
npzacs's avatar
npzacs committed
475
        return AACS_ERROR_NO_PK;
npzacs's avatar
npzacs committed
476
    }
npzacs's avatar
npzacs committed
477

npzacs's avatar
npzacs committed
478
    return AACS_ERROR_CORRUPTED_DISC;
cRTrn13's avatar
keyfile  
cRTrn13 committed
479
}
480

npzacs's avatar
npzacs committed
481
static int _mmc_read_auth(AACS *aacs, cert_list *hcl, int type, uint8_t *p1, uint8_t *p2)
cRTrn13's avatar
openssl  
cRTrn13 committed
482
{
cRTrn13's avatar
cRTrn13 committed
483
    MMC* mmc = NULL;
npzacs's avatar
npzacs committed
484
    if (!(mmc = mmc_open(aacs->path))) {
npzacs's avatar
npzacs committed
485
        return AACS_ERROR_MMC_OPEN;
486 487
    }

npzacs's avatar
npzacs committed
488 489
    int error_code = AACS_ERROR_NO_CERT;

490
    const uint8_t *drive_cert = mmc_get_drive_cert(mmc);
491

npzacs's avatar
npzacs committed
492
    for (; hcl ; hcl = hcl->next) {
493 494 495

        char tmp_str[2*92+1];

npzacs's avatar
npzacs committed
496
        if (!crypto_aacs_verify_host_cert(hcl->host_cert)) {
npzacs's avatar
npzacs committed
497
            BD_DEBUG(DBG_AACS, "Not using invalid host certificate %s.\n",
npzacs's avatar
npzacs committed
498
                  str_print_hex(tmp_str, hcl->host_cert, 92));
npzacs's avatar
npzacs committed
499 500
            continue;
        }
501

npzacs's avatar
npzacs committed
502
        if (drive_cert && (drive_cert[1] & 0x01) && !(hcl->host_cert[1] & 0x01)) {
npzacs's avatar
npzacs committed
503
            BD_DEBUG(DBG_AACS, "Certificate (id 0x%s) does not support bus encryption\n",
npzacs's avatar
npzacs committed
504
                  str_print_hex(tmp_str, hcl->host_cert + 4, 6));
505 506 507
            //continue;
        }

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

npzacs's avatar
npzacs committed
511
        int mmc_result = mmc_read_auth(mmc, hcl->host_priv_key, hcl->host_cert, type, p1, p2);
npzacs's avatar
npzacs committed
512 513 514 515 516 517 518 519 520 521 522
        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;
523 524 525 526 527
        }
    }

    mmc_close(mmc);

npzacs's avatar
npzacs committed
528
    return error_code;
529
}
cRTrn13's avatar
openssl  
cRTrn13 committed
530

npzacs's avatar
npzacs committed
531
static int _read_vid(AACS *aacs, cert_list *hcl)
532
{
npzacs's avatar
npzacs committed
533 534 535
    /* Use VID given in config file if available */
    if (memcmp(aacs->vid, empty_key, 16)) {
        return AACS_SUCCESS;
536 537
    }

npzacs's avatar
npzacs committed
538 539
    int error_code = _mmc_read_auth(aacs, hcl, MMC_READ_VID, aacs->vid, NULL);
    if (error_code != AACS_SUCCESS) {
npzacs's avatar
npzacs committed
540
        BD_DEBUG(DBG_AACS, "Error reading VID!\n");
npzacs's avatar
npzacs committed
541 542 543
    } else {
        /* cache vid */
        keycache_save("vid", aacs->disc_id, aacs->vid, 16);
544 545 546 547
    }
    return error_code;
}

npzacs's avatar
npzacs committed
548
static int _read_read_data_key(AACS *aacs, cert_list *hcl)
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
549
{
npzacs's avatar
npzacs committed
550 551
    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
552
        BD_DEBUG(DBG_AACS, "Error reading data keys!\n");
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
553
    }
npzacs's avatar
npzacs committed
554 555
    return error_code;
}
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
556

npzacs's avatar
npzacs committed
557 558 559 560
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
561
        BD_DEBUG(DBG_AACS, "Error reading PMSN!\n");
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
562 563 564 565
    }
    return error_code;
}

566
static int _calc_vuk(AACS *aacs, uint8_t *mk, uint8_t *vuk, config_file *cf)
567
{
npzacs's avatar
npzacs committed
568 569
    int error_code;

570
    /* Skip if retrieved from config file */
571
    if (memcmp(vuk, empty_key, 16)) {
npzacs's avatar
npzacs committed
572
        BD_DEBUG(DBG_AACS, "Using VUK from config file\n");
npzacs's avatar
npzacs committed
573 574
        return AACS_SUCCESS;
    }
575

npzacs's avatar
npzacs committed
576
    /* get cached vuk */
577
    if (keycache_find("vuk", aacs->disc_id, vuk, 16)) {
npzacs's avatar
npzacs committed
578
        BD_DEBUG(DBG_AACS, "Using cached VUK\n");
npzacs's avatar
npzacs committed
579
        return AACS_SUCCESS;
npzacs's avatar
npzacs committed
580 581
    }

582 583 584 585
    if (!cf) {
        return AACS_ERROR_NO_CONFIG;
    }

586
    /* make sure we have media key */
587
    error_code = _calc_mk(aacs, mk, cf->pkl, cf->dkl);
npzacs's avatar
npzacs committed
588 589
    if (error_code != AACS_SUCCESS) {
        return error_code;
590 591
    }

npzacs's avatar
npzacs committed
592
    /* acquire VID */
593
    error_code = _read_vid(aacs, cf->host_cert_list);
npzacs's avatar
npzacs committed
594 595 596
    if (error_code != AACS_SUCCESS) {
        return error_code;
    }
597

npzacs's avatar
npzacs committed
598
    /* calculate VUK */
599

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

npzacs's avatar
npzacs committed
602
    int a;
npzacs's avatar
npzacs committed
603
    for (a = 0; a < 16; a++) {
604
        vuk[a] ^= aacs->vid[a];
npzacs's avatar
npzacs committed
605
    }
606

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

npzacs's avatar
npzacs committed
610
    /* cache vuk */
611
    keycache_save("vuk", aacs->disc_id, vuk, 16);
npzacs's avatar
npzacs committed
612

npzacs's avatar
npzacs committed
613
    return AACS_SUCCESS;
cRTrn13's avatar
openssl  
cRTrn13 committed
614 615
}

616 617
static uint16_t _read_u16(AACS_FILE_H *fp)
{
npzacs's avatar
npzacs committed
618
  uint8_t data[2] = {0, 0};
619 620 621 622 623 624 625 626 627 628 629

  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
630
    BD_DEBUG(DBG_AACS, "Assigning CPS units to titles ...\n");
631 632 633 634 635 636 637 638 639

    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
640 641
    BD_DEBUG(DBG_AACS, "Title FP : CPS unit %d\n", first_play);
    BD_DEBUG(DBG_AACS, "Title TM : CPS unit %d\n", top_menu);
642 643 644 645 646 647 648 649 650

    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
651
        BD_DEBUG(DBG_AACS, "Title %02d : CPS unit %d\n", i - 1, aacs->cps_units[i]);
652 653 654 655 656 657 658
    }

    /* 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
659
            BD_DEBUG(DBG_AACS, " *** Invalid CPS unit for title %d: %d !\n", (int) i - 1, aacs->cps_units[i]);
660 661 662 663 664
            aacs->cps_units[i] = 0;
        }
    }
}

npzacs's avatar
npzacs committed
665
/* Function that collects keys from keydb config entry */
666 667
static void _find_config_entry(AACS *aacs, title_entry_list *ce,
                               uint8_t *mk, uint8_t *vuk)
npzacs's avatar
npzacs committed
668 669 670 671 672 673 674
{
    char str[48];

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

        while (ce && ce->entry.discid) {
npzacs's avatar
npzacs committed
675
            if (!memcmp(aacs->disc_id, ce->entry.discid, 20)) {
npzacs's avatar
npzacs committed
676
                BD_DEBUG(DBG_AACS, "Found config entry for discid %s\n",
npzacs's avatar
npzacs committed
677
                      str_print_hex(str, ce->entry.discid, 20));
npzacs's avatar
npzacs committed
678 679 680 681 682 683 684 685 686 687
                break;
            }

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

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

npzacs's avatar
npzacs committed
690
            BD_DEBUG(DBG_AACS, "Found media key for %s: %s\n",
npzacs's avatar
npzacs committed
691
                  ce->entry.discid, str_print_hex(str, mk, 16));
npzacs's avatar
npzacs committed
692 693 694 695 696 697
        }

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

npzacs's avatar
npzacs committed
698
            BD_DEBUG(DBG_AACS, "Found volume id for %s: %s\n",
npzacs's avatar
npzacs committed
699
                  ce->entry.discid, str_print_hex(str, aacs->vid, 16));
npzacs's avatar
npzacs committed
700 701 702
        }

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

npzacs's avatar
npzacs committed
705
            BD_DEBUG(DBG_AACS, "Found volume unique key for %s: %s\n",
npzacs's avatar
npzacs committed
706
                  ce->entry.discid, str_print_hex(str, vuk, 16));
npzacs's avatar
npzacs committed
707 708 709
        }

        if (ce->entry.uk) {
npzacs's avatar
npzacs committed
710
            BD_DEBUG(DBG_AACS, "Acquire CPS unit keys from keydb config file...\n");
npzacs's avatar
npzacs committed
711 712 713 714 715 716 717 718 719

            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
720
                BD_DEBUG(DBG_AACS, "Unit key %d from keydb entry: %s\n",
npzacs's avatar
npzacs committed
721
                      aacs->num_uks,
npzacs's avatar
npzacs committed
722
                      str_print_hex(str, aacs->uks + (16 * (aacs->num_uks - 1)), 16));
npzacs's avatar
npzacs committed
723 724 725 726 727 728

                ukcursor = ukcursor->next;
            }
        }
}

729
static int _calc_uks(AACS *aacs, config_file *cf)
cRTrn13's avatar
openssl  
cRTrn13 committed
730
{
731
    AACS_FILE_H *fp = NULL;
732
    uint8_t  buf[16];
733
    uint64_t f_pos;
734
    unsigned int i;
npzacs's avatar
npzacs committed
735
    int error_code;
cRTrn13's avatar
openssl  
cRTrn13 committed
736

737 738
    uint8_t mk[16] = {0}, vuk[16] = {0};

739
    if (cf) {
npzacs's avatar
npzacs committed
740
        BD_DEBUG(DBG_AACS, "Searching for keydb config entry...\n");
741
        _find_config_entry(aacs, cf->list, mk, vuk);
742

743 744 745 746
        /* Skip if retrieved from config file */
        if (aacs->uks) {
            return AACS_SUCCESS;
        }
747
    }
748

749
    /* Make sure we have VUK */
750
    error_code = _calc_vuk(aacs, mk, vuk, cf);
npzacs's avatar
npzacs committed
751 752
    if (error_code != AACS_SUCCESS) {
        return error_code;
753
    }
754

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

npzacs's avatar
npzacs committed
757
    fp = _file_open(aacs, "AACS" DIR_SEP "Unit_Key_RO.inf");
npzacs's avatar
npzacs committed
758
    if (!fp) {
npzacs's avatar
npzacs committed
759
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Error opening unit key file (AACS/Unit_Key_RO.inf)\n");
npzacs's avatar
npzacs committed
760 761
        return AACS_ERROR_CORRUPTED_DISC;
    }
cRTrn13's avatar
openssl  
cRTrn13 committed
762

npzacs's avatar
npzacs committed
763 764
    if ((file_read(fp, buf, 4)) == 4) {
        f_pos = MKINT_BE32(buf);
npzacs's avatar
npzacs committed
765

npzacs's avatar
npzacs committed
766 767 768 769
        // 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
770

npzacs's avatar
npzacs committed
771 772
            X_FREE(aacs->uks);
            aacs->uks = calloc(aacs->num_uks, 16);
npzacs's avatar
npzacs committed
773

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

npzacs's avatar
npzacs committed
776 777
        } else {
            aacs->num_uks = 0;
npzacs's avatar
npzacs committed
778
            BD_DEBUG(DBG_AACS | DBG_CRIT, "Error reading number of unit keys\n");
npzacs's avatar
npzacs committed
779 780
            error_code = AACS_ERROR_CORRUPTED_DISC;
        }
cRTrn13's avatar
openssl  
cRTrn13 committed
781

npzacs's avatar
npzacs committed
782 783 784
        // Read keys
        for (i = 0; i < aacs->num_uks; i++) {
            f_pos += 48;
cRTrn13's avatar
openssl  
cRTrn13 committed
785

npzacs's avatar
npzacs committed
786 787
            file_seek(fp, f_pos, SEEK_SET);
            if ((file_read(fp, buf, 16)) != 16) {
npzacs's avatar
npzacs committed
788
                BD_DEBUG(DBG_AACS, "Unit key %d: read error\n", i);
npzacs's avatar
npzacs committed
789 790 791
                aacs->num_uks = i;
                error_code = AACS_ERROR_CORRUPTED_DISC;
                break;
npzacs's avatar
npzacs committed
792
            }
cRTrn13's avatar
openssl  
cRTrn13 committed
793

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

npzacs's avatar
npzacs committed
796
            char str[40];
npzacs's avatar
npzacs committed
797
            BD_DEBUG(DBG_AACS, "Unit key %d: %s\n", i,
npzacs's avatar
npzacs committed
798
                  str_print_hex(str, aacs->uks + 16*i, 16));
799 800
        }

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

804
        file_close(fp);
cRTrn13's avatar
openssl  
cRTrn13 committed
805

npzacs's avatar
npzacs committed
806 807 808 809 810
        return error_code;
    }

    file_close(fp);

npzacs's avatar
npzacs committed
811
    BD_DEBUG(DBG_AACS | DBG_CRIT, "Error reading unit keys\n");
npzacs's avatar
npzacs committed
812
    return AACS_ERROR_CORRUPTED_DISC;
cRTrn13's avatar
openssl  
cRTrn13 committed
813 814
}

npzacs's avatar
npzacs committed
815
static int _calc_title_hash(AACS *aacs)
816
{
817
    AACS_FILE_H *fp = NULL;
818 819 820
    uint8_t *ukf_buf;
    char     str[48];
    int64_t  f_size;
npzacs's avatar
npzacs committed
821
    int      result = AACS_SUCCESS;
822

npzacs's avatar
npzacs committed
823
    fp = _file_open(aacs, "AACS" DIR_SEP "Unit_Key_RO.inf");
npzacs's avatar
npzacs committed
824
    if (!fp) {
npzacs's avatar
npzacs committed
825
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Error opening unit key file (AACS/Unit_Key_RO.inf)\n");
npzacs's avatar
npzacs committed
826
        return AACS_ERROR_CORRUPTED_DISC;
827 828 829 830 831 832 833 834
    }

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

    ukf_buf = malloc(f_size);

npzacs's avatar
npzacs committed
835
    if ((file_read(fp, ukf_buf, f_size)) == f_size) {
npzacs's avatar
npzacs committed
836
        crypto_aacs_title_hash(ukf_buf, f_size, aacs->disc_id);
npzacs's avatar
npzacs committed
837
        BD_DEBUG(DBG_AACS, "Disc ID: %s\n", str_print_hex(str, aacs->disc_id, 20));
cRTrn13's avatar
cRTrn13 committed
838

npzacs's avatar
npzacs committed
839 840
    } else {
        result = AACS_ERROR_CORRUPTED_DISC;
npzacs's avatar
npzacs committed
841
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Failed to read %lu bytes from unit key file (AACS/Unit_Key_RO.inf)", (unsigned long)f_size);
842 843 844 845 846
    }

    file_close(fp);
    X_FREE(ukf_buf);

npzacs's avatar
npzacs committed
847
    return result;
848
}
cRTrn13's avatar
cRTrn13 committed
849

npzacs's avatar
npzacs committed
850
static size_t _read_file(AACS *aacs, const char *file, void **data)
851 852
{
    AACS_FILE_H *fp = NULL;
npzacs's avatar
npzacs committed
853 854 855
    int64_t f_size;

    *data = NULL;
856

npzacs's avatar
npzacs committed
857
    fp = _file_open(aacs, file);
858
    if (!fp) {
npzacs's avatar
npzacs committed
859
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Unable to open %s\n", file);
860 861 862
        return 0;
    }

npzacs's avatar
npzacs committed
863 864 865 866 867 868 869 870 871 872
    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);
        }
873
    } else {
npzacs's avatar
npzacs committed
874
        BD_DEBUG(DBG_AACS | DBG_CRIT, "Out of memory\n");
875 876 877
    }

    file_close(fp);
npzacs's avatar
npzacs committed
878 879 880 881 882 883 884