mirror of
https://github.com/Rockbox/rockbox.git
synced 2025-12-07 13:45:03 -05:00
4d632a1774
Also adds support for IM3 functions and SHA-1 on S5L8720. Tested on ipod6g (normal and bootloader builds) This is a part of the large iPod Nano 3G and iPod Nano 4G support patch. Credit: Cástor Muñoz <cmvidal@gmail.com> Change-Id: Ic5e6f5a3321d4b1ec4efd753a4c30e29d83fd7c2
134 lines
4.1 KiB
C
134 lines
4.1 KiB
C
/***************************************************************************
|
|
* __________ __ ___.
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
* \/ \/ \/ \/ \/
|
|
* $Id$
|
|
*
|
|
* Copyright © 2009 Michael Sparmann
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version 2
|
|
* of the License, or (at your option) any later version.
|
|
*
|
|
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
|
* KIND, either express or implied.
|
|
*
|
|
****************************************************************************/
|
|
#include <stdint.h>
|
|
#include <stdbool.h>
|
|
#include <string.h>
|
|
|
|
#include "config.h"
|
|
#include "system.h"
|
|
|
|
#include "s5l87xx.h"
|
|
#include "clocking-s5l8702.h"
|
|
#include "crypto-s5l8702.h"
|
|
|
|
void hwkeyaes(enum hwkeyaes_direction direction, uint32_t keyidx, void* data, uint32_t size)
|
|
{
|
|
int i;
|
|
clockgate_enable(CLOCKGATE_AES, true);
|
|
for (i = 0; i < 4; i++) AESIV[i] = 0;
|
|
AESUNKREG0 = 1;
|
|
AESUNKREG0 = 0;
|
|
AESCONTROL = 1;
|
|
AESUNKREG1 = 0;
|
|
AESTYPE = keyidx;
|
|
AESTYPE2 = ~AESTYPE;
|
|
AESUNKREG2 = 0;
|
|
AESKEYLEN = direction == HWKEYAES_ENCRYPT ? 9 : 8;
|
|
AESOUTSIZE = size;
|
|
AESOUTADDR = data;
|
|
AESINSIZE = size;
|
|
AESINADDR = data;
|
|
AESAUXSIZE = size;
|
|
AESAUXADDR = data;
|
|
AESSIZE3 = size;
|
|
commit_discard_dcache();
|
|
AESGO = 1;
|
|
while (!(AESSTATUS & 0xf));
|
|
clockgate_enable(CLOCKGATE_AES, false);
|
|
}
|
|
|
|
void sha1(void* data, uint32_t size, void* hash)
|
|
{
|
|
int i, space;
|
|
bool done = false;
|
|
uint32_t tmp32[16];
|
|
uint8_t* tmp8 = (uint8_t*)tmp32;
|
|
uint32_t* databuf = (uint32_t*)data;
|
|
uint32_t* hashbuf = (uint32_t*)hash;
|
|
clockgate_enable(CLOCKGATE_SHA, true);
|
|
SHA1RESET = 1;
|
|
while (SHA1CONFIG & 1);
|
|
SHA1RESET = 0;
|
|
SHA1CONFIG = 0;
|
|
#if CONFIG_CPU == S5L8720
|
|
SHA1UNK10 = 0;
|
|
SHA1UNK80 = 0;
|
|
#endif
|
|
while (!done)
|
|
{
|
|
space = ((uint32_t)databuf) - ((uint32_t)data) - size + 64;
|
|
if (space > 0)
|
|
{
|
|
for (i = 0; i < 16; i++) tmp32[i] = 0;
|
|
if (space <= 64)
|
|
{
|
|
for (i = 0; i < 64 - space; i++)
|
|
tmp8[i] = ((uint8_t*)databuf)[i];
|
|
tmp8[64 - space] = 0x80;
|
|
}
|
|
if (space >= 8)
|
|
{
|
|
tmp8[0x3b] = (size >> 29) & 0xff;
|
|
tmp8[0x3c] = (size >> 21) & 0xff;
|
|
tmp8[0x3d] = (size >> 13) & 0xff;
|
|
tmp8[0x3e] = (size >> 5) & 0xff;
|
|
tmp8[0x3f] = (size << 3) & 0xff;
|
|
done = true;
|
|
}
|
|
for (i = 0; i < 16; i++) SHA1DATAIN[i] = tmp32[i];
|
|
}
|
|
else
|
|
for (i = 0; i < 16; i++) SHA1DATAIN[i] = *databuf++;
|
|
SHA1CONFIG |= 2;
|
|
while (SHA1CONFIG & 1);
|
|
SHA1CONFIG |= 8;
|
|
}
|
|
for (i = 0; i < 5; i++) *hashbuf++ = SHA1RESULT[i];
|
|
clockgate_enable(CLOCKGATE_SHA, false);
|
|
}
|
|
|
|
|
|
/*
|
|
* IM3
|
|
*/
|
|
static inline uint32_t get_uint32le(unsigned char *p)
|
|
{
|
|
return p[0] | (p[1] << 8) | (p[2] << 16) | (p[3] << 24);
|
|
}
|
|
|
|
/* calculates SHA1, truncate the result to 128 bits, and encrypt it */
|
|
void im3_sign(uint32_t keyidx, void* data, uint32_t size, void* sign)
|
|
{
|
|
unsigned char hash[SHA1_SZ];
|
|
sha1(data, size, hash);
|
|
memcpy(sign, hash, SIGN_SZ);
|
|
hwkeyaes(HWKEYAES_ENCRYPT, keyidx, sign, SIGN_SZ);
|
|
}
|
|
|
|
/* only supports enc_type 1 and 2 (UKEY) */
|
|
void im3_crypt(enum hwkeyaes_direction direction,
|
|
struct Im3Info *hinfo, void *fw_addr)
|
|
{
|
|
uint32_t fw_size = get_uint32le(hinfo->data_sz);
|
|
hinfo->enc_type = (direction == HWKEYAES_ENCRYPT) ? 1 : 2;
|
|
im3_sign(HWKEYAES_UKEY, hinfo, IM3INFOSIGN_SZ, hinfo->info_sign);
|
|
hwkeyaes(direction, HWKEYAES_UKEY, fw_addr, fw_size);
|
|
}
|