Don't check for NULL-pointers before calling free().
[tinc] / src / gcrypt / cipher.c
1 /*
2     cipher.c -- Symmetric block cipher handling
3     Copyright (C) 2007-2012 Guus Sliepen <guus@tinc-vpn.org>
4
5     This program is free software; you can redistribute it and/or modify
6     it under the terms of the GNU General Public License as published by
7     the Free Software Foundation; either version 2 of the License, or
8     (at your option) any later version.
9
10     This program is distributed in the hope that it will be useful,
11     but WITHOUT ANY WARRANTY; without even the implied warranty of
12     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13     GNU General Public License for more details.
14
15     You should have received a copy of the GNU General Public License along
16     with this program; if not, write to the Free Software Foundation, Inc.,
17     51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18 */
19
20 #include "system.h"
21
22 #include "cipher.h"
23 #include "logger.h"
24 #include "xalloc.h"
25
26 static struct {
27         const char *name;
28         int algo;
29         int mode;
30         int nid;
31 } ciphertable[] = {
32         {"none", GCRY_CIPHER_NONE, GCRY_CIPHER_MODE_NONE, 0},
33
34         {NULL, GCRY_CIPHER_BLOWFISH, GCRY_CIPHER_MODE_ECB, 92},
35         {"blowfish", GCRY_CIPHER_BLOWFISH, GCRY_CIPHER_MODE_CBC, 91},
36         {NULL, GCRY_CIPHER_BLOWFISH, GCRY_CIPHER_MODE_CFB, 93},
37         {NULL, GCRY_CIPHER_BLOWFISH, GCRY_CIPHER_MODE_OFB, 94},
38
39         {NULL, GCRY_CIPHER_AES, GCRY_CIPHER_MODE_ECB, 418},
40         {"aes", GCRY_CIPHER_AES, GCRY_CIPHER_MODE_CBC, 419},
41         {NULL, GCRY_CIPHER_AES, GCRY_CIPHER_MODE_CFB, 421},
42         {NULL, GCRY_CIPHER_AES, GCRY_CIPHER_MODE_OFB, 420},
43
44         {NULL, GCRY_CIPHER_AES192, GCRY_CIPHER_MODE_ECB, 422},
45         {"aes192", GCRY_CIPHER_AES192, GCRY_CIPHER_MODE_CBC, 423},
46         {NULL, GCRY_CIPHER_AES192, GCRY_CIPHER_MODE_CFB, 425},
47         {NULL, GCRY_CIPHER_AES192, GCRY_CIPHER_MODE_OFB, 424},
48
49         {NULL, GCRY_CIPHER_AES256, GCRY_CIPHER_MODE_ECB, 426},
50         {"aes256", GCRY_CIPHER_AES256, GCRY_CIPHER_MODE_CBC, 427},
51         {NULL, GCRY_CIPHER_AES256, GCRY_CIPHER_MODE_CFB, 429},
52         {NULL, GCRY_CIPHER_AES256, GCRY_CIPHER_MODE_OFB, 428},
53 };
54
55 static bool nametocipher(const char *name, int *algo, int *mode) {
56         size_t i;
57
58         for(i = 0; i < sizeof(ciphertable) / sizeof(*ciphertable); i++) {
59                 if(ciphertable[i].name && !strcasecmp(name, ciphertable[i].name)) {
60                         *algo = ciphertable[i].algo;
61                         *mode = ciphertable[i].mode;
62                         return true;
63                 }
64         }
65
66         return false;
67 }
68
69 static bool nidtocipher(int nid, int *algo, int *mode) {
70         size_t i;
71
72         for(i = 0; i < sizeof(ciphertable) / sizeof(*ciphertable); i++) {
73                 if(nid == ciphertable[i].nid) {
74                         *algo = ciphertable[i].algo;
75                         *mode = ciphertable[i].mode;
76                         return true;
77                 }
78         }
79
80         return false;
81 }
82
83 static bool ciphertonid(int algo, int mode, int *nid) {
84         size_t i;
85
86         for(i = 0; i < sizeof(ciphertable) / sizeof(*ciphertable); i++) {
87                 if(algo == ciphertable[i].algo && mode == ciphertable[i].mode) {
88                         *nid = ciphertable[i].nid;
89                         return true;
90                 }
91         }
92
93         return false;
94 }
95
96 static bool cipher_open(cipher_t *cipher, int algo, int mode) {
97         gcry_error_t err;
98
99         if(!ciphertonid(algo, mode, &cipher->nid)) {
100                 logger(DEBUG_ALWAYS, LOG_DEBUG, "Cipher %d mode %d has no corresponding nid!", algo, mode);
101                 return false;
102         }
103
104         if((err = gcry_cipher_open(&cipher->handle, algo, mode, 0))) {
105                 logger(DEBUG_ALWAYS, LOG_DEBUG, "Unable to initialise cipher %d mode %d: %s", algo, mode, gcry_strerror(err));
106                 return false;
107         }
108
109         cipher->keylen = gcry_cipher_get_algo_keylen(algo);
110         cipher->blklen = gcry_cipher_get_algo_blklen(algo);
111         cipher->key = xmalloc(cipher->keylen + cipher->blklen);
112         cipher->padding = mode == GCRY_CIPHER_MODE_ECB || mode == GCRY_CIPHER_MODE_CBC;
113
114         return true;
115 }
116
117 bool cipher_open_by_name(cipher_t *cipher, const char *name) {
118         int algo, mode;
119
120         if(!nametocipher(name, &algo, &mode)) {
121                 logger(DEBUG_ALWAYS, LOG_DEBUG, "Unknown cipher name '%s'!", name);
122                 return false;
123         }
124
125         return cipher_open(cipher, algo, mode);
126 }
127
128 bool cipher_open_by_nid(cipher_t *cipher, int nid) {
129         int algo, mode;
130
131         if(!nidtocipher(nid, &algo, &mode)) {
132                 logger(DEBUG_ALWAYS, LOG_DEBUG, "Unknown cipher ID %d!", nid);
133                 return false;
134         }
135
136         return cipher_open(cipher, algo, mode);
137 }
138
139 bool cipher_open_blowfish_ofb(cipher_t *cipher) {
140         return cipher_open(cipher, GCRY_CIPHER_BLOWFISH, GCRY_CIPHER_MODE_OFB);
141 }
142
143 void cipher_close(cipher_t *cipher) {
144         if(cipher->handle) {
145                 gcry_cipher_close(cipher->handle);
146                 cipher->handle = NULL;
147         }
148
149         free(cipher->key);
150         cipher->key = NULL;
151 }
152
153 size_t cipher_keylength(const cipher_t *cipher) {
154         return cipher->keylen + cipher->blklen;
155 }
156
157 void cipher_get_key(const cipher_t *cipher, void *key) {
158         memcpy(key, cipher->key, cipher->keylen + cipher->blklen);
159 }
160
161 bool cipher_set_key(cipher_t *cipher, void *key, bool encrypt) {
162         memcpy(cipher->key, key, cipher->keylen + cipher->blklen);
163
164         gcry_cipher_setkey(cipher->handle, cipher->key, cipher->keylen);
165         gcry_cipher_setiv(cipher->handle, cipher->key + cipher->keylen, cipher->blklen);
166
167         return true;
168 }
169
170 bool cipher_set_key_from_rsa(cipher_t *cipher, void *key, size_t len, bool encrypt) {
171         memcpy(cipher->key, key + len - cipher->keylen, cipher->keylen + cipher->blklen);
172         memcpy(cipher->key + cipher->keylen, key + len - cipher->keylen - cipher->blklen, cipher->blklen);
173
174         gcry_cipher_setkey(cipher->handle, cipher->key, cipher->keylen);
175         gcry_cipher_setiv(cipher->handle, cipher->key + cipher->keylen, cipher->blklen);
176
177         return true;
178 }
179
180 bool cipher_regenerate_key(cipher_t *cipher, bool encrypt) {
181         gcry_create_nonce(cipher->key, cipher->keylen + cipher->blklen);
182
183         gcry_cipher_setkey(cipher->handle, cipher->key, cipher->keylen);
184         gcry_cipher_setiv(cipher->handle, cipher->key + cipher->keylen, cipher->blklen);
185
186         return true;
187 }
188
189 bool cipher_encrypt(cipher_t *cipher, const void *indata, size_t inlen, void *outdata, size_t *outlen, bool oneshot) {
190         gcry_error_t err;
191         uint8_t pad[cipher->blklen];
192
193         if(cipher->padding) {
194                 if(!oneshot) {
195                         return false;
196                 }
197
198                 size_t reqlen = ((inlen + cipher->blklen) / cipher->blklen) * cipher->blklen;
199
200                 if(*outlen < reqlen) {
201                         logger(DEBUG_ALWAYS, LOG_ERR, "Error while encrypting: not enough room for padding");
202                         return false;
203                 }
204
205                 uint8_t padbyte = reqlen - inlen;
206                 inlen = reqlen - cipher->blklen;
207
208                 for(int i = 0; i < cipher->blklen; i++)
209                         if(i < cipher->blklen - padbyte) {
210                                 pad[i] = ((uint8_t *)indata)[inlen + i];
211                         } else {
212                                 pad[i] = padbyte;
213                         }
214         }
215
216         if(oneshot) {
217                 gcry_cipher_setiv(cipher->handle, cipher->key + cipher->keylen, cipher->blklen);
218         }
219
220         if((err = gcry_cipher_encrypt(cipher->handle, outdata, *outlen, indata, inlen))) {
221                 logger(DEBUG_ALWAYS, LOG_ERR, "Error while encrypting: %s", gcry_strerror(err));
222                 return false;
223         }
224
225         if(cipher->padding) {
226                 if((err = gcry_cipher_encrypt(cipher->handle, outdata + inlen, cipher->blklen, pad, cipher->blklen))) {
227                         logger(DEBUG_ALWAYS, LOG_ERR, "Error while encrypting: %s", gcry_strerror(err));
228                         return false;
229                 }
230
231                 inlen += cipher->blklen;
232         }
233
234         *outlen = inlen;
235         return true;
236 }
237
238 bool cipher_decrypt(cipher_t *cipher, const void *indata, size_t inlen, void *outdata, size_t *outlen, bool oneshot) {
239         gcry_error_t err;
240
241         if(oneshot) {
242                 gcry_cipher_setiv(cipher->handle, cipher->key + cipher->keylen, cipher->blklen);
243         }
244
245         if((err = gcry_cipher_decrypt(cipher->handle, outdata, *outlen, indata, inlen))) {
246                 logger(DEBUG_ALWAYS, LOG_ERR, "Error while decrypting: %s", gcry_strerror(err));
247                 return false;
248         }
249
250         if(cipher->padding) {
251                 if(!oneshot) {
252                         return false;
253                 }
254
255                 uint8_t padbyte = ((uint8_t *)outdata)[inlen - 1];
256
257                 if(padbyte == 0 || padbyte > cipher->blklen || padbyte > inlen) {
258                         logger(DEBUG_ALWAYS, LOG_ERR, "Error while decrypting: invalid padding");
259                         return false;
260                 }
261
262                 size_t origlen = inlen - padbyte;
263
264                 for(int i = inlen - 1; i >= origlen; i--)
265                         if(((uint8_t *)outdata)[i] != padbyte) {
266                                 logger(DEBUG_ALWAYS, LOG_ERR, "Error while decrypting: invalid padding");
267                                 return false;
268                         }
269
270                 *outlen = origlen;
271         } else {
272                 *outlen = inlen;
273         }
274
275         return true;
276 }
277
278 int cipher_get_nid(const cipher_t *cipher) {
279         return cipher->nid;
280 }
281
282 bool cipher_active(const cipher_t *cipher) {
283         return cipher->nid != 0;
284 }