mirror of
				https://github.com/dolphin-emu/dolphin.git
				synced 2025-10-25 01:19:19 +00:00 
			
		
		
		
	
		
			
				
	
	
		
			394 lines
		
	
	
	
		
			6.4 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
			
		
		
	
	
			394 lines
		
	
	
	
		
			6.4 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
| // Copyright 2013 Dolphin Emulator Project
 | |
| // Licensed under GPLv2
 | |
| // Refer to the license.txt file included.
 | |
| 
 | |
| // Copyright 2007,2008  Segher Boessenkool  <segher@kernel.crashing.org>
 | |
| // Licensed under the terms of the GNU GPL, version 2
 | |
| // http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt
 | |
| 
 | |
| #include <cstdio>
 | |
| #include <cstdlib>
 | |
| #include <ctime>
 | |
| #include <string.h>
 | |
| 
 | |
| #include "Common/Common.h"
 | |
| #include "Common/Crypto/bn.h"
 | |
| #include "Common/Crypto/ec.h"
 | |
| 
 | |
| // y**2 + x*y = x**3 + x + b
 | |
| UNUSED static const u8 ec_b[30] =
 | |
| 	{0x00,0x66,0x64,0x7e,0xde,0x6c,0x33,0x2c,0x7f,0x8c,0x09,0x23,0xbb,0x58,0x21
 | |
| 	,0x3b,0x33,0x3b,0x20,0xe9,0xce,0x42,0x81,0xfe,0x11,0x5f,0x7d,0x8f,0x90,0xad};
 | |
| 
 | |
| // order of the addition group of points
 | |
| static const u8 ec_N[30] =
 | |
| 	{0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00
 | |
| 	,0x13,0xe9,0x74,0xe7,0x2f,0x8a,0x69,0x22,0x03,0x1d,0x26,0x03,0xcf,0xe0,0xd7};
 | |
| 
 | |
| // base point
 | |
| static const u8 ec_G[60] =
 | |
| 	{0x00,0xfa,0xc9,0xdf,0xcb,0xac,0x83,0x13,0xbb,0x21,0x39,0xf1,0xbb,0x75,0x5f
 | |
| 	,0xef,0x65,0xbc,0x39,0x1f,0x8b,0x36,0xf8,0xf8,0xeb,0x73,0x71,0xfd,0x55,0x8b
 | |
| 	,0x01,0x00,0x6a,0x08,0xa4,0x19,0x03,0x35,0x06,0x78,0xe5,0x85,0x28,0xbe,0xbf
 | |
| 	,0x8a,0x0b,0xef,0xf8,0x67,0xa7,0xca,0x36,0x71,0x6f,0x7e,0x01,0xf8,0x10,0x52};
 | |
| 
 | |
| static void elt_copy(u8 *d, const u8 *a)
 | |
| {
 | |
| 	memcpy(d, a, 30);
 | |
| }
 | |
| 
 | |
| static void elt_zero(u8 *d)
 | |
| {
 | |
| 	memset(d, 0, 30);
 | |
| }
 | |
| 
 | |
| static int elt_is_zero(const u8 *d)
 | |
| {
 | |
| 	u32 i;
 | |
| 
 | |
| 	for (i = 0; i < 30; i++)
 | |
| 		if (d[i] != 0)
 | |
| 			return 0;
 | |
| 
 | |
| 	return 1;
 | |
| }
 | |
| 
 | |
| static void elt_add(u8 *d, const u8 *a, const u8 *b)
 | |
| {
 | |
| 	u32 i;
 | |
| 
 | |
| 	for (i = 0; i < 30; i++)
 | |
| 		d[i] = a[i] ^ b[i];
 | |
| }
 | |
| 
 | |
| static void elt_mul_x(u8 *d, const u8 *a)
 | |
| {
 | |
| 	u8 carry, x, y;
 | |
| 	u32 i;
 | |
| 
 | |
| 	carry = a[0] & 1;
 | |
| 
 | |
| 	x = 0;
 | |
| 	for (i = 0; i < 29; i++) {
 | |
| 		y = a[i + 1];
 | |
| 		d[i] = x ^ (y >> 7);
 | |
| 		x = y << 1;
 | |
| 	}
 | |
| 	d[29] = x ^ carry;
 | |
| 
 | |
| 	d[20] ^= carry << 2;
 | |
| }
 | |
| 
 | |
| static void elt_mul(u8 *d, const u8 *a, const u8 *b)
 | |
| {
 | |
| 	u32 i, n;
 | |
| 	u8 mask;
 | |
| 
 | |
| 	elt_zero(d);
 | |
| 
 | |
| 	i = 0;
 | |
| 	mask = 1;
 | |
| 	for (n = 0; n < 233; n++) {
 | |
| 		elt_mul_x(d, d);
 | |
| 
 | |
| 		if ((a[i] & mask) != 0)
 | |
| 			elt_add(d, d, b);
 | |
| 
 | |
| 		mask >>= 1;
 | |
| 		if (mask == 0) {
 | |
| 			mask = 0x80;
 | |
| 			i++;
 | |
| 		}
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static const u8 square[16] =
 | |
| 	{0x00,0x01,0x04,0x05,0x10,0x11,0x14,0x15,0x40,0x41,0x44,0x45,0x50,0x51,0x54,0x55};
 | |
| 
 | |
| static void elt_square_to_wide(u8 *d, const u8 *a)
 | |
| {
 | |
| 	u32 i;
 | |
| 
 | |
| 	for (i = 0; i < 30; i++) {
 | |
| 		d[2*i] = square[a[i] >> 4];
 | |
| 		d[2*i + 1] = square[a[i] & 15];
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void wide_reduce(u8 *d)
 | |
| {
 | |
| 	u32 i;
 | |
| 	u8 x;
 | |
| 
 | |
| 	for (i = 0; i < 30; i++) {
 | |
| 		x = d[i];
 | |
| 
 | |
| 		d[i + 19] ^= x >> 7;
 | |
| 		d[i + 20] ^= x << 1;
 | |
| 
 | |
| 		d[i + 29] ^= x >> 1;
 | |
| 		d[i + 30] ^= x << 7;
 | |
| 	}
 | |
| 
 | |
| 	x = d[30] & ~1;
 | |
| 
 | |
| 	d[49] ^= x >> 7;
 | |
| 	d[50] ^= x << 1;
 | |
| 
 | |
| 	d[59] ^= x >> 1;
 | |
| 
 | |
| 	d[30] &= 1;
 | |
| }
 | |
| 
 | |
| static void elt_square(u8 *d, const u8 *a)
 | |
| {
 | |
| 	u8 wide[60];
 | |
| 
 | |
| 	elt_square_to_wide(wide, a);
 | |
| 	wide_reduce(wide);
 | |
| 
 | |
| 	elt_copy(d, wide + 30);
 | |
| }
 | |
| 
 | |
| static void itoh_tsujii(u8 *d, const u8 *a, const u8 *b, u32 j)
 | |
| {
 | |
| 	u8 t[30];
 | |
| 
 | |
| 	elt_copy(t, a);
 | |
| 	while (j--) {
 | |
| 		elt_square(d, t);
 | |
| 		elt_copy(t, d);
 | |
| 	}
 | |
| 
 | |
| 	elt_mul(d, t, b);
 | |
| }
 | |
| 
 | |
| static void elt_inv(u8 *d, const u8 *a)
 | |
| {
 | |
| 	u8 t[30];
 | |
| 	u8 s[30];
 | |
| 
 | |
| 	itoh_tsujii(t, a, a, 1);
 | |
| 	itoh_tsujii(s, t, a, 1);
 | |
| 	itoh_tsujii(t, s, s, 3);
 | |
| 	itoh_tsujii(s, t, a, 1);
 | |
| 	itoh_tsujii(t, s, s, 7);
 | |
| 	itoh_tsujii(s, t, t, 14);
 | |
| 	itoh_tsujii(t, s, a, 1);
 | |
| 	itoh_tsujii(s, t, t, 29);
 | |
| 	itoh_tsujii(t, s, s, 58);
 | |
| 	itoh_tsujii(s, t, t, 116);
 | |
| 	elt_square(d, s);
 | |
| }
 | |
| 
 | |
| UNUSED static int point_is_on_curve(u8 *p)
 | |
| {
 | |
| 	u8 s[30], t[30];
 | |
| 	u8 *x, *y;
 | |
| 
 | |
| 	x = p;
 | |
| 	y = p + 30;
 | |
| 
 | |
| 	elt_square(t, x);
 | |
| 	elt_mul(s, t, x);
 | |
| 
 | |
| 	elt_add(s, s, t);
 | |
| 
 | |
| 	elt_square(t, y);
 | |
| 	elt_add(s, s, t);
 | |
| 
 | |
| 	elt_mul(t, x, y);
 | |
| 	elt_add(s, s, t);
 | |
| 
 | |
| 	elt_add(s, s, ec_b);
 | |
| 
 | |
| 	return elt_is_zero(s);
 | |
| }
 | |
| 
 | |
| static int point_is_zero(const u8 *p)
 | |
| {
 | |
| 	return elt_is_zero(p) && elt_is_zero(p + 30);
 | |
| }
 | |
| 
 | |
| static void point_double(u8 *r, const u8 *p)
 | |
| {
 | |
| 	u8 s[30], t[30];
 | |
| 	const u8 *px, *py;
 | |
| 	u8 *rx, *ry;
 | |
| 
 | |
| 	px = p;
 | |
| 	py = p + 30;
 | |
| 	rx = r;
 | |
| 	ry = r + 30;
 | |
| 
 | |
| 	if (elt_is_zero(px)) {
 | |
| 		elt_zero(rx);
 | |
| 		elt_zero(ry);
 | |
| 
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	elt_inv(t, px);
 | |
| 	elt_mul(s, py, t);
 | |
| 	elt_add(s, s, px);
 | |
| 
 | |
| 	elt_square(t, px);
 | |
| 
 | |
| 	elt_square(rx, s);
 | |
| 	elt_add(rx, rx, s);
 | |
| 	rx[29] ^= 1;
 | |
| 
 | |
| 	elt_mul(ry, s, rx);
 | |
| 	elt_add(ry, ry, rx);
 | |
| 	elt_add(ry, ry, t);
 | |
| }
 | |
| 
 | |
| static void point_add(u8 *r, const u8 *p, const u8 *q)
 | |
| {
 | |
| 	u8 s[30], t[30], u[30];
 | |
| 	const u8 *px, *py, *qx, *qy;
 | |
| 	u8 *rx, *ry;
 | |
| 
 | |
| 	px = p;
 | |
| 	py = p + 30;
 | |
| 	qx = q;
 | |
| 	qy = q + 30;
 | |
| 	rx = r;
 | |
| 	ry = r + 30;
 | |
| 
 | |
| 	if (point_is_zero(p)) {
 | |
| 		elt_copy(rx, qx);
 | |
| 		elt_copy(ry, qy);
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	if (point_is_zero(q)) {
 | |
| 		elt_copy(rx, px);
 | |
| 		elt_copy(ry, py);
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	elt_add(u, px, qx);
 | |
| 
 | |
| 	if (elt_is_zero(u)) {
 | |
| 		elt_add(u, py, qy);
 | |
| 		if (elt_is_zero(u))
 | |
| 			point_double(r, p);
 | |
| 		else {
 | |
| 			elt_zero(rx);
 | |
| 			elt_zero(ry);
 | |
| 		}
 | |
| 
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	elt_inv(t, u);
 | |
| 	elt_add(u, py, qy);
 | |
| 	elt_mul(s, t, u);
 | |
| 
 | |
| 	elt_square(t, s);
 | |
| 	elt_add(t, t, s);
 | |
| 	elt_add(t, t, qx);
 | |
| 	t[29] ^= 1;
 | |
| 
 | |
| 	elt_mul(u, s, t);
 | |
| 	elt_add(s, u, py);
 | |
| 	elt_add(rx, t, px);
 | |
| 	elt_add(ry, s, rx);
 | |
| }
 | |
| 
 | |
| static void point_mul(u8 *d, const u8 *a, const u8 *b) // a is bignum
 | |
| {
 | |
| 	u32 i;
 | |
| 	u8 mask;
 | |
| 
 | |
| 	elt_zero(d);
 | |
| 	elt_zero(d + 30);
 | |
| 
 | |
| 	for (i = 0; i < 30; i++)
 | |
| 		for (mask = 0x80; mask != 0; mask >>= 1) {
 | |
| 			point_double(d, d);
 | |
| 			if ((a[i] & mask) != 0)
 | |
| 				point_add(d, d, b);
 | |
| 		}
 | |
| }
 | |
| 
 | |
| static void silly_random(u8 * rndArea, u8 count)
 | |
| {
 | |
| 	u16 i;
 | |
| 	srand((unsigned) (time(nullptr)));
 | |
| 
 | |
| 	for (i=0;i<count;i++)
 | |
| 	{
 | |
| 		rndArea[i]=rand();
 | |
| 	}
 | |
| }
 | |
| 
 | |
| void generate_ecdsa(u8 *R, u8 *S, const u8 *k, const u8 *hash)
 | |
| {
 | |
| 	u8 e[30];
 | |
| 	u8 kk[30];
 | |
| 	u8 m[30];
 | |
| 	u8 minv[30];
 | |
| 	u8 mG[60];
 | |
| 	//FILE *fp;
 | |
| 
 | |
| 	elt_zero(e);
 | |
| 	memcpy(e + 10, hash, 20);
 | |
| 
 | |
| 	//Changing random number generator to a lame one...
 | |
| 	silly_random(m, sizeof(m));
 | |
| 	//fp = fopen("/dev/random", "rb");
 | |
| 	//if (fread(m, sizeof m, 1, fp) != 1)
 | |
| 	//	fatal("reading random");
 | |
| 	//fclose(fp);
 | |
| 	m[0] = 0;
 | |
| 
 | |
| 	//	R = (mG).x
 | |
| 
 | |
| 	point_mul(mG, m, ec_G);
 | |
| 	elt_copy(R, mG);
 | |
| 	if (bn_compare(R, ec_N, 30) >= 0)
 | |
| 		bn_sub_modulus(R, ec_N, 30);
 | |
| 
 | |
| 	//	S = m**-1*(e + Rk) (mod N)
 | |
| 
 | |
| 	elt_copy(kk, k);
 | |
| 	if (bn_compare(kk, ec_N, 30) >= 0)
 | |
| 		bn_sub_modulus(kk, ec_N, 30);
 | |
| 	bn_mul(S, R, kk, ec_N, 30);
 | |
| 	bn_add(kk, S, e, ec_N, 30);
 | |
| 	bn_inv(minv, m, ec_N, 30);
 | |
| 	bn_mul(S, minv, kk, ec_N, 30);
 | |
| }
 | |
| 
 | |
| UNUSED static int check_ecdsa(u8 *Q, u8 *R, u8 *S, const u8 *hash)
 | |
| {
 | |
| 	u8 Sinv[30];
 | |
| 	u8 e[30];
 | |
| 	u8 w1[30], w2[30];
 | |
| 	u8 r1[60], r2[60];
 | |
| 
 | |
| 	bn_inv(Sinv, S, ec_N, 30);
 | |
| 
 | |
| 	elt_zero(e);
 | |
| 	memcpy(e + 10, hash, 20);
 | |
| 
 | |
| 	bn_mul(w1, e, Sinv, ec_N, 30);
 | |
| 	bn_mul(w2, R, Sinv, ec_N, 30);
 | |
| 
 | |
| 	point_mul(r1, w1, ec_G);
 | |
| 	point_mul(r2, w2, Q);
 | |
| 
 | |
| 	point_add(r1, r1, r2);
 | |
| 
 | |
| 	if (bn_compare(r1, ec_N, 30) >= 0)
 | |
| 		bn_sub_modulus(r1, ec_N, 30);
 | |
| 
 | |
| 	return (bn_compare(r1, R, 30) == 0);
 | |
| }
 | |
| 
 | |
| void ec_priv_to_pub(const u8 *k, u8 *Q)
 | |
| {
 | |
| 	point_mul(Q, k, ec_G);
 | |
| }
 |