wolfSSL SSL/TLS library, support up to TLS1.3
Dependents: CyaSSL-Twitter-OAuth4Tw Example-client-tls-cert TwitterReader TweetTest ... more
wolfcrypt/src/des3.c@0:d92f9d21154c, 2015-06-26 (annotated)
- Committer:
- wolfSSL
- Date:
- Fri Jun 26 00:39:20 2015 +0000
- Revision:
- 0:d92f9d21154c
wolfSSL 3.6.0
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
wolfSSL | 0:d92f9d21154c | 1 | /* des3.c |
wolfSSL | 0:d92f9d21154c | 2 | * |
wolfSSL | 0:d92f9d21154c | 3 | * Copyright (C) 2006-2015 wolfSSL Inc. |
wolfSSL | 0:d92f9d21154c | 4 | * |
wolfSSL | 0:d92f9d21154c | 5 | * This file is part of wolfSSL. (formerly known as CyaSSL) |
wolfSSL | 0:d92f9d21154c | 6 | * |
wolfSSL | 0:d92f9d21154c | 7 | * wolfSSL is free software; you can redistribute it and/or modify |
wolfSSL | 0:d92f9d21154c | 8 | * it under the terms of the GNU General Public License as published by |
wolfSSL | 0:d92f9d21154c | 9 | * the Free Software Foundation; either version 2 of the License, or |
wolfSSL | 0:d92f9d21154c | 10 | * (at your option) any later version. |
wolfSSL | 0:d92f9d21154c | 11 | * |
wolfSSL | 0:d92f9d21154c | 12 | * wolfSSL is distributed in the hope that it will be useful, |
wolfSSL | 0:d92f9d21154c | 13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
wolfSSL | 0:d92f9d21154c | 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
wolfSSL | 0:d92f9d21154c | 15 | * GNU General Public License for more details. |
wolfSSL | 0:d92f9d21154c | 16 | * |
wolfSSL | 0:d92f9d21154c | 17 | * You should have received a copy of the GNU General Public License |
wolfSSL | 0:d92f9d21154c | 18 | * along with this program; if not, write to the Free Software |
wolfSSL | 0:d92f9d21154c | 19 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA |
wolfSSL | 0:d92f9d21154c | 20 | */ |
wolfSSL | 0:d92f9d21154c | 21 | |
wolfSSL | 0:d92f9d21154c | 22 | #ifdef HAVE_CONFIG_H |
wolfSSL | 0:d92f9d21154c | 23 | #include <config.h> |
wolfSSL | 0:d92f9d21154c | 24 | #endif |
wolfSSL | 0:d92f9d21154c | 25 | |
wolfSSL | 0:d92f9d21154c | 26 | #include <wolfssl/wolfcrypt/settings.h> |
wolfSSL | 0:d92f9d21154c | 27 | |
wolfSSL | 0:d92f9d21154c | 28 | #ifndef NO_DES3 |
wolfSSL | 0:d92f9d21154c | 29 | |
wolfSSL | 0:d92f9d21154c | 30 | #include <wolfssl/wolfcrypt/des3.h> |
wolfSSL | 0:d92f9d21154c | 31 | |
wolfSSL | 0:d92f9d21154c | 32 | #ifdef HAVE_FIPS |
wolfSSL | 0:d92f9d21154c | 33 | #ifdef HAVE_CAVIUM |
wolfSSL | 0:d92f9d21154c | 34 | static int wc_Des3_CaviumSetKey(Des3* des3, const byte* key, const byte* iv); |
wolfSSL | 0:d92f9d21154c | 35 | static int wc_Des3_CaviumCbcEncrypt(Des3* des3, byte* out, const byte* in, |
wolfSSL | 0:d92f9d21154c | 36 | word32 length); |
wolfSSL | 0:d92f9d21154c | 37 | static int wc_Des3_CaviumCbcDecrypt(Des3* des3, byte* out, const byte* in, |
wolfSSL | 0:d92f9d21154c | 38 | word32 length); |
wolfSSL | 0:d92f9d21154c | 39 | #endif |
wolfSSL | 0:d92f9d21154c | 40 | |
wolfSSL | 0:d92f9d21154c | 41 | int wc_Des_SetKey(Des* des, const byte* key, const byte* iv, int dir) |
wolfSSL | 0:d92f9d21154c | 42 | { |
wolfSSL | 0:d92f9d21154c | 43 | return Des_SetKey(des, key, iv, dir); |
wolfSSL | 0:d92f9d21154c | 44 | } |
wolfSSL | 0:d92f9d21154c | 45 | |
wolfSSL | 0:d92f9d21154c | 46 | |
wolfSSL | 0:d92f9d21154c | 47 | int wc_Des3_SetKey(Des3* des, const byte* key, const byte* iv, int dir) |
wolfSSL | 0:d92f9d21154c | 48 | { |
wolfSSL | 0:d92f9d21154c | 49 | return Des3_SetKey_fips(des, key, iv, dir); |
wolfSSL | 0:d92f9d21154c | 50 | } |
wolfSSL | 0:d92f9d21154c | 51 | |
wolfSSL | 0:d92f9d21154c | 52 | |
wolfSSL | 0:d92f9d21154c | 53 | int wc_Des_CbcEncrypt(Des* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 54 | { |
wolfSSL | 0:d92f9d21154c | 55 | return Des_CbcEncrypt(des, out, in, sz); |
wolfSSL | 0:d92f9d21154c | 56 | } |
wolfSSL | 0:d92f9d21154c | 57 | |
wolfSSL | 0:d92f9d21154c | 58 | |
wolfSSL | 0:d92f9d21154c | 59 | int wc_Des_CbcDecrypt(Des* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 60 | { |
wolfSSL | 0:d92f9d21154c | 61 | return Des_CbcDecrypt(des, out, in, sz); |
wolfSSL | 0:d92f9d21154c | 62 | } |
wolfSSL | 0:d92f9d21154c | 63 | |
wolfSSL | 0:d92f9d21154c | 64 | |
wolfSSL | 0:d92f9d21154c | 65 | int wc_Des3_CbcEncrypt(Des3* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 66 | { |
wolfSSL | 0:d92f9d21154c | 67 | return Des3_CbcEncrypt_fips(des, out, in, sz); |
wolfSSL | 0:d92f9d21154c | 68 | } |
wolfSSL | 0:d92f9d21154c | 69 | |
wolfSSL | 0:d92f9d21154c | 70 | |
wolfSSL | 0:d92f9d21154c | 71 | int wc_Des3_CbcDecrypt(Des3* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 72 | { |
wolfSSL | 0:d92f9d21154c | 73 | return Des3_CbcDecrypt_fips(des, out, in, sz); |
wolfSSL | 0:d92f9d21154c | 74 | } |
wolfSSL | 0:d92f9d21154c | 75 | |
wolfSSL | 0:d92f9d21154c | 76 | |
wolfSSL | 0:d92f9d21154c | 77 | #ifdef WOLFSSL_DES_ECB |
wolfSSL | 0:d92f9d21154c | 78 | |
wolfSSL | 0:d92f9d21154c | 79 | /* One block, compatibility only */ |
wolfSSL | 0:d92f9d21154c | 80 | int wc_Des_EcbEncrypt(Des* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 81 | { |
wolfSSL | 0:d92f9d21154c | 82 | return Des_EcbEncrypt(des, out, in, sz); |
wolfSSL | 0:d92f9d21154c | 83 | } |
wolfSSL | 0:d92f9d21154c | 84 | |
wolfSSL | 0:d92f9d21154c | 85 | #endif /* WOLFSSL_DES_ECB */ |
wolfSSL | 0:d92f9d21154c | 86 | |
wolfSSL | 0:d92f9d21154c | 87 | |
wolfSSL | 0:d92f9d21154c | 88 | void wc_Des_SetIV(Des* des, const byte* iv) |
wolfSSL | 0:d92f9d21154c | 89 | { |
wolfSSL | 0:d92f9d21154c | 90 | Des_SetIV(des, iv); |
wolfSSL | 0:d92f9d21154c | 91 | } |
wolfSSL | 0:d92f9d21154c | 92 | |
wolfSSL | 0:d92f9d21154c | 93 | |
wolfSSL | 0:d92f9d21154c | 94 | int wc_Des_CbcDecryptWithKey(byte* out, const byte* in, word32 sz, |
wolfSSL | 0:d92f9d21154c | 95 | const byte* key, const byte* iv) |
wolfSSL | 0:d92f9d21154c | 96 | { |
wolfSSL | 0:d92f9d21154c | 97 | return Des_CbcDecryptWithKey(out, in, sz, key, iv); |
wolfSSL | 0:d92f9d21154c | 98 | } |
wolfSSL | 0:d92f9d21154c | 99 | |
wolfSSL | 0:d92f9d21154c | 100 | |
wolfSSL | 0:d92f9d21154c | 101 | int wc_Des3_SetIV(Des3* des, const byte* iv) |
wolfSSL | 0:d92f9d21154c | 102 | { |
wolfSSL | 0:d92f9d21154c | 103 | return Des3_SetIV_fips(des, iv); |
wolfSSL | 0:d92f9d21154c | 104 | } |
wolfSSL | 0:d92f9d21154c | 105 | |
wolfSSL | 0:d92f9d21154c | 106 | |
wolfSSL | 0:d92f9d21154c | 107 | int wc_Des3_CbcDecryptWithKey(byte* out, const byte* in, word32 sz, |
wolfSSL | 0:d92f9d21154c | 108 | const byte* key, const byte* iv) |
wolfSSL | 0:d92f9d21154c | 109 | { |
wolfSSL | 0:d92f9d21154c | 110 | return Des3_CbcDecryptWithKey(out, in, sz, key, iv); |
wolfSSL | 0:d92f9d21154c | 111 | } |
wolfSSL | 0:d92f9d21154c | 112 | |
wolfSSL | 0:d92f9d21154c | 113 | |
wolfSSL | 0:d92f9d21154c | 114 | #ifdef HAVE_CAVIUM |
wolfSSL | 0:d92f9d21154c | 115 | |
wolfSSL | 0:d92f9d21154c | 116 | /* Initiliaze Des3 for use with Nitrox device */ |
wolfSSL | 0:d92f9d21154c | 117 | int wc_Des3_InitCavium(Des3* des3, int devId) |
wolfSSL | 0:d92f9d21154c | 118 | { |
wolfSSL | 0:d92f9d21154c | 119 | return Des3_InitCavium(des3, devId); |
wolfSSL | 0:d92f9d21154c | 120 | } |
wolfSSL | 0:d92f9d21154c | 121 | |
wolfSSL | 0:d92f9d21154c | 122 | |
wolfSSL | 0:d92f9d21154c | 123 | /* Free Des3 from use with Nitrox device */ |
wolfSSL | 0:d92f9d21154c | 124 | void wc_Des3_FreeCavium(Des3* des3) |
wolfSSL | 0:d92f9d21154c | 125 | { |
wolfSSL | 0:d92f9d21154c | 126 | Des3_FreeCavium(des3); |
wolfSSL | 0:d92f9d21154c | 127 | } |
wolfSSL | 0:d92f9d21154c | 128 | |
wolfSSL | 0:d92f9d21154c | 129 | |
wolfSSL | 0:d92f9d21154c | 130 | #endif /* HAVE_CAVIUM */ |
wolfSSL | 0:d92f9d21154c | 131 | #else /* build without fips */ |
wolfSSL | 0:d92f9d21154c | 132 | |
wolfSSL | 0:d92f9d21154c | 133 | #if defined(WOLFSSL_TI_CRYPT) |
wolfSSL | 0:d92f9d21154c | 134 | #include <wolfcrypt/src/port/ti/ti-des3.c> |
wolfSSL | 0:d92f9d21154c | 135 | #else |
wolfSSL | 0:d92f9d21154c | 136 | |
wolfSSL | 0:d92f9d21154c | 137 | #include <wolfssl/wolfcrypt/error-crypt.h> |
wolfSSL | 0:d92f9d21154c | 138 | #include <wolfssl/wolfcrypt/logging.h> |
wolfSSL | 0:d92f9d21154c | 139 | |
wolfSSL | 0:d92f9d21154c | 140 | #ifdef NO_INLINE |
wolfSSL | 0:d92f9d21154c | 141 | #include <wolfssl/wolfcrypt/misc.h> |
wolfSSL | 0:d92f9d21154c | 142 | #else |
wolfSSL | 0:d92f9d21154c | 143 | #include <wolfcrypt/src/misc.c> |
wolfSSL | 0:d92f9d21154c | 144 | #endif |
wolfSSL | 0:d92f9d21154c | 145 | |
wolfSSL | 0:d92f9d21154c | 146 | |
wolfSSL | 0:d92f9d21154c | 147 | #ifdef HAVE_CAVIUM |
wolfSSL | 0:d92f9d21154c | 148 | static int wc_Des3_CaviumSetKey(Des3* des3, const byte* key, const byte* iv); |
wolfSSL | 0:d92f9d21154c | 149 | static int wc_Des3_CaviumCbcEncrypt(Des3* des3, byte* out, const byte* in, |
wolfSSL | 0:d92f9d21154c | 150 | word32 length); |
wolfSSL | 0:d92f9d21154c | 151 | static int wc_Des3_CaviumCbcDecrypt(Des3* des3, byte* out, const byte* in, |
wolfSSL | 0:d92f9d21154c | 152 | word32 length); |
wolfSSL | 0:d92f9d21154c | 153 | #endif |
wolfSSL | 0:d92f9d21154c | 154 | |
wolfSSL | 0:d92f9d21154c | 155 | |
wolfSSL | 0:d92f9d21154c | 156 | |
wolfSSL | 0:d92f9d21154c | 157 | |
wolfSSL | 0:d92f9d21154c | 158 | #ifdef STM32F2_CRYPTO |
wolfSSL | 0:d92f9d21154c | 159 | /* |
wolfSSL | 0:d92f9d21154c | 160 | * STM32F2 hardware DES/3DES support through the STM32F2 standard |
wolfSSL | 0:d92f9d21154c | 161 | * peripheral library. Documentation located in STM32F2xx Standard |
wolfSSL | 0:d92f9d21154c | 162 | * Peripheral Library document (See note in README). |
wolfSSL | 0:d92f9d21154c | 163 | */ |
wolfSSL | 0:d92f9d21154c | 164 | #include "stm32f2xx.h" |
wolfSSL | 0:d92f9d21154c | 165 | #include "stm32f2xx_cryp.h" |
wolfSSL | 0:d92f9d21154c | 166 | |
wolfSSL | 0:d92f9d21154c | 167 | int wc_Des_SetKey(Des* des, const byte* key, const byte* iv, int dir) |
wolfSSL | 0:d92f9d21154c | 168 | { |
wolfSSL | 0:d92f9d21154c | 169 | word32 *dkey = des->key; |
wolfSSL | 0:d92f9d21154c | 170 | |
wolfSSL | 0:d92f9d21154c | 171 | XMEMCPY(dkey, key, 8); |
wolfSSL | 0:d92f9d21154c | 172 | ByteReverseWords(dkey, dkey, 8); |
wolfSSL | 0:d92f9d21154c | 173 | |
wolfSSL | 0:d92f9d21154c | 174 | wc_Des_SetIV(des, iv); |
wolfSSL | 0:d92f9d21154c | 175 | |
wolfSSL | 0:d92f9d21154c | 176 | return 0; |
wolfSSL | 0:d92f9d21154c | 177 | } |
wolfSSL | 0:d92f9d21154c | 178 | |
wolfSSL | 0:d92f9d21154c | 179 | int wc_Des3_SetKey(Des3* des, const byte* key, const byte* iv, int dir) |
wolfSSL | 0:d92f9d21154c | 180 | { |
wolfSSL | 0:d92f9d21154c | 181 | word32 *dkey1 = des->key[0]; |
wolfSSL | 0:d92f9d21154c | 182 | word32 *dkey2 = des->key[1]; |
wolfSSL | 0:d92f9d21154c | 183 | word32 *dkey3 = des->key[2]; |
wolfSSL | 0:d92f9d21154c | 184 | |
wolfSSL | 0:d92f9d21154c | 185 | XMEMCPY(dkey1, key, 8); /* set key 1 */ |
wolfSSL | 0:d92f9d21154c | 186 | XMEMCPY(dkey2, key + 8, 8); /* set key 2 */ |
wolfSSL | 0:d92f9d21154c | 187 | XMEMCPY(dkey3, key + 16, 8); /* set key 3 */ |
wolfSSL | 0:d92f9d21154c | 188 | |
wolfSSL | 0:d92f9d21154c | 189 | ByteReverseWords(dkey1, dkey1, 8); |
wolfSSL | 0:d92f9d21154c | 190 | ByteReverseWords(dkey2, dkey2, 8); |
wolfSSL | 0:d92f9d21154c | 191 | ByteReverseWords(dkey3, dkey3, 8); |
wolfSSL | 0:d92f9d21154c | 192 | |
wolfSSL | 0:d92f9d21154c | 193 | return wc_Des3_SetIV(des, iv); |
wolfSSL | 0:d92f9d21154c | 194 | } |
wolfSSL | 0:d92f9d21154c | 195 | |
wolfSSL | 0:d92f9d21154c | 196 | void DesCrypt(Des* des, byte* out, const byte* in, word32 sz, |
wolfSSL | 0:d92f9d21154c | 197 | int dir, int mode) |
wolfSSL | 0:d92f9d21154c | 198 | { |
wolfSSL | 0:d92f9d21154c | 199 | word32 *dkey, *iv; |
wolfSSL | 0:d92f9d21154c | 200 | CRYP_InitTypeDef DES_CRYP_InitStructure; |
wolfSSL | 0:d92f9d21154c | 201 | CRYP_KeyInitTypeDef DES_CRYP_KeyInitStructure; |
wolfSSL | 0:d92f9d21154c | 202 | CRYP_IVInitTypeDef DES_CRYP_IVInitStructure; |
wolfSSL | 0:d92f9d21154c | 203 | |
wolfSSL | 0:d92f9d21154c | 204 | dkey = des->key; |
wolfSSL | 0:d92f9d21154c | 205 | iv = des->reg; |
wolfSSL | 0:d92f9d21154c | 206 | |
wolfSSL | 0:d92f9d21154c | 207 | /* crypto structure initialization */ |
wolfSSL | 0:d92f9d21154c | 208 | CRYP_KeyStructInit(&DES_CRYP_KeyInitStructure); |
wolfSSL | 0:d92f9d21154c | 209 | CRYP_StructInit(&DES_CRYP_InitStructure); |
wolfSSL | 0:d92f9d21154c | 210 | CRYP_IVStructInit(&DES_CRYP_IVInitStructure); |
wolfSSL | 0:d92f9d21154c | 211 | |
wolfSSL | 0:d92f9d21154c | 212 | /* reset registers to their default values */ |
wolfSSL | 0:d92f9d21154c | 213 | CRYP_DeInit(); |
wolfSSL | 0:d92f9d21154c | 214 | |
wolfSSL | 0:d92f9d21154c | 215 | /* set direction, mode, and datatype */ |
wolfSSL | 0:d92f9d21154c | 216 | if (dir == DES_ENCRYPTION) { |
wolfSSL | 0:d92f9d21154c | 217 | DES_CRYP_InitStructure.CRYP_AlgoDir = CRYP_AlgoDir_Encrypt; |
wolfSSL | 0:d92f9d21154c | 218 | } else { /* DES_DECRYPTION */ |
wolfSSL | 0:d92f9d21154c | 219 | DES_CRYP_InitStructure.CRYP_AlgoDir = CRYP_AlgoDir_Decrypt; |
wolfSSL | 0:d92f9d21154c | 220 | } |
wolfSSL | 0:d92f9d21154c | 221 | |
wolfSSL | 0:d92f9d21154c | 222 | if (mode == DES_CBC) { |
wolfSSL | 0:d92f9d21154c | 223 | DES_CRYP_InitStructure.CRYP_AlgoMode = CRYP_AlgoMode_DES_CBC; |
wolfSSL | 0:d92f9d21154c | 224 | } else { /* DES_ECB */ |
wolfSSL | 0:d92f9d21154c | 225 | DES_CRYP_InitStructure.CRYP_AlgoMode = CRYP_AlgoMode_DES_ECB; |
wolfSSL | 0:d92f9d21154c | 226 | } |
wolfSSL | 0:d92f9d21154c | 227 | |
wolfSSL | 0:d92f9d21154c | 228 | DES_CRYP_InitStructure.CRYP_DataType = CRYP_DataType_8b; |
wolfSSL | 0:d92f9d21154c | 229 | CRYP_Init(&DES_CRYP_InitStructure); |
wolfSSL | 0:d92f9d21154c | 230 | |
wolfSSL | 0:d92f9d21154c | 231 | /* load key into correct registers */ |
wolfSSL | 0:d92f9d21154c | 232 | DES_CRYP_KeyInitStructure.CRYP_Key1Left = dkey[0]; |
wolfSSL | 0:d92f9d21154c | 233 | DES_CRYP_KeyInitStructure.CRYP_Key1Right = dkey[1]; |
wolfSSL | 0:d92f9d21154c | 234 | CRYP_KeyInit(&DES_CRYP_KeyInitStructure); |
wolfSSL | 0:d92f9d21154c | 235 | |
wolfSSL | 0:d92f9d21154c | 236 | /* set iv */ |
wolfSSL | 0:d92f9d21154c | 237 | ByteReverseWords(iv, iv, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 238 | DES_CRYP_IVInitStructure.CRYP_IV0Left = iv[0]; |
wolfSSL | 0:d92f9d21154c | 239 | DES_CRYP_IVInitStructure.CRYP_IV0Right = iv[1]; |
wolfSSL | 0:d92f9d21154c | 240 | CRYP_IVInit(&DES_CRYP_IVInitStructure); |
wolfSSL | 0:d92f9d21154c | 241 | |
wolfSSL | 0:d92f9d21154c | 242 | /* enable crypto processor */ |
wolfSSL | 0:d92f9d21154c | 243 | CRYP_Cmd(ENABLE); |
wolfSSL | 0:d92f9d21154c | 244 | |
wolfSSL | 0:d92f9d21154c | 245 | while (sz > 0) |
wolfSSL | 0:d92f9d21154c | 246 | { |
wolfSSL | 0:d92f9d21154c | 247 | /* flush IN/OUT FIFOs */ |
wolfSSL | 0:d92f9d21154c | 248 | CRYP_FIFOFlush(); |
wolfSSL | 0:d92f9d21154c | 249 | |
wolfSSL | 0:d92f9d21154c | 250 | /* if input and output same will overwrite input iv */ |
wolfSSL | 0:d92f9d21154c | 251 | XMEMCPY(des->tmp, in + sz - DES_BLOCK_SIZE, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 252 | |
wolfSSL | 0:d92f9d21154c | 253 | CRYP_DataIn(*(uint32_t*)&in[0]); |
wolfSSL | 0:d92f9d21154c | 254 | CRYP_DataIn(*(uint32_t*)&in[4]); |
wolfSSL | 0:d92f9d21154c | 255 | |
wolfSSL | 0:d92f9d21154c | 256 | /* wait until the complete message has been processed */ |
wolfSSL | 0:d92f9d21154c | 257 | while(CRYP_GetFlagStatus(CRYP_FLAG_BUSY) != RESET) {} |
wolfSSL | 0:d92f9d21154c | 258 | |
wolfSSL | 0:d92f9d21154c | 259 | *(uint32_t*)&out[0] = CRYP_DataOut(); |
wolfSSL | 0:d92f9d21154c | 260 | *(uint32_t*)&out[4] = CRYP_DataOut(); |
wolfSSL | 0:d92f9d21154c | 261 | |
wolfSSL | 0:d92f9d21154c | 262 | /* store iv for next call */ |
wolfSSL | 0:d92f9d21154c | 263 | XMEMCPY(des->reg, des->tmp, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 264 | |
wolfSSL | 0:d92f9d21154c | 265 | sz -= DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 266 | in += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 267 | out += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 268 | } |
wolfSSL | 0:d92f9d21154c | 269 | |
wolfSSL | 0:d92f9d21154c | 270 | /* disable crypto processor */ |
wolfSSL | 0:d92f9d21154c | 271 | CRYP_Cmd(DISABLE); |
wolfSSL | 0:d92f9d21154c | 272 | } |
wolfSSL | 0:d92f9d21154c | 273 | |
wolfSSL | 0:d92f9d21154c | 274 | int wc_Des_CbcEncrypt(Des* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 275 | { |
wolfSSL | 0:d92f9d21154c | 276 | DesCrypt(des, out, in, sz, DES_ENCRYPTION, DES_CBC); |
wolfSSL | 0:d92f9d21154c | 277 | return 0; |
wolfSSL | 0:d92f9d21154c | 278 | } |
wolfSSL | 0:d92f9d21154c | 279 | |
wolfSSL | 0:d92f9d21154c | 280 | int wc_Des_CbcDecrypt(Des* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 281 | { |
wolfSSL | 0:d92f9d21154c | 282 | DesCrypt(des, out, in, sz, DES_DECRYPTION, DES_CBC); |
wolfSSL | 0:d92f9d21154c | 283 | return 0; |
wolfSSL | 0:d92f9d21154c | 284 | } |
wolfSSL | 0:d92f9d21154c | 285 | |
wolfSSL | 0:d92f9d21154c | 286 | int wc_Des_EcbEncrypt(Des* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 287 | { |
wolfSSL | 0:d92f9d21154c | 288 | DesCrypt(des, out, in, sz, DES_ENCRYPTION, DES_ECB); |
wolfSSL | 0:d92f9d21154c | 289 | return 0; |
wolfSSL | 0:d92f9d21154c | 290 | } |
wolfSSL | 0:d92f9d21154c | 291 | |
wolfSSL | 0:d92f9d21154c | 292 | void Des3Crypt(Des3* des, byte* out, const byte* in, word32 sz, |
wolfSSL | 0:d92f9d21154c | 293 | int dir) |
wolfSSL | 0:d92f9d21154c | 294 | { |
wolfSSL | 0:d92f9d21154c | 295 | word32 *dkey1, *dkey2, *dkey3, *iv; |
wolfSSL | 0:d92f9d21154c | 296 | CRYP_InitTypeDef DES3_CRYP_InitStructure; |
wolfSSL | 0:d92f9d21154c | 297 | CRYP_KeyInitTypeDef DES3_CRYP_KeyInitStructure; |
wolfSSL | 0:d92f9d21154c | 298 | CRYP_IVInitTypeDef DES3_CRYP_IVInitStructure; |
wolfSSL | 0:d92f9d21154c | 299 | |
wolfSSL | 0:d92f9d21154c | 300 | dkey1 = des->key[0]; |
wolfSSL | 0:d92f9d21154c | 301 | dkey2 = des->key[1]; |
wolfSSL | 0:d92f9d21154c | 302 | dkey3 = des->key[2]; |
wolfSSL | 0:d92f9d21154c | 303 | iv = des->reg; |
wolfSSL | 0:d92f9d21154c | 304 | |
wolfSSL | 0:d92f9d21154c | 305 | /* crypto structure initialization */ |
wolfSSL | 0:d92f9d21154c | 306 | CRYP_KeyStructInit(&DES3_CRYP_KeyInitStructure); |
wolfSSL | 0:d92f9d21154c | 307 | CRYP_StructInit(&DES3_CRYP_InitStructure); |
wolfSSL | 0:d92f9d21154c | 308 | CRYP_IVStructInit(&DES3_CRYP_IVInitStructure); |
wolfSSL | 0:d92f9d21154c | 309 | |
wolfSSL | 0:d92f9d21154c | 310 | /* reset registers to their default values */ |
wolfSSL | 0:d92f9d21154c | 311 | CRYP_DeInit(); |
wolfSSL | 0:d92f9d21154c | 312 | |
wolfSSL | 0:d92f9d21154c | 313 | /* set direction, mode, and datatype */ |
wolfSSL | 0:d92f9d21154c | 314 | if (dir == DES_ENCRYPTION) { |
wolfSSL | 0:d92f9d21154c | 315 | DES3_CRYP_InitStructure.CRYP_AlgoDir = CRYP_AlgoDir_Encrypt; |
wolfSSL | 0:d92f9d21154c | 316 | } else { |
wolfSSL | 0:d92f9d21154c | 317 | DES3_CRYP_InitStructure.CRYP_AlgoDir = CRYP_AlgoDir_Decrypt; |
wolfSSL | 0:d92f9d21154c | 318 | } |
wolfSSL | 0:d92f9d21154c | 319 | |
wolfSSL | 0:d92f9d21154c | 320 | DES3_CRYP_InitStructure.CRYP_AlgoMode = CRYP_AlgoMode_TDES_CBC; |
wolfSSL | 0:d92f9d21154c | 321 | DES3_CRYP_InitStructure.CRYP_DataType = CRYP_DataType_8b; |
wolfSSL | 0:d92f9d21154c | 322 | CRYP_Init(&DES3_CRYP_InitStructure); |
wolfSSL | 0:d92f9d21154c | 323 | |
wolfSSL | 0:d92f9d21154c | 324 | /* load key into correct registers */ |
wolfSSL | 0:d92f9d21154c | 325 | DES3_CRYP_KeyInitStructure.CRYP_Key1Left = dkey1[0]; |
wolfSSL | 0:d92f9d21154c | 326 | DES3_CRYP_KeyInitStructure.CRYP_Key1Right = dkey1[1]; |
wolfSSL | 0:d92f9d21154c | 327 | DES3_CRYP_KeyInitStructure.CRYP_Key2Left = dkey2[0]; |
wolfSSL | 0:d92f9d21154c | 328 | DES3_CRYP_KeyInitStructure.CRYP_Key2Right = dkey2[1]; |
wolfSSL | 0:d92f9d21154c | 329 | DES3_CRYP_KeyInitStructure.CRYP_Key3Left = dkey3[0]; |
wolfSSL | 0:d92f9d21154c | 330 | DES3_CRYP_KeyInitStructure.CRYP_Key3Right = dkey3[1]; |
wolfSSL | 0:d92f9d21154c | 331 | CRYP_KeyInit(&DES3_CRYP_KeyInitStructure); |
wolfSSL | 0:d92f9d21154c | 332 | |
wolfSSL | 0:d92f9d21154c | 333 | /* set iv */ |
wolfSSL | 0:d92f9d21154c | 334 | ByteReverseWords(iv, iv, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 335 | DES3_CRYP_IVInitStructure.CRYP_IV0Left = iv[0]; |
wolfSSL | 0:d92f9d21154c | 336 | DES3_CRYP_IVInitStructure.CRYP_IV0Right = iv[1]; |
wolfSSL | 0:d92f9d21154c | 337 | CRYP_IVInit(&DES3_CRYP_IVInitStructure); |
wolfSSL | 0:d92f9d21154c | 338 | |
wolfSSL | 0:d92f9d21154c | 339 | /* enable crypto processor */ |
wolfSSL | 0:d92f9d21154c | 340 | CRYP_Cmd(ENABLE); |
wolfSSL | 0:d92f9d21154c | 341 | |
wolfSSL | 0:d92f9d21154c | 342 | while (sz > 0) |
wolfSSL | 0:d92f9d21154c | 343 | { |
wolfSSL | 0:d92f9d21154c | 344 | /* flush IN/OUT FIFOs */ |
wolfSSL | 0:d92f9d21154c | 345 | CRYP_FIFOFlush(); |
wolfSSL | 0:d92f9d21154c | 346 | |
wolfSSL | 0:d92f9d21154c | 347 | CRYP_DataIn(*(uint32_t*)&in[0]); |
wolfSSL | 0:d92f9d21154c | 348 | CRYP_DataIn(*(uint32_t*)&in[4]); |
wolfSSL | 0:d92f9d21154c | 349 | |
wolfSSL | 0:d92f9d21154c | 350 | /* wait until the complete message has been processed */ |
wolfSSL | 0:d92f9d21154c | 351 | while(CRYP_GetFlagStatus(CRYP_FLAG_BUSY) != RESET) {} |
wolfSSL | 0:d92f9d21154c | 352 | |
wolfSSL | 0:d92f9d21154c | 353 | *(uint32_t*)&out[0] = CRYP_DataOut(); |
wolfSSL | 0:d92f9d21154c | 354 | *(uint32_t*)&out[4] = CRYP_DataOut(); |
wolfSSL | 0:d92f9d21154c | 355 | |
wolfSSL | 0:d92f9d21154c | 356 | /* store iv for next call */ |
wolfSSL | 0:d92f9d21154c | 357 | XMEMCPY(des->reg, out + sz - DES_BLOCK_SIZE, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 358 | |
wolfSSL | 0:d92f9d21154c | 359 | sz -= DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 360 | in += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 361 | out += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 362 | } |
wolfSSL | 0:d92f9d21154c | 363 | |
wolfSSL | 0:d92f9d21154c | 364 | /* disable crypto processor */ |
wolfSSL | 0:d92f9d21154c | 365 | CRYP_Cmd(DISABLE); |
wolfSSL | 0:d92f9d21154c | 366 | |
wolfSSL | 0:d92f9d21154c | 367 | } |
wolfSSL | 0:d92f9d21154c | 368 | |
wolfSSL | 0:d92f9d21154c | 369 | int wc_Des3_CbcEncrypt(Des3* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 370 | { |
wolfSSL | 0:d92f9d21154c | 371 | Des3Crypt(des, out, in, sz, DES_ENCRYPTION); |
wolfSSL | 0:d92f9d21154c | 372 | return 0; |
wolfSSL | 0:d92f9d21154c | 373 | } |
wolfSSL | 0:d92f9d21154c | 374 | |
wolfSSL | 0:d92f9d21154c | 375 | int wc_Des3_CbcDecrypt(Des3* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 376 | { |
wolfSSL | 0:d92f9d21154c | 377 | Des3Crypt(des, out, in, sz, DES_DECRYPTION); |
wolfSSL | 0:d92f9d21154c | 378 | return 0; |
wolfSSL | 0:d92f9d21154c | 379 | } |
wolfSSL | 0:d92f9d21154c | 380 | |
wolfSSL | 0:d92f9d21154c | 381 | #elif defined(HAVE_COLDFIRE_SEC) |
wolfSSL | 0:d92f9d21154c | 382 | |
wolfSSL | 0:d92f9d21154c | 383 | #include <wolfssl/ctaocrypt/types.h> |
wolfSSL | 0:d92f9d21154c | 384 | |
wolfSSL | 0:d92f9d21154c | 385 | #include "sec.h" |
wolfSSL | 0:d92f9d21154c | 386 | #include "mcf5475_sec.h" |
wolfSSL | 0:d92f9d21154c | 387 | #include "mcf5475_siu.h" |
wolfSSL | 0:d92f9d21154c | 388 | |
wolfSSL | 0:d92f9d21154c | 389 | #if defined (HAVE_THREADX) |
wolfSSL | 0:d92f9d21154c | 390 | #include "memory_pools.h" |
wolfSSL | 0:d92f9d21154c | 391 | extern TX_BYTE_POOL mp_ncached; /* Non Cached memory pool */ |
wolfSSL | 0:d92f9d21154c | 392 | #endif |
wolfSSL | 0:d92f9d21154c | 393 | |
wolfSSL | 0:d92f9d21154c | 394 | #define DES_BUFFER_SIZE (DES_BLOCK_SIZE * 64) |
wolfSSL | 0:d92f9d21154c | 395 | static unsigned char *desBuffIn = NULL ; |
wolfSSL | 0:d92f9d21154c | 396 | static unsigned char *desBuffOut = NULL ; |
wolfSSL | 0:d92f9d21154c | 397 | static byte *secIV ; |
wolfSSL | 0:d92f9d21154c | 398 | static byte *secKey ; |
wolfSSL | 0:d92f9d21154c | 399 | static volatile SECdescriptorType *secDesc ; |
wolfSSL | 0:d92f9d21154c | 400 | |
wolfSSL | 0:d92f9d21154c | 401 | static wolfSSL_Mutex Mutex_DesSEC ; |
wolfSSL | 0:d92f9d21154c | 402 | |
wolfSSL | 0:d92f9d21154c | 403 | #define SEC_DESC_DES_CBC_ENCRYPT 0x20500010 |
wolfSSL | 0:d92f9d21154c | 404 | #define SEC_DESC_DES_CBC_DECRYPT 0x20400010 |
wolfSSL | 0:d92f9d21154c | 405 | #define SEC_DESC_DES3_CBC_ENCRYPT 0x20700010 |
wolfSSL | 0:d92f9d21154c | 406 | #define SEC_DESC_DES3_CBC_DECRYPT 0x20600010 |
wolfSSL | 0:d92f9d21154c | 407 | |
wolfSSL | 0:d92f9d21154c | 408 | #define DES_IVLEN 8 |
wolfSSL | 0:d92f9d21154c | 409 | #define DES_KEYLEN 8 |
wolfSSL | 0:d92f9d21154c | 410 | #define DES3_IVLEN 8 |
wolfSSL | 0:d92f9d21154c | 411 | #define DES3_KEYLEN 24 |
wolfSSL | 0:d92f9d21154c | 412 | |
wolfSSL | 0:d92f9d21154c | 413 | extern volatile unsigned char __MBAR[]; |
wolfSSL | 0:d92f9d21154c | 414 | |
wolfSSL | 0:d92f9d21154c | 415 | static void wc_Des_Cbc(byte* out, const byte* in, word32 sz, |
wolfSSL | 0:d92f9d21154c | 416 | byte *key, byte *iv, word32 desc) |
wolfSSL | 0:d92f9d21154c | 417 | { |
wolfSSL | 0:d92f9d21154c | 418 | #ifdef DEBUG_WOLFSSL |
wolfSSL | 0:d92f9d21154c | 419 | int ret ; int stat1,stat2 ; |
wolfSSL | 0:d92f9d21154c | 420 | #endif |
wolfSSL | 0:d92f9d21154c | 421 | int size ; |
wolfSSL | 0:d92f9d21154c | 422 | volatile int v ; |
wolfSSL | 0:d92f9d21154c | 423 | |
wolfSSL | 0:d92f9d21154c | 424 | LockMutex(&Mutex_DesSEC) ; |
wolfSSL | 0:d92f9d21154c | 425 | |
wolfSSL | 0:d92f9d21154c | 426 | secDesc->length1 = 0x0; |
wolfSSL | 0:d92f9d21154c | 427 | secDesc->pointer1 = NULL; |
wolfSSL | 0:d92f9d21154c | 428 | if((desc==SEC_DESC_DES_CBC_ENCRYPT)||(desc==SEC_DESC_DES_CBC_DECRYPT)){ |
wolfSSL | 0:d92f9d21154c | 429 | secDesc->length2 = DES_IVLEN ; |
wolfSSL | 0:d92f9d21154c | 430 | secDesc->length3 = DES_KEYLEN ; |
wolfSSL | 0:d92f9d21154c | 431 | } else { |
wolfSSL | 0:d92f9d21154c | 432 | secDesc->length2 = DES3_IVLEN ; |
wolfSSL | 0:d92f9d21154c | 433 | secDesc->length3 = DES3_KEYLEN ; |
wolfSSL | 0:d92f9d21154c | 434 | } |
wolfSSL | 0:d92f9d21154c | 435 | secDesc->pointer2 = secIV ; |
wolfSSL | 0:d92f9d21154c | 436 | secDesc->pointer3 = secKey; |
wolfSSL | 0:d92f9d21154c | 437 | secDesc->pointer4 = desBuffIn ; |
wolfSSL | 0:d92f9d21154c | 438 | secDesc->pointer5 = desBuffOut ; |
wolfSSL | 0:d92f9d21154c | 439 | secDesc->length6 = 0; |
wolfSSL | 0:d92f9d21154c | 440 | secDesc->pointer6 = NULL; |
wolfSSL | 0:d92f9d21154c | 441 | secDesc->length7 = 0x0; |
wolfSSL | 0:d92f9d21154c | 442 | secDesc->pointer7 = NULL; |
wolfSSL | 0:d92f9d21154c | 443 | secDesc->nextDescriptorPtr = NULL ; |
wolfSSL | 0:d92f9d21154c | 444 | |
wolfSSL | 0:d92f9d21154c | 445 | while(sz) { |
wolfSSL | 0:d92f9d21154c | 446 | XMEMCPY(secIV, iv, secDesc->length2) ; |
wolfSSL | 0:d92f9d21154c | 447 | if((sz%DES_BUFFER_SIZE) == sz) { |
wolfSSL | 0:d92f9d21154c | 448 | size = sz ; |
wolfSSL | 0:d92f9d21154c | 449 | sz = 0 ; |
wolfSSL | 0:d92f9d21154c | 450 | } else { |
wolfSSL | 0:d92f9d21154c | 451 | size = DES_BUFFER_SIZE ; |
wolfSSL | 0:d92f9d21154c | 452 | sz -= DES_BUFFER_SIZE ; |
wolfSSL | 0:d92f9d21154c | 453 | } |
wolfSSL | 0:d92f9d21154c | 454 | |
wolfSSL | 0:d92f9d21154c | 455 | XMEMCPY(desBuffIn, in, size) ; |
wolfSSL | 0:d92f9d21154c | 456 | XMEMCPY(secKey, key, secDesc->length3) ; |
wolfSSL | 0:d92f9d21154c | 457 | |
wolfSSL | 0:d92f9d21154c | 458 | secDesc->header = desc ; |
wolfSSL | 0:d92f9d21154c | 459 | secDesc->length4 = size; |
wolfSSL | 0:d92f9d21154c | 460 | secDesc->length5 = size; |
wolfSSL | 0:d92f9d21154c | 461 | /* Point SEC to the location of the descriptor */ |
wolfSSL | 0:d92f9d21154c | 462 | MCF_SEC_FR0 = (uint32)secDesc; |
wolfSSL | 0:d92f9d21154c | 463 | /* Initialize SEC and wait for encryption to complete */ |
wolfSSL | 0:d92f9d21154c | 464 | MCF_SEC_CCCR0 = 0x0000001a; |
wolfSSL | 0:d92f9d21154c | 465 | /* poll SISR to determine when channel is complete */ |
wolfSSL | 0:d92f9d21154c | 466 | v=0 ; |
wolfSSL | 0:d92f9d21154c | 467 | while((secDesc->header>> 24) != 0xff) { |
wolfSSL | 0:d92f9d21154c | 468 | if(v++ > 1000)break ; |
wolfSSL | 0:d92f9d21154c | 469 | } |
wolfSSL | 0:d92f9d21154c | 470 | |
wolfSSL | 0:d92f9d21154c | 471 | #ifdef DEBUG_WOLFSSL |
wolfSSL | 0:d92f9d21154c | 472 | ret = MCF_SEC_SISRH; |
wolfSSL | 0:d92f9d21154c | 473 | stat1 = MCF_SEC_DSR ; |
wolfSSL | 0:d92f9d21154c | 474 | stat2 = MCF_SEC_DISR ; |
wolfSSL | 0:d92f9d21154c | 475 | if(ret & 0xe0000000) { |
wolfSSL | 0:d92f9d21154c | 476 | /* db_printf("Des_Cbc(%x):ISRH=%08x, DSR=%08x, DISR=%08x\n", desc, ret, stat1, stat2) ; */ |
wolfSSL | 0:d92f9d21154c | 477 | } |
wolfSSL | 0:d92f9d21154c | 478 | #endif |
wolfSSL | 0:d92f9d21154c | 479 | |
wolfSSL | 0:d92f9d21154c | 480 | XMEMCPY(out, desBuffOut, size) ; |
wolfSSL | 0:d92f9d21154c | 481 | |
wolfSSL | 0:d92f9d21154c | 482 | if((desc==SEC_DESC_DES3_CBC_ENCRYPT)||(desc==SEC_DESC_DES_CBC_ENCRYPT)) { |
wolfSSL | 0:d92f9d21154c | 483 | XMEMCPY((void*)iv, (void*)&(out[size-secDesc->length2]), secDesc->length2) ; |
wolfSSL | 0:d92f9d21154c | 484 | } else { |
wolfSSL | 0:d92f9d21154c | 485 | XMEMCPY((void*)iv, (void*)&(in[size-secDesc->length2]), secDesc->length2) ; |
wolfSSL | 0:d92f9d21154c | 486 | } |
wolfSSL | 0:d92f9d21154c | 487 | |
wolfSSL | 0:d92f9d21154c | 488 | in += size ; |
wolfSSL | 0:d92f9d21154c | 489 | out += size ; |
wolfSSL | 0:d92f9d21154c | 490 | |
wolfSSL | 0:d92f9d21154c | 491 | } |
wolfSSL | 0:d92f9d21154c | 492 | UnLockMutex(&Mutex_DesSEC) ; |
wolfSSL | 0:d92f9d21154c | 493 | |
wolfSSL | 0:d92f9d21154c | 494 | } |
wolfSSL | 0:d92f9d21154c | 495 | |
wolfSSL | 0:d92f9d21154c | 496 | |
wolfSSL | 0:d92f9d21154c | 497 | int wc_Des_CbcEncrypt(Des* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 498 | { |
wolfSSL | 0:d92f9d21154c | 499 | wc_Des_Cbc(out, in, sz, (byte *)des->key, (byte *)des->reg, SEC_DESC_DES_CBC_ENCRYPT) ; |
wolfSSL | 0:d92f9d21154c | 500 | return 0; |
wolfSSL | 0:d92f9d21154c | 501 | } |
wolfSSL | 0:d92f9d21154c | 502 | |
wolfSSL | 0:d92f9d21154c | 503 | int wc_Des_CbcDecrypt(Des* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 504 | { |
wolfSSL | 0:d92f9d21154c | 505 | wc_Des_Cbc(out, in, sz, (byte *)des->key, (byte *)des->reg, SEC_DESC_DES_CBC_DECRYPT) ; |
wolfSSL | 0:d92f9d21154c | 506 | return 0; |
wolfSSL | 0:d92f9d21154c | 507 | } |
wolfSSL | 0:d92f9d21154c | 508 | |
wolfSSL | 0:d92f9d21154c | 509 | int wc_Des3_CbcEncrypt(Des3* des3, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 510 | { |
wolfSSL | 0:d92f9d21154c | 511 | wc_Des_Cbc(out, in, sz, (byte *)des3->key, (byte *)des3->reg, SEC_DESC_DES3_CBC_ENCRYPT) ; |
wolfSSL | 0:d92f9d21154c | 512 | return 0; |
wolfSSL | 0:d92f9d21154c | 513 | } |
wolfSSL | 0:d92f9d21154c | 514 | |
wolfSSL | 0:d92f9d21154c | 515 | |
wolfSSL | 0:d92f9d21154c | 516 | int wc_Des3_CbcDecrypt(Des3* des3, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 517 | { |
wolfSSL | 0:d92f9d21154c | 518 | wc_Des_Cbc(out, in, sz, (byte *)des3->key, (byte *)des3->reg, SEC_DESC_DES3_CBC_DECRYPT) ; |
wolfSSL | 0:d92f9d21154c | 519 | return 0; |
wolfSSL | 0:d92f9d21154c | 520 | } |
wolfSSL | 0:d92f9d21154c | 521 | |
wolfSSL | 0:d92f9d21154c | 522 | static void setParity(byte *buf, int len) |
wolfSSL | 0:d92f9d21154c | 523 | { |
wolfSSL | 0:d92f9d21154c | 524 | int i, j ; |
wolfSSL | 0:d92f9d21154c | 525 | byte v ; |
wolfSSL | 0:d92f9d21154c | 526 | int bits ; |
wolfSSL | 0:d92f9d21154c | 527 | |
wolfSSL | 0:d92f9d21154c | 528 | for(i=0; i<len; i++) |
wolfSSL | 0:d92f9d21154c | 529 | { |
wolfSSL | 0:d92f9d21154c | 530 | v = buf[i] >> 1 ; |
wolfSSL | 0:d92f9d21154c | 531 | buf[i] = v << 1 ; |
wolfSSL | 0:d92f9d21154c | 532 | bits = 0 ; |
wolfSSL | 0:d92f9d21154c | 533 | for(j=0; j<7; j++) |
wolfSSL | 0:d92f9d21154c | 534 | { |
wolfSSL | 0:d92f9d21154c | 535 | bits += (v&0x1) ; |
wolfSSL | 0:d92f9d21154c | 536 | v = v >> 1 ; |
wolfSSL | 0:d92f9d21154c | 537 | } |
wolfSSL | 0:d92f9d21154c | 538 | buf[i] |= (1 - (bits&0x1)) ; |
wolfSSL | 0:d92f9d21154c | 539 | } |
wolfSSL | 0:d92f9d21154c | 540 | |
wolfSSL | 0:d92f9d21154c | 541 | } |
wolfSSL | 0:d92f9d21154c | 542 | |
wolfSSL | 0:d92f9d21154c | 543 | |
wolfSSL | 0:d92f9d21154c | 544 | int wc_Des_SetKey(Des* des, const byte* key, const byte* iv, int dir) |
wolfSSL | 0:d92f9d21154c | 545 | { |
wolfSSL | 0:d92f9d21154c | 546 | if(desBuffIn == NULL) { |
wolfSSL | 0:d92f9d21154c | 547 | #if defined (HAVE_THREADX) |
wolfSSL | 0:d92f9d21154c | 548 | int s1, s2, s3, s4, s5 ; |
wolfSSL | 0:d92f9d21154c | 549 | s5 = tx_byte_allocate(&mp_ncached,(void *)&secDesc, |
wolfSSL | 0:d92f9d21154c | 550 | sizeof(SECdescriptorType), TX_NO_WAIT); |
wolfSSL | 0:d92f9d21154c | 551 | s1 = tx_byte_allocate(&mp_ncached,(void *)&desBuffIn, DES_BUFFER_SIZE, TX_NO_WAIT); |
wolfSSL | 0:d92f9d21154c | 552 | s2 = tx_byte_allocate(&mp_ncached,(void *)&desBuffOut, DES_BUFFER_SIZE, TX_NO_WAIT); |
wolfSSL | 0:d92f9d21154c | 553 | /* Don't know des or des3 to be used. Allocate larger buffers */ |
wolfSSL | 0:d92f9d21154c | 554 | s3 = tx_byte_allocate(&mp_ncached,(void *)&secKey, DES3_KEYLEN,TX_NO_WAIT); |
wolfSSL | 0:d92f9d21154c | 555 | s4 = tx_byte_allocate(&mp_ncached,(void *)&secIV, DES3_IVLEN, TX_NO_WAIT); |
wolfSSL | 0:d92f9d21154c | 556 | #else |
wolfSSL | 0:d92f9d21154c | 557 | #warning "Allocate non-Cache buffers" |
wolfSSL | 0:d92f9d21154c | 558 | #endif |
wolfSSL | 0:d92f9d21154c | 559 | |
wolfSSL | 0:d92f9d21154c | 560 | InitMutex(&Mutex_DesSEC) ; |
wolfSSL | 0:d92f9d21154c | 561 | } |
wolfSSL | 0:d92f9d21154c | 562 | |
wolfSSL | 0:d92f9d21154c | 563 | XMEMCPY(des->key, key, DES_KEYLEN); |
wolfSSL | 0:d92f9d21154c | 564 | setParity((byte *)des->key, DES_KEYLEN) ; |
wolfSSL | 0:d92f9d21154c | 565 | |
wolfSSL | 0:d92f9d21154c | 566 | if (iv) { |
wolfSSL | 0:d92f9d21154c | 567 | XMEMCPY(des->reg, iv, DES_IVLEN); |
wolfSSL | 0:d92f9d21154c | 568 | } else { |
wolfSSL | 0:d92f9d21154c | 569 | XMEMSET(des->reg, 0x0, DES_IVLEN) ; |
wolfSSL | 0:d92f9d21154c | 570 | } |
wolfSSL | 0:d92f9d21154c | 571 | return 0; |
wolfSSL | 0:d92f9d21154c | 572 | } |
wolfSSL | 0:d92f9d21154c | 573 | |
wolfSSL | 0:d92f9d21154c | 574 | int wc_Des3_SetKey(Des3* des3, const byte* key, const byte* iv, int dir) |
wolfSSL | 0:d92f9d21154c | 575 | { |
wolfSSL | 0:d92f9d21154c | 576 | |
wolfSSL | 0:d92f9d21154c | 577 | if(desBuffIn == NULL) { |
wolfSSL | 0:d92f9d21154c | 578 | #if defined (HAVE_THREADX) |
wolfSSL | 0:d92f9d21154c | 579 | int s1, s2, s3, s4, s5 ; |
wolfSSL | 0:d92f9d21154c | 580 | s5 = tx_byte_allocate(&mp_ncached,(void *)&secDesc, |
wolfSSL | 0:d92f9d21154c | 581 | sizeof(SECdescriptorType), TX_NO_WAIT); |
wolfSSL | 0:d92f9d21154c | 582 | s1 = tx_byte_allocate(&mp_ncached,(void *)&desBuffIn, DES_BUFFER_SIZE, TX_NO_WAIT); |
wolfSSL | 0:d92f9d21154c | 583 | s2 = tx_byte_allocate(&mp_ncached,(void *)&desBuffOut, DES_BUFFER_SIZE, TX_NO_WAIT); |
wolfSSL | 0:d92f9d21154c | 584 | s3 = tx_byte_allocate(&mp_ncached,(void *)&secKey, DES3_KEYLEN,TX_NO_WAIT); |
wolfSSL | 0:d92f9d21154c | 585 | s4 = tx_byte_allocate(&mp_ncached,(void *)&secIV, DES3_IVLEN, TX_NO_WAIT); |
wolfSSL | 0:d92f9d21154c | 586 | #else |
wolfSSL | 0:d92f9d21154c | 587 | #warning "Allocate non-Cache buffers" |
wolfSSL | 0:d92f9d21154c | 588 | #endif |
wolfSSL | 0:d92f9d21154c | 589 | |
wolfSSL | 0:d92f9d21154c | 590 | InitMutex(&Mutex_DesSEC) ; |
wolfSSL | 0:d92f9d21154c | 591 | } |
wolfSSL | 0:d92f9d21154c | 592 | |
wolfSSL | 0:d92f9d21154c | 593 | XMEMCPY(des3->key[0], key, DES3_KEYLEN); |
wolfSSL | 0:d92f9d21154c | 594 | setParity((byte *)des3->key[0], DES3_KEYLEN) ; |
wolfSSL | 0:d92f9d21154c | 595 | |
wolfSSL | 0:d92f9d21154c | 596 | if (iv) { |
wolfSSL | 0:d92f9d21154c | 597 | XMEMCPY(des3->reg, iv, DES3_IVLEN); |
wolfSSL | 0:d92f9d21154c | 598 | } else { |
wolfSSL | 0:d92f9d21154c | 599 | XMEMSET(des3->reg, 0x0, DES3_IVLEN) ; |
wolfSSL | 0:d92f9d21154c | 600 | } |
wolfSSL | 0:d92f9d21154c | 601 | return 0; |
wolfSSL | 0:d92f9d21154c | 602 | |
wolfSSL | 0:d92f9d21154c | 603 | } |
wolfSSL | 0:d92f9d21154c | 604 | |
wolfSSL | 0:d92f9d21154c | 605 | #elif defined FREESCALE_MMCAU |
wolfSSL | 0:d92f9d21154c | 606 | /* |
wolfSSL | 0:d92f9d21154c | 607 | * Freescale mmCAU hardware DES/3DES support through the CAU/mmCAU library. |
wolfSSL | 0:d92f9d21154c | 608 | * Documentation located in ColdFire/ColdFire+ CAU and Kinetis mmCAU |
wolfSSL | 0:d92f9d21154c | 609 | * Software Library User Guide (See note in README). |
wolfSSL | 0:d92f9d21154c | 610 | */ |
wolfSSL | 0:d92f9d21154c | 611 | #include "cau_api.h" |
wolfSSL | 0:d92f9d21154c | 612 | |
wolfSSL | 0:d92f9d21154c | 613 | const unsigned char parityLookup[128] = |
wolfSSL | 0:d92f9d21154c | 614 | { |
wolfSSL | 0:d92f9d21154c | 615 | 1,0,0,1,0,1,1,0,0,1,1,0,1,0,0,1,0,1,1,0,1,0,0,1,1,0,0,1,0,1,1,0, |
wolfSSL | 0:d92f9d21154c | 616 | 0,1,1,0,1,0,0,1,1,0,0,1,0,1,1,0,1,0,0,1,0,1,1,0,0,1,1,0,1,0,0,1, |
wolfSSL | 0:d92f9d21154c | 617 | 0,1,1,0,1,0,0,1,1,0,0,1,0,1,1,0,1,0,0,1,0,1,1,0,0,1,1,0,1,0,0,1, |
wolfSSL | 0:d92f9d21154c | 618 | 1,0,0,1,0,1,1,0,0,1,1,0,1,0,0,1,0,1,1,0,1,0,0,1,1,0,0,1,0,1,1,0 |
wolfSSL | 0:d92f9d21154c | 619 | }; |
wolfSSL | 0:d92f9d21154c | 620 | |
wolfSSL | 0:d92f9d21154c | 621 | int wc_Des_SetKey(Des* des, const byte* key, const byte* iv, int dir) |
wolfSSL | 0:d92f9d21154c | 622 | { |
wolfSSL | 0:d92f9d21154c | 623 | int i = 0; |
wolfSSL | 0:d92f9d21154c | 624 | byte* dkey = (byte*)des->key; |
wolfSSL | 0:d92f9d21154c | 625 | |
wolfSSL | 0:d92f9d21154c | 626 | XMEMCPY(dkey, key, 8); |
wolfSSL | 0:d92f9d21154c | 627 | |
wolfSSL | 0:d92f9d21154c | 628 | wc_Des_SetIV(des, iv); |
wolfSSL | 0:d92f9d21154c | 629 | |
wolfSSL | 0:d92f9d21154c | 630 | /* fix key parity, if needed */ |
wolfSSL | 0:d92f9d21154c | 631 | for (i = 0; i < 8; i++) { |
wolfSSL | 0:d92f9d21154c | 632 | dkey[i] = ((dkey[i] & 0xFE) | parityLookup[dkey[i] >> 1]); |
wolfSSL | 0:d92f9d21154c | 633 | } |
wolfSSL | 0:d92f9d21154c | 634 | |
wolfSSL | 0:d92f9d21154c | 635 | return 0; |
wolfSSL | 0:d92f9d21154c | 636 | } |
wolfSSL | 0:d92f9d21154c | 637 | |
wolfSSL | 0:d92f9d21154c | 638 | int wc_Des3_SetKey(Des3* des, const byte* key, const byte* iv, int dir) |
wolfSSL | 0:d92f9d21154c | 639 | { |
wolfSSL | 0:d92f9d21154c | 640 | int i = 0, ret = 0; |
wolfSSL | 0:d92f9d21154c | 641 | byte* dkey1 = (byte*)des->key[0]; |
wolfSSL | 0:d92f9d21154c | 642 | byte* dkey2 = (byte*)des->key[1]; |
wolfSSL | 0:d92f9d21154c | 643 | byte* dkey3 = (byte*)des->key[2]; |
wolfSSL | 0:d92f9d21154c | 644 | |
wolfSSL | 0:d92f9d21154c | 645 | XMEMCPY(dkey1, key, 8); /* set key 1 */ |
wolfSSL | 0:d92f9d21154c | 646 | XMEMCPY(dkey2, key + 8, 8); /* set key 2 */ |
wolfSSL | 0:d92f9d21154c | 647 | XMEMCPY(dkey3, key + 16, 8); /* set key 3 */ |
wolfSSL | 0:d92f9d21154c | 648 | |
wolfSSL | 0:d92f9d21154c | 649 | ret = wc_Des3_SetIV(des, iv); |
wolfSSL | 0:d92f9d21154c | 650 | if (ret != 0) |
wolfSSL | 0:d92f9d21154c | 651 | return ret; |
wolfSSL | 0:d92f9d21154c | 652 | |
wolfSSL | 0:d92f9d21154c | 653 | /* fix key parity if needed */ |
wolfSSL | 0:d92f9d21154c | 654 | for (i = 0; i < 8; i++) |
wolfSSL | 0:d92f9d21154c | 655 | dkey1[i] = ((dkey1[i] & 0xFE) | parityLookup[dkey1[i] >> 1]); |
wolfSSL | 0:d92f9d21154c | 656 | |
wolfSSL | 0:d92f9d21154c | 657 | for (i = 0; i < 8; i++) |
wolfSSL | 0:d92f9d21154c | 658 | dkey2[i] = ((dkey2[i] & 0xFE) | parityLookup[dkey2[i] >> 1]); |
wolfSSL | 0:d92f9d21154c | 659 | |
wolfSSL | 0:d92f9d21154c | 660 | for (i = 0; i < 8; i++) |
wolfSSL | 0:d92f9d21154c | 661 | dkey3[i] = ((dkey3[i] & 0xFE) | parityLookup[dkey3[i] >> 1]); |
wolfSSL | 0:d92f9d21154c | 662 | |
wolfSSL | 0:d92f9d21154c | 663 | return ret; |
wolfSSL | 0:d92f9d21154c | 664 | } |
wolfSSL | 0:d92f9d21154c | 665 | |
wolfSSL | 0:d92f9d21154c | 666 | int wc_Des_CbcEncrypt(Des* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 667 | { |
wolfSSL | 0:d92f9d21154c | 668 | int i; |
wolfSSL | 0:d92f9d21154c | 669 | int offset = 0; |
wolfSSL | 0:d92f9d21154c | 670 | int len = sz; |
wolfSSL | 0:d92f9d21154c | 671 | byte *iv; |
wolfSSL | 0:d92f9d21154c | 672 | byte temp_block[DES_BLOCK_SIZE]; |
wolfSSL | 0:d92f9d21154c | 673 | |
wolfSSL | 0:d92f9d21154c | 674 | iv = (byte*)des->reg; |
wolfSSL | 0:d92f9d21154c | 675 | |
wolfSSL | 0:d92f9d21154c | 676 | if ((wolfssl_word)out % WOLFSSL_MMCAU_ALIGNMENT) { |
wolfSSL | 0:d92f9d21154c | 677 | WOLFSSL_MSG("Bad cau_des_encrypt alignment"); |
wolfSSL | 0:d92f9d21154c | 678 | return BAD_ALIGN_E; |
wolfSSL | 0:d92f9d21154c | 679 | } |
wolfSSL | 0:d92f9d21154c | 680 | |
wolfSSL | 0:d92f9d21154c | 681 | while (len > 0) |
wolfSSL | 0:d92f9d21154c | 682 | { |
wolfSSL | 0:d92f9d21154c | 683 | XMEMCPY(temp_block, in + offset, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 684 | |
wolfSSL | 0:d92f9d21154c | 685 | /* XOR block with IV for CBC */ |
wolfSSL | 0:d92f9d21154c | 686 | for (i = 0; i < DES_BLOCK_SIZE; i++) |
wolfSSL | 0:d92f9d21154c | 687 | temp_block[i] ^= iv[i]; |
wolfSSL | 0:d92f9d21154c | 688 | |
wolfSSL | 0:d92f9d21154c | 689 | cau_des_encrypt(temp_block, (byte*)des->key, out + offset); |
wolfSSL | 0:d92f9d21154c | 690 | |
wolfSSL | 0:d92f9d21154c | 691 | len -= DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 692 | offset += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 693 | |
wolfSSL | 0:d92f9d21154c | 694 | /* store IV for next block */ |
wolfSSL | 0:d92f9d21154c | 695 | XMEMCPY(iv, out + offset - DES_BLOCK_SIZE, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 696 | } |
wolfSSL | 0:d92f9d21154c | 697 | |
wolfSSL | 0:d92f9d21154c | 698 | return 0; |
wolfSSL | 0:d92f9d21154c | 699 | } |
wolfSSL | 0:d92f9d21154c | 700 | |
wolfSSL | 0:d92f9d21154c | 701 | int wc_Des_CbcDecrypt(Des* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 702 | { |
wolfSSL | 0:d92f9d21154c | 703 | int i; |
wolfSSL | 0:d92f9d21154c | 704 | int offset = 0; |
wolfSSL | 0:d92f9d21154c | 705 | int len = sz; |
wolfSSL | 0:d92f9d21154c | 706 | byte* iv; |
wolfSSL | 0:d92f9d21154c | 707 | byte temp_block[DES_BLOCK_SIZE]; |
wolfSSL | 0:d92f9d21154c | 708 | |
wolfSSL | 0:d92f9d21154c | 709 | iv = (byte*)des->reg; |
wolfSSL | 0:d92f9d21154c | 710 | |
wolfSSL | 0:d92f9d21154c | 711 | if ((wolfssl_word)out % WOLFSSL_MMCAU_ALIGNMENT) { |
wolfSSL | 0:d92f9d21154c | 712 | WOLFSSL_MSG("Bad cau_des_decrypt alignment"); |
wolfSSL | 0:d92f9d21154c | 713 | return BAD_ALIGN_E; |
wolfSSL | 0:d92f9d21154c | 714 | } |
wolfSSL | 0:d92f9d21154c | 715 | |
wolfSSL | 0:d92f9d21154c | 716 | while (len > 0) |
wolfSSL | 0:d92f9d21154c | 717 | { |
wolfSSL | 0:d92f9d21154c | 718 | XMEMCPY(temp_block, in + offset, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 719 | |
wolfSSL | 0:d92f9d21154c | 720 | cau_des_decrypt(in + offset, (byte*)des->key, out + offset); |
wolfSSL | 0:d92f9d21154c | 721 | |
wolfSSL | 0:d92f9d21154c | 722 | /* XOR block with IV for CBC */ |
wolfSSL | 0:d92f9d21154c | 723 | for (i = 0; i < DES_BLOCK_SIZE; i++) |
wolfSSL | 0:d92f9d21154c | 724 | (out + offset)[i] ^= iv[i]; |
wolfSSL | 0:d92f9d21154c | 725 | |
wolfSSL | 0:d92f9d21154c | 726 | /* store IV for next block */ |
wolfSSL | 0:d92f9d21154c | 727 | XMEMCPY(iv, temp_block, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 728 | |
wolfSSL | 0:d92f9d21154c | 729 | len -= DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 730 | offset += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 731 | } |
wolfSSL | 0:d92f9d21154c | 732 | |
wolfSSL | 0:d92f9d21154c | 733 | return 0; |
wolfSSL | 0:d92f9d21154c | 734 | } |
wolfSSL | 0:d92f9d21154c | 735 | |
wolfSSL | 0:d92f9d21154c | 736 | int wc_Des3_CbcEncrypt(Des3* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 737 | { |
wolfSSL | 0:d92f9d21154c | 738 | int i; |
wolfSSL | 0:d92f9d21154c | 739 | int offset = 0; |
wolfSSL | 0:d92f9d21154c | 740 | int len = sz; |
wolfSSL | 0:d92f9d21154c | 741 | |
wolfSSL | 0:d92f9d21154c | 742 | byte *iv; |
wolfSSL | 0:d92f9d21154c | 743 | byte temp_block[DES_BLOCK_SIZE]; |
wolfSSL | 0:d92f9d21154c | 744 | |
wolfSSL | 0:d92f9d21154c | 745 | iv = (byte*)des->reg; |
wolfSSL | 0:d92f9d21154c | 746 | |
wolfSSL | 0:d92f9d21154c | 747 | if ((wolfssl_word)out % WOLFSSL_MMCAU_ALIGNMENT) { |
wolfSSL | 0:d92f9d21154c | 748 | WOLFSSL_MSG("Bad 3ede cau_des_encrypt alignment"); |
wolfSSL | 0:d92f9d21154c | 749 | return BAD_ALIGN_E; |
wolfSSL | 0:d92f9d21154c | 750 | } |
wolfSSL | 0:d92f9d21154c | 751 | |
wolfSSL | 0:d92f9d21154c | 752 | while (len > 0) |
wolfSSL | 0:d92f9d21154c | 753 | { |
wolfSSL | 0:d92f9d21154c | 754 | XMEMCPY(temp_block, in + offset, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 755 | |
wolfSSL | 0:d92f9d21154c | 756 | /* XOR block with IV for CBC */ |
wolfSSL | 0:d92f9d21154c | 757 | for (i = 0; i < DES_BLOCK_SIZE; i++) |
wolfSSL | 0:d92f9d21154c | 758 | temp_block[i] ^= iv[i]; |
wolfSSL | 0:d92f9d21154c | 759 | |
wolfSSL | 0:d92f9d21154c | 760 | cau_des_encrypt(temp_block , (byte*)des->key[0], out + offset); |
wolfSSL | 0:d92f9d21154c | 761 | cau_des_decrypt(out + offset, (byte*)des->key[1], out + offset); |
wolfSSL | 0:d92f9d21154c | 762 | cau_des_encrypt(out + offset, (byte*)des->key[2], out + offset); |
wolfSSL | 0:d92f9d21154c | 763 | |
wolfSSL | 0:d92f9d21154c | 764 | len -= DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 765 | offset += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 766 | |
wolfSSL | 0:d92f9d21154c | 767 | /* store IV for next block */ |
wolfSSL | 0:d92f9d21154c | 768 | XMEMCPY(iv, out + offset - DES_BLOCK_SIZE, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 769 | } |
wolfSSL | 0:d92f9d21154c | 770 | |
wolfSSL | 0:d92f9d21154c | 771 | return 0; |
wolfSSL | 0:d92f9d21154c | 772 | } |
wolfSSL | 0:d92f9d21154c | 773 | |
wolfSSL | 0:d92f9d21154c | 774 | int wc_Des3_CbcDecrypt(Des3* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 775 | { |
wolfSSL | 0:d92f9d21154c | 776 | int i; |
wolfSSL | 0:d92f9d21154c | 777 | int offset = 0; |
wolfSSL | 0:d92f9d21154c | 778 | int len = sz; |
wolfSSL | 0:d92f9d21154c | 779 | |
wolfSSL | 0:d92f9d21154c | 780 | byte* iv; |
wolfSSL | 0:d92f9d21154c | 781 | byte temp_block[DES_BLOCK_SIZE]; |
wolfSSL | 0:d92f9d21154c | 782 | |
wolfSSL | 0:d92f9d21154c | 783 | iv = (byte*)des->reg; |
wolfSSL | 0:d92f9d21154c | 784 | |
wolfSSL | 0:d92f9d21154c | 785 | if ((wolfssl_word)out % WOLFSSL_MMCAU_ALIGNMENT) { |
wolfSSL | 0:d92f9d21154c | 786 | WOLFSSL_MSG("Bad 3ede cau_des_decrypt alignment"); |
wolfSSL | 0:d92f9d21154c | 787 | return BAD_ALIGN_E; |
wolfSSL | 0:d92f9d21154c | 788 | } |
wolfSSL | 0:d92f9d21154c | 789 | |
wolfSSL | 0:d92f9d21154c | 790 | while (len > 0) |
wolfSSL | 0:d92f9d21154c | 791 | { |
wolfSSL | 0:d92f9d21154c | 792 | XMEMCPY(temp_block, in + offset, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 793 | |
wolfSSL | 0:d92f9d21154c | 794 | cau_des_decrypt(in + offset , (byte*)des->key[2], out + offset); |
wolfSSL | 0:d92f9d21154c | 795 | cau_des_encrypt(out + offset, (byte*)des->key[1], out + offset); |
wolfSSL | 0:d92f9d21154c | 796 | cau_des_decrypt(out + offset, (byte*)des->key[0], out + offset); |
wolfSSL | 0:d92f9d21154c | 797 | |
wolfSSL | 0:d92f9d21154c | 798 | /* XOR block with IV for CBC */ |
wolfSSL | 0:d92f9d21154c | 799 | for (i = 0; i < DES_BLOCK_SIZE; i++) |
wolfSSL | 0:d92f9d21154c | 800 | (out + offset)[i] ^= iv[i]; |
wolfSSL | 0:d92f9d21154c | 801 | |
wolfSSL | 0:d92f9d21154c | 802 | /* store IV for next block */ |
wolfSSL | 0:d92f9d21154c | 803 | XMEMCPY(iv, temp_block, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 804 | |
wolfSSL | 0:d92f9d21154c | 805 | len -= DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 806 | offset += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 807 | } |
wolfSSL | 0:d92f9d21154c | 808 | |
wolfSSL | 0:d92f9d21154c | 809 | return 0; |
wolfSSL | 0:d92f9d21154c | 810 | } |
wolfSSL | 0:d92f9d21154c | 811 | |
wolfSSL | 0:d92f9d21154c | 812 | |
wolfSSL | 0:d92f9d21154c | 813 | #elif defined(WOLFSSL_PIC32MZ_CRYPT) |
wolfSSL | 0:d92f9d21154c | 814 | |
wolfSSL | 0:d92f9d21154c | 815 | #include "wolfssl/wolfcrypt/port/pic32/pic32mz-crypt.h" |
wolfSSL | 0:d92f9d21154c | 816 | |
wolfSSL | 0:d92f9d21154c | 817 | void wc_Des_SetIV(Des* des, const byte* iv); |
wolfSSL | 0:d92f9d21154c | 818 | int wc_Des3_SetIV(Des3* des, const byte* iv); |
wolfSSL | 0:d92f9d21154c | 819 | |
wolfSSL | 0:d92f9d21154c | 820 | int wc_Des_SetKey(Des* des, const byte* key, const byte* iv, int dir) |
wolfSSL | 0:d92f9d21154c | 821 | { |
wolfSSL | 0:d92f9d21154c | 822 | word32 *dkey = des->key ; |
wolfSSL | 0:d92f9d21154c | 823 | word32 *dreg = des->reg ; |
wolfSSL | 0:d92f9d21154c | 824 | |
wolfSSL | 0:d92f9d21154c | 825 | XMEMCPY((byte *)dkey, (byte *)key, 8); |
wolfSSL | 0:d92f9d21154c | 826 | ByteReverseWords(dkey, dkey, 8); |
wolfSSL | 0:d92f9d21154c | 827 | XMEMCPY((byte *)dreg, (byte *)iv, 8); |
wolfSSL | 0:d92f9d21154c | 828 | ByteReverseWords(dreg, dreg, 8); |
wolfSSL | 0:d92f9d21154c | 829 | |
wolfSSL | 0:d92f9d21154c | 830 | return 0; |
wolfSSL | 0:d92f9d21154c | 831 | } |
wolfSSL | 0:d92f9d21154c | 832 | |
wolfSSL | 0:d92f9d21154c | 833 | int wc_Des3_SetKey(Des3* des, const byte* key, const byte* iv, int dir) |
wolfSSL | 0:d92f9d21154c | 834 | { |
wolfSSL | 0:d92f9d21154c | 835 | word32 *dkey1 = des->key[0]; |
wolfSSL | 0:d92f9d21154c | 836 | word32 *dreg = des->reg ; |
wolfSSL | 0:d92f9d21154c | 837 | |
wolfSSL | 0:d92f9d21154c | 838 | XMEMCPY(dkey1, key, 24); |
wolfSSL | 0:d92f9d21154c | 839 | ByteReverseWords(dkey1, dkey1, 24); |
wolfSSL | 0:d92f9d21154c | 840 | XMEMCPY(dreg, iv, 8); |
wolfSSL | 0:d92f9d21154c | 841 | ByteReverseWords(dreg, dreg, 8) ; |
wolfSSL | 0:d92f9d21154c | 842 | |
wolfSSL | 0:d92f9d21154c | 843 | return 0; |
wolfSSL | 0:d92f9d21154c | 844 | } |
wolfSSL | 0:d92f9d21154c | 845 | |
wolfSSL | 0:d92f9d21154c | 846 | void DesCrypt(word32 *key, word32 *iv, byte* out, const byte* in, word32 sz, |
wolfSSL | 0:d92f9d21154c | 847 | int dir, int algo, int cryptoalgo) |
wolfSSL | 0:d92f9d21154c | 848 | { |
wolfSSL | 0:d92f9d21154c | 849 | securityAssociation *sa_p ; |
wolfSSL | 0:d92f9d21154c | 850 | bufferDescriptor *bd_p ; |
wolfSSL | 0:d92f9d21154c | 851 | const byte *in_p, *in_l ; |
wolfSSL | 0:d92f9d21154c | 852 | byte *out_p, *out_l ; |
wolfSSL | 0:d92f9d21154c | 853 | volatile securityAssociation sa __attribute__((aligned (8))); |
wolfSSL | 0:d92f9d21154c | 854 | volatile bufferDescriptor bd __attribute__((aligned (8))); |
wolfSSL | 0:d92f9d21154c | 855 | volatile int k ; |
wolfSSL | 0:d92f9d21154c | 856 | |
wolfSSL | 0:d92f9d21154c | 857 | /* get uncached address */ |
wolfSSL | 0:d92f9d21154c | 858 | |
wolfSSL | 0:d92f9d21154c | 859 | in_l = in; |
wolfSSL | 0:d92f9d21154c | 860 | out_l = out ; |
wolfSSL | 0:d92f9d21154c | 861 | sa_p = KVA0_TO_KVA1(&sa) ; |
wolfSSL | 0:d92f9d21154c | 862 | bd_p = KVA0_TO_KVA1(&bd) ; |
wolfSSL | 0:d92f9d21154c | 863 | in_p = KVA0_TO_KVA1(in_l) ; |
wolfSSL | 0:d92f9d21154c | 864 | out_p= KVA0_TO_KVA1(out_l); |
wolfSSL | 0:d92f9d21154c | 865 | |
wolfSSL | 0:d92f9d21154c | 866 | if(PIC32MZ_IF_RAM(in_p)) |
wolfSSL | 0:d92f9d21154c | 867 | XMEMCPY((void *)in_p, (void *)in, sz); |
wolfSSL | 0:d92f9d21154c | 868 | XMEMSET((void *)out_p, 0, sz); |
wolfSSL | 0:d92f9d21154c | 869 | |
wolfSSL | 0:d92f9d21154c | 870 | /* Set up the Security Association */ |
wolfSSL | 0:d92f9d21154c | 871 | XMEMSET((byte *)KVA0_TO_KVA1(&sa), 0, sizeof(sa)); |
wolfSSL | 0:d92f9d21154c | 872 | sa_p->SA_CTRL.ALGO = algo ; |
wolfSSL | 0:d92f9d21154c | 873 | sa_p->SA_CTRL.LNC = 1; |
wolfSSL | 0:d92f9d21154c | 874 | sa_p->SA_CTRL.LOADIV = 1; |
wolfSSL | 0:d92f9d21154c | 875 | sa_p->SA_CTRL.FB = 1; |
wolfSSL | 0:d92f9d21154c | 876 | sa_p->SA_CTRL.ENCTYPE = dir ; /* Encryption/Decryption */ |
wolfSSL | 0:d92f9d21154c | 877 | sa_p->SA_CTRL.CRYPTOALGO = cryptoalgo; |
wolfSSL | 0:d92f9d21154c | 878 | sa_p->SA_CTRL.KEYSIZE = 1 ; /* KEY is 192 bits */ |
wolfSSL | 0:d92f9d21154c | 879 | XMEMCPY((byte *)KVA0_TO_KVA1(&sa.SA_ENCKEY[algo==PIC32_ALGO_TDES ? 2 : 6]), |
wolfSSL | 0:d92f9d21154c | 880 | (byte *)key, algo==PIC32_ALGO_TDES ? 24 : 8); |
wolfSSL | 0:d92f9d21154c | 881 | XMEMCPY((byte *)KVA0_TO_KVA1(&sa.SA_ENCIV[2]), (byte *)iv, 8); |
wolfSSL | 0:d92f9d21154c | 882 | |
wolfSSL | 0:d92f9d21154c | 883 | XMEMSET((byte *)KVA0_TO_KVA1(&bd), 0, sizeof(bd)); |
wolfSSL | 0:d92f9d21154c | 884 | /* Set up the Buffer Descriptor */ |
wolfSSL | 0:d92f9d21154c | 885 | bd_p->BD_CTRL.BUFLEN = sz; |
wolfSSL | 0:d92f9d21154c | 886 | bd_p->BD_CTRL.LIFM = 1; |
wolfSSL | 0:d92f9d21154c | 887 | bd_p->BD_CTRL.SA_FETCH_EN = 1; |
wolfSSL | 0:d92f9d21154c | 888 | bd_p->BD_CTRL.LAST_BD = 1; |
wolfSSL | 0:d92f9d21154c | 889 | bd_p->BD_CTRL.DESC_EN = 1; |
wolfSSL | 0:d92f9d21154c | 890 | |
wolfSSL | 0:d92f9d21154c | 891 | bd_p->SA_ADDR = (unsigned int)KVA_TO_PA(&sa) ; /* (unsigned int)sa_p; */ |
wolfSSL | 0:d92f9d21154c | 892 | bd_p->SRCADDR = (unsigned int)KVA_TO_PA(in) ; /* (unsigned int)in_p; */ |
wolfSSL | 0:d92f9d21154c | 893 | bd_p->DSTADDR = (unsigned int)KVA_TO_PA(out); /* (unsigned int)out_p; */ |
wolfSSL | 0:d92f9d21154c | 894 | bd_p->NXTPTR = (unsigned int)KVA_TO_PA(&bd); |
wolfSSL | 0:d92f9d21154c | 895 | bd_p->MSGLEN = sz ; |
wolfSSL | 0:d92f9d21154c | 896 | |
wolfSSL | 0:d92f9d21154c | 897 | /* Fire in the hole! */ |
wolfSSL | 0:d92f9d21154c | 898 | CECON = 1 << 6; |
wolfSSL | 0:d92f9d21154c | 899 | while (CECON); |
wolfSSL | 0:d92f9d21154c | 900 | |
wolfSSL | 0:d92f9d21154c | 901 | /* Run the engine */ |
wolfSSL | 0:d92f9d21154c | 902 | CEBDPADDR = (unsigned int)KVA_TO_PA(&bd) ; /* (unsigned int)bd_p ; */ |
wolfSSL | 0:d92f9d21154c | 903 | CEINTEN = 0x07; |
wolfSSL | 0:d92f9d21154c | 904 | CECON = 0x27; |
wolfSSL | 0:d92f9d21154c | 905 | |
wolfSSL | 0:d92f9d21154c | 906 | WAIT_ENGINE ; |
wolfSSL | 0:d92f9d21154c | 907 | |
wolfSSL | 0:d92f9d21154c | 908 | if((cryptoalgo == PIC32_CRYPTOALGO_CBC) || |
wolfSSL | 0:d92f9d21154c | 909 | (cryptoalgo == PIC32_CRYPTOALGO_TCBC)|| |
wolfSSL | 0:d92f9d21154c | 910 | (cryptoalgo == PIC32_CRYPTOALGO_RCBC)) { |
wolfSSL | 0:d92f9d21154c | 911 | /* set iv for the next call */ |
wolfSSL | 0:d92f9d21154c | 912 | if(dir == PIC32_ENCRYPTION) { |
wolfSSL | 0:d92f9d21154c | 913 | XMEMCPY((void *)iv, (void*)&(out_p[sz-DES_IVLEN]), DES_IVLEN) ; |
wolfSSL | 0:d92f9d21154c | 914 | } else { |
wolfSSL | 0:d92f9d21154c | 915 | ByteReverseWords((word32*)iv, (word32 *)&(in_p[sz-DES_IVLEN]), |
wolfSSL | 0:d92f9d21154c | 916 | DES_IVLEN); |
wolfSSL | 0:d92f9d21154c | 917 | } |
wolfSSL | 0:d92f9d21154c | 918 | |
wolfSSL | 0:d92f9d21154c | 919 | } |
wolfSSL | 0:d92f9d21154c | 920 | |
wolfSSL | 0:d92f9d21154c | 921 | ByteReverseWords((word32*)out, (word32 *)KVA0_TO_KVA1(out), sz); |
wolfSSL | 0:d92f9d21154c | 922 | } |
wolfSSL | 0:d92f9d21154c | 923 | |
wolfSSL | 0:d92f9d21154c | 924 | int wc_Des_CbcEncrypt(Des* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 925 | { |
wolfSSL | 0:d92f9d21154c | 926 | DesCrypt(des->key, des->reg, out, in, sz, |
wolfSSL | 0:d92f9d21154c | 927 | PIC32_ENCRYPTION, PIC32_ALGO_DES, PIC32_CRYPTOALGO_CBC ); |
wolfSSL | 0:d92f9d21154c | 928 | return 0; |
wolfSSL | 0:d92f9d21154c | 929 | } |
wolfSSL | 0:d92f9d21154c | 930 | |
wolfSSL | 0:d92f9d21154c | 931 | int wc_Des_CbcDecrypt(Des* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 932 | { |
wolfSSL | 0:d92f9d21154c | 933 | DesCrypt(des->key, des->reg, out, in, sz, |
wolfSSL | 0:d92f9d21154c | 934 | PIC32_DECRYPTION, PIC32_ALGO_DES, PIC32_CRYPTOALGO_CBC); |
wolfSSL | 0:d92f9d21154c | 935 | return 0; |
wolfSSL | 0:d92f9d21154c | 936 | } |
wolfSSL | 0:d92f9d21154c | 937 | |
wolfSSL | 0:d92f9d21154c | 938 | int wc_Des3_CbcEncrypt(Des3* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 939 | { |
wolfSSL | 0:d92f9d21154c | 940 | DesCrypt(des->key[0], des->reg, out, in, sz, |
wolfSSL | 0:d92f9d21154c | 941 | PIC32_ENCRYPTION, PIC32_ALGO_TDES, PIC32_CRYPTOALGO_TCBC); |
wolfSSL | 0:d92f9d21154c | 942 | return 0; |
wolfSSL | 0:d92f9d21154c | 943 | } |
wolfSSL | 0:d92f9d21154c | 944 | |
wolfSSL | 0:d92f9d21154c | 945 | int wc_Des3_CbcDecrypt(Des3* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 946 | { |
wolfSSL | 0:d92f9d21154c | 947 | DesCrypt(des->key[0], des->reg, out, in, sz, |
wolfSSL | 0:d92f9d21154c | 948 | PIC32_DECRYPTION, PIC32_ALGO_TDES, PIC32_CRYPTOALGO_TCBC); |
wolfSSL | 0:d92f9d21154c | 949 | return 0; |
wolfSSL | 0:d92f9d21154c | 950 | } |
wolfSSL | 0:d92f9d21154c | 951 | |
wolfSSL | 0:d92f9d21154c | 952 | #else /* CTaoCrypt software implementation */ |
wolfSSL | 0:d92f9d21154c | 953 | |
wolfSSL | 0:d92f9d21154c | 954 | /* permuted choice table (key) */ |
wolfSSL | 0:d92f9d21154c | 955 | static const byte pc1[] = { |
wolfSSL | 0:d92f9d21154c | 956 | 57, 49, 41, 33, 25, 17, 9, |
wolfSSL | 0:d92f9d21154c | 957 | 1, 58, 50, 42, 34, 26, 18, |
wolfSSL | 0:d92f9d21154c | 958 | 10, 2, 59, 51, 43, 35, 27, |
wolfSSL | 0:d92f9d21154c | 959 | 19, 11, 3, 60, 52, 44, 36, |
wolfSSL | 0:d92f9d21154c | 960 | |
wolfSSL | 0:d92f9d21154c | 961 | 63, 55, 47, 39, 31, 23, 15, |
wolfSSL | 0:d92f9d21154c | 962 | 7, 62, 54, 46, 38, 30, 22, |
wolfSSL | 0:d92f9d21154c | 963 | 14, 6, 61, 53, 45, 37, 29, |
wolfSSL | 0:d92f9d21154c | 964 | 21, 13, 5, 28, 20, 12, 4 |
wolfSSL | 0:d92f9d21154c | 965 | }; |
wolfSSL | 0:d92f9d21154c | 966 | |
wolfSSL | 0:d92f9d21154c | 967 | /* number left rotations of pc1 */ |
wolfSSL | 0:d92f9d21154c | 968 | static const byte totrot[] = { |
wolfSSL | 0:d92f9d21154c | 969 | 1,2,4,6,8,10,12,14,15,17,19,21,23,25,27,28 |
wolfSSL | 0:d92f9d21154c | 970 | }; |
wolfSSL | 0:d92f9d21154c | 971 | |
wolfSSL | 0:d92f9d21154c | 972 | /* permuted choice key (table) */ |
wolfSSL | 0:d92f9d21154c | 973 | static const byte pc2[] = { |
wolfSSL | 0:d92f9d21154c | 974 | 14, 17, 11, 24, 1, 5, |
wolfSSL | 0:d92f9d21154c | 975 | 3, 28, 15, 6, 21, 10, |
wolfSSL | 0:d92f9d21154c | 976 | 23, 19, 12, 4, 26, 8, |
wolfSSL | 0:d92f9d21154c | 977 | 16, 7, 27, 20, 13, 2, |
wolfSSL | 0:d92f9d21154c | 978 | 41, 52, 31, 37, 47, 55, |
wolfSSL | 0:d92f9d21154c | 979 | 30, 40, 51, 45, 33, 48, |
wolfSSL | 0:d92f9d21154c | 980 | 44, 49, 39, 56, 34, 53, |
wolfSSL | 0:d92f9d21154c | 981 | 46, 42, 50, 36, 29, 32 |
wolfSSL | 0:d92f9d21154c | 982 | }; |
wolfSSL | 0:d92f9d21154c | 983 | |
wolfSSL | 0:d92f9d21154c | 984 | /* End of DES-defined tables */ |
wolfSSL | 0:d92f9d21154c | 985 | |
wolfSSL | 0:d92f9d21154c | 986 | /* bit 0 is left-most in byte */ |
wolfSSL | 0:d92f9d21154c | 987 | static const int bytebit[] = { |
wolfSSL | 0:d92f9d21154c | 988 | 0200,0100,040,020,010,04,02,01 |
wolfSSL | 0:d92f9d21154c | 989 | }; |
wolfSSL | 0:d92f9d21154c | 990 | |
wolfSSL | 0:d92f9d21154c | 991 | static const word32 Spbox[8][64] = { |
wolfSSL | 0:d92f9d21154c | 992 | { |
wolfSSL | 0:d92f9d21154c | 993 | 0x01010400,0x00000000,0x00010000,0x01010404, |
wolfSSL | 0:d92f9d21154c | 994 | 0x01010004,0x00010404,0x00000004,0x00010000, |
wolfSSL | 0:d92f9d21154c | 995 | 0x00000400,0x01010400,0x01010404,0x00000400, |
wolfSSL | 0:d92f9d21154c | 996 | 0x01000404,0x01010004,0x01000000,0x00000004, |
wolfSSL | 0:d92f9d21154c | 997 | 0x00000404,0x01000400,0x01000400,0x00010400, |
wolfSSL | 0:d92f9d21154c | 998 | 0x00010400,0x01010000,0x01010000,0x01000404, |
wolfSSL | 0:d92f9d21154c | 999 | 0x00010004,0x01000004,0x01000004,0x00010004, |
wolfSSL | 0:d92f9d21154c | 1000 | 0x00000000,0x00000404,0x00010404,0x01000000, |
wolfSSL | 0:d92f9d21154c | 1001 | 0x00010000,0x01010404,0x00000004,0x01010000, |
wolfSSL | 0:d92f9d21154c | 1002 | 0x01010400,0x01000000,0x01000000,0x00000400, |
wolfSSL | 0:d92f9d21154c | 1003 | 0x01010004,0x00010000,0x00010400,0x01000004, |
wolfSSL | 0:d92f9d21154c | 1004 | 0x00000400,0x00000004,0x01000404,0x00010404, |
wolfSSL | 0:d92f9d21154c | 1005 | 0x01010404,0x00010004,0x01010000,0x01000404, |
wolfSSL | 0:d92f9d21154c | 1006 | 0x01000004,0x00000404,0x00010404,0x01010400, |
wolfSSL | 0:d92f9d21154c | 1007 | 0x00000404,0x01000400,0x01000400,0x00000000, |
wolfSSL | 0:d92f9d21154c | 1008 | 0x00010004,0x00010400,0x00000000,0x01010004}, |
wolfSSL | 0:d92f9d21154c | 1009 | { |
wolfSSL | 0:d92f9d21154c | 1010 | 0x80108020,0x80008000,0x00008000,0x00108020, |
wolfSSL | 0:d92f9d21154c | 1011 | 0x00100000,0x00000020,0x80100020,0x80008020, |
wolfSSL | 0:d92f9d21154c | 1012 | 0x80000020,0x80108020,0x80108000,0x80000000, |
wolfSSL | 0:d92f9d21154c | 1013 | 0x80008000,0x00100000,0x00000020,0x80100020, |
wolfSSL | 0:d92f9d21154c | 1014 | 0x00108000,0x00100020,0x80008020,0x00000000, |
wolfSSL | 0:d92f9d21154c | 1015 | 0x80000000,0x00008000,0x00108020,0x80100000, |
wolfSSL | 0:d92f9d21154c | 1016 | 0x00100020,0x80000020,0x00000000,0x00108000, |
wolfSSL | 0:d92f9d21154c | 1017 | 0x00008020,0x80108000,0x80100000,0x00008020, |
wolfSSL | 0:d92f9d21154c | 1018 | 0x00000000,0x00108020,0x80100020,0x00100000, |
wolfSSL | 0:d92f9d21154c | 1019 | 0x80008020,0x80100000,0x80108000,0x00008000, |
wolfSSL | 0:d92f9d21154c | 1020 | 0x80100000,0x80008000,0x00000020,0x80108020, |
wolfSSL | 0:d92f9d21154c | 1021 | 0x00108020,0x00000020,0x00008000,0x80000000, |
wolfSSL | 0:d92f9d21154c | 1022 | 0x00008020,0x80108000,0x00100000,0x80000020, |
wolfSSL | 0:d92f9d21154c | 1023 | 0x00100020,0x80008020,0x80000020,0x00100020, |
wolfSSL | 0:d92f9d21154c | 1024 | 0x00108000,0x00000000,0x80008000,0x00008020, |
wolfSSL | 0:d92f9d21154c | 1025 | 0x80000000,0x80100020,0x80108020,0x00108000}, |
wolfSSL | 0:d92f9d21154c | 1026 | { |
wolfSSL | 0:d92f9d21154c | 1027 | 0x00000208,0x08020200,0x00000000,0x08020008, |
wolfSSL | 0:d92f9d21154c | 1028 | 0x08000200,0x00000000,0x00020208,0x08000200, |
wolfSSL | 0:d92f9d21154c | 1029 | 0x00020008,0x08000008,0x08000008,0x00020000, |
wolfSSL | 0:d92f9d21154c | 1030 | 0x08020208,0x00020008,0x08020000,0x00000208, |
wolfSSL | 0:d92f9d21154c | 1031 | 0x08000000,0x00000008,0x08020200,0x00000200, |
wolfSSL | 0:d92f9d21154c | 1032 | 0x00020200,0x08020000,0x08020008,0x00020208, |
wolfSSL | 0:d92f9d21154c | 1033 | 0x08000208,0x00020200,0x00020000,0x08000208, |
wolfSSL | 0:d92f9d21154c | 1034 | 0x00000008,0x08020208,0x00000200,0x08000000, |
wolfSSL | 0:d92f9d21154c | 1035 | 0x08020200,0x08000000,0x00020008,0x00000208, |
wolfSSL | 0:d92f9d21154c | 1036 | 0x00020000,0x08020200,0x08000200,0x00000000, |
wolfSSL | 0:d92f9d21154c | 1037 | 0x00000200,0x00020008,0x08020208,0x08000200, |
wolfSSL | 0:d92f9d21154c | 1038 | 0x08000008,0x00000200,0x00000000,0x08020008, |
wolfSSL | 0:d92f9d21154c | 1039 | 0x08000208,0x00020000,0x08000000,0x08020208, |
wolfSSL | 0:d92f9d21154c | 1040 | 0x00000008,0x00020208,0x00020200,0x08000008, |
wolfSSL | 0:d92f9d21154c | 1041 | 0x08020000,0x08000208,0x00000208,0x08020000, |
wolfSSL | 0:d92f9d21154c | 1042 | 0x00020208,0x00000008,0x08020008,0x00020200}, |
wolfSSL | 0:d92f9d21154c | 1043 | { |
wolfSSL | 0:d92f9d21154c | 1044 | 0x00802001,0x00002081,0x00002081,0x00000080, |
wolfSSL | 0:d92f9d21154c | 1045 | 0x00802080,0x00800081,0x00800001,0x00002001, |
wolfSSL | 0:d92f9d21154c | 1046 | 0x00000000,0x00802000,0x00802000,0x00802081, |
wolfSSL | 0:d92f9d21154c | 1047 | 0x00000081,0x00000000,0x00800080,0x00800001, |
wolfSSL | 0:d92f9d21154c | 1048 | 0x00000001,0x00002000,0x00800000,0x00802001, |
wolfSSL | 0:d92f9d21154c | 1049 | 0x00000080,0x00800000,0x00002001,0x00002080, |
wolfSSL | 0:d92f9d21154c | 1050 | 0x00800081,0x00000001,0x00002080,0x00800080, |
wolfSSL | 0:d92f9d21154c | 1051 | 0x00002000,0x00802080,0x00802081,0x00000081, |
wolfSSL | 0:d92f9d21154c | 1052 | 0x00800080,0x00800001,0x00802000,0x00802081, |
wolfSSL | 0:d92f9d21154c | 1053 | 0x00000081,0x00000000,0x00000000,0x00802000, |
wolfSSL | 0:d92f9d21154c | 1054 | 0x00002080,0x00800080,0x00800081,0x00000001, |
wolfSSL | 0:d92f9d21154c | 1055 | 0x00802001,0x00002081,0x00002081,0x00000080, |
wolfSSL | 0:d92f9d21154c | 1056 | 0x00802081,0x00000081,0x00000001,0x00002000, |
wolfSSL | 0:d92f9d21154c | 1057 | 0x00800001,0x00002001,0x00802080,0x00800081, |
wolfSSL | 0:d92f9d21154c | 1058 | 0x00002001,0x00002080,0x00800000,0x00802001, |
wolfSSL | 0:d92f9d21154c | 1059 | 0x00000080,0x00800000,0x00002000,0x00802080}, |
wolfSSL | 0:d92f9d21154c | 1060 | { |
wolfSSL | 0:d92f9d21154c | 1061 | 0x00000100,0x02080100,0x02080000,0x42000100, |
wolfSSL | 0:d92f9d21154c | 1062 | 0x00080000,0x00000100,0x40000000,0x02080000, |
wolfSSL | 0:d92f9d21154c | 1063 | 0x40080100,0x00080000,0x02000100,0x40080100, |
wolfSSL | 0:d92f9d21154c | 1064 | 0x42000100,0x42080000,0x00080100,0x40000000, |
wolfSSL | 0:d92f9d21154c | 1065 | 0x02000000,0x40080000,0x40080000,0x00000000, |
wolfSSL | 0:d92f9d21154c | 1066 | 0x40000100,0x42080100,0x42080100,0x02000100, |
wolfSSL | 0:d92f9d21154c | 1067 | 0x42080000,0x40000100,0x00000000,0x42000000, |
wolfSSL | 0:d92f9d21154c | 1068 | 0x02080100,0x02000000,0x42000000,0x00080100, |
wolfSSL | 0:d92f9d21154c | 1069 | 0x00080000,0x42000100,0x00000100,0x02000000, |
wolfSSL | 0:d92f9d21154c | 1070 | 0x40000000,0x02080000,0x42000100,0x40080100, |
wolfSSL | 0:d92f9d21154c | 1071 | 0x02000100,0x40000000,0x42080000,0x02080100, |
wolfSSL | 0:d92f9d21154c | 1072 | 0x40080100,0x00000100,0x02000000,0x42080000, |
wolfSSL | 0:d92f9d21154c | 1073 | 0x42080100,0x00080100,0x42000000,0x42080100, |
wolfSSL | 0:d92f9d21154c | 1074 | 0x02080000,0x00000000,0x40080000,0x42000000, |
wolfSSL | 0:d92f9d21154c | 1075 | 0x00080100,0x02000100,0x40000100,0x00080000, |
wolfSSL | 0:d92f9d21154c | 1076 | 0x00000000,0x40080000,0x02080100,0x40000100}, |
wolfSSL | 0:d92f9d21154c | 1077 | { |
wolfSSL | 0:d92f9d21154c | 1078 | 0x20000010,0x20400000,0x00004000,0x20404010, |
wolfSSL | 0:d92f9d21154c | 1079 | 0x20400000,0x00000010,0x20404010,0x00400000, |
wolfSSL | 0:d92f9d21154c | 1080 | 0x20004000,0x00404010,0x00400000,0x20000010, |
wolfSSL | 0:d92f9d21154c | 1081 | 0x00400010,0x20004000,0x20000000,0x00004010, |
wolfSSL | 0:d92f9d21154c | 1082 | 0x00000000,0x00400010,0x20004010,0x00004000, |
wolfSSL | 0:d92f9d21154c | 1083 | 0x00404000,0x20004010,0x00000010,0x20400010, |
wolfSSL | 0:d92f9d21154c | 1084 | 0x20400010,0x00000000,0x00404010,0x20404000, |
wolfSSL | 0:d92f9d21154c | 1085 | 0x00004010,0x00404000,0x20404000,0x20000000, |
wolfSSL | 0:d92f9d21154c | 1086 | 0x20004000,0x00000010,0x20400010,0x00404000, |
wolfSSL | 0:d92f9d21154c | 1087 | 0x20404010,0x00400000,0x00004010,0x20000010, |
wolfSSL | 0:d92f9d21154c | 1088 | 0x00400000,0x20004000,0x20000000,0x00004010, |
wolfSSL | 0:d92f9d21154c | 1089 | 0x20000010,0x20404010,0x00404000,0x20400000, |
wolfSSL | 0:d92f9d21154c | 1090 | 0x00404010,0x20404000,0x00000000,0x20400010, |
wolfSSL | 0:d92f9d21154c | 1091 | 0x00000010,0x00004000,0x20400000,0x00404010, |
wolfSSL | 0:d92f9d21154c | 1092 | 0x00004000,0x00400010,0x20004010,0x00000000, |
wolfSSL | 0:d92f9d21154c | 1093 | 0x20404000,0x20000000,0x00400010,0x20004010}, |
wolfSSL | 0:d92f9d21154c | 1094 | { |
wolfSSL | 0:d92f9d21154c | 1095 | 0x00200000,0x04200002,0x04000802,0x00000000, |
wolfSSL | 0:d92f9d21154c | 1096 | 0x00000800,0x04000802,0x00200802,0x04200800, |
wolfSSL | 0:d92f9d21154c | 1097 | 0x04200802,0x00200000,0x00000000,0x04000002, |
wolfSSL | 0:d92f9d21154c | 1098 | 0x00000002,0x04000000,0x04200002,0x00000802, |
wolfSSL | 0:d92f9d21154c | 1099 | 0x04000800,0x00200802,0x00200002,0x04000800, |
wolfSSL | 0:d92f9d21154c | 1100 | 0x04000002,0x04200000,0x04200800,0x00200002, |
wolfSSL | 0:d92f9d21154c | 1101 | 0x04200000,0x00000800,0x00000802,0x04200802, |
wolfSSL | 0:d92f9d21154c | 1102 | 0x00200800,0x00000002,0x04000000,0x00200800, |
wolfSSL | 0:d92f9d21154c | 1103 | 0x04000000,0x00200800,0x00200000,0x04000802, |
wolfSSL | 0:d92f9d21154c | 1104 | 0x04000802,0x04200002,0x04200002,0x00000002, |
wolfSSL | 0:d92f9d21154c | 1105 | 0x00200002,0x04000000,0x04000800,0x00200000, |
wolfSSL | 0:d92f9d21154c | 1106 | 0x04200800,0x00000802,0x00200802,0x04200800, |
wolfSSL | 0:d92f9d21154c | 1107 | 0x00000802,0x04000002,0x04200802,0x04200000, |
wolfSSL | 0:d92f9d21154c | 1108 | 0x00200800,0x00000000,0x00000002,0x04200802, |
wolfSSL | 0:d92f9d21154c | 1109 | 0x00000000,0x00200802,0x04200000,0x00000800, |
wolfSSL | 0:d92f9d21154c | 1110 | 0x04000002,0x04000800,0x00000800,0x00200002}, |
wolfSSL | 0:d92f9d21154c | 1111 | { |
wolfSSL | 0:d92f9d21154c | 1112 | 0x10001040,0x00001000,0x00040000,0x10041040, |
wolfSSL | 0:d92f9d21154c | 1113 | 0x10000000,0x10001040,0x00000040,0x10000000, |
wolfSSL | 0:d92f9d21154c | 1114 | 0x00040040,0x10040000,0x10041040,0x00041000, |
wolfSSL | 0:d92f9d21154c | 1115 | 0x10041000,0x00041040,0x00001000,0x00000040, |
wolfSSL | 0:d92f9d21154c | 1116 | 0x10040000,0x10000040,0x10001000,0x00001040, |
wolfSSL | 0:d92f9d21154c | 1117 | 0x00041000,0x00040040,0x10040040,0x10041000, |
wolfSSL | 0:d92f9d21154c | 1118 | 0x00001040,0x00000000,0x00000000,0x10040040, |
wolfSSL | 0:d92f9d21154c | 1119 | 0x10000040,0x10001000,0x00041040,0x00040000, |
wolfSSL | 0:d92f9d21154c | 1120 | 0x00041040,0x00040000,0x10041000,0x00001000, |
wolfSSL | 0:d92f9d21154c | 1121 | 0x00000040,0x10040040,0x00001000,0x00041040, |
wolfSSL | 0:d92f9d21154c | 1122 | 0x10001000,0x00000040,0x10000040,0x10040000, |
wolfSSL | 0:d92f9d21154c | 1123 | 0x10040040,0x10000000,0x00040000,0x10001040, |
wolfSSL | 0:d92f9d21154c | 1124 | 0x00000000,0x10041040,0x00040040,0x10000040, |
wolfSSL | 0:d92f9d21154c | 1125 | 0x10040000,0x10001000,0x10001040,0x00000000, |
wolfSSL | 0:d92f9d21154c | 1126 | 0x10041040,0x00041000,0x00041000,0x00001040, |
wolfSSL | 0:d92f9d21154c | 1127 | 0x00001040,0x00040040,0x10000000,0x10041000} |
wolfSSL | 0:d92f9d21154c | 1128 | }; |
wolfSSL | 0:d92f9d21154c | 1129 | |
wolfSSL | 0:d92f9d21154c | 1130 | |
wolfSSL | 0:d92f9d21154c | 1131 | static INLINE void IPERM(word32* left, word32* right) |
wolfSSL | 0:d92f9d21154c | 1132 | { |
wolfSSL | 0:d92f9d21154c | 1133 | word32 work; |
wolfSSL | 0:d92f9d21154c | 1134 | |
wolfSSL | 0:d92f9d21154c | 1135 | *right = rotlFixed(*right, 4U); |
wolfSSL | 0:d92f9d21154c | 1136 | work = (*left ^ *right) & 0xf0f0f0f0; |
wolfSSL | 0:d92f9d21154c | 1137 | *left ^= work; |
wolfSSL | 0:d92f9d21154c | 1138 | |
wolfSSL | 0:d92f9d21154c | 1139 | *right = rotrFixed(*right^work, 20U); |
wolfSSL | 0:d92f9d21154c | 1140 | work = (*left ^ *right) & 0xffff0000; |
wolfSSL | 0:d92f9d21154c | 1141 | *left ^= work; |
wolfSSL | 0:d92f9d21154c | 1142 | |
wolfSSL | 0:d92f9d21154c | 1143 | *right = rotrFixed(*right^work, 18U); |
wolfSSL | 0:d92f9d21154c | 1144 | work = (*left ^ *right) & 0x33333333; |
wolfSSL | 0:d92f9d21154c | 1145 | *left ^= work; |
wolfSSL | 0:d92f9d21154c | 1146 | |
wolfSSL | 0:d92f9d21154c | 1147 | *right = rotrFixed(*right^work, 6U); |
wolfSSL | 0:d92f9d21154c | 1148 | work = (*left ^ *right) & 0x00ff00ff; |
wolfSSL | 0:d92f9d21154c | 1149 | *left ^= work; |
wolfSSL | 0:d92f9d21154c | 1150 | |
wolfSSL | 0:d92f9d21154c | 1151 | *right = rotlFixed(*right^work, 9U); |
wolfSSL | 0:d92f9d21154c | 1152 | work = (*left ^ *right) & 0xaaaaaaaa; |
wolfSSL | 0:d92f9d21154c | 1153 | *left = rotlFixed(*left^work, 1U); |
wolfSSL | 0:d92f9d21154c | 1154 | *right ^= work; |
wolfSSL | 0:d92f9d21154c | 1155 | } |
wolfSSL | 0:d92f9d21154c | 1156 | |
wolfSSL | 0:d92f9d21154c | 1157 | |
wolfSSL | 0:d92f9d21154c | 1158 | static INLINE void FPERM(word32* left, word32* right) |
wolfSSL | 0:d92f9d21154c | 1159 | { |
wolfSSL | 0:d92f9d21154c | 1160 | word32 work; |
wolfSSL | 0:d92f9d21154c | 1161 | |
wolfSSL | 0:d92f9d21154c | 1162 | *right = rotrFixed(*right, 1U); |
wolfSSL | 0:d92f9d21154c | 1163 | work = (*left ^ *right) & 0xaaaaaaaa; |
wolfSSL | 0:d92f9d21154c | 1164 | *right ^= work; |
wolfSSL | 0:d92f9d21154c | 1165 | |
wolfSSL | 0:d92f9d21154c | 1166 | *left = rotrFixed(*left^work, 9U); |
wolfSSL | 0:d92f9d21154c | 1167 | work = (*left ^ *right) & 0x00ff00ff; |
wolfSSL | 0:d92f9d21154c | 1168 | *right ^= work; |
wolfSSL | 0:d92f9d21154c | 1169 | |
wolfSSL | 0:d92f9d21154c | 1170 | *left = rotlFixed(*left^work, 6U); |
wolfSSL | 0:d92f9d21154c | 1171 | work = (*left ^ *right) & 0x33333333; |
wolfSSL | 0:d92f9d21154c | 1172 | *right ^= work; |
wolfSSL | 0:d92f9d21154c | 1173 | |
wolfSSL | 0:d92f9d21154c | 1174 | *left = rotlFixed(*left^work, 18U); |
wolfSSL | 0:d92f9d21154c | 1175 | work = (*left ^ *right) & 0xffff0000; |
wolfSSL | 0:d92f9d21154c | 1176 | *right ^= work; |
wolfSSL | 0:d92f9d21154c | 1177 | |
wolfSSL | 0:d92f9d21154c | 1178 | *left = rotlFixed(*left^work, 20U); |
wolfSSL | 0:d92f9d21154c | 1179 | work = (*left ^ *right) & 0xf0f0f0f0; |
wolfSSL | 0:d92f9d21154c | 1180 | *right ^= work; |
wolfSSL | 0:d92f9d21154c | 1181 | |
wolfSSL | 0:d92f9d21154c | 1182 | *left = rotrFixed(*left^work, 4U); |
wolfSSL | 0:d92f9d21154c | 1183 | } |
wolfSSL | 0:d92f9d21154c | 1184 | |
wolfSSL | 0:d92f9d21154c | 1185 | |
wolfSSL | 0:d92f9d21154c | 1186 | static int DesSetKey(const byte* key, int dir, word32* out) |
wolfSSL | 0:d92f9d21154c | 1187 | { |
wolfSSL | 0:d92f9d21154c | 1188 | #ifdef WOLFSSL_SMALL_STACK |
wolfSSL | 0:d92f9d21154c | 1189 | byte* buffer = (byte*)XMALLOC(56+56+8, NULL, DYNAMIC_TYPE_TMP_BUFFER); |
wolfSSL | 0:d92f9d21154c | 1190 | |
wolfSSL | 0:d92f9d21154c | 1191 | if (buffer == NULL) |
wolfSSL | 0:d92f9d21154c | 1192 | return MEMORY_E; |
wolfSSL | 0:d92f9d21154c | 1193 | #else |
wolfSSL | 0:d92f9d21154c | 1194 | byte buffer[56+56+8]; |
wolfSSL | 0:d92f9d21154c | 1195 | #endif |
wolfSSL | 0:d92f9d21154c | 1196 | |
wolfSSL | 0:d92f9d21154c | 1197 | { |
wolfSSL | 0:d92f9d21154c | 1198 | byte* const pc1m = buffer; /* place to modify pc1 into */ |
wolfSSL | 0:d92f9d21154c | 1199 | byte* const pcr = pc1m + 56; /* place to rotate pc1 into */ |
wolfSSL | 0:d92f9d21154c | 1200 | byte* const ks = pcr + 56; |
wolfSSL | 0:d92f9d21154c | 1201 | register int i, j, l; |
wolfSSL | 0:d92f9d21154c | 1202 | int m; |
wolfSSL | 0:d92f9d21154c | 1203 | |
wolfSSL | 0:d92f9d21154c | 1204 | for (j = 0; j < 56; j++) { /* convert pc1 to bits of key */ |
wolfSSL | 0:d92f9d21154c | 1205 | l = pc1[j] - 1; /* integer bit location */ |
wolfSSL | 0:d92f9d21154c | 1206 | m = l & 07; /* find bit */ |
wolfSSL | 0:d92f9d21154c | 1207 | pc1m[j] = (key[l >> 3] & /* find which key byte l is in */ |
wolfSSL | 0:d92f9d21154c | 1208 | bytebit[m]) /* and which bit of that byte */ |
wolfSSL | 0:d92f9d21154c | 1209 | ? 1 : 0; /* and store 1-bit result */ |
wolfSSL | 0:d92f9d21154c | 1210 | } |
wolfSSL | 0:d92f9d21154c | 1211 | |
wolfSSL | 0:d92f9d21154c | 1212 | for (i = 0; i < 16; i++) { /* key chunk for each iteration */ |
wolfSSL | 0:d92f9d21154c | 1213 | XMEMSET(ks, 0, 8); /* Clear key schedule */ |
wolfSSL | 0:d92f9d21154c | 1214 | |
wolfSSL | 0:d92f9d21154c | 1215 | for (j = 0; j < 56; j++) /* rotate pc1 the right amount */ |
wolfSSL | 0:d92f9d21154c | 1216 | pcr[j] = |
wolfSSL | 0:d92f9d21154c | 1217 | pc1m[(l = j + totrot[i]) < (j < 28 ? 28 : 56) ? l : l-28]; |
wolfSSL | 0:d92f9d21154c | 1218 | |
wolfSSL | 0:d92f9d21154c | 1219 | /* rotate left and right halves independently */ |
wolfSSL | 0:d92f9d21154c | 1220 | for (j = 0; j < 48; j++) { /* select bits individually */ |
wolfSSL | 0:d92f9d21154c | 1221 | if (pcr[pc2[j] - 1]) { /* check bit that goes to ks[j] */ |
wolfSSL | 0:d92f9d21154c | 1222 | l= j % 6; /* mask it in if it's there */ |
wolfSSL | 0:d92f9d21154c | 1223 | ks[j/6] |= bytebit[l] >> 2; |
wolfSSL | 0:d92f9d21154c | 1224 | } |
wolfSSL | 0:d92f9d21154c | 1225 | } |
wolfSSL | 0:d92f9d21154c | 1226 | |
wolfSSL | 0:d92f9d21154c | 1227 | /* Now convert to odd/even interleaved form for use in F */ |
wolfSSL | 0:d92f9d21154c | 1228 | out[2*i] = ((word32) ks[0] << 24) |
wolfSSL | 0:d92f9d21154c | 1229 | | ((word32) ks[2] << 16) |
wolfSSL | 0:d92f9d21154c | 1230 | | ((word32) ks[4] << 8) |
wolfSSL | 0:d92f9d21154c | 1231 | | ((word32) ks[6]); |
wolfSSL | 0:d92f9d21154c | 1232 | |
wolfSSL | 0:d92f9d21154c | 1233 | out[2*i + 1] = ((word32) ks[1] << 24) |
wolfSSL | 0:d92f9d21154c | 1234 | | ((word32) ks[3] << 16) |
wolfSSL | 0:d92f9d21154c | 1235 | | ((word32) ks[5] << 8) |
wolfSSL | 0:d92f9d21154c | 1236 | | ((word32) ks[7]); |
wolfSSL | 0:d92f9d21154c | 1237 | } |
wolfSSL | 0:d92f9d21154c | 1238 | |
wolfSSL | 0:d92f9d21154c | 1239 | /* reverse key schedule order */ |
wolfSSL | 0:d92f9d21154c | 1240 | if (dir == DES_DECRYPTION) { |
wolfSSL | 0:d92f9d21154c | 1241 | for (i = 0; i < 16; i += 2) { |
wolfSSL | 0:d92f9d21154c | 1242 | word32 swap = out[i]; |
wolfSSL | 0:d92f9d21154c | 1243 | out[i] = out[DES_KS_SIZE - 2 - i]; |
wolfSSL | 0:d92f9d21154c | 1244 | out[DES_KS_SIZE - 2 - i] = swap; |
wolfSSL | 0:d92f9d21154c | 1245 | |
wolfSSL | 0:d92f9d21154c | 1246 | swap = out[i + 1]; |
wolfSSL | 0:d92f9d21154c | 1247 | out[i + 1] = out[DES_KS_SIZE - 1 - i]; |
wolfSSL | 0:d92f9d21154c | 1248 | out[DES_KS_SIZE - 1 - i] = swap; |
wolfSSL | 0:d92f9d21154c | 1249 | } |
wolfSSL | 0:d92f9d21154c | 1250 | } |
wolfSSL | 0:d92f9d21154c | 1251 | |
wolfSSL | 0:d92f9d21154c | 1252 | #ifdef WOLFSSL_SMALL_STACK |
wolfSSL | 0:d92f9d21154c | 1253 | XFREE(buffer, NULL, DYNAMIC_TYPE_TMP_BUFFER); |
wolfSSL | 0:d92f9d21154c | 1254 | #endif |
wolfSSL | 0:d92f9d21154c | 1255 | } |
wolfSSL | 0:d92f9d21154c | 1256 | |
wolfSSL | 0:d92f9d21154c | 1257 | return 0; |
wolfSSL | 0:d92f9d21154c | 1258 | } |
wolfSSL | 0:d92f9d21154c | 1259 | |
wolfSSL | 0:d92f9d21154c | 1260 | |
wolfSSL | 0:d92f9d21154c | 1261 | static INLINE int Reverse(int dir) |
wolfSSL | 0:d92f9d21154c | 1262 | { |
wolfSSL | 0:d92f9d21154c | 1263 | return !dir; |
wolfSSL | 0:d92f9d21154c | 1264 | } |
wolfSSL | 0:d92f9d21154c | 1265 | |
wolfSSL | 0:d92f9d21154c | 1266 | |
wolfSSL | 0:d92f9d21154c | 1267 | int wc_Des_SetKey(Des* des, const byte* key, const byte* iv, int dir) |
wolfSSL | 0:d92f9d21154c | 1268 | { |
wolfSSL | 0:d92f9d21154c | 1269 | wc_Des_SetIV(des, iv); |
wolfSSL | 0:d92f9d21154c | 1270 | |
wolfSSL | 0:d92f9d21154c | 1271 | return DesSetKey(key, dir, des->key); |
wolfSSL | 0:d92f9d21154c | 1272 | } |
wolfSSL | 0:d92f9d21154c | 1273 | |
wolfSSL | 0:d92f9d21154c | 1274 | |
wolfSSL | 0:d92f9d21154c | 1275 | int wc_Des3_SetKey(Des3* des, const byte* key, const byte* iv, int dir) |
wolfSSL | 0:d92f9d21154c | 1276 | { |
wolfSSL | 0:d92f9d21154c | 1277 | int ret; |
wolfSSL | 0:d92f9d21154c | 1278 | |
wolfSSL | 0:d92f9d21154c | 1279 | #ifdef HAVE_CAVIUM |
wolfSSL | 0:d92f9d21154c | 1280 | if (des->magic == WOLFSSL_3DES_CAVIUM_MAGIC) |
wolfSSL | 0:d92f9d21154c | 1281 | return wc_Des3_CaviumSetKey(des, key, iv); |
wolfSSL | 0:d92f9d21154c | 1282 | #endif |
wolfSSL | 0:d92f9d21154c | 1283 | |
wolfSSL | 0:d92f9d21154c | 1284 | ret = DesSetKey(key + (dir == DES_ENCRYPTION ? 0:16), dir, des->key[0]); |
wolfSSL | 0:d92f9d21154c | 1285 | if (ret != 0) |
wolfSSL | 0:d92f9d21154c | 1286 | return ret; |
wolfSSL | 0:d92f9d21154c | 1287 | |
wolfSSL | 0:d92f9d21154c | 1288 | ret = DesSetKey(key + 8, Reverse(dir), des->key[1]); |
wolfSSL | 0:d92f9d21154c | 1289 | if (ret != 0) |
wolfSSL | 0:d92f9d21154c | 1290 | return ret; |
wolfSSL | 0:d92f9d21154c | 1291 | |
wolfSSL | 0:d92f9d21154c | 1292 | ret = DesSetKey(key + (dir == DES_DECRYPTION ? 0:16), dir, des->key[2]); |
wolfSSL | 0:d92f9d21154c | 1293 | if (ret != 0) |
wolfSSL | 0:d92f9d21154c | 1294 | return ret; |
wolfSSL | 0:d92f9d21154c | 1295 | |
wolfSSL | 0:d92f9d21154c | 1296 | return wc_Des3_SetIV(des, iv); |
wolfSSL | 0:d92f9d21154c | 1297 | } |
wolfSSL | 0:d92f9d21154c | 1298 | |
wolfSSL | 0:d92f9d21154c | 1299 | |
wolfSSL | 0:d92f9d21154c | 1300 | static void DesRawProcessBlock(word32* lIn, word32* rIn, const word32* kptr) |
wolfSSL | 0:d92f9d21154c | 1301 | { |
wolfSSL | 0:d92f9d21154c | 1302 | word32 l = *lIn, r = *rIn, i; |
wolfSSL | 0:d92f9d21154c | 1303 | |
wolfSSL | 0:d92f9d21154c | 1304 | for (i=0; i<8; i++) |
wolfSSL | 0:d92f9d21154c | 1305 | { |
wolfSSL | 0:d92f9d21154c | 1306 | word32 work = rotrFixed(r, 4U) ^ kptr[4*i+0]; |
wolfSSL | 0:d92f9d21154c | 1307 | l ^= Spbox[6][(work) & 0x3f] |
wolfSSL | 0:d92f9d21154c | 1308 | ^ Spbox[4][(work >> 8) & 0x3f] |
wolfSSL | 0:d92f9d21154c | 1309 | ^ Spbox[2][(work >> 16) & 0x3f] |
wolfSSL | 0:d92f9d21154c | 1310 | ^ Spbox[0][(work >> 24) & 0x3f]; |
wolfSSL | 0:d92f9d21154c | 1311 | work = r ^ kptr[4*i+1]; |
wolfSSL | 0:d92f9d21154c | 1312 | l ^= Spbox[7][(work) & 0x3f] |
wolfSSL | 0:d92f9d21154c | 1313 | ^ Spbox[5][(work >> 8) & 0x3f] |
wolfSSL | 0:d92f9d21154c | 1314 | ^ Spbox[3][(work >> 16) & 0x3f] |
wolfSSL | 0:d92f9d21154c | 1315 | ^ Spbox[1][(work >> 24) & 0x3f]; |
wolfSSL | 0:d92f9d21154c | 1316 | |
wolfSSL | 0:d92f9d21154c | 1317 | work = rotrFixed(l, 4U) ^ kptr[4*i+2]; |
wolfSSL | 0:d92f9d21154c | 1318 | r ^= Spbox[6][(work) & 0x3f] |
wolfSSL | 0:d92f9d21154c | 1319 | ^ Spbox[4][(work >> 8) & 0x3f] |
wolfSSL | 0:d92f9d21154c | 1320 | ^ Spbox[2][(work >> 16) & 0x3f] |
wolfSSL | 0:d92f9d21154c | 1321 | ^ Spbox[0][(work >> 24) & 0x3f]; |
wolfSSL | 0:d92f9d21154c | 1322 | work = l ^ kptr[4*i+3]; |
wolfSSL | 0:d92f9d21154c | 1323 | r ^= Spbox[7][(work) & 0x3f] |
wolfSSL | 0:d92f9d21154c | 1324 | ^ Spbox[5][(work >> 8) & 0x3f] |
wolfSSL | 0:d92f9d21154c | 1325 | ^ Spbox[3][(work >> 16) & 0x3f] |
wolfSSL | 0:d92f9d21154c | 1326 | ^ Spbox[1][(work >> 24) & 0x3f]; |
wolfSSL | 0:d92f9d21154c | 1327 | } |
wolfSSL | 0:d92f9d21154c | 1328 | |
wolfSSL | 0:d92f9d21154c | 1329 | *lIn = l; *rIn = r; |
wolfSSL | 0:d92f9d21154c | 1330 | } |
wolfSSL | 0:d92f9d21154c | 1331 | |
wolfSSL | 0:d92f9d21154c | 1332 | |
wolfSSL | 0:d92f9d21154c | 1333 | static void DesProcessBlock(Des* des, const byte* in, byte* out) |
wolfSSL | 0:d92f9d21154c | 1334 | { |
wolfSSL | 0:d92f9d21154c | 1335 | word32 l, r; |
wolfSSL | 0:d92f9d21154c | 1336 | |
wolfSSL | 0:d92f9d21154c | 1337 | XMEMCPY(&l, in, sizeof(l)); |
wolfSSL | 0:d92f9d21154c | 1338 | XMEMCPY(&r, in + sizeof(l), sizeof(r)); |
wolfSSL | 0:d92f9d21154c | 1339 | #ifdef LITTLE_ENDIAN_ORDER |
wolfSSL | 0:d92f9d21154c | 1340 | l = ByteReverseWord32(l); |
wolfSSL | 0:d92f9d21154c | 1341 | r = ByteReverseWord32(r); |
wolfSSL | 0:d92f9d21154c | 1342 | #endif |
wolfSSL | 0:d92f9d21154c | 1343 | IPERM(&l,&r); |
wolfSSL | 0:d92f9d21154c | 1344 | |
wolfSSL | 0:d92f9d21154c | 1345 | DesRawProcessBlock(&l, &r, des->key); |
wolfSSL | 0:d92f9d21154c | 1346 | |
wolfSSL | 0:d92f9d21154c | 1347 | FPERM(&l,&r); |
wolfSSL | 0:d92f9d21154c | 1348 | #ifdef LITTLE_ENDIAN_ORDER |
wolfSSL | 0:d92f9d21154c | 1349 | l = ByteReverseWord32(l); |
wolfSSL | 0:d92f9d21154c | 1350 | r = ByteReverseWord32(r); |
wolfSSL | 0:d92f9d21154c | 1351 | #endif |
wolfSSL | 0:d92f9d21154c | 1352 | XMEMCPY(out, &r, sizeof(r)); |
wolfSSL | 0:d92f9d21154c | 1353 | XMEMCPY(out + sizeof(r), &l, sizeof(l)); |
wolfSSL | 0:d92f9d21154c | 1354 | } |
wolfSSL | 0:d92f9d21154c | 1355 | |
wolfSSL | 0:d92f9d21154c | 1356 | |
wolfSSL | 0:d92f9d21154c | 1357 | static void Des3ProcessBlock(Des3* des, const byte* in, byte* out) |
wolfSSL | 0:d92f9d21154c | 1358 | { |
wolfSSL | 0:d92f9d21154c | 1359 | word32 l, r; |
wolfSSL | 0:d92f9d21154c | 1360 | |
wolfSSL | 0:d92f9d21154c | 1361 | XMEMCPY(&l, in, sizeof(l)); |
wolfSSL | 0:d92f9d21154c | 1362 | XMEMCPY(&r, in + sizeof(l), sizeof(r)); |
wolfSSL | 0:d92f9d21154c | 1363 | #ifdef LITTLE_ENDIAN_ORDER |
wolfSSL | 0:d92f9d21154c | 1364 | l = ByteReverseWord32(l); |
wolfSSL | 0:d92f9d21154c | 1365 | r = ByteReverseWord32(r); |
wolfSSL | 0:d92f9d21154c | 1366 | #endif |
wolfSSL | 0:d92f9d21154c | 1367 | IPERM(&l,&r); |
wolfSSL | 0:d92f9d21154c | 1368 | |
wolfSSL | 0:d92f9d21154c | 1369 | DesRawProcessBlock(&l, &r, des->key[0]); |
wolfSSL | 0:d92f9d21154c | 1370 | DesRawProcessBlock(&r, &l, des->key[1]); |
wolfSSL | 0:d92f9d21154c | 1371 | DesRawProcessBlock(&l, &r, des->key[2]); |
wolfSSL | 0:d92f9d21154c | 1372 | |
wolfSSL | 0:d92f9d21154c | 1373 | FPERM(&l,&r); |
wolfSSL | 0:d92f9d21154c | 1374 | #ifdef LITTLE_ENDIAN_ORDER |
wolfSSL | 0:d92f9d21154c | 1375 | l = ByteReverseWord32(l); |
wolfSSL | 0:d92f9d21154c | 1376 | r = ByteReverseWord32(r); |
wolfSSL | 0:d92f9d21154c | 1377 | #endif |
wolfSSL | 0:d92f9d21154c | 1378 | XMEMCPY(out, &r, sizeof(r)); |
wolfSSL | 0:d92f9d21154c | 1379 | XMEMCPY(out + sizeof(r), &l, sizeof(l)); |
wolfSSL | 0:d92f9d21154c | 1380 | } |
wolfSSL | 0:d92f9d21154c | 1381 | |
wolfSSL | 0:d92f9d21154c | 1382 | |
wolfSSL | 0:d92f9d21154c | 1383 | int wc_Des_CbcEncrypt(Des* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 1384 | { |
wolfSSL | 0:d92f9d21154c | 1385 | word32 blocks = sz / DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 1386 | |
wolfSSL | 0:d92f9d21154c | 1387 | while (blocks--) { |
wolfSSL | 0:d92f9d21154c | 1388 | xorbuf((byte*)des->reg, in, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1389 | DesProcessBlock(des, (byte*)des->reg, (byte*)des->reg); |
wolfSSL | 0:d92f9d21154c | 1390 | XMEMCPY(out, des->reg, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1391 | |
wolfSSL | 0:d92f9d21154c | 1392 | out += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 1393 | in += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 1394 | } |
wolfSSL | 0:d92f9d21154c | 1395 | return 0; |
wolfSSL | 0:d92f9d21154c | 1396 | } |
wolfSSL | 0:d92f9d21154c | 1397 | |
wolfSSL | 0:d92f9d21154c | 1398 | |
wolfSSL | 0:d92f9d21154c | 1399 | int wc_Des_CbcDecrypt(Des* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 1400 | { |
wolfSSL | 0:d92f9d21154c | 1401 | word32 blocks = sz / DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 1402 | byte hold[DES_BLOCK_SIZE]; |
wolfSSL | 0:d92f9d21154c | 1403 | |
wolfSSL | 0:d92f9d21154c | 1404 | while (blocks--) { |
wolfSSL | 0:d92f9d21154c | 1405 | XMEMCPY(des->tmp, in, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1406 | DesProcessBlock(des, (byte*)des->tmp, out); |
wolfSSL | 0:d92f9d21154c | 1407 | xorbuf(out, (byte*)des->reg, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1408 | |
wolfSSL | 0:d92f9d21154c | 1409 | XMEMCPY(hold, des->reg, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1410 | XMEMCPY(des->reg, des->tmp, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1411 | XMEMCPY(des->tmp, hold, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1412 | |
wolfSSL | 0:d92f9d21154c | 1413 | out += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 1414 | in += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 1415 | } |
wolfSSL | 0:d92f9d21154c | 1416 | return 0; |
wolfSSL | 0:d92f9d21154c | 1417 | } |
wolfSSL | 0:d92f9d21154c | 1418 | |
wolfSSL | 0:d92f9d21154c | 1419 | |
wolfSSL | 0:d92f9d21154c | 1420 | int wc_Des3_CbcEncrypt(Des3* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 1421 | { |
wolfSSL | 0:d92f9d21154c | 1422 | word32 blocks; |
wolfSSL | 0:d92f9d21154c | 1423 | |
wolfSSL | 0:d92f9d21154c | 1424 | #ifdef HAVE_CAVIUM |
wolfSSL | 0:d92f9d21154c | 1425 | if (des->magic == WOLFSSL_3DES_CAVIUM_MAGIC) |
wolfSSL | 0:d92f9d21154c | 1426 | return wc_Des3_CaviumCbcEncrypt(des, out, in, sz); |
wolfSSL | 0:d92f9d21154c | 1427 | #endif |
wolfSSL | 0:d92f9d21154c | 1428 | |
wolfSSL | 0:d92f9d21154c | 1429 | blocks = sz / DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 1430 | while (blocks--) { |
wolfSSL | 0:d92f9d21154c | 1431 | xorbuf((byte*)des->reg, in, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1432 | Des3ProcessBlock(des, (byte*)des->reg, (byte*)des->reg); |
wolfSSL | 0:d92f9d21154c | 1433 | XMEMCPY(out, des->reg, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1434 | |
wolfSSL | 0:d92f9d21154c | 1435 | out += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 1436 | in += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 1437 | } |
wolfSSL | 0:d92f9d21154c | 1438 | return 0; |
wolfSSL | 0:d92f9d21154c | 1439 | } |
wolfSSL | 0:d92f9d21154c | 1440 | |
wolfSSL | 0:d92f9d21154c | 1441 | |
wolfSSL | 0:d92f9d21154c | 1442 | int wc_Des3_CbcDecrypt(Des3* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 1443 | { |
wolfSSL | 0:d92f9d21154c | 1444 | word32 blocks; |
wolfSSL | 0:d92f9d21154c | 1445 | |
wolfSSL | 0:d92f9d21154c | 1446 | #ifdef HAVE_CAVIUM |
wolfSSL | 0:d92f9d21154c | 1447 | if (des->magic == WOLFSSL_3DES_CAVIUM_MAGIC) |
wolfSSL | 0:d92f9d21154c | 1448 | return wc_Des3_CaviumCbcDecrypt(des, out, in, sz); |
wolfSSL | 0:d92f9d21154c | 1449 | #endif |
wolfSSL | 0:d92f9d21154c | 1450 | |
wolfSSL | 0:d92f9d21154c | 1451 | blocks = sz / DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 1452 | while (blocks--) { |
wolfSSL | 0:d92f9d21154c | 1453 | XMEMCPY(des->tmp, in, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1454 | Des3ProcessBlock(des, (byte*)des->tmp, out); |
wolfSSL | 0:d92f9d21154c | 1455 | xorbuf(out, (byte*)des->reg, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1456 | XMEMCPY(des->reg, des->tmp, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1457 | |
wolfSSL | 0:d92f9d21154c | 1458 | out += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 1459 | in += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 1460 | } |
wolfSSL | 0:d92f9d21154c | 1461 | return 0; |
wolfSSL | 0:d92f9d21154c | 1462 | } |
wolfSSL | 0:d92f9d21154c | 1463 | |
wolfSSL | 0:d92f9d21154c | 1464 | #ifdef WOLFSSL_DES_ECB |
wolfSSL | 0:d92f9d21154c | 1465 | |
wolfSSL | 0:d92f9d21154c | 1466 | /* One block, compatibility only */ |
wolfSSL | 0:d92f9d21154c | 1467 | int wc_Des_EcbEncrypt(Des* des, byte* out, const byte* in, word32 sz) |
wolfSSL | 0:d92f9d21154c | 1468 | { |
wolfSSL | 0:d92f9d21154c | 1469 | word32 blocks = sz / DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 1470 | |
wolfSSL | 0:d92f9d21154c | 1471 | while (blocks--) { |
wolfSSL | 0:d92f9d21154c | 1472 | DesProcessBlock(des, in, out); |
wolfSSL | 0:d92f9d21154c | 1473 | |
wolfSSL | 0:d92f9d21154c | 1474 | out += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 1475 | in += DES_BLOCK_SIZE; |
wolfSSL | 0:d92f9d21154c | 1476 | } |
wolfSSL | 0:d92f9d21154c | 1477 | return 0; |
wolfSSL | 0:d92f9d21154c | 1478 | } |
wolfSSL | 0:d92f9d21154c | 1479 | |
wolfSSL | 0:d92f9d21154c | 1480 | #endif /* WOLFSSL_DES_ECB */ |
wolfSSL | 0:d92f9d21154c | 1481 | |
wolfSSL | 0:d92f9d21154c | 1482 | #endif /* STM32F2_CRYPTO */ |
wolfSSL | 0:d92f9d21154c | 1483 | |
wolfSSL | 0:d92f9d21154c | 1484 | void wc_Des_SetIV(Des* des, const byte* iv) |
wolfSSL | 0:d92f9d21154c | 1485 | { |
wolfSSL | 0:d92f9d21154c | 1486 | if (des && iv) |
wolfSSL | 0:d92f9d21154c | 1487 | XMEMCPY(des->reg, iv, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1488 | else if (des) |
wolfSSL | 0:d92f9d21154c | 1489 | XMEMSET(des->reg, 0, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1490 | } |
wolfSSL | 0:d92f9d21154c | 1491 | |
wolfSSL | 0:d92f9d21154c | 1492 | |
wolfSSL | 0:d92f9d21154c | 1493 | int wc_Des_CbcDecryptWithKey(byte* out, const byte* in, word32 sz, |
wolfSSL | 0:d92f9d21154c | 1494 | const byte* key, const byte* iv) |
wolfSSL | 0:d92f9d21154c | 1495 | { |
wolfSSL | 0:d92f9d21154c | 1496 | int ret = 0; |
wolfSSL | 0:d92f9d21154c | 1497 | #ifdef WOLFSSL_SMALL_STACK |
wolfSSL | 0:d92f9d21154c | 1498 | Des* des = NULL; |
wolfSSL | 0:d92f9d21154c | 1499 | #else |
wolfSSL | 0:d92f9d21154c | 1500 | Des des[1]; |
wolfSSL | 0:d92f9d21154c | 1501 | #endif |
wolfSSL | 0:d92f9d21154c | 1502 | |
wolfSSL | 0:d92f9d21154c | 1503 | #ifdef WOLFSSL_SMALL_STACK |
wolfSSL | 0:d92f9d21154c | 1504 | des = (Des*)XMALLOC(sizeof(Des), NULL, DYNAMIC_TYPE_TMP_BUFFER); |
wolfSSL | 0:d92f9d21154c | 1505 | if (des == NULL) |
wolfSSL | 0:d92f9d21154c | 1506 | return MEMORY_E; |
wolfSSL | 0:d92f9d21154c | 1507 | #endif |
wolfSSL | 0:d92f9d21154c | 1508 | |
wolfSSL | 0:d92f9d21154c | 1509 | ret = wc_Des_SetKey(des, key, iv, DES_DECRYPTION); |
wolfSSL | 0:d92f9d21154c | 1510 | if (ret == 0) |
wolfSSL | 0:d92f9d21154c | 1511 | ret = wc_Des_CbcDecrypt(des, out, in, sz); |
wolfSSL | 0:d92f9d21154c | 1512 | |
wolfSSL | 0:d92f9d21154c | 1513 | #ifdef WOLFSSL_SMALL_STACK |
wolfSSL | 0:d92f9d21154c | 1514 | XFREE(des, NULL, DYNAMIC_TYPE_TMP_BUFFER); |
wolfSSL | 0:d92f9d21154c | 1515 | #endif |
wolfSSL | 0:d92f9d21154c | 1516 | |
wolfSSL | 0:d92f9d21154c | 1517 | return ret; |
wolfSSL | 0:d92f9d21154c | 1518 | } |
wolfSSL | 0:d92f9d21154c | 1519 | |
wolfSSL | 0:d92f9d21154c | 1520 | |
wolfSSL | 0:d92f9d21154c | 1521 | int wc_Des3_SetIV(Des3* des, const byte* iv) |
wolfSSL | 0:d92f9d21154c | 1522 | { |
wolfSSL | 0:d92f9d21154c | 1523 | if (des && iv) |
wolfSSL | 0:d92f9d21154c | 1524 | XMEMCPY(des->reg, iv, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1525 | else if (des) |
wolfSSL | 0:d92f9d21154c | 1526 | XMEMSET(des->reg, 0, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1527 | |
wolfSSL | 0:d92f9d21154c | 1528 | return 0; |
wolfSSL | 0:d92f9d21154c | 1529 | } |
wolfSSL | 0:d92f9d21154c | 1530 | |
wolfSSL | 0:d92f9d21154c | 1531 | |
wolfSSL | 0:d92f9d21154c | 1532 | int wc_Des3_CbcDecryptWithKey(byte* out, const byte* in, word32 sz, |
wolfSSL | 0:d92f9d21154c | 1533 | const byte* key, const byte* iv) |
wolfSSL | 0:d92f9d21154c | 1534 | { |
wolfSSL | 0:d92f9d21154c | 1535 | int ret = 0; |
wolfSSL | 0:d92f9d21154c | 1536 | #ifdef WOLFSSL_SMALL_STACK |
wolfSSL | 0:d92f9d21154c | 1537 | Des3* des3 = NULL; |
wolfSSL | 0:d92f9d21154c | 1538 | #else |
wolfSSL | 0:d92f9d21154c | 1539 | Des3 des3[1]; |
wolfSSL | 0:d92f9d21154c | 1540 | #endif |
wolfSSL | 0:d92f9d21154c | 1541 | |
wolfSSL | 0:d92f9d21154c | 1542 | #ifdef WOLFSSL_SMALL_STACK |
wolfSSL | 0:d92f9d21154c | 1543 | des3 = (Des3*)XMALLOC(sizeof(Des3), NULL, DYNAMIC_TYPE_TMP_BUFFER); |
wolfSSL | 0:d92f9d21154c | 1544 | if (des3 == NULL) |
wolfSSL | 0:d92f9d21154c | 1545 | return MEMORY_E; |
wolfSSL | 0:d92f9d21154c | 1546 | #endif |
wolfSSL | 0:d92f9d21154c | 1547 | |
wolfSSL | 0:d92f9d21154c | 1548 | ret = wc_Des3_SetKey(des3, key, iv, DES_DECRYPTION); |
wolfSSL | 0:d92f9d21154c | 1549 | if (ret == 0) |
wolfSSL | 0:d92f9d21154c | 1550 | ret = wc_Des3_CbcDecrypt(des3, out, in, sz); |
wolfSSL | 0:d92f9d21154c | 1551 | |
wolfSSL | 0:d92f9d21154c | 1552 | #ifdef WOLFSSL_SMALL_STACK |
wolfSSL | 0:d92f9d21154c | 1553 | XFREE(des3, NULL, DYNAMIC_TYPE_TMP_BUFFER); |
wolfSSL | 0:d92f9d21154c | 1554 | #endif |
wolfSSL | 0:d92f9d21154c | 1555 | |
wolfSSL | 0:d92f9d21154c | 1556 | return ret; |
wolfSSL | 0:d92f9d21154c | 1557 | } |
wolfSSL | 0:d92f9d21154c | 1558 | |
wolfSSL | 0:d92f9d21154c | 1559 | |
wolfSSL | 0:d92f9d21154c | 1560 | #ifdef HAVE_CAVIUM |
wolfSSL | 0:d92f9d21154c | 1561 | |
wolfSSL | 0:d92f9d21154c | 1562 | #include "cavium_common.h" |
wolfSSL | 0:d92f9d21154c | 1563 | |
wolfSSL | 0:d92f9d21154c | 1564 | /* Initiliaze Des3 for use with Nitrox device */ |
wolfSSL | 0:d92f9d21154c | 1565 | int wc_Des3_InitCavium(Des3* des3, int devId) |
wolfSSL | 0:d92f9d21154c | 1566 | { |
wolfSSL | 0:d92f9d21154c | 1567 | if (des3 == NULL) |
wolfSSL | 0:d92f9d21154c | 1568 | return -1; |
wolfSSL | 0:d92f9d21154c | 1569 | |
wolfSSL | 0:d92f9d21154c | 1570 | if (CspAllocContext(CONTEXT_SSL, &des3->contextHandle, devId) != 0) |
wolfSSL | 0:d92f9d21154c | 1571 | return -1; |
wolfSSL | 0:d92f9d21154c | 1572 | |
wolfSSL | 0:d92f9d21154c | 1573 | des3->devId = devId; |
wolfSSL | 0:d92f9d21154c | 1574 | des3->magic = WOLFSSL_3DES_CAVIUM_MAGIC; |
wolfSSL | 0:d92f9d21154c | 1575 | |
wolfSSL | 0:d92f9d21154c | 1576 | return 0; |
wolfSSL | 0:d92f9d21154c | 1577 | } |
wolfSSL | 0:d92f9d21154c | 1578 | |
wolfSSL | 0:d92f9d21154c | 1579 | |
wolfSSL | 0:d92f9d21154c | 1580 | /* Free Des3 from use with Nitrox device */ |
wolfSSL | 0:d92f9d21154c | 1581 | void wc_Des3_FreeCavium(Des3* des3) |
wolfSSL | 0:d92f9d21154c | 1582 | { |
wolfSSL | 0:d92f9d21154c | 1583 | if (des3 == NULL) |
wolfSSL | 0:d92f9d21154c | 1584 | return; |
wolfSSL | 0:d92f9d21154c | 1585 | |
wolfSSL | 0:d92f9d21154c | 1586 | if (des3->magic != WOLFSSL_3DES_CAVIUM_MAGIC) |
wolfSSL | 0:d92f9d21154c | 1587 | return; |
wolfSSL | 0:d92f9d21154c | 1588 | |
wolfSSL | 0:d92f9d21154c | 1589 | CspFreeContext(CONTEXT_SSL, des3->contextHandle, des3->devId); |
wolfSSL | 0:d92f9d21154c | 1590 | des3->magic = 0; |
wolfSSL | 0:d92f9d21154c | 1591 | } |
wolfSSL | 0:d92f9d21154c | 1592 | |
wolfSSL | 0:d92f9d21154c | 1593 | |
wolfSSL | 0:d92f9d21154c | 1594 | static int wc_Des3_CaviumSetKey(Des3* des3, const byte* key, const byte* iv) |
wolfSSL | 0:d92f9d21154c | 1595 | { |
wolfSSL | 0:d92f9d21154c | 1596 | if (des3 == NULL) |
wolfSSL | 0:d92f9d21154c | 1597 | return -1; |
wolfSSL | 0:d92f9d21154c | 1598 | |
wolfSSL | 0:d92f9d21154c | 1599 | /* key[0] holds key, iv in reg */ |
wolfSSL | 0:d92f9d21154c | 1600 | XMEMCPY(des3->key[0], key, DES_BLOCK_SIZE*3); |
wolfSSL | 0:d92f9d21154c | 1601 | |
wolfSSL | 0:d92f9d21154c | 1602 | return wc_Des3_SetIV(des3, iv); |
wolfSSL | 0:d92f9d21154c | 1603 | } |
wolfSSL | 0:d92f9d21154c | 1604 | |
wolfSSL | 0:d92f9d21154c | 1605 | |
wolfSSL | 0:d92f9d21154c | 1606 | static int wc_Des3_CaviumCbcEncrypt(Des3* des3, byte* out, const byte* in, |
wolfSSL | 0:d92f9d21154c | 1607 | word32 length) |
wolfSSL | 0:d92f9d21154c | 1608 | { |
wolfSSL | 0:d92f9d21154c | 1609 | wolfssl_word offset = 0; |
wolfSSL | 0:d92f9d21154c | 1610 | word32 requestId; |
wolfSSL | 0:d92f9d21154c | 1611 | |
wolfSSL | 0:d92f9d21154c | 1612 | while (length > WOLFSSL_MAX_16BIT) { |
wolfSSL | 0:d92f9d21154c | 1613 | word16 slen = (word16)WOLFSSL_MAX_16BIT; |
wolfSSL | 0:d92f9d21154c | 1614 | if (CspEncrypt3Des(CAVIUM_BLOCKING, des3->contextHandle, |
wolfSSL | 0:d92f9d21154c | 1615 | CAVIUM_NO_UPDATE, slen, (byte*)in + offset, |
wolfSSL | 0:d92f9d21154c | 1616 | out + offset, (byte*)des3->reg, (byte*)des3->key[0], |
wolfSSL | 0:d92f9d21154c | 1617 | &requestId, des3->devId) != 0) { |
wolfSSL | 0:d92f9d21154c | 1618 | WOLFSSL_MSG("Bad Cavium 3DES Cbc Encrypt"); |
wolfSSL | 0:d92f9d21154c | 1619 | return -1; |
wolfSSL | 0:d92f9d21154c | 1620 | } |
wolfSSL | 0:d92f9d21154c | 1621 | length -= WOLFSSL_MAX_16BIT; |
wolfSSL | 0:d92f9d21154c | 1622 | offset += WOLFSSL_MAX_16BIT; |
wolfSSL | 0:d92f9d21154c | 1623 | XMEMCPY(des3->reg, out + offset - DES_BLOCK_SIZE, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1624 | } |
wolfSSL | 0:d92f9d21154c | 1625 | if (length) { |
wolfSSL | 0:d92f9d21154c | 1626 | word16 slen = (word16)length; |
wolfSSL | 0:d92f9d21154c | 1627 | |
wolfSSL | 0:d92f9d21154c | 1628 | if (CspEncrypt3Des(CAVIUM_BLOCKING, des3->contextHandle, |
wolfSSL | 0:d92f9d21154c | 1629 | CAVIUM_NO_UPDATE, slen, (byte*)in + offset, |
wolfSSL | 0:d92f9d21154c | 1630 | out + offset, (byte*)des3->reg, (byte*)des3->key[0], |
wolfSSL | 0:d92f9d21154c | 1631 | &requestId, des3->devId) != 0) { |
wolfSSL | 0:d92f9d21154c | 1632 | WOLFSSL_MSG("Bad Cavium 3DES Cbc Encrypt"); |
wolfSSL | 0:d92f9d21154c | 1633 | return -1; |
wolfSSL | 0:d92f9d21154c | 1634 | } |
wolfSSL | 0:d92f9d21154c | 1635 | XMEMCPY(des3->reg, out+offset+length - DES_BLOCK_SIZE, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1636 | } |
wolfSSL | 0:d92f9d21154c | 1637 | return 0; |
wolfSSL | 0:d92f9d21154c | 1638 | } |
wolfSSL | 0:d92f9d21154c | 1639 | |
wolfSSL | 0:d92f9d21154c | 1640 | static int wc_Des3_CaviumCbcDecrypt(Des3* des3, byte* out, const byte* in, |
wolfSSL | 0:d92f9d21154c | 1641 | word32 length) |
wolfSSL | 0:d92f9d21154c | 1642 | { |
wolfSSL | 0:d92f9d21154c | 1643 | word32 requestId; |
wolfSSL | 0:d92f9d21154c | 1644 | wolfssl_word offset = 0; |
wolfSSL | 0:d92f9d21154c | 1645 | |
wolfSSL | 0:d92f9d21154c | 1646 | while (length > WOLFSSL_MAX_16BIT) { |
wolfSSL | 0:d92f9d21154c | 1647 | word16 slen = (word16)WOLFSSL_MAX_16BIT; |
wolfSSL | 0:d92f9d21154c | 1648 | XMEMCPY(des3->tmp, in + offset + slen - DES_BLOCK_SIZE, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1649 | if (CspDecrypt3Des(CAVIUM_BLOCKING, des3->contextHandle, |
wolfSSL | 0:d92f9d21154c | 1650 | CAVIUM_NO_UPDATE, slen, (byte*)in+offset, out+offset, |
wolfSSL | 0:d92f9d21154c | 1651 | (byte*)des3->reg, (byte*)des3->key[0], &requestId, |
wolfSSL | 0:d92f9d21154c | 1652 | des3->devId) != 0) { |
wolfSSL | 0:d92f9d21154c | 1653 | WOLFSSL_MSG("Bad Cavium 3Des Decrypt"); |
wolfSSL | 0:d92f9d21154c | 1654 | return -1; |
wolfSSL | 0:d92f9d21154c | 1655 | } |
wolfSSL | 0:d92f9d21154c | 1656 | length -= WOLFSSL_MAX_16BIT; |
wolfSSL | 0:d92f9d21154c | 1657 | offset += WOLFSSL_MAX_16BIT; |
wolfSSL | 0:d92f9d21154c | 1658 | XMEMCPY(des3->reg, des3->tmp, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1659 | } |
wolfSSL | 0:d92f9d21154c | 1660 | if (length) { |
wolfSSL | 0:d92f9d21154c | 1661 | word16 slen = (word16)length; |
wolfSSL | 0:d92f9d21154c | 1662 | XMEMCPY(des3->tmp, in + offset + slen - DES_BLOCK_SIZE,DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1663 | if (CspDecrypt3Des(CAVIUM_BLOCKING, des3->contextHandle, |
wolfSSL | 0:d92f9d21154c | 1664 | CAVIUM_NO_UPDATE, slen, (byte*)in+offset, out+offset, |
wolfSSL | 0:d92f9d21154c | 1665 | (byte*)des3->reg, (byte*)des3->key[0], &requestId, |
wolfSSL | 0:d92f9d21154c | 1666 | des3->devId) != 0) { |
wolfSSL | 0:d92f9d21154c | 1667 | WOLFSSL_MSG("Bad Cavium 3Des Decrypt"); |
wolfSSL | 0:d92f9d21154c | 1668 | return -1; |
wolfSSL | 0:d92f9d21154c | 1669 | } |
wolfSSL | 0:d92f9d21154c | 1670 | XMEMCPY(des3->reg, des3->tmp, DES_BLOCK_SIZE); |
wolfSSL | 0:d92f9d21154c | 1671 | } |
wolfSSL | 0:d92f9d21154c | 1672 | return 0; |
wolfSSL | 0:d92f9d21154c | 1673 | } |
wolfSSL | 0:d92f9d21154c | 1674 | |
wolfSSL | 0:d92f9d21154c | 1675 | #endif /* HAVE_CAVIUM */ |
wolfSSL | 0:d92f9d21154c | 1676 | #endif /* WOLFSSL_TI_CRYPT */ |
wolfSSL | 0:d92f9d21154c | 1677 | #endif /* HAVE_FIPS */ |
wolfSSL | 0:d92f9d21154c | 1678 | #endif /* NO_DES3 */ |
wolfSSL | 0:d92f9d21154c | 1679 |