]> git.zerfleddert.de Git - proxmark3-svn/blame - common/crapto1/crypto1.c
code cleaning
[proxmark3-svn] / common / crapto1 / crypto1.c
CommitLineData
f89c7050
M
1/* crypto1.c
2
9cefee6f 3 This program is free software; you can redistribute it and/or
4 modify it under the terms of the GNU General Public License
5 as published by the Free Software Foundation; either version 2
6 of the License, or (at your option) any later version.
7
8 This program is distributed in the hope that it will be useful,
9 but WITHOUT ANY WARRANTY; without even the implied warranty of
10 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 GNU General Public License for more details.
12
13 You should have received a copy of the GNU General Public License
14 along with this program; if not, write to the Free Software
15 Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
16 MA 02110-1301, US
17
18 Copyright (C) 2008-2008 bla <blapost@gmail.com>
f89c7050
M
19*/
20#include "crapto1.h"
1f065e1d 21
f89c7050 22#include <stdlib.h>
1f065e1d 23#include "parity.h"
f89c7050
M
24
25#define SWAPENDIAN(x)\
26 (x = (x >> 8 & 0xff00ff) | (x & 0xff00ff) << 8, x = x >> 16 | x << 16)
27
bd2797de 28#if defined(__arm__) && !defined(__linux__) && !defined(_WIN32) && !defined(__APPLE__) // bare metal ARM Proxmark lacks malloc()/free()
33443e7c 29void crypto1_create(struct Crypto1State *s, uint64_t key)
30{
f89c7050
M
31 int i;
32
33 for(i = 47;s && i > 0; i -= 2) {
34 s->odd = s->odd << 1 | BIT(key, (i - 1) ^ 7);
35 s->even = s->even << 1 | BIT(key, i ^ 7);
36 }
33443e7c 37 return;
33443e7c 38}
33443e7c 39void crypto1_destroy(struct Crypto1State *state)
40{
41 state->odd = 0;
42 state->even = 0;
f89c7050 43}
33443e7c 44#else
0ca9bc0e 45struct Crypto1State * crypto1_create(uint64_t key)
46{
47 struct Crypto1State *s = malloc(sizeof(*s));
48 int i;
49
50 for(i = 47;s && i > 0; i -= 2) {
51 s->odd = s->odd << 1 | BIT(key, (i - 1) ^ 7);
52 s->even = s->even << 1 | BIT(key, i ^ 7);
53 }
54 return s;
55}
f89c7050
M
56void crypto1_destroy(struct Crypto1State *state)
57{
58 free(state);
59}
33443e7c 60#endif
f89c7050
M
61void crypto1_get_lfsr(struct Crypto1State *state, uint64_t *lfsr)
62{
63 int i;
64 for(*lfsr = 0, i = 23; i >= 0; --i) {
65 *lfsr = *lfsr << 1 | BIT(state->odd, i ^ 3);
66 *lfsr = *lfsr << 1 | BIT(state->even, i ^ 3);
67 }
68}
69uint8_t crypto1_bit(struct Crypto1State *s, uint8_t in, int is_encrypted)
70{
0ca9bc0e 71 uint32_t feedin, t;
f89c7050
M
72 uint8_t ret = filter(s->odd);
73
74 feedin = ret & !!is_encrypted;
75 feedin ^= !!in;
76 feedin ^= LF_POLY_ODD & s->odd;
77 feedin ^= LF_POLY_EVEN & s->even;
1f065e1d 78 s->even = s->even << 1 | evenparity32(feedin);
f89c7050 79
0ca9bc0e 80 t = s->odd, s->odd = s->even, s->even = t;
f89c7050
M
81
82 return ret;
83}
84uint8_t crypto1_byte(struct Crypto1State *s, uint8_t in, int is_encrypted)
85{
86 uint8_t i, ret = 0;
87
88 for (i = 0; i < 8; ++i)
89 ret |= crypto1_bit(s, BIT(in, i), is_encrypted) << i;
90
91 return ret;
92}
93uint32_t crypto1_word(struct Crypto1State *s, uint32_t in, int is_encrypted)
94{
95 uint32_t i, ret = 0;
96
0ca9bc0e 97 for (i = 0; i < 32; ++i)
98 ret |= crypto1_bit(s, BEBIT(in, i), is_encrypted) << (i ^ 24);
f89c7050
M
99
100 return ret;
101}
102
103/* prng_successor
104 * helper used to obscure the keystream during authentication
105 */
106uint32_t prng_successor(uint32_t x, uint32_t n)
107{
108 SWAPENDIAN(x);
109 while(n--)
110 x = x >> 1 | (x >> 16 ^ x >> 18 ^ x >> 19 ^ x >> 21) << 31;
111
112 return SWAPENDIAN(x);
113}
Impressum, Datenschutz