mirror of
https://github.com/RfidResearchGroup/proxmark3.git
synced 2025-02-20 22:24:10 +08:00
86 lines
2 KiB
C
86 lines
2 KiB
C
//-----------------------------------------------------------------------------
|
|
// This code is licensed to you under the terms of the GNU GPL, version 2 or,
|
|
// at your option, any later version. See the LICENSE.txt file for the text of
|
|
// the license.
|
|
//-----------------------------------------------------------------------------
|
|
// Generic TEA crypto code.
|
|
// ref: http://143.53.36.235:8080/source.htm#ansi
|
|
//-----------------------------------------------------------------------------
|
|
#include "tea.h"
|
|
#define ROUNDS 32
|
|
#define DELTA 0x9E3779B9
|
|
#define SUM 0xC6EF3720
|
|
#define SWAPENDIAN(x)\
|
|
(x = (x >> 8 & 0xff00ff) | (x & 0xff00ff) << 8, x = x >> 16 | x << 16)
|
|
|
|
void tea_encrypt(uint8_t *v, uint8_t *key) {
|
|
|
|
uint32_t a=0,b=0,c=0,d=0,y=0,z=0;
|
|
uint32_t sum = 0;
|
|
uint8_t n = ROUNDS;
|
|
|
|
//key
|
|
a = bytes_to_num(key, 4);
|
|
b = bytes_to_num(key+4, 4);
|
|
c = bytes_to_num(key+8, 4);
|
|
d = bytes_to_num(key+12, 4);
|
|
|
|
//input
|
|
y = bytes_to_num(v, 4);
|
|
z = bytes_to_num(v+4, 4);
|
|
|
|
// SWAPENDIAN(a);
|
|
// SWAPENDIAN(b);
|
|
// SWAPENDIAN(c);
|
|
// SWAPENDIAN(d);
|
|
// SWAPENDIAN(y);
|
|
// SWAPENDIAN(z);
|
|
|
|
while ( n-- > 0 ) {
|
|
sum += DELTA;
|
|
y += ((z << 4) + a) ^ (z + sum) ^ ((z >> 5) + b);
|
|
z += ((y << 4) + c) ^ (y + sum) ^ ((y >> 5) + d);
|
|
}
|
|
|
|
// SWAPENDIAN(y);
|
|
// SWAPENDIAN(z);
|
|
|
|
num_to_bytes(y, 4, v);
|
|
num_to_bytes(z, 4, v+4);
|
|
}
|
|
|
|
void tea_decrypt(uint8_t *v, uint8_t *key) {
|
|
|
|
uint32_t a=0,b=0,c=0,d=0,y=0,z=0;
|
|
uint32_t sum = SUM;
|
|
uint8_t n = ROUNDS;
|
|
|
|
//key
|
|
a = bytes_to_num(key, 4);
|
|
b = bytes_to_num(key+4, 4);
|
|
c = bytes_to_num(key+8, 4);
|
|
d = bytes_to_num(key+12, 4);
|
|
|
|
//input
|
|
y = bytes_to_num(v, 4);
|
|
z = bytes_to_num(v+4, 4);
|
|
|
|
// SWAPENDIAN(a);
|
|
// SWAPENDIAN(b);
|
|
// SWAPENDIAN(c);
|
|
// SWAPENDIAN(d);
|
|
// SWAPENDIAN(y);
|
|
// SWAPENDIAN(z);
|
|
|
|
/* sum = delta<<5, in general sum = delta * n */
|
|
while ( n-- > 0 ) {
|
|
z -= ((y << 4) + c) ^ (y + sum) ^ ((y >> 5) + d);
|
|
y -= ((z << 4) + a) ^ (z + sum) ^ ((z >> 5) + b);
|
|
sum -= DELTA;
|
|
}
|
|
|
|
// SWAPENDIAN(y);
|
|
// SWAPENDIAN(z);
|
|
num_to_bytes(y, 4, v);
|
|
num_to_bytes(z, 4, v+4);
|
|
}
|