]> git.zerfleddert.de Git - proxmark3-svn/blame - armsrc/desfire_key.c
FIX: old bug back, and now fixed again. @marshmellow42
[proxmark3-svn] / armsrc / desfire_key.c
CommitLineData
f38a1528 1/*-
2 * Copyright (C) 2010, Romain Tartiere.
3 *
4 * This program is free software: you can redistribute it and/or modify it
5 * under the terms of the GNU Lesser General Public License as published by the
6 * Free Software Foundation, either version 3 of the License, or (at your
7 * option) any later version.
8 *
9 * This program is distributed in the hope that it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 *
14 * You should have received a copy of the GNU Lesser General Public License
15 * along with this program. If not, see <http://www.gnu.org/licenses/>
16 *
17 * $Id$
18 */
f6c18637 19#include <stdlib.h>
20#include "desfire_key.h"
f38a1528 21
22static inline void update_key_schedules (desfirekey_t key);
23
24static inline void update_key_schedules (desfirekey_t key) {
25 // DES_set_key ((DES_cblock *)key->data, &(key->ks1));
26 // DES_set_key ((DES_cblock *)(key->data + 8), &(key->ks2));
27 // if (T_3K3DES == key->type) {
28 // DES_set_key ((DES_cblock *)(key->data + 16), &(key->ks3));
29 // }
30}
31
f6c18637 32void Desfire_des_key_new (const uint8_t value[8], desfirekey_t key) {
f38a1528 33 uint8_t data[8];
34 memcpy (data, value, 8);
35 for (int n=0; n < 8; n++)
36 data[n] &= 0xfe;
f6c18637 37 Desfire_des_key_new_with_version (data, key);
f38a1528 38}
39
f6c18637 40void Desfire_des_key_new_with_version (const uint8_t value[8], desfirekey_t key) {
41 if ( key != NULL) {
42 key->type = T_DES;
43 memcpy (key->data, value, 8);
44 memcpy (key->data+8, value, 8);
45 update_key_schedules (key);
46 }
f38a1528 47}
48
f6c18637 49void Desfire_3des_key_new (const uint8_t value[16], desfirekey_t key) {
f38a1528 50 uint8_t data[16];
51 memcpy (data, value, 16);
52 for (int n=0; n < 8; n++)
53 data[n] &= 0xfe;
54 for (int n=8; n < 16; n++)
55 data[n] |= 0x01;
f6c18637 56 Desfire_3des_key_new_with_version (data, key);
f38a1528 57}
58
f6c18637 59void Desfire_3des_key_new_with_version (const uint8_t value[16], desfirekey_t key) {
60 if ( key != NULL ){
61 key->type = T_3DES;
62 memcpy (key->data, value, 16);
63 update_key_schedules (key);
64 }
f38a1528 65}
66
f6c18637 67void Desfire_3k3des_key_new (const uint8_t value[24], desfirekey_t key) {
f38a1528 68 uint8_t data[24];
69 memcpy (data, value, 24);
70 for (int n=0; n < 8; n++)
71 data[n] &= 0xfe;
f6c18637 72 Desfire_3k3des_key_new_with_version (data, key);
f38a1528 73}
74
f6c18637 75void Desfire_3k3des_key_new_with_version (const uint8_t value[24], desfirekey_t key) {
76 if ( key != NULL){
77 key->type = T_3K3DES;
78 memcpy (key->data, value, 24);
79 update_key_schedules (key);
80 }
f38a1528 81}
82
f6c18637 83 void Desfire_aes_key_new (const uint8_t value[16], desfirekey_t key) {
84 Desfire_aes_key_new_with_version (value, 0, key);
f38a1528 85}
86
f6c18637 87 void Desfire_aes_key_new_with_version (const uint8_t value[16], uint8_t version, desfirekey_t key) {
88
89 if (key != NULL) {
90 memcpy (key->data, value, 16);
91 key->type = T_AES;
92 key->aes_version = version;
93 }
f38a1528 94}
95
96uint8_t Desfire_key_get_version (desfirekey_t key) {
97 uint8_t version = 0;
98
99 for (int n = 0; n < 8; n++) {
100 version |= ((key->data[n] & 1) << (7 - n));
101 }
f38a1528 102 return version;
103}
104
105void Desfire_key_set_version (desfirekey_t key, uint8_t version)
106{
107 for (int n = 0; n < 8; n++) {
108 uint8_t version_bit = ((version & (1 << (7-n))) >> (7-n));
109 key->data[n] &= 0xfe;
110 key->data[n] |= version_bit;
111 if (key->type == T_DES) {
112 key->data[n+8] = key->data[n];
113 } else {
114 // Write ~version to avoid turning a 3DES key into a DES key
115 key->data[n+8] &= 0xfe;
116 key->data[n+8] |= ~version_bit;
117 }
118 }
119}
120
f6c18637 121void Desfire_session_key_new (const uint8_t rnda[], const uint8_t rndb[], desfirekey_t authkey, desfirekey_t key) {
f38a1528 122
123 uint8_t buffer[24];
124
125 switch (authkey->type) {
126 case T_DES:
127 memcpy (buffer, rnda, 4);
128 memcpy (buffer+4, rndb, 4);
f6c18637 129 Desfire_des_key_new_with_version (buffer, key);
f38a1528 130 break;
131 case T_3DES:
132 memcpy (buffer, rnda, 4);
133 memcpy (buffer+4, rndb, 4);
134 memcpy (buffer+8, rnda+4, 4);
135 memcpy (buffer+12, rndb+4, 4);
f6c18637 136 Desfire_3des_key_new_with_version (buffer, key);
f38a1528 137 break;
138 case T_3K3DES:
139 memcpy (buffer, rnda, 4);
140 memcpy (buffer+4, rndb, 4);
141 memcpy (buffer+8, rnda+6, 4);
142 memcpy (buffer+12, rndb+6, 4);
143 memcpy (buffer+16, rnda+12, 4);
144 memcpy (buffer+20, rndb+12, 4);
f6c18637 145 Desfire_3k3des_key_new (buffer, key);
f38a1528 146 break;
147 case T_AES:
148 memcpy (buffer, rnda, 4);
149 memcpy (buffer+4, rndb, 4);
150 memcpy (buffer+8, rnda+12, 4);
151 memcpy (buffer+12, rndb+12, 4);
f6c18637 152 Desfire_aes_key_new (buffer, key);
f38a1528 153 break;
154 }
f38a1528 155}
Impressum, Datenschutz