mirror of
https://github.com/Rockbox/rockbox.git
synced 2025-11-23 03:52:45 -05:00
sbinfo: add decryption support and pretty print boot section structure
The encryption/decryption uses a public domain source code git-svn-id: svn://svn.rockbox.org/rockbox/trunk@28696 a1c6a512-1295-4272-9138-f99709370657
This commit is contained in:
Amaury Pouly
parent
a0480c734a
commit
084c6905db
4 changed files with 601 additions and 36 deletions
|
|
@ -3,7 +3,7 @@ TGT = sbinfo
|
||||||
all: $(TGT)
|
all: $(TGT)
|
||||||
|
|
||||||
$(TGT): sbinfo.c
|
$(TGT): sbinfo.c
|
||||||
$(CC) -ansi -o $(TGT) -W -Wall sbinfo.c
|
$(CC) -std=c99 -o $(TGT) -W -Wall sbinfo.c aes128_impl.c
|
||||||
|
|
||||||
clean:
|
clean:
|
||||||
rm -fr $(TGT)
|
rm -fr $(TGT)
|
||||||
|
|
|
||||||
236
utils/sbinfo/aes128_impl.c
Normal file
236
utils/sbinfo/aes128_impl.c
Normal file
|
|
@ -0,0 +1,236 @@
|
||||||
|
// Simple, thoroughly commented implementation of 128-bit AES / Rijndael using C
|
||||||
|
// Chris Hulbert - chris.hulbert@gmail.com - http://splinter.com.au/blog
|
||||||
|
// References:
|
||||||
|
// http://en.wikipedia.org/wiki/Advanced_Encryption_Standard
|
||||||
|
// http://en.wikipedia.org/wiki/Rijndael_key_schedule
|
||||||
|
// http://en.wikipeia.org/wiki/Rijndael_mix_columns
|
||||||
|
// http://en.wikipedia.org/wiki/Rijndael_S-box
|
||||||
|
// This code is public domain, or any OSI-approved license, your choice. No warranty.
|
||||||
|
#include "aes128_impl.h"
|
||||||
|
|
||||||
|
// Here are all the lookup tables for the row shifts, rcon, s-boxes, and galois field multiplications
|
||||||
|
byte shift_rows_table[] = {0,5,10,15,4,9,14,3,8,13,2,7,12,1,6,11};
|
||||||
|
byte shift_rows_table_inv[] = {0,13,10,7,4,1,14,11,8,5,2,15,12,9,6,3};
|
||||||
|
byte lookup_rcon[]={0x8d,0x01,0x02,0x04,0x08,0x10,0x20,0x40,0x80,0x1b,0x36,0x6c,0xd8,0xab,0x4d,0x9a};
|
||||||
|
byte lookup_sbox[]={0x63,0x7c,0x77,0x7b,0xf2,0x6b,0x6f,0xc5,0x30,0x01,0x67,0x2b,0xfe,0xd7,0xab,0x76,0xca,0x82,0xc9,0x7d,0xfa,0x59,0x47,0xf0,0xad,0xd4,0xa2,0xaf,0x9c,0xa4,0x72,0xc0,0xb7,0xfd,0x93,0x26,0x36,0x3f,0xf7,0xcc,0x34,0xa5,0xe5,0xf1,0x71,0xd8,0x31,0x15,0x04,0xc7,0x23,0xc3,0x18,0x96,0x05,0x9a,0x07,0x12,0x80,0xe2,0xeb,0x27,0xb2,0x75,0x09,0x83,0x2c,0x1a,0x1b,0x6e,0x5a,0xa0,0x52,0x3b,0xd6,0xb3,0x29,0xe3,0x2f,0x84,0x53,0xd1,0x00,0xed,0x20,0xfc,0xb1,0x5b,0x6a,0xcb,0xbe,0x39,0x4a,0x4c,0x58,0xcf,0xd0,0xef,0xaa,0xfb,0x43,0x4d,0x33,0x85,0x45,0xf9,0x02,0x7f,0x50,0x3c,0x9f,0xa8,0x51,0xa3,0x40,0x8f,0x92,0x9d,0x38,0xf5,0xbc,0xb6,0xda,0x21,0x10,0xff,0xf3,0xd2,0xcd,0x0c,0x13,0xec,0x5f,0x97,0x44,0x17,0xc4,0xa7,0x7e,0x3d,0x64,0x5d,0x19,0x73,0x60,0x81,0x4f,0xdc,0x22,0x2a,0x90,0x88,0x46,0xee,0xb8,0x14,0xde,0x5e,0x0b,0xdb,0xe0,0x32,0x3a,0x0a,0x49,0x06,0x24,0x5c,0xc2,0xd3,0xac,0x62,0x91,0x95,0xe4,0x79,0xe7,0xc8,0x37,0x6d,0x8d,0xd5,0x4e,0xa9,0x6c,0x56,0xf4,0xea,0x65,0x7a,0xae,0x08,0xba,0x78,0x25,0x2e,0x1c,0xa6,0xb4,0xc6,0xe8,0xdd,0x74,0x1f,0x4b,0xbd,0x8b,0x8a,0x70,0x3e,0xb5,0x66,0x48,0x03,0xf6,0x0e,0x61,0x35,0x57,0xb9,0x86,0xc1,0x1d,0x9e,0xe1,0xf8,0x98,0x11,0x69,0xd9,0x8e,0x94,0x9b,0x1e,0x87,0xe9,0xce,0x55,0x28,0xdf,0x8c,0xa1,0x89,0x0d,0xbf,0xe6,0x42,0x68,0x41,0x99,0x2d,0x0f,0xb0,0x54,0xbb,0x16};
|
||||||
|
byte lookup_sbox_inv[]={0x52,0x09,0x6a,0xd5,0x30,0x36,0xa5,0x38,0xbf,0x40,0xa3,0x9e,0x81,0xf3,0xd7,0xfb,0x7c,0xe3,0x39,0x82,0x9b,0x2f,0xff,0x87,0x34,0x8e,0x43,0x44,0xc4,0xde,0xe9,0xcb,0x54,0x7b,0x94,0x32,0xa6,0xc2,0x23,0x3d,0xee,0x4c,0x95,0x0b,0x42,0xfa,0xc3,0x4e,0x08,0x2e,0xa1,0x66,0x28,0xd9,0x24,0xb2,0x76,0x5b,0xa2,0x49,0x6d,0x8b,0xd1,0x25,0x72,0xf8,0xf6,0x64,0x86,0x68,0x98,0x16,0xd4,0xa4,0x5c,0xcc,0x5d,0x65,0xb6,0x92,0x6c,0x70,0x48,0x50,0xfd,0xed,0xb9,0xda,0x5e,0x15,0x46,0x57,0xa7,0x8d,0x9d,0x84,0x90,0xd8,0xab,0x00,0x8c,0xbc,0xd3,0x0a,0xf7,0xe4,0x58,0x05,0xb8,0xb3,0x45,0x06,0xd0,0x2c,0x1e,0x8f,0xca,0x3f,0x0f,0x02,0xc1,0xaf,0xbd,0x03,0x01,0x13,0x8a,0x6b,0x3a,0x91,0x11,0x41,0x4f,0x67,0xdc,0xea,0x97,0xf2,0xcf,0xce,0xf0,0xb4,0xe6,0x73,0x96,0xac,0x74,0x22,0xe7,0xad,0x35,0x85,0xe2,0xf9,0x37,0xe8,0x1c,0x75,0xdf,0x6e,0x47,0xf1,0x1a,0x71,0x1d,0x29,0xc5,0x89,0x6f,0xb7,0x62,0x0e,0xaa,0x18,0xbe,0x1b,0xfc,0x56,0x3e,0x4b,0xc6,0xd2,0x79,0x20,0x9a,0xdb,0xc0,0xfe,0x78,0xcd,0x5a,0xf4,0x1f,0xdd,0xa8,0x33,0x88,0x07,0xc7,0x31,0xb1,0x12,0x10,0x59,0x27,0x80,0xec,0x5f,0x60,0x51,0x7f,0xa9,0x19,0xb5,0x4a,0x0d,0x2d,0xe5,0x7a,0x9f,0x93,0xc9,0x9c,0xef,0xa0,0xe0,0x3b,0x4d,0xae,0x2a,0xf5,0xb0,0xc8,0xeb,0xbb,0x3c,0x83,0x53,0x99,0x61,0x17,0x2b,0x04,0x7e,0xba,0x77,0xd6,0x26,0xe1,0x69,0x14,0x63,0x55,0x21,0x0c,0x7d};
|
||||||
|
byte lookup_g2 []={0x00,0x02,0x04,0x06,0x08,0x0a,0x0c,0x0e,0x10,0x12,0x14,0x16,0x18,0x1a,0x1c,0x1e,0x20,0x22,0x24,0x26,0x28,0x2a,0x2c,0x2e,0x30,0x32,0x34,0x36,0x38,0x3a,0x3c,0x3e,0x40,0x42,0x44,0x46,0x48,0x4a,0x4c,0x4e,0x50,0x52,0x54,0x56,0x58,0x5a,0x5c,0x5e,0x60,0x62,0x64,0x66,0x68,0x6a,0x6c,0x6e,0x70,0x72,0x74,0x76,0x78,0x7a,0x7c,0x7e,0x80,0x82,0x84,0x86,0x88,0x8a,0x8c,0x8e,0x90,0x92,0x94,0x96,0x98,0x9a,0x9c,0x9e,0xa0,0xa2,0xa4,0xa6,0xa8,0xaa,0xac,0xae,0xb0,0xb2,0xb4,0xb6,0xb8,0xba,0xbc,0xbe,0xc0,0xc2,0xc4,0xc6,0xc8,0xca,0xcc,0xce,0xd0,0xd2,0xd4,0xd6,0xd8,0xda,0xdc,0xde,0xe0,0xe2,0xe4,0xe6,0xe8,0xea,0xec,0xee,0xf0,0xf2,0xf4,0xf6,0xf8,0xfa,0xfc,0xfe,0x1b,0x19,0x1f,0x1d,0x13,0x11,0x17,0x15,0x0b,0x09,0x0f,0x0d,0x03,0x01,0x07,0x05,0x3b,0x39,0x3f,0x3d,0x33,0x31,0x37,0x35,0x2b,0x29,0x2f,0x2d,0x23,0x21,0x27,0x25,0x5b,0x59,0x5f,0x5d,0x53,0x51,0x57,0x55,0x4b,0x49,0x4f,0x4d,0x43,0x41,0x47,0x45,0x7b,0x79,0x7f,0x7d,0x73,0x71,0x77,0x75,0x6b,0x69,0x6f,0x6d,0x63,0x61,0x67,0x65,0x9b,0x99,0x9f,0x9d,0x93,0x91,0x97,0x95,0x8b,0x89,0x8f,0x8d,0x83,0x81,0x87,0x85,0xbb,0xb9,0xbf,0xbd,0xb3,0xb1,0xb7,0xb5,0xab,0xa9,0xaf,0xad,0xa3,0xa1,0xa7,0xa5,0xdb,0xd9,0xdf,0xdd,0xd3,0xd1,0xd7,0xd5,0xcb,0xc9,0xcf,0xcd,0xc3,0xc1,0xc7,0xc5,0xfb,0xf9,0xff,0xfd,0xf3,0xf1,0xf7,0xf5,0xeb,0xe9,0xef,0xed,0xe3,0xe1,0xe7,0xe5};
|
||||||
|
byte lookup_g3 []={0x00,0x03,0x06,0x05,0x0c,0x0f,0x0a,0x09,0x18,0x1b,0x1e,0x1d,0x14,0x17,0x12,0x11,0x30,0x33,0x36,0x35,0x3c,0x3f,0x3a,0x39,0x28,0x2b,0x2e,0x2d,0x24,0x27,0x22,0x21,0x60,0x63,0x66,0x65,0x6c,0x6f,0x6a,0x69,0x78,0x7b,0x7e,0x7d,0x74,0x77,0x72,0x71,0x50,0x53,0x56,0x55,0x5c,0x5f,0x5a,0x59,0x48,0x4b,0x4e,0x4d,0x44,0x47,0x42,0x41,0xc0,0xc3,0xc6,0xc5,0xcc,0xcf,0xca,0xc9,0xd8,0xdb,0xde,0xdd,0xd4,0xd7,0xd2,0xd1,0xf0,0xf3,0xf6,0xf5,0xfc,0xff,0xfa,0xf9,0xe8,0xeb,0xee,0xed,0xe4,0xe7,0xe2,0xe1,0xa0,0xa3,0xa6,0xa5,0xac,0xaf,0xaa,0xa9,0xb8,0xbb,0xbe,0xbd,0xb4,0xb7,0xb2,0xb1,0x90,0x93,0x96,0x95,0x9c,0x9f,0x9a,0x99,0x88,0x8b,0x8e,0x8d,0x84,0x87,0x82,0x81,0x9b,0x98,0x9d,0x9e,0x97,0x94,0x91,0x92,0x83,0x80,0x85,0x86,0x8f,0x8c,0x89,0x8a,0xab,0xa8,0xad,0xae,0xa7,0xa4,0xa1,0xa2,0xb3,0xb0,0xb5,0xb6,0xbf,0xbc,0xb9,0xba,0xfb,0xf8,0xfd,0xfe,0xf7,0xf4,0xf1,0xf2,0xe3,0xe0,0xe5,0xe6,0xef,0xec,0xe9,0xea,0xcb,0xc8,0xcd,0xce,0xc7,0xc4,0xc1,0xc2,0xd3,0xd0,0xd5,0xd6,0xdf,0xdc,0xd9,0xda,0x5b,0x58,0x5d,0x5e,0x57,0x54,0x51,0x52,0x43,0x40,0x45,0x46,0x4f,0x4c,0x49,0x4a,0x6b,0x68,0x6d,0x6e,0x67,0x64,0x61,0x62,0x73,0x70,0x75,0x76,0x7f,0x7c,0x79,0x7a,0x3b,0x38,0x3d,0x3e,0x37,0x34,0x31,0x32,0x23,0x20,0x25,0x26,0x2f,0x2c,0x29,0x2a,0x0b,0x08,0x0d,0x0e,0x07,0x04,0x01,0x02,0x13,0x10,0x15,0x16,0x1f,0x1c,0x19,0x1a};
|
||||||
|
byte lookup_g9 []={0x00,0x09,0x12,0x1b,0x24,0x2d,0x36,0x3f,0x48,0x41,0x5a,0x53,0x6c,0x65,0x7e,0x77,0x90,0x99,0x82,0x8b,0xb4,0xbd,0xa6,0xaf,0xd8,0xd1,0xca,0xc3,0xfc,0xf5,0xee,0xe7,0x3b,0x32,0x29,0x20,0x1f,0x16,0x0d,0x04,0x73,0x7a,0x61,0x68,0x57,0x5e,0x45,0x4c,0xab,0xa2,0xb9,0xb0,0x8f,0x86,0x9d,0x94,0xe3,0xea,0xf1,0xf8,0xc7,0xce,0xd5,0xdc,0x76,0x7f,0x64,0x6d,0x52,0x5b,0x40,0x49,0x3e,0x37,0x2c,0x25,0x1a,0x13,0x08,0x01,0xe6,0xef,0xf4,0xfd,0xc2,0xcb,0xd0,0xd9,0xae,0xa7,0xbc,0xb5,0x8a,0x83,0x98,0x91,0x4d,0x44,0x5f,0x56,0x69,0x60,0x7b,0x72,0x05,0x0c,0x17,0x1e,0x21,0x28,0x33,0x3a,0xdd,0xd4,0xcf,0xc6,0xf9,0xf0,0xeb,0xe2,0x95,0x9c,0x87,0x8e,0xb1,0xb8,0xa3,0xaa,0xec,0xe5,0xfe,0xf7,0xc8,0xc1,0xda,0xd3,0xa4,0xad,0xb6,0xbf,0x80,0x89,0x92,0x9b,0x7c,0x75,0x6e,0x67,0x58,0x51,0x4a,0x43,0x34,0x3d,0x26,0x2f,0x10,0x19,0x02,0x0b,0xd7,0xde,0xc5,0xcc,0xf3,0xfa,0xe1,0xe8,0x9f,0x96,0x8d,0x84,0xbb,0xb2,0xa9,0xa0,0x47,0x4e,0x55,0x5c,0x63,0x6a,0x71,0x78,0x0f,0x06,0x1d,0x14,0x2b,0x22,0x39,0x30,0x9a,0x93,0x88,0x81,0xbe,0xb7,0xac,0xa5,0xd2,0xdb,0xc0,0xc9,0xf6,0xff,0xe4,0xed,0x0a,0x03,0x18,0x11,0x2e,0x27,0x3c,0x35,0x42,0x4b,0x50,0x59,0x66,0x6f,0x74,0x7d,0xa1,0xa8,0xb3,0xba,0x85,0x8c,0x97,0x9e,0xe9,0xe0,0xfb,0xf2,0xcd,0xc4,0xdf,0xd6,0x31,0x38,0x23,0x2a,0x15,0x1c,0x07,0x0e,0x79,0x70,0x6b,0x62,0x5d,0x54,0x4f,0x46};
|
||||||
|
byte lookup_g11 []={0x00,0x0b,0x16,0x1d,0x2c,0x27,0x3a,0x31,0x58,0x53,0x4e,0x45,0x74,0x7f,0x62,0x69,0xb0,0xbb,0xa6,0xad,0x9c,0x97,0x8a,0x81,0xe8,0xe3,0xfe,0xf5,0xc4,0xcf,0xd2,0xd9,0x7b,0x70,0x6d,0x66,0x57,0x5c,0x41,0x4a,0x23,0x28,0x35,0x3e,0x0f,0x04,0x19,0x12,0xcb,0xc0,0xdd,0xd6,0xe7,0xec,0xf1,0xfa,0x93,0x98,0x85,0x8e,0xbf,0xb4,0xa9,0xa2,0xf6,0xfd,0xe0,0xeb,0xda,0xd1,0xcc,0xc7,0xae,0xa5,0xb8,0xb3,0x82,0x89,0x94,0x9f,0x46,0x4d,0x50,0x5b,0x6a,0x61,0x7c,0x77,0x1e,0x15,0x08,0x03,0x32,0x39,0x24,0x2f,0x8d,0x86,0x9b,0x90,0xa1,0xaa,0xb7,0xbc,0xd5,0xde,0xc3,0xc8,0xf9,0xf2,0xef,0xe4,0x3d,0x36,0x2b,0x20,0x11,0x1a,0x07,0x0c,0x65,0x6e,0x73,0x78,0x49,0x42,0x5f,0x54,0xf7,0xfc,0xe1,0xea,0xdb,0xd0,0xcd,0xc6,0xaf,0xa4,0xb9,0xb2,0x83,0x88,0x95,0x9e,0x47,0x4c,0x51,0x5a,0x6b,0x60,0x7d,0x76,0x1f,0x14,0x09,0x02,0x33,0x38,0x25,0x2e,0x8c,0x87,0x9a,0x91,0xa0,0xab,0xb6,0xbd,0xd4,0xdf,0xc2,0xc9,0xf8,0xf3,0xee,0xe5,0x3c,0x37,0x2a,0x21,0x10,0x1b,0x06,0x0d,0x64,0x6f,0x72,0x79,0x48,0x43,0x5e,0x55,0x01,0x0a,0x17,0x1c,0x2d,0x26,0x3b,0x30,0x59,0x52,0x4f,0x44,0x75,0x7e,0x63,0x68,0xb1,0xba,0xa7,0xac,0x9d,0x96,0x8b,0x80,0xe9,0xe2,0xff,0xf4,0xc5,0xce,0xd3,0xd8,0x7a,0x71,0x6c,0x67,0x56,0x5d,0x40,0x4b,0x22,0x29,0x34,0x3f,0x0e,0x05,0x18,0x13,0xca,0xc1,0xdc,0xd7,0xe6,0xed,0xf0,0xfb,0x92,0x99,0x84,0x8f,0xbe,0xb5,0xa8,0xa3};
|
||||||
|
byte lookup_g13 []={0x00,0x0d,0x1a,0x17,0x34,0x39,0x2e,0x23,0x68,0x65,0x72,0x7f,0x5c,0x51,0x46,0x4b,0xd0,0xdd,0xca,0xc7,0xe4,0xe9,0xfe,0xf3,0xb8,0xb5,0xa2,0xaf,0x8c,0x81,0x96,0x9b,0xbb,0xb6,0xa1,0xac,0x8f,0x82,0x95,0x98,0xd3,0xde,0xc9,0xc4,0xe7,0xea,0xfd,0xf0,0x6b,0x66,0x71,0x7c,0x5f,0x52,0x45,0x48,0x03,0x0e,0x19,0x14,0x37,0x3a,0x2d,0x20,0x6d,0x60,0x77,0x7a,0x59,0x54,0x43,0x4e,0x05,0x08,0x1f,0x12,0x31,0x3c,0x2b,0x26,0xbd,0xb0,0xa7,0xaa,0x89,0x84,0x93,0x9e,0xd5,0xd8,0xcf,0xc2,0xe1,0xec,0xfb,0xf6,0xd6,0xdb,0xcc,0xc1,0xe2,0xef,0xf8,0xf5,0xbe,0xb3,0xa4,0xa9,0x8a,0x87,0x90,0x9d,0x06,0x0b,0x1c,0x11,0x32,0x3f,0x28,0x25,0x6e,0x63,0x74,0x79,0x5a,0x57,0x40,0x4d,0xda,0xd7,0xc0,0xcd,0xee,0xe3,0xf4,0xf9,0xb2,0xbf,0xa8,0xa5,0x86,0x8b,0x9c,0x91,0x0a,0x07,0x10,0x1d,0x3e,0x33,0x24,0x29,0x62,0x6f,0x78,0x75,0x56,0x5b,0x4c,0x41,0x61,0x6c,0x7b,0x76,0x55,0x58,0x4f,0x42,0x09,0x04,0x13,0x1e,0x3d,0x30,0x27,0x2a,0xb1,0xbc,0xab,0xa6,0x85,0x88,0x9f,0x92,0xd9,0xd4,0xc3,0xce,0xed,0xe0,0xf7,0xfa,0xb7,0xba,0xad,0xa0,0x83,0x8e,0x99,0x94,0xdf,0xd2,0xc5,0xc8,0xeb,0xe6,0xf1,0xfc,0x67,0x6a,0x7d,0x70,0x53,0x5e,0x49,0x44,0x0f,0x02,0x15,0x18,0x3b,0x36,0x21,0x2c,0x0c,0x01,0x16,0x1b,0x38,0x35,0x22,0x2f,0x64,0x69,0x7e,0x73,0x50,0x5d,0x4a,0x47,0xdc,0xd1,0xc6,0xcb,0xe8,0xe5,0xf2,0xff,0xb4,0xb9,0xae,0xa3,0x80,0x8d,0x9a,0x97};
|
||||||
|
byte lookup_g14 []={0x00,0x0e,0x1c,0x12,0x38,0x36,0x24,0x2a,0x70,0x7e,0x6c,0x62,0x48,0x46,0x54,0x5a,0xe0,0xee,0xfc,0xf2,0xd8,0xd6,0xc4,0xca,0x90,0x9e,0x8c,0x82,0xa8,0xa6,0xb4,0xba,0xdb,0xd5,0xc7,0xc9,0xe3,0xed,0xff,0xf1,0xab,0xa5,0xb7,0xb9,0x93,0x9d,0x8f,0x81,0x3b,0x35,0x27,0x29,0x03,0x0d,0x1f,0x11,0x4b,0x45,0x57,0x59,0x73,0x7d,0x6f,0x61,0xad,0xa3,0xb1,0xbf,0x95,0x9b,0x89,0x87,0xdd,0xd3,0xc1,0xcf,0xe5,0xeb,0xf9,0xf7,0x4d,0x43,0x51,0x5f,0x75,0x7b,0x69,0x67,0x3d,0x33,0x21,0x2f,0x05,0x0b,0x19,0x17,0x76,0x78,0x6a,0x64,0x4e,0x40,0x52,0x5c,0x06,0x08,0x1a,0x14,0x3e,0x30,0x22,0x2c,0x96,0x98,0x8a,0x84,0xae,0xa0,0xb2,0xbc,0xe6,0xe8,0xfa,0xf4,0xde,0xd0,0xc2,0xcc,0x41,0x4f,0x5d,0x53,0x79,0x77,0x65,0x6b,0x31,0x3f,0x2d,0x23,0x09,0x07,0x15,0x1b,0xa1,0xaf,0xbd,0xb3,0x99,0x97,0x85,0x8b,0xd1,0xdf,0xcd,0xc3,0xe9,0xe7,0xf5,0xfb,0x9a,0x94,0x86,0x88,0xa2,0xac,0xbe,0xb0,0xea,0xe4,0xf6,0xf8,0xd2,0xdc,0xce,0xc0,0x7a,0x74,0x66,0x68,0x42,0x4c,0x5e,0x50,0x0a,0x04,0x16,0x18,0x32,0x3c,0x2e,0x20,0xec,0xe2,0xf0,0xfe,0xd4,0xda,0xc8,0xc6,0x9c,0x92,0x80,0x8e,0xa4,0xaa,0xb8,0xb6,0x0c,0x02,0x10,0x1e,0x34,0x3a,0x28,0x26,0x7c,0x72,0x60,0x6e,0x44,0x4a,0x58,0x56,0x37,0x39,0x2b,0x25,0x0f,0x01,0x13,0x1d,0x47,0x49,0x5b,0x55,0x7f,0x71,0x63,0x6d,0xd7,0xd9,0xcb,0xc5,0xef,0xe1,0xf3,0xfd,0xa7,0xa9,0xbb,0xb5,0x9f,0x91,0x83,0x8d};
|
||||||
|
|
||||||
|
// Xor's all elements in a n byte array a by b
|
||||||
|
void xor_(byte *a, byte *b, int n) {
|
||||||
|
int i;
|
||||||
|
for (i=0;i<n;i++)
|
||||||
|
a[i] ^= b[i];
|
||||||
|
}
|
||||||
|
|
||||||
|
// Xor the current cipher state by a specific round key
|
||||||
|
static void xor_round_key(byte *state, byte *keys, int round) {
|
||||||
|
xor_(state,keys+round*16,16);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Apply and reverse the rijndael s-box to all elements in an array
|
||||||
|
// http://en.wikipedia.org/wiki/Rijndael_S-box
|
||||||
|
static void sub_bytes(byte *a,int n) {
|
||||||
|
int i;
|
||||||
|
for (i=0;i<n;i++)
|
||||||
|
a[i] = lookup_sbox[a[i]];
|
||||||
|
}
|
||||||
|
static void sub_bytes_inv(byte *a,int n) {
|
||||||
|
int i;
|
||||||
|
for (i=0;i<n;i++)
|
||||||
|
a[i] = lookup_sbox_inv[a[i]];
|
||||||
|
}
|
||||||
|
|
||||||
|
// Perform the core key schedule transform on 4 bytes, as part of the key expansion process
|
||||||
|
// http://en.wikipedia.org/wiki/Rijndael_key_schedule#Key_schedule_core
|
||||||
|
static void key_schedule_core(byte *a, int i) {
|
||||||
|
byte temp = a[0]; // Rotate the output eight bits to the left
|
||||||
|
a[0]=a[1];
|
||||||
|
a[1]=a[2];
|
||||||
|
a[2]=a[3];
|
||||||
|
a[3]=temp;
|
||||||
|
sub_bytes(a,4); // Apply Rijndael's S-box on all four individual bytes in the output word
|
||||||
|
a[0]^=lookup_rcon[i]; // On just the first (leftmost) byte of the output word, perform the rcon operation with i
|
||||||
|
// as the input, and exclusive or the rcon output with the first byte of the output word
|
||||||
|
}
|
||||||
|
|
||||||
|
// Expand the 16-byte key to 11 round keys (176 bytes)
|
||||||
|
// http://en.wikipedia.org/wiki/Rijndael_key_schedule#The_key_schedule
|
||||||
|
static void expand_key(byte *key, byte *keys) {
|
||||||
|
int bytes=16; // The count of how many bytes we've created so far
|
||||||
|
int i=1; // The rcon iteration value i is set to 1
|
||||||
|
int j; // For repeating the second stage 3 times
|
||||||
|
byte t[4]; // Temporary working area known as 't' in the Wiki article
|
||||||
|
memcpy(keys,key,16); // The first 16 bytes of the expanded key are simply the encryption key
|
||||||
|
|
||||||
|
while (bytes<176) { // Until we have 176 bytes of expanded key, we do the following:
|
||||||
|
memcpy(t,keys+bytes-4,4); // We assign the value of the previous four bytes in the expanded key to t
|
||||||
|
key_schedule_core(t, i); // We perform the key schedule core on t, with i as the rcon iteration value
|
||||||
|
i++; // We increment i by 1
|
||||||
|
xor_(t,keys+bytes-16,4); // We exclusive-or t with the four-byte block 16 bytes before the new expanded key.
|
||||||
|
memcpy(keys+bytes,t,4); // This becomes the next 4 bytes in the expanded key
|
||||||
|
bytes+=4; // Keep track of how many expanded key bytes we've added
|
||||||
|
|
||||||
|
// We then do the following three times to create the next twelve bytes
|
||||||
|
for (j=0;j<3;j++) {
|
||||||
|
memcpy(t,keys+bytes-4,4); // We assign the value of the previous 4 bytes in the expanded key to t
|
||||||
|
xor_(t,keys+bytes-16,4); // We exclusive-or t with the four-byte block n bytes before
|
||||||
|
memcpy(keys+bytes,t,4); // This becomes the next 4 bytes in the expanded key
|
||||||
|
bytes+=4; // Keep track of how many expanded key bytes we've added
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
// Apply / reverse the shift rows step on the 16 byte cipher state
|
||||||
|
// http://en.wikipedia.org/wiki/Advanced_Encryption_Standard#The_ShiftRows_step
|
||||||
|
static void shift_rows(byte *state) {
|
||||||
|
int i;
|
||||||
|
byte temp[16];
|
||||||
|
memcpy(temp,state,16);
|
||||||
|
for (i=0;i<16;i++)
|
||||||
|
state[i]=temp[shift_rows_table[i]];
|
||||||
|
}
|
||||||
|
static void shift_rows_inv(byte *state) {
|
||||||
|
int i;
|
||||||
|
byte temp[16];
|
||||||
|
memcpy(temp,state,16);
|
||||||
|
for (i=0;i<16;i++)
|
||||||
|
state[i]=temp[shift_rows_table_inv[i]];
|
||||||
|
}
|
||||||
|
|
||||||
|
// Perform the mix columns matrix on one column of 4 bytes
|
||||||
|
// http://en.wikipedia.org/wiki/Rijndael_mix_columns
|
||||||
|
static void mix_col (byte *state) {
|
||||||
|
byte a0 = state[0];
|
||||||
|
byte a1 = state[1];
|
||||||
|
byte a2 = state[2];
|
||||||
|
byte a3 = state[3];
|
||||||
|
state[0] = lookup_g2[a0] ^ lookup_g3[a1] ^ a2 ^ a3;
|
||||||
|
state[1] = lookup_g2[a1] ^ lookup_g3[a2] ^ a3 ^ a0;
|
||||||
|
state[2] = lookup_g2[a2] ^ lookup_g3[a3] ^ a0 ^ a1;
|
||||||
|
state[3] = lookup_g2[a3] ^ lookup_g3[a0] ^ a1 ^ a2;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Perform the mix columns matrix on each column of the 16 bytes
|
||||||
|
static void mix_cols (byte *state) {
|
||||||
|
mix_col(state);
|
||||||
|
mix_col(state+4);
|
||||||
|
mix_col(state+8);
|
||||||
|
mix_col(state+12);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Perform the inverse mix columns matrix on one column of 4 bytes
|
||||||
|
// http://en.wikipedia.org/wiki/Rijndael_mix_columns
|
||||||
|
static void mix_col_inv (byte *state) {
|
||||||
|
byte a0 = state[0];
|
||||||
|
byte a1 = state[1];
|
||||||
|
byte a2 = state[2];
|
||||||
|
byte a3 = state[3];
|
||||||
|
state[0] = lookup_g14[a0] ^ lookup_g9[a3] ^ lookup_g13[a2] ^ lookup_g11[a1];
|
||||||
|
state[1] = lookup_g14[a1] ^ lookup_g9[a0] ^ lookup_g13[a3] ^ lookup_g11[a2];
|
||||||
|
state[2] = lookup_g14[a2] ^ lookup_g9[a1] ^ lookup_g13[a0] ^ lookup_g11[a3];
|
||||||
|
state[3] = lookup_g14[a3] ^ lookup_g9[a2] ^ lookup_g13[a1] ^ lookup_g11[a0];
|
||||||
|
}
|
||||||
|
|
||||||
|
// Perform the inverse mix columns matrix on each column of the 16 bytes
|
||||||
|
static void mix_cols_inv (byte *state) {
|
||||||
|
mix_col_inv(state);
|
||||||
|
mix_col_inv(state+4);
|
||||||
|
mix_col_inv(state+8);
|
||||||
|
mix_col_inv(state+12);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Encrypt a single 128 bit block by a 128 bit key using AES
|
||||||
|
// http://en.wikipedia.org/wiki/Advanced_Encryption_Standard
|
||||||
|
void EncryptAES(byte *msg, byte *key, byte *c) {
|
||||||
|
int i; // To count the rounds
|
||||||
|
|
||||||
|
// Key expansion
|
||||||
|
byte keys[176];
|
||||||
|
expand_key(key,keys);
|
||||||
|
|
||||||
|
// First Round
|
||||||
|
memcpy(c, msg, 16);
|
||||||
|
xor_round_key(c,keys,0);
|
||||||
|
|
||||||
|
// Middle rounds
|
||||||
|
for(i=0; i<9; i++) {
|
||||||
|
sub_bytes(c,16);
|
||||||
|
shift_rows(c);
|
||||||
|
mix_cols(c);
|
||||||
|
xor_round_key(c, keys, i+1);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Final Round
|
||||||
|
sub_bytes(c,16);
|
||||||
|
shift_rows(c);
|
||||||
|
xor_round_key(c, keys, 10);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Decrypt a single 128 bit block by a 128 bit key using AES
|
||||||
|
// http://en.wikipedia.org/wiki/Advanced_Encryption_Standard
|
||||||
|
void DecryptAES(byte *c, byte *key, byte *m) {
|
||||||
|
int i; // To count the rounds
|
||||||
|
|
||||||
|
// Key expansion
|
||||||
|
byte keys[176];
|
||||||
|
expand_key(key,keys);
|
||||||
|
|
||||||
|
// Reverse the final Round
|
||||||
|
memcpy(m,c,16);
|
||||||
|
xor_round_key(m,keys,10);
|
||||||
|
shift_rows_inv(m);
|
||||||
|
sub_bytes_inv(m, 16);
|
||||||
|
|
||||||
|
// Reverse the middle rounds
|
||||||
|
for (i=0; i<9; i++) {
|
||||||
|
xor_round_key(m,keys,9-i);
|
||||||
|
mix_cols_inv(m);
|
||||||
|
shift_rows_inv(m);
|
||||||
|
sub_bytes_inv(m, 16);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Reverse the first Round
|
||||||
|
xor_round_key(m, keys, 0);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
// Pretty-print a key (or any smallish buffer) onto screen as hex
|
||||||
|
void Pretty(byte* b,int len,const char* label)
|
||||||
|
{
|
||||||
|
char out[100];
|
||||||
|
int i;
|
||||||
|
for (i=0;i<len;i++)
|
||||||
|
sprintf(out+i*2,"%02x",b[i]);
|
||||||
|
|
||||||
|
printf("%s%s",label, out);
|
||||||
|
}
|
||||||
|
*/
|
||||||
|
|
||||||
|
/*
|
||||||
|
// Test AES
|
||||||
|
int main(void)
|
||||||
|
{
|
||||||
|
byte key[] = {0x12,0x34,0x56,0x12,0x34,0x56,0x12,0x34,0x56,0x12,0x34,0x56,0x12,0x34,0x56,0x12};
|
||||||
|
byte msg[] = {0xab,0xcd,0xef,0xab,0xcd,0xef,0xab,0xcd,0xef,0xab,0xcd,0xef,0xab,0xcd,0xef,0xab};
|
||||||
|
byte encrypted[16], decrypted[16];
|
||||||
|
|
||||||
|
printf("Test AES\r\n\n");
|
||||||
|
Pretty(key,16,"Key: ");
|
||||||
|
Pretty(msg,16,"Original: ");
|
||||||
|
|
||||||
|
EncryptAES(msg,key,encrypted);
|
||||||
|
printf("Encrypted should be: 85E5A3D7356A61E29A8AFA559AD67102\r\n");
|
||||||
|
Pretty(encrypted,16,"Encrypted: ");
|
||||||
|
|
||||||
|
DecryptAES(encrypted,key,decrypted);
|
||||||
|
Pretty(decrypted,16,"Decrypted: ");
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
*/
|
||||||
10
utils/sbinfo/aes128_impl.h
Normal file
10
utils/sbinfo/aes128_impl.h
Normal file
|
|
@ -0,0 +1,10 @@
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
|
typedef uint8_t byte;
|
||||||
|
|
||||||
|
void xor_(byte *a, byte *b, int n);
|
||||||
|
void EncryptAES(byte *msg, byte *key, byte *c);
|
||||||
|
void DecryptAES(byte *c, byte *key, byte *m);
|
||||||
|
void Pretty(byte* b,int len,const char* label);
|
||||||
|
|
@ -38,6 +38,7 @@
|
||||||
#include <string.h>
|
#include <string.h>
|
||||||
#include <ctype.h>
|
#include <ctype.h>
|
||||||
#include <time.h>
|
#include <time.h>
|
||||||
|
#include "aes128_impl.h"
|
||||||
|
|
||||||
#if 1 /* ANSI colors */
|
#if 1 /* ANSI colors */
|
||||||
|
|
||||||
|
|
@ -73,12 +74,48 @@ char BLUE[] = { 0x1b, 0x5b, 0x31, 0x3b, '3', '4', 0x6d, '\0' };
|
||||||
|
|
||||||
size_t sz; /* file size */
|
size_t sz; /* file size */
|
||||||
uint8_t *buf; /* file content */
|
uint8_t *buf; /* file content */
|
||||||
|
#define PREFIX_SIZE 128
|
||||||
|
char out_prefix[PREFIX_SIZE];
|
||||||
|
const char *key_file;
|
||||||
|
|
||||||
|
#define SB_INST_OP(inst) (((inst) >> 8) & 0xff)
|
||||||
|
#define SB_INST_UNK(inst) ((inst) & 0xff)
|
||||||
|
|
||||||
/* 1st block description */
|
#define SB_INST_NOP 0x0
|
||||||
uint32_t idx,checksum,bs_multiplier,firmware_sz;
|
#define SB_INST_TAG 0x1
|
||||||
uint32_t unknown_4_1; uint16_t unknown_1, unknown_2;
|
#define SB_INST_LOAD 0x2
|
||||||
uint32_t unknown_4_2,unknown_4_3;
|
#define SB_INST_FILL 0x3
|
||||||
|
#define SB_INST_JUMP 0x4
|
||||||
|
#define SB_INST_CALL 0x5
|
||||||
|
#define SB_INST_MODE 0x6
|
||||||
|
|
||||||
|
struct sb_instruction_header_t
|
||||||
|
{
|
||||||
|
uint32_t inst;
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct sb_instruction_load_t
|
||||||
|
{
|
||||||
|
struct sb_instruction_header_t hdr;
|
||||||
|
uint32_t addr;
|
||||||
|
uint32_t len;
|
||||||
|
uint32_t crc;
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct sb_instruction_fill_t
|
||||||
|
{
|
||||||
|
struct sb_instruction_header_t hdr;
|
||||||
|
uint32_t addr;
|
||||||
|
uint32_t len;
|
||||||
|
uint32_t pattern;
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct sb_instruction_call_t
|
||||||
|
{
|
||||||
|
struct sb_instruction_header_t hdr;
|
||||||
|
uint32_t addr;
|
||||||
|
uint32_t arg;
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
static void *xmalloc(size_t s) /* malloc helper */
|
static void *xmalloc(size_t s) /* malloc helper */
|
||||||
{
|
{
|
||||||
|
|
@ -122,6 +159,12 @@ static void printhex(int offset, int len)
|
||||||
printf("\n");
|
printf("\n");
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void print_key(byte key[16])
|
||||||
|
{
|
||||||
|
for(int i = 0; i < 16; i++)
|
||||||
|
printf("%02X ", key[i]);
|
||||||
|
}
|
||||||
|
|
||||||
/* verify the firmware header */
|
/* verify the firmware header */
|
||||||
static void check(unsigned long filesize)
|
static void check(unsigned long filesize)
|
||||||
{
|
{
|
||||||
|
|
@ -137,6 +180,205 @@ static void check(unsigned long filesize)
|
||||||
assert(filesize == totalsize);
|
assert(filesize == totalsize);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
int convxdigit(char digit, byte *val)
|
||||||
|
{
|
||||||
|
if(digit >= '0' && digit <= '9')
|
||||||
|
{
|
||||||
|
*val = digit - '0';
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
else if(digit >= 'A' && digit <= 'F')
|
||||||
|
{
|
||||||
|
*val = digit - 'A' + 10;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
else if(digit >= 'a' && digit <= 'f')
|
||||||
|
{
|
||||||
|
*val = digit - 'a' + 10;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
typedef byte (*key_array_t)[16];
|
||||||
|
|
||||||
|
static key_array_t read_keys(int num_keys)
|
||||||
|
{
|
||||||
|
int size;
|
||||||
|
struct stat st;
|
||||||
|
int fd = open(key_file,O_RDONLY);
|
||||||
|
if(fd == -1)
|
||||||
|
bugp("opening key file failed");
|
||||||
|
if(fstat(fd,&st) == -1)
|
||||||
|
bugp("key file stat() failed");
|
||||||
|
size = st.st_size;
|
||||||
|
char *buf = xmalloc(size);
|
||||||
|
if(read(fd,buf,sz)!=(ssize_t)size)
|
||||||
|
bugp("reading key file");
|
||||||
|
close(fd);
|
||||||
|
|
||||||
|
key_array_t keys = xmalloc(sizeof(byte[16]) * num_keys);
|
||||||
|
int pos = 0;
|
||||||
|
for(int i = 0; i < num_keys; i++)
|
||||||
|
{
|
||||||
|
/* skip ws */
|
||||||
|
while(pos < size && isspace(buf[pos]))
|
||||||
|
pos++;
|
||||||
|
/* enough space ? */
|
||||||
|
if((pos + 32) > size)
|
||||||
|
bugp("invalid key file (not enough keys)");
|
||||||
|
for(int j = 0; j < 16; j++)
|
||||||
|
{
|
||||||
|
byte a, b;
|
||||||
|
if(convxdigit(buf[pos + 2 * j], &a) || convxdigit(buf[pos + 2 * j + 1], &b))
|
||||||
|
bugp(" invalid key, it should be a 128-bit key written in hexadecimal\n");
|
||||||
|
keys[i][j] = (a << 4) | b;
|
||||||
|
}
|
||||||
|
pos += 32;
|
||||||
|
}
|
||||||
|
free(buf);
|
||||||
|
|
||||||
|
return keys;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void cbc_mac(
|
||||||
|
byte *in_data, /* Input data */
|
||||||
|
byte *out_data, /* Output data (or NULL) */
|
||||||
|
int nr_blocks, /* Number of blocks to encrypt/decrypt (one block=16 bytes) */
|
||||||
|
byte key[16], /* Key */
|
||||||
|
byte iv[16], /* Initialisation Vector */
|
||||||
|
byte (*out_cbc_mac)[16], /* CBC-MAC of the result (or NULL) */
|
||||||
|
int encrypt /* 1 to encrypt, 0 to decrypt */
|
||||||
|
)
|
||||||
|
{
|
||||||
|
byte feedback[16];
|
||||||
|
memcpy(feedback, iv, 16);
|
||||||
|
|
||||||
|
if(encrypt)
|
||||||
|
{
|
||||||
|
/* for each block */
|
||||||
|
for(int i = 0; i < nr_blocks; i++)
|
||||||
|
{
|
||||||
|
/* xor it with feedback */
|
||||||
|
xor_(feedback, &in_data[i * 16], 16);
|
||||||
|
/* encrypt it using aes */
|
||||||
|
EncryptAES(feedback, key, feedback);
|
||||||
|
/* write cipher to output */
|
||||||
|
if(out_data)
|
||||||
|
memcpy(&out_data[i * 16], feedback, 16);
|
||||||
|
}
|
||||||
|
if(out_cbc_mac)
|
||||||
|
memcpy(out_cbc_mac, feedback, 16);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* nothing to do ? */
|
||||||
|
if(out_data == NULL)
|
||||||
|
bugp("can't ask to decrypt with no output buffer");
|
||||||
|
|
||||||
|
/* for each block */
|
||||||
|
for(int i = 0; i < nr_blocks; i++)
|
||||||
|
{
|
||||||
|
/* decrypt it using aes */
|
||||||
|
DecryptAES(&in_data[i * 16], key, &out_data[i * 16]);
|
||||||
|
/* xor it with iv */
|
||||||
|
xor_(&out_data[i * 16], feedback, 16);
|
||||||
|
/* copy cipher to iv */
|
||||||
|
memcpy(feedback, &in_data[i * 16], 16);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#define ROUND_UP(val, round) ((((val) + (round) - 1) / (round)) * (round))
|
||||||
|
|
||||||
|
static void extract_section(int data_sec, char name[5], byte *buf, int size, const char *indent)
|
||||||
|
{
|
||||||
|
char filename[PREFIX_SIZE + 16];
|
||||||
|
snprintf(filename, sizeof filename, "%s%s.bin", out_prefix, name);
|
||||||
|
FILE *fd = fopen(filename, "wb");
|
||||||
|
if (fd != NULL) {
|
||||||
|
fwrite(buf, size, 1, fd);
|
||||||
|
fclose(fd);
|
||||||
|
}
|
||||||
|
if(data_sec)
|
||||||
|
return;
|
||||||
|
/* Pretty print the content */
|
||||||
|
int pos = 0;
|
||||||
|
while(pos < size)
|
||||||
|
{
|
||||||
|
struct sb_instruction_header_t *hdr = (struct sb_instruction_header_t *)&buf[pos];
|
||||||
|
if(SB_INST_OP(hdr->inst) == SB_INST_LOAD)
|
||||||
|
{
|
||||||
|
struct sb_instruction_load_t *load = (struct sb_instruction_load_t *)&buf[pos];
|
||||||
|
color(RED);
|
||||||
|
printf("%sLOAD", indent);
|
||||||
|
color(OFF);printf(" | ");
|
||||||
|
color(BLUE);
|
||||||
|
printf("addr=%#08x", load->addr);
|
||||||
|
color(OFF);printf(" | ");
|
||||||
|
color(GREEN);
|
||||||
|
printf("len=%#08x", load->len);
|
||||||
|
color(OFF);printf(" | ");
|
||||||
|
color(YELLOW);
|
||||||
|
printf("crc=%#08x\n", load->crc);
|
||||||
|
color(OFF);
|
||||||
|
|
||||||
|
pos += load->len + sizeof(struct sb_instruction_load_t);
|
||||||
|
// unsure about rounding
|
||||||
|
pos = ROUND_UP(pos, 16);
|
||||||
|
}
|
||||||
|
else if(SB_INST_OP(hdr->inst) == SB_INST_FILL)
|
||||||
|
{
|
||||||
|
struct sb_instruction_fill_t *fill = (struct sb_instruction_fill_t *)&buf[pos];
|
||||||
|
color(RED);
|
||||||
|
printf("%sFILL", indent);
|
||||||
|
color(OFF);printf(" | ");
|
||||||
|
color(BLUE);
|
||||||
|
printf("addr=%#08x", fill->addr);
|
||||||
|
color(OFF);printf(" | ");
|
||||||
|
color(GREEN);
|
||||||
|
printf("len=%#08x", fill->len);
|
||||||
|
color(OFF);printf(" | ");
|
||||||
|
color(YELLOW);
|
||||||
|
printf("pattern=%#08x\n", fill->pattern);
|
||||||
|
color(OFF);
|
||||||
|
|
||||||
|
pos += sizeof(struct sb_instruction_fill_t);
|
||||||
|
// fixme: useless as pos is a multiple of 16 and fill struct is 4-bytes wide ?
|
||||||
|
pos = ROUND_UP(pos, 16);
|
||||||
|
}
|
||||||
|
else if(SB_INST_OP(hdr->inst) == SB_INST_CALL ||
|
||||||
|
SB_INST_OP(hdr->inst) == SB_INST_JUMP)
|
||||||
|
{
|
||||||
|
int is_call = (SB_INST_OP(hdr->inst) == SB_INST_CALL);
|
||||||
|
struct sb_instruction_call_t *call = (struct sb_instruction_call_t *)&buf[pos];
|
||||||
|
color(RED);
|
||||||
|
if(is_call)
|
||||||
|
printf("%sCALL", indent);
|
||||||
|
else
|
||||||
|
printf("%sJUMP", indent);
|
||||||
|
color(OFF);printf(" | ");
|
||||||
|
color(BLUE);
|
||||||
|
printf("addr=%#08x", call->addr);
|
||||||
|
color(OFF);printf(" | ");
|
||||||
|
color(GREEN);
|
||||||
|
printf("arg=%#08x\n", call->arg);
|
||||||
|
color(OFF);
|
||||||
|
|
||||||
|
pos += sizeof(struct sb_instruction_call_t);
|
||||||
|
// fixme: useless as pos is a multiple of 16 and call struct is 4-bytes wide ?
|
||||||
|
pos = ROUND_UP(pos, 16);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
color(RED);
|
||||||
|
printf("Unknown instruction %d at address %#08lx\n", SB_INST_OP(hdr->inst), (unsigned long)pos);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
static void extract(unsigned long filesize)
|
static void extract(unsigned long filesize)
|
||||||
{
|
{
|
||||||
/* Basic header info */
|
/* Basic header info */
|
||||||
|
|
@ -154,7 +396,7 @@ static void extract(unsigned long filesize)
|
||||||
printf("Sizes and offsets:\n");
|
printf("Sizes and offsets:\n");
|
||||||
color(GREEN);
|
color(GREEN);
|
||||||
int num_enc = get16le(0x28);
|
int num_enc = get16le(0x28);
|
||||||
printf("\t# of encryption info = %d\n", num_enc);
|
printf("\t# of encryption keys = %d\n", num_enc);
|
||||||
int num_chunks = get16le(0x2E);
|
int num_chunks = get16le(0x2E);
|
||||||
printf("\t# of chunk headers = %d\n", num_chunks);
|
printf("\t# of chunk headers = %d\n", num_chunks);
|
||||||
|
|
||||||
|
|
@ -187,12 +429,72 @@ static void extract(unsigned long filesize)
|
||||||
printf("\tProduct version = %X.%X.%X\n", p_maj, p_min, p_sub);
|
printf("\tProduct version = %X.%X.%X\n", p_maj, p_min, p_sub);
|
||||||
printf("\tComponent version = %X.%X.%X\n", c_maj, c_min, c_sub);
|
printf("\tComponent version = %X.%X.%X\n", c_maj, c_min, c_sub);
|
||||||
|
|
||||||
|
/* encryption cbc-mac */
|
||||||
|
key_array_t keys = NULL; /* array of 16-bytes keys */
|
||||||
|
byte real_key[16];
|
||||||
|
if(num_enc > 0)
|
||||||
|
{
|
||||||
|
keys = read_keys(num_enc);
|
||||||
|
color(BLUE),
|
||||||
|
printf("Encryption data\n");
|
||||||
|
for(int i = 0; i < num_enc; i++)
|
||||||
|
{
|
||||||
|
color(RED);
|
||||||
|
printf("\tKey %d: ", i);
|
||||||
|
print_key(keys[i]);
|
||||||
|
printf("\n");
|
||||||
|
color(GREEN);
|
||||||
|
printf("\t\tCBC-MAC of headers: ");
|
||||||
|
/* copy the cbc mac */
|
||||||
|
byte hdr_cbc_mac[16];
|
||||||
|
memcpy(hdr_cbc_mac, &buf[0x60 + 16 * num_chunks + 32 * i], 16);
|
||||||
|
print_key(hdr_cbc_mac);
|
||||||
|
/* check it */
|
||||||
|
byte computed_cbc_mac[16];
|
||||||
|
byte zero[16];
|
||||||
|
memset(zero, 0, 16);
|
||||||
|
cbc_mac(buf, NULL, 6 + num_chunks, keys[i], zero, &computed_cbc_mac, 1);
|
||||||
|
color(RED);
|
||||||
|
if(memcmp(hdr_cbc_mac, computed_cbc_mac, 16) == 0)
|
||||||
|
printf(" Ok\n");
|
||||||
|
else
|
||||||
|
printf(" Failed\n");
|
||||||
|
color(GREEN);
|
||||||
|
|
||||||
|
printf("\t\tEncrypted key : ");
|
||||||
|
byte (*encrypted_key)[16];
|
||||||
|
encrypted_key = (key_array_t)&buf[0x60 + 16 * num_chunks + 32 * i + 16];
|
||||||
|
print_key(*encrypted_key);
|
||||||
|
printf("\n");
|
||||||
|
/* decrypt */
|
||||||
|
byte decrypted_key[16];
|
||||||
|
byte iv[16];
|
||||||
|
memcpy(iv, buf, 16); /* uses the first 16-bytes of SHA-1 sig as IV */
|
||||||
|
cbc_mac(*encrypted_key, decrypted_key, 1, keys[i], iv, NULL, 0);
|
||||||
|
printf("\t\tDecrypted key : ");
|
||||||
|
print_key(decrypted_key);
|
||||||
|
/* cross-check or copy */
|
||||||
|
if(i == 0)
|
||||||
|
memcpy(real_key, decrypted_key, 16);
|
||||||
|
else if(memcmp(real_key, decrypted_key, 16) == 0)
|
||||||
|
{
|
||||||
|
color(RED);
|
||||||
|
printf(" Cross-Check Ok");
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
color(RED);
|
||||||
|
printf(" Cross-Check Failed");
|
||||||
|
}
|
||||||
|
printf("\n");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
/* chunks */
|
/* chunks */
|
||||||
color(BLUE);
|
color(BLUE);
|
||||||
printf("Chunks\n");
|
printf("Chunks\n");
|
||||||
|
|
||||||
int i;
|
for (int i = 0; i < num_chunks; i++) {
|
||||||
for (i = 0; i < num_chunks; i++) {
|
|
||||||
uint32_t ofs = 0x60 + (i * 16);
|
uint32_t ofs = 0x60 + (i * 16);
|
||||||
|
|
||||||
char name[5];
|
char name[5];
|
||||||
|
|
@ -200,22 +502,32 @@ static void extract(unsigned long filesize)
|
||||||
int pos = 16 * get32le(ofs + 4);
|
int pos = 16 * get32le(ofs + 4);
|
||||||
int size = 16 * get32le(ofs + 8);
|
int size = 16 * get32le(ofs + 8);
|
||||||
int flags = get32le(ofs + 12);
|
int flags = get32le(ofs + 12);
|
||||||
|
int data_sec = (flags == 2);
|
||||||
|
int encrypted = !data_sec && (num_enc > 0);
|
||||||
|
|
||||||
color(GREEN);
|
color(GREEN);
|
||||||
printf("\tChunk '%s'\n", name);
|
printf("\tChunk '%s'\n", name);
|
||||||
printf("\t\tpos = %8x - %8x\n", pos, pos+size);
|
printf("\t\tpos = %8x - %8x\n", pos, pos+size);
|
||||||
printf("\t\tlen = %8x\n", size);
|
printf("\t\tlen = %8x\n", size);
|
||||||
printf("\t\tflags = %8x\n", flags);
|
printf("\t\tflags = %8x", flags);
|
||||||
|
color(RED);
|
||||||
|
if(data_sec)
|
||||||
|
printf(" Data Section");
|
||||||
|
else
|
||||||
|
printf(" Boot Section");
|
||||||
|
if(encrypted)
|
||||||
|
printf(" (Encrypted)");
|
||||||
|
printf("\n");
|
||||||
|
|
||||||
/* save it */
|
/* save it */
|
||||||
char filename[16];
|
byte *sec = xmalloc(size);
|
||||||
strcpy(filename, name);
|
if(encrypted)
|
||||||
strcat(filename, ".bin");
|
cbc_mac(buf + pos, sec, size / 16, real_key, buf, NULL, 0);
|
||||||
FILE *file = fopen(filename, "wb");
|
else
|
||||||
if (file != NULL) {
|
memcpy(sec, buf + pos, size);
|
||||||
fwrite(buf + pos, size, 1, file);
|
|
||||||
fclose(file);
|
extract_section(data_sec, name, sec, size, "\t\t\t");
|
||||||
}
|
free(sec);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* final signature */
|
/* final signature */
|
||||||
|
|
@ -229,29 +541,36 @@ static void extract(unsigned long filesize)
|
||||||
|
|
||||||
int main(int argc, const char **argv)
|
int main(int argc, const char **argv)
|
||||||
{
|
{
|
||||||
int fd;
|
int fd;
|
||||||
struct stat st;
|
struct stat st;
|
||||||
if(argc != 2)
|
if(argc != 3 && argc != 4)
|
||||||
bug("Usage: %s <firmware>\n",*argv);
|
bug("Usage: %s <firmware> <key file> [<out prefix>]\n",*argv);
|
||||||
|
|
||||||
if( (fd = open(argv[1],O_RDONLY)) == -1 )
|
if(argc == 4)
|
||||||
bugp("opening firmware failed");
|
snprintf(out_prefix, PREFIX_SIZE, "%s", argv[3]);
|
||||||
|
else
|
||||||
|
strcpy(out_prefix, "");
|
||||||
|
|
||||||
if(fstat(fd,&st) == -1)
|
if( (fd = open(argv[1],O_RDONLY)) == -1 )
|
||||||
bugp("firmware stat() failed");
|
bugp("opening firmware failed");
|
||||||
sz = st.st_size;
|
|
||||||
|
|
||||||
buf=xmalloc(sz);
|
key_file = argv[2];
|
||||||
if(read(fd,buf,sz)!=(ssize_t)sz) /* load the whole file into memory */
|
|
||||||
bugp("reading firmware");
|
|
||||||
|
|
||||||
close(fd);
|
if(fstat(fd,&st) == -1)
|
||||||
|
bugp("firmware stat() failed");
|
||||||
|
sz = st.st_size;
|
||||||
|
|
||||||
check(st.st_size); /* verify header and checksums */
|
buf=xmalloc(sz);
|
||||||
extract(st.st_size); /* split in blocks */
|
if(read(fd,buf,sz)!=(ssize_t)sz) /* load the whole file into memory */
|
||||||
|
bugp("reading firmware");
|
||||||
|
|
||||||
color(OFF);
|
close(fd);
|
||||||
|
|
||||||
free(buf);
|
check(st.st_size); /* verify header and checksums */
|
||||||
return 0;
|
extract(st.st_size); /* split in blocks */
|
||||||
|
|
||||||
|
color(OFF);
|
||||||
|
|
||||||
|
free(buf);
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
|
||||||
Loading…
Add table
Add a link
Reference in a new issue