aacs.c 33.7 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 26
#include <util/attributes.h>

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

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

npzacs's avatar
npzacs committed
46

npzacs's avatar
npzacs committed
47
struct aacs {
npzacs's avatar
npzacs committed
48 49 50 51 52
    /* current disc */
    char     *path;
    int       mkb_version;
    uint8_t   disc_id[20];

53 54
    /* VID is cached for BD-J */
    uint8_t   vid[16];
55 56
    /* PMSN is cached for BD-J */
    uint8_t   pmsn[16];
npzacs's avatar
npzacs committed
57 58
    /* Media key is cached for BD+ */
    uint8_t   mk[16];
npzacs's avatar
npzacs committed
59 60 61 62

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

npzacs's avatar
npzacs committed
64 65 66 67 68 69
    /* CPS unit of currently selected title */
    uint16_t  current_cps_unit;

    /* title -> CPS unit mappings */
    uint32_t  num_titles;
    uint16_t *cps_units;  /* [0] = first play ; [1] = top menu ; [2] = title 1 ... */
70 71 72 73

    /* bus encryption */
    int       bee;        /* bus encryption enabled flag in content certificate */
    int       bec;        /* bus encryption capable flag in drive certificate */
74
    uint8_t   read_data_key[16];
75 76 77 78

    /* AACS Online (BD-J) */
    uint8_t   device_nonce[16];
    uint8_t   device_binding_id[16];
npzacs's avatar
npzacs committed
79 80
};

81 82
static const uint8_t empty_key[] = "\x00\x00\x00\x00\x00\x00\x00\x00"
                                   "\x00\x00\x00\x00\x00\x00\x00\x00";
83 84
static const uint8_t aacs_iv[]   = "\x0b\xa0\xf8\xdd\xfe\xa6\x1f\xb3"
                                   "\xd8\xdf\x9f\x56\x6a\x05\x0f\x78";
85

86 87
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
88
                        uint8_t *mk)
cRTrn13's avatar
cRTrn13 committed
89
{
90
    gcry_cipher_hd_t gcry_h;
npzacs's avatar
npzacs committed
91
    int a;
cRTrn13's avatar
cRTrn13 committed
92
    uint8_t dec_vd[16];
93
    char str[40];
cRTrn13's avatar
cRTrn13 committed
94

95
    DEBUG(DBG_AACS, "Validate processing key %s...\n", print_hex(str, pk, 16));
cRTrn13's avatar
cRTrn13 committed
96
    DEBUG(DBG_AACS, " Using:\n");
97 98 99
    DEBUG(DBG_AACS, "   UV: %s\n", print_hex(str, uv, 4));
    DEBUG(DBG_AACS, "   cvalue: %s\n", print_hex(str, cvalue, 16));
    DEBUG(DBG_AACS, "   Verification data: %s\n", print_hex(str, vd, 16));
100

101 102 103
    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);
104

cRTrn13's avatar
cRTrn13 committed
105 106 107 108
    for (a = 0; a < 4; a++) {
        mk[a + 12] ^= uv[a];
    }

109 110 111
    gcry_cipher_setkey(gcry_h, mk, 16);
    gcry_cipher_decrypt (gcry_h, dec_vd, 16, vd, 16);
    gcry_cipher_close(gcry_h);
112

cRTrn13's avatar
cRTrn13 committed
113
    if (!memcmp(dec_vd, "\x01\x23\x45\x67\x89\xAB\xCD\xEF", 8)) {
npzacs's avatar
npzacs committed
114
        DEBUG(DBG_AACS, "Processing key %s is valid!\n", print_hex(str, pk, 16));
npzacs's avatar
npzacs committed
115
        return AACS_SUCCESS;
cRTrn13's avatar
cRTrn13 committed
116 117
    }

npzacs's avatar
npzacs committed
118
    return AACS_ERROR_NO_PK;
cRTrn13's avatar
cRTrn13 committed
119
}
120

121 122 123 124 125 126 127 128 129 130 131 132 133
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) {
        DEBUG(DBG_AACS, "revocation list size mismatch\n");
        return 0;
    }

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

134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160
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) {
        DEBUG(DBG_AACS | DBG_CRIT, "ignoring empty %s\n", name);
        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)) {
          DEBUG(DBG_AACS | DBG_CRIT, "invalid %s signature, not using it\n", name);
        } else {
          cache_save(name, version, data, rl_len + 12);
        }
        X_FREE(data);
    }
}

static void _update_rl(MKB *mkb)
161 162 163
{
    uint32_t version = mkb_version(mkb);
    uint32_t cache_version;
164
    size_t   rl_len;
165 166

    if (!cache_get("drl", &cache_version, NULL, NULL) || cache_version < version) {
167 168 169 170 171 172 173 174 175 176 177
        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);
178 179 180 181
        }
    }
}

182 183 184 185 186 187 188 189 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 233 234
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];
    DEBUG(DBG_AACS, "Processing key: %s\n",  print_hex(str, pk, 16));
}

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
235 236 237
        if (!dkl->uv) {
            continue;
        }
238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 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
        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) {
        DEBUG(DBG_AACS | DBG_CRIT, "could not find applying device key (device 0x%x)\n", device_number);
    } else {
        char str[128];
        DEBUG(DBG_AACS, "Applying device key is #%d %s\n", key_idx, print_hex(str, dkl->key, 16));
        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);
        *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;
        }
292
        device_number = dk_num->node;
293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 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 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) {
                DEBUG(DBG_AACS | DBG_CRIT, "device 0x%x is revoked\n", device_number);
                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) {
            DEBUG(DBG_AACS | DBG_CRIT, "could not find applying subset-difference for device 0x%x\n", device_number);
            /* try next device */
            continue;
        }

        DEBUG(DBG_AACS, "Applying subset-difference for device 0x%x is #%d:\n", device_number, uvs_idx);
        DEBUG(DBG_AACS,"  UV: 0x%08x  U mask: 0x%08x  V mask: 0x%08x\n", uv, u_mask, v_mask);

        /* 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) {

            DEBUG(DBG_AACS, "Media key: %s\n", print_hex(str, mk, 16));
            return AACS_SUCCESS;
        }

        DEBUG(DBG_AACS | DBG_CRIT, "Processing key %s is invalid!\n", print_hex(str, pk, 16));

        /* try next device */
    }

    return AACS_ERROR_NO_DK;
}

npzacs's avatar
npzacs committed
369 370 371 372 373 374 375 376 377 378 379 380
static AACS_FILE_H *_file_open(AACS *aacs, const char *file)
{
    AACS_FILE_H *fp;
    char        *f_name;

    f_name = str_printf("%s/%s", aacs->path, file);
    fp = file_open(f_name, "rb");
    X_FREE(f_name);

    return fp;
}

381
static int _calc_mk(AACS *aacs, uint8_t *mk, pk_list *pkl, dk_list *dkl)
cRTrn13's avatar
keyfile  
cRTrn13 committed
382 383 384 385
{
    int a, num_uvs = 0;
    size_t len;
    MKB *mkb = NULL;
386
    const uint8_t *rec, *uvs;
cRTrn13's avatar
keyfile  
cRTrn13 committed
387

388
    /* Skip if retrieved from config file */
389 390 391
    if (memcmp(mk, empty_key, 16)) {
        return AACS_SUCCESS;
    }
392

cRTrn13's avatar
cRTrn13 committed
393 394
    DEBUG(DBG_AACS, "Calculate media key...\n");

npzacs's avatar
npzacs committed
395
    if ((mkb = mkb_open(aacs->path))) {
396

npzacs's avatar
npzacs committed
397
        aacs->mkb_version = mkb_version(mkb);
398
        _update_rl(mkb);
399 400 401

        /* try device keys first */
        if (dkl && _calc_pk_mk(mkb, dkl, mk) == AACS_SUCCESS) {
npzacs's avatar
npzacs committed
402
            memcpy(aacs->mk, mk, sizeof(aacs->mk));
403 404 405 406 407
            mkb_close(mkb);
            return AACS_SUCCESS;
        }

        DEBUG(DBG_AACS, "Get UVS...\n");
408 409 410 411 412 413 414 415
        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
416

417 418
        DEBUG(DBG_AACS, "Get cvalues...\n");
        rec = mkb_cvalues(mkb, &len);
419

npzacs's avatar
npzacs committed
420
        for (; pkl; pkl = pkl->next) {
421 422 423
                DEBUG(DBG_AACS, "Trying processing key...\n");

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

428
                        char str[40];
429
                        DEBUG(DBG_AACS, "Media key: %s\n", print_hex(str, mk, 16));
npzacs's avatar
npzacs committed
430
                        memcpy(aacs->mk, mk, sizeof(aacs->mk));
npzacs's avatar
npzacs committed
431
                        return AACS_SUCCESS;
432 433
                    }
                }
cRTrn13's avatar
keyfile  
cRTrn13 committed
434 435
            }

436
        mkb_close(mkb);
cRTrn13's avatar
keyfile  
cRTrn13 committed
437

npzacs's avatar
npzacs committed
438
        DEBUG(DBG_AACS | DBG_CRIT, "Error calculating media key. Missing right processing key ?\n");
npzacs's avatar
npzacs committed
439
        return AACS_ERROR_NO_PK;
npzacs's avatar
npzacs committed
440
    }
npzacs's avatar
npzacs committed
441

npzacs's avatar
npzacs committed
442
    DEBUG(DBG_AACS | DBG_CRIT, "Error opening %s/AACS/MKB_RO.inf\n", aacs->path);
npzacs's avatar
npzacs committed
443
    return AACS_ERROR_CORRUPTED_DISC;
cRTrn13's avatar
keyfile  
cRTrn13 committed
444
}
445

npzacs's avatar
npzacs committed
446
static int _mmc_read_auth(AACS *aacs, cert_list *hcl, int type, uint8_t *p1, uint8_t *p2)
cRTrn13's avatar
openssl  
cRTrn13 committed
447
{
cRTrn13's avatar
cRTrn13 committed
448
    MMC* mmc = NULL;
npzacs's avatar
npzacs committed
449
    if (!(mmc = mmc_open(aacs->path))) {
npzacs's avatar
npzacs committed
450
        return AACS_ERROR_MMC_OPEN;
451 452
    }

npzacs's avatar
npzacs committed
453 454
    int error_code = AACS_ERROR_NO_CERT;

455
    const uint8_t *drive_cert = mmc_get_drive_cert(mmc);
456

npzacs's avatar
npzacs committed
457
    for (; hcl ; hcl = hcl->next) {
458 459 460

        char tmp_str[2*92+1];

npzacs's avatar
npzacs committed
461
        if (!crypto_aacs_verify_host_cert(hcl->host_cert)) {
npzacs's avatar
npzacs committed
462
            DEBUG(DBG_AACS, "Not using invalid host certificate %s.\n",
npzacs's avatar
npzacs committed
463
                  print_hex(tmp_str, hcl->host_cert, 92));
npzacs's avatar
npzacs committed
464 465
            continue;
        }
466

npzacs's avatar
npzacs committed
467
        if (drive_cert && (drive_cert[1] & 0x01) && !(hcl->host_cert[1] & 0x01)) {
468
            DEBUG(DBG_AACS, "Certificate (id 0x%s) does not support bus encryption\n",
npzacs's avatar
npzacs committed
469
                  print_hex(tmp_str, hcl->host_cert + 4, 6));
470 471 472
            //continue;
        }

473
        DEBUG(DBG_AACS, "Trying host certificate (id 0x%s)...\n",
npzacs's avatar
npzacs committed
474
              print_hex(tmp_str, hcl->host_cert + 4, 6));
475

npzacs's avatar
npzacs committed
476
        int mmc_result = mmc_read_auth(mmc, hcl->host_priv_key, hcl->host_cert, type, p1, p2);
npzacs's avatar
npzacs committed
477 478 479 480 481 482 483 484 485 486 487
        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;
488 489 490 491 492
        }
    }

    mmc_close(mmc);

npzacs's avatar
npzacs committed
493
    return error_code;
494
}
cRTrn13's avatar
openssl  
cRTrn13 committed
495

npzacs's avatar
npzacs committed
496
static int _read_vid(AACS *aacs, cert_list *hcl)
497
{
npzacs's avatar
npzacs committed
498 499 500
    /* Use VID given in config file if available */
    if (memcmp(aacs->vid, empty_key, 16)) {
        return AACS_SUCCESS;
501 502
    }

npzacs's avatar
npzacs committed
503 504 505 506 507 508
    int error_code = _mmc_read_auth(aacs, hcl, MMC_READ_VID, aacs->vid, NULL);
    if (error_code != AACS_SUCCESS) {
        DEBUG(DBG_AACS, "Error reading VID!\n");
    } else {
        /* cache vid */
        keycache_save("vid", aacs->disc_id, aacs->vid, 16);
509 510 511 512
    }
    return error_code;
}

npzacs's avatar
npzacs committed
513
static int _read_read_data_key(AACS *aacs, cert_list *hcl)
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
514
{
npzacs's avatar
npzacs committed
515 516 517
    int error_code = _mmc_read_auth(aacs, hcl, MMC_READ_DATA_KEYS, aacs->read_data_key, NULL);
    if (error_code != AACS_SUCCESS) {
        DEBUG(DBG_AACS, "Error reading data keys!\n");
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
518
    }
npzacs's avatar
npzacs committed
519 520
    return error_code;
}
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
521

npzacs's avatar
npzacs committed
522 523 524 525 526
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) {
        DEBUG(DBG_AACS, "Error reading PMSN!\n");
Janusz Dziemidowicz's avatar
Janusz Dziemidowicz committed
527 528 529 530
    }
    return error_code;
}

531
static int _calc_vuk(AACS *aacs, uint8_t *mk, uint8_t *vuk, config_file *cf)
532
{
npzacs's avatar
npzacs committed
533 534
    int error_code;

535
    /* Skip if retrieved from config file */
536
    if (memcmp(vuk, empty_key, 16)) {
npzacs's avatar
npzacs committed
537 538 539
        DEBUG(DBG_AACS, "Using VUK from config file\n");
        return AACS_SUCCESS;
    }
540

npzacs's avatar
npzacs committed
541
    /* get cached vuk */
542
    if (keycache_find("vuk", aacs->disc_id, vuk, 16)) {
npzacs's avatar
npzacs committed
543
        DEBUG(DBG_AACS, "Using cached VUK\n");
npzacs's avatar
npzacs committed
544
        return AACS_SUCCESS;
npzacs's avatar
npzacs committed
545 546
    }

547 548 549 550
    if (!cf) {
        return AACS_ERROR_NO_CONFIG;
    }

551
    /* make sure we have media key */
552
    error_code = _calc_mk(aacs, mk, cf->pkl, cf->dkl);
npzacs's avatar
npzacs committed
553 554
    if (error_code != AACS_SUCCESS) {
        return error_code;
555 556
    }

npzacs's avatar
npzacs committed
557
    /* acquire VID */
558
    error_code = _read_vid(aacs, cf->host_cert_list);
npzacs's avatar
npzacs committed
559 560 561
    if (error_code != AACS_SUCCESS) {
        return error_code;
    }
562

npzacs's avatar
npzacs committed
563
    /* calculate VUK */
564

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

npzacs's avatar
npzacs committed
567
    int a;
npzacs's avatar
npzacs committed
568
    for (a = 0; a < 16; a++) {
569
        vuk[a] ^= aacs->vid[a];
npzacs's avatar
npzacs committed
570
    }
571

npzacs's avatar
npzacs committed
572
    char str[40];
573
    DEBUG(DBG_AACS, "Volume unique key: %s\n", print_hex(str, vuk, 16));
574

npzacs's avatar
npzacs committed
575
    /* cache vuk */
576
    keycache_save("vuk", aacs->disc_id, vuk, 16);
npzacs's avatar
npzacs committed
577

npzacs's avatar
npzacs committed
578
    return AACS_SUCCESS;
cRTrn13's avatar
openssl  
cRTrn13 committed
579 580
}

581 582
static uint16_t _read_u16(AACS_FILE_H *fp)
{
npzacs's avatar
npzacs committed
583
  uint8_t data[2] = {0, 0};
584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 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;

    DEBUG(DBG_AACS, "Assigning CPS units to titles ...\n");

    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);

    DEBUG(DBG_AACS, "Title FP : CPS unit %d\n", first_play);
    DEBUG(DBG_AACS, "Title TM : CPS unit %d\n", top_menu);

    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);
        DEBUG(DBG_AACS, "Title %02d : CPS unit %d\n", i - 1, aacs->cps_units[i]);
    }

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

npzacs's avatar
npzacs committed
630
/* Function that collects keys from keydb config entry */
631 632
static void _find_config_entry(AACS *aacs, title_entry_list *ce,
                               uint8_t *mk, uint8_t *vuk)
npzacs's avatar
npzacs committed
633 634 635 636 637 638 639
{
    char str[48];

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

        while (ce && ce->entry.discid) {
npzacs's avatar
npzacs committed
640
            if (!memcmp(aacs->disc_id, ce->entry.discid, 20)) {
npzacs's avatar
npzacs committed
641
                DEBUG(DBG_AACS, "Found config entry for discid %s\n",
npzacs's avatar
npzacs committed
642
                      print_hex(str, ce->entry.discid, 20));
npzacs's avatar
npzacs committed
643 644 645 646 647 648 649 650 651 652
                break;
            }

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

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

            DEBUG(DBG_AACS, "Found media key for %s: %s\n",
656
                  ce->entry.discid, print_hex(str, mk, 16));
npzacs's avatar
npzacs committed
657 658 659 660 661 662 663 664 665 666 667
        }

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

            DEBUG(DBG_AACS, "Found volume id for %s: %s\n",
                  ce->entry.discid, print_hex(str, aacs->vid, 16));
        }

        if (ce->entry.vuk) {
668
            hexstring_to_hex_array(vuk, 16, ce->entry.vuk);
npzacs's avatar
npzacs committed
669 670

            DEBUG(DBG_AACS, "Found volume unique key for %s: %s\n",
671
                  ce->entry.discid, print_hex(str, vuk, 16));
npzacs's avatar
npzacs committed
672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693
        }

        if (ce->entry.uk) {
            DEBUG(DBG_AACS, "Acquire CPS unit keys from keydb config file...\n");

            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);

                DEBUG(DBG_AACS, "Unit key %d from keydb entry: %s\n",
                      aacs->num_uks,
                      print_hex(str, aacs->uks + (16 * (aacs->num_uks - 1)), 16));

                ukcursor = ukcursor->next;
            }
        }
}

694
static int _calc_uks(AACS *aacs, config_file *cf)
cRTrn13's avatar
openssl  
cRTrn13 committed
695
{
696
    AACS_FILE_H *fp = NULL;
697
    uint8_t  buf[16];
698
    uint64_t f_pos;
699
    unsigned int i;
npzacs's avatar
npzacs committed
700
    int error_code;
cRTrn13's avatar
openssl  
cRTrn13 committed
701

702 703
    uint8_t mk[16] = {0}, vuk[16] = {0};

704 705 706
    if (cf) {
        DEBUG(DBG_AACS, "Searching for keydb config entry...\n");
        _find_config_entry(aacs, cf->list, mk, vuk);
707

708 709 710 711
        /* Skip if retrieved from config file */
        if (aacs->uks) {
            return AACS_SUCCESS;
        }
712
    }
713

714
    /* Make sure we have VUK */
715
    error_code = _calc_vuk(aacs, mk, vuk, cf);
npzacs's avatar
npzacs committed
716 717
    if (error_code != AACS_SUCCESS) {
        return error_code;
718
    }
719

720 721
    DEBUG(DBG_AACS, "Calculate CPS unit keys...\n");

npzacs's avatar
npzacs committed
722
    fp = _file_open(aacs, "AACS/Unit_Key_RO.inf");
npzacs's avatar
npzacs committed
723
    if (!fp) {
npzacs's avatar
npzacs committed
724
        DEBUG(DBG_AACS | DBG_CRIT, "Error opening unit key file (AACS/Unit_Key_RO.inf)\n");
npzacs's avatar
npzacs committed
725 726
        return AACS_ERROR_CORRUPTED_DISC;
    }
cRTrn13's avatar
openssl  
cRTrn13 committed
727

npzacs's avatar
npzacs committed
728 729
    if ((file_read(fp, buf, 4)) == 4) {
        f_pos = MKINT_BE32(buf);
npzacs's avatar
npzacs committed
730

npzacs's avatar
npzacs committed
731 732 733 734
        // 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
735

npzacs's avatar
npzacs committed
736 737
            X_FREE(aacs->uks);
            aacs->uks = calloc(aacs->num_uks, 16);
npzacs's avatar
npzacs committed
738

npzacs's avatar
npzacs committed
739
            DEBUG(DBG_AACS, "%d CPS unit keys\n", aacs->num_uks);
npzacs's avatar
npzacs committed
740

npzacs's avatar
npzacs committed
741 742 743 744 745
        } else {
            aacs->num_uks = 0;
            DEBUG(DBG_AACS | DBG_CRIT, "Error reading number of unit keys\n");
            error_code = AACS_ERROR_CORRUPTED_DISC;
        }
cRTrn13's avatar
openssl  
cRTrn13 committed
746

npzacs's avatar
npzacs committed
747 748 749
        // Read keys
        for (i = 0; i < aacs->num_uks; i++) {
            f_pos += 48;
cRTrn13's avatar
openssl  
cRTrn13 committed
750

npzacs's avatar
npzacs committed
751 752 753 754 755 756
            file_seek(fp, f_pos, SEEK_SET);
            if ((file_read(fp, buf, 16)) != 16) {
                DEBUG(DBG_AACS, "Unit key %d: read error\n", i);
                aacs->num_uks = i;
                error_code = AACS_ERROR_CORRUPTED_DISC;
                break;
npzacs's avatar
npzacs committed
757
            }
cRTrn13's avatar
openssl  
cRTrn13 committed
758

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

npzacs's avatar
npzacs committed
761 762 763
            char str[40];
            DEBUG(DBG_AACS, "Unit key %d: %s\n", i,
                  print_hex(str, aacs->uks + 16*i, 16));
764 765
        }

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

769
        file_close(fp);
cRTrn13's avatar
openssl  
cRTrn13 committed
770

npzacs's avatar
npzacs committed
771 772 773 774 775 776 777
        return error_code;
    }

    file_close(fp);

    DEBUG(DBG_AACS | DBG_CRIT, "Error reading unit keys\n");
    return AACS_ERROR_CORRUPTED_DISC;
cRTrn13's avatar
openssl  
cRTrn13 committed
778 779
}

npzacs's avatar
npzacs committed
780
static int _calc_title_hash(AACS *aacs)
781
{
782
    AACS_FILE_H *fp = NULL;
783 784 785
    uint8_t *ukf_buf;
    char     str[48];
    int64_t  f_size;
npzacs's avatar
npzacs committed
786
    int      result = AACS_SUCCESS;
787

npzacs's avatar
npzacs committed
788
    fp = _file_open(aacs, "AACS/Unit_Key_RO.inf");
npzacs's avatar
npzacs committed
789
    if (!fp) {
npzacs's avatar
npzacs committed
790
        DEBUG(DBG_AACS | DBG_CRIT, "Error opening unit key file (AACS/Unit_Key_RO.inf)\n");
npzacs's avatar
npzacs committed
791
        return AACS_ERROR_CORRUPTED_DISC;
792 793 794 795 796 797 798 799
    }

    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
800
    if ((file_read(fp, ukf_buf, f_size)) == f_size) {
npzacs's avatar
npzacs committed
801 802
        crypto_aacs_title_hash(ukf_buf, f_size, aacs->disc_id);
        DEBUG(DBG_AACS, "Disc ID: %s\n", print_hex(str, aacs->disc_id, 20));
cRTrn13's avatar
cRTrn13 committed
803

npzacs's avatar
npzacs committed
804 805
    } else {
        result = AACS_ERROR_CORRUPTED_DISC;
npzacs's avatar
npzacs committed
806
        DEBUG(DBG_AACS | DBG_CRIT, "Failed to read %lu bytes from unit key file (AACS/Unit_Key_RO.inf)", (unsigned long)f_size);
807 808 809 810 811
    }

    file_close(fp);
    X_FREE(ukf_buf);

npzacs's avatar
npzacs committed
812
    return result;
813
}
cRTrn13's avatar
cRTrn13 committed
814

npzacs's avatar
npzacs committed
815
static int _get_bus_encryption_enabled(AACS *aacs)
816 817 818 819 820
{
    AACS_FILE_H *fp = NULL;
    uint8_t buf[2];
    int bee = 0;

npzacs's avatar
npzacs committed
821
    fp = _file_open(aacs, "AACS/Content000.cer");
822
    if (!fp) {
npzacs's avatar
npzacs committed
823
        DEBUG(DBG_AACS | DBG_CRIT, "Unable to open content certificate (AACS/Content000.cer)\n");
824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858
        return 0;
    }

    if (file_read(fp, buf, 2) == 2) {
        bee = (buf[1] & 0x80) >> 7;
        DEBUG(DBG_AACS, "Bus Encryption Enabled flag in content certificate: %d\n", bee);
    } else {
        DEBUG(DBG_AACS | DBG_CRIT, "Failed to read Bus Encryption Enabled flag from content certificate file\n");
    }

    file_close(fp);
    return bee;
}

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] & 1;
        DEBUG(DBG_AACS, "Bus Encryption Capable flag in drive certificate: %d\n", bec);
    } else {
        DEBUG(DBG_AACS | DBG_CRIT, "Unable to read drive certificate\n");
    }

    mmc_close(mmc);
    return bec;
}

npzacs's avatar
npzacs committed
859
static int _verify_ts(uint8_t *buf, size_t size)
860
{
861 862
    uint8_t *ptr;

cRTrn13's avatar
cRTrn13 committed
863 864 865 866 867 868 869
    if (size < 192) {
        return 1;
    }

    for (ptr=buf; ptr < buf+192; ptr++) {
        int failed = 0;
        if (*ptr == 0x47) {
870 871 872 873
            uint8_t *ptr2;

            for (ptr2=ptr; ptr2 < buf + size; ptr2 += 192) {
                if (*ptr2 != 0x47) {
cRTrn13's avatar
cRTrn13 committed
874 875
                    failed = 1;
                    break;
876 877
                }
            }
cRTrn13's avatar
cRTrn13 committed
878 879 880
            if (!failed) {
                return 1;
            }
881 882 883 884
        }
        ptr++;
    }

cRTrn13's avatar
cRTrn13 committed
885
    DEBUG(DBG_AACS, "Failed to verify TS!\n");
886

cRTrn13's avatar
cRTrn13 committed
887
    return 0;
888 889
}

890
#define ALIGNED_UNIT_LEN 6144
891
static int _decrypt_unit(AACS *aacs, uint8_t *out_buf, const uint8_t *in_buf, uint32_t curr_uk)
cRTrn13's avatar
cRTrn13 committed
892
{
893 894
    gcry_cipher_hd_t gcry_h;
    int a;
895
    uint8_t key[16];
896 897 898

    gcry_cipher_open(&gcry_h, GCRY_CIPHER_AES, GCRY_CIPHER_MODE_ECB, 0);
    gcry_cipher_setkey(gcry_h, aacs->uks + curr_uk * 16, 16);
899
    gcry_cipher_encrypt(gcry_h, key, 16, in_buf, 16);
900
    gcry_cipher_close(gcry_h);
cRTrn13's avatar
cRTrn13 committed
901

cRTrn13's avatar
cRTrn13 committed
902
    for (a = 0; a < 16; a++) {
903
        key[a] ^= in_buf[a];
cRTrn13's avatar
cRTrn13 committed
904 905
    }

906 907
    memcpy(out_buf, in_buf, 16); /* first 16 bytes are plain */

908 909
    gcry_cipher_open(&gcry_h, GCRY_CIPHER_AES, GCRY_CIPHER_MODE_CBC, 0);
    gcry_cipher_setkey(gcry_h, key, 16);
910
    gcry_cipher_setiv(gcry_h, aacs_iv, 16);
911
    gcry_cipher_decrypt(gcry_h, out_buf + 16, ALIGNED_UNIT_LEN - 16, in_buf + 16, ALIGNED_UNIT_LEN - 16);
912
    gcry_cipher_close(gcry_h);
cRTrn13's avatar
cRTrn13 committed
913

914
    if (_verify_ts(out_buf, ALIGNED_UNIT_LEN)) {
cRTrn13's avatar
cRTrn13 committed
915 916 917
        return 1;
    }

918
    if (curr_uk < aacs->num_uks - 1) {
919
        return _decrypt_unit(aacs, out_buf, in_buf, curr_uk++);
npzacs's avatar
npzacs committed
920 921
    }

cRTrn13's avatar
cRTrn13 committed
922 923 924
    return 0;
}

925
#define SECTOR_LEN 2048
926
static void _decrypt_bus(AACS *aacs, uint8_t *buf)
927 928 929 930 931
{
    gcry_cipher_hd_t gcry_h;

    gcry_cipher_open(&gcry_h, GCRY_CIPHER_AES, GCRY_CIPHER_MODE_CBC, 0);
    gcry_cipher_setkey(gcry_h, aacs->read_data_key, 16);
932
    gcry_cipher_setiv(gcry_h, aacs_iv, 16);
933
    gcry_cipher_decrypt(gcry_h, buf + 16, SECTOR_LEN - 16, NULL, 0);
934 935 936
    gcry_cipher_close(gcry_h);
}

npzacs's avatar
npzacs committed
937 938
void aacs_get_version(int *major, int *minor, int *micro)
{
npzacs's avatar
npzacs committed
939 940 941
    *major = AACS_VERSION_MAJOR;
    *minor = AACS_VERSION_MINOR;
    *micro = AACS_VERSION_MICRO;
npzacs's avatar
npzacs committed
942 943
}

npzacs's avatar
npzacs committed
944
/* aacs_open2() wrapper for backwards compability */
cRTrn13's avatar
cRTrn13 committed
945
AACS *aacs_open(const char *path, const char *configfile_path)
npzacs's avatar
npzacs committed
946 947 948 949 950
{
    int error_code;
    AACS *aacs;

    aacs = aacs_open2(path, configfile_path, &error_code);
npzacs's avatar
npzacs committed
951
    if (!aacs || error_code == AACS_SUCCESS) {
npzacs's avatar
npzacs committed
952 953 954 955 956 957 958 959
        return aacs;
    }

    aacs_close(aacs);
    return NULL;
}

AACS *aacs_open2(const char *path, const char *configfile_path, int *error_code)
cRTrn13's avatar
cRTrn13 committed
960
{
npzacs's avatar
npzacs committed
961
    DEBUG(DBG_AACS, "libaacs "AACS_VERSION_STRING" [%u]\n", (unsigned)sizeof(AACS));
cRTrn13's avatar
cRTrn13 committed
962

963
    DEBUG(DBG_AACS, "Initializing libgcrypt...\n");
npzacs's avatar
npzacs committed
964
    if (!crypto_init()) {
npzacs's avatar
npzacs committed
965
        DEBUG(DBG_AACS | DBG_CRIT, "Failed to initialize libgcrypt\n");