Merge branch 'master' of github.com:borkmann/netsniff-ng into lldp
[netsniff-ng.git] / curve.c
blob6d04266c7f05f93a6cb41e92b6cf7bb32e25d4cb
1 /*
2 * netsniff-ng - the packet sniffing beast
3 * By Daniel Borkmann <daniel@netsniff-ng.org>
4 * Copyright 2011 - 2013 Daniel Borkmann.
5 * Subject to the GPL, version 2.
6 */
8 #include <stdio.h>
9 #include <stdlib.h>
10 #include <stdint.h>
11 #include <errno.h>
12 #include <fcntl.h>
13 #include <syslog.h>
14 #include <limits.h>
15 #include <string.h>
16 #include <sys/types.h>
17 #include <sys/time.h>
18 #include <sys/stat.h>
20 #include "built_in.h"
21 #include "xmalloc.h"
22 #include "curve.h"
23 #include "xutils.h"
24 #include "xio.h"
25 #include "die.h"
26 #include "curvetun.h"
27 #include "locking.h"
28 #include "crypto_verify_32.h"
29 #include "crypto_box_curve25519xsalsa20poly1305.h"
30 #include "crypto_scalarmult_curve25519.h"
32 #define crypto_box_beforenm crypto_box_curve25519xsalsa20poly1305_beforenm
33 #define crypto_box_afternm crypto_box_curve25519xsalsa20poly1305_afternm
34 #define crypto_box_open_afternm crypto_box_curve25519xsalsa20poly1305_open_afternm
36 #define NONCE_LENGTH (sizeof(struct taia))
37 #define NONCE_OFFSET (crypto_box_curve25519xsalsa20poly1305_NONCEBYTES - NONCE_LENGTH)
39 void curve25519_selftest(void)
41 int i;
42 unsigned char alicesk[32] = {
43 0x77, 0x07, 0x6d, 0x0a, 0x73, 0x18, 0xa5, 0x7d,
44 0x3c, 0x16, 0xc1, 0x72, 0x51, 0xb2, 0x66, 0x45,
45 0xdf, 0x4c, 0x2f, 0x87, 0xeb, 0xc0, 0x99, 0x2a,
46 0xb1, 0x77, 0xfb, 0xa5, 0x1d, 0xb9, 0x2c, 0x2a
48 unsigned char bobpk[32] = {
49 0xde, 0x9e, 0xdb, 0x7d, 0x7b, 0x7d, 0xc1, 0xb4,
50 0xd3, 0x5b, 0x61, 0xc2, 0xec, 0xe4, 0x35, 0x37,
51 0x3f, 0x83, 0x43, 0xc8, 0x5b, 0x78, 0x67, 0x4d,
52 0xad, 0xfc, 0x7e, 0x14, 0x6f, 0x88, 0x2b, 0x4f
54 unsigned char nonce[24] = {
55 0x69, 0x69, 0x6e, 0xe9, 0x55, 0xb6, 0x2b, 0x73,
56 0xcd, 0x62, 0xbd, 0xa8, 0x75, 0xfc, 0x73, 0xd6,
57 0x82, 0x19, 0xe0, 0x03, 0x6b, 0x7a, 0x0b, 0x37
59 unsigned char m[163] = {
60 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
61 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
62 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
63 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
64 0xbe, 0x07, 0x5f, 0xc5, 0x3c, 0x81, 0xf2, 0xd5,
65 0xcf, 0x14, 0x13, 0x16, 0xeb, 0xeb, 0x0c, 0x7b,
66 0x52, 0x28, 0xc5, 0x2a, 0x4c, 0x62, 0xcb, 0xd4,
67 0x4b, 0x66, 0x84, 0x9b, 0x64, 0x24, 0x4f, 0xfc,
68 0xe5, 0xec, 0xba, 0xaf, 0x33, 0xbd, 0x75, 0x1a,
69 0x1a, 0xc7, 0x28, 0xd4, 0x5e, 0x6c, 0x61, 0x29,
70 0x6c, 0xdc, 0x3c, 0x01, 0x23, 0x35, 0x61, 0xf4,
71 0x1d, 0xb6, 0x6c, 0xce, 0x31, 0x4a, 0xdb, 0x31,
72 0x0e, 0x3b, 0xe8, 0x25, 0x0c, 0x46, 0xf0, 0x6d,
73 0xce, 0xea, 0x3a, 0x7f, 0xa1, 0x34, 0x80, 0x57,
74 0xe2, 0xf6, 0x55, 0x6a, 0xd6, 0xb1, 0x31, 0x8a,
75 0x02, 0x4a, 0x83, 0x8f, 0x21, 0xaf, 0x1f, 0xde,
76 0x04, 0x89, 0x77, 0xeb, 0x48, 0xf5, 0x9f, 0xfd,
77 0x49, 0x24, 0xca, 0x1c, 0x60, 0x90, 0x2e, 0x52,
78 0xf0, 0xa0, 0x89, 0xbc, 0x76, 0x89, 0x70, 0x40,
79 0xe0, 0x82, 0xf9, 0x37, 0x76, 0x38, 0x48, 0x64,
80 0x5e, 0x07, 0x05
82 unsigned char c[163];
83 unsigned char result[147] = {
84 0xf3, 0xff, 0xc7, 0x70, 0x3f, 0x94, 0x00, 0xe5,
85 0x2a, 0x7d, 0xfb, 0x4b, 0x3d, 0x33, 0x05, 0xd9,
86 0x8e, 0x99, 0x3b, 0x9f, 0x48, 0x68, 0x12, 0x73,
87 0xc2, 0x96, 0x50, 0xba, 0x32, 0xfc, 0x76, 0xce,
88 0x48, 0x33, 0x2e, 0xa7, 0x16, 0x4d, 0x96, 0xa4,
89 0x47, 0x6f, 0xb8, 0xc5, 0x31, 0xa1, 0x18, 0x6a,
90 0xc0, 0xdf, 0xc1, 0x7c, 0x98, 0xdc, 0xe8, 0x7b,
91 0x4d, 0xa7, 0xf0, 0x11, 0xec, 0x48, 0xc9, 0x72,
92 0x71, 0xd2, 0xc2, 0x0f, 0x9b, 0x92, 0x8f, 0xe2,
93 0x27, 0x0d, 0x6f, 0xb8, 0x63, 0xd5, 0x17, 0x38,
94 0xb4, 0x8e, 0xee, 0xe3, 0x14, 0xa7, 0xcc, 0x8a,
95 0xb9, 0x32, 0x16, 0x45, 0x48, 0xe5, 0x26, 0xae,
96 0x90, 0x22, 0x43, 0x68, 0x51, 0x7a, 0xcf, 0xea,
97 0xbd, 0x6b, 0xb3, 0x73, 0x2b, 0xc0, 0xe9, 0xda,
98 0x99, 0x83, 0x2b, 0x61, 0xca, 0x01, 0xb6, 0xde,
99 0x56, 0x24, 0x4a, 0x9e, 0x88, 0xd5, 0xf9, 0xb3,
100 0x79, 0x73, 0xf6, 0x22, 0xa4, 0x3d, 0x14, 0xa6,
101 0x59, 0x9b, 0x1f, 0x65, 0x4c, 0xb4, 0x5a, 0x74,
102 0xe3, 0x55, 0xa5
105 bug_on(NONCE_LENGTH != 16);
107 crypto_box_curve25519xsalsa20poly1305(c, m, 163, nonce, bobpk, alicesk);
109 for (i = 16; i < 163; ++i) {
110 if (c[i] != result[i - 16])
111 panic("Crypto selftest failed! :-(\n");
115 int curve25519_pubkey_hexparse_32(unsigned char *bin, size_t blen,
116 const char *ascii, size_t alen)
118 int ret = sscanf(ascii,
119 "%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:"
120 "%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:"
121 "%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:"
122 "%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx:%2hhx",
123 &bin[0], &bin[1], &bin[2], &bin[3], &bin[4],
124 &bin[5], &bin[6], &bin[7], &bin[8], &bin[9],
125 &bin[10], &bin[11], &bin[12], &bin[13], &bin[14],
126 &bin[15], &bin[16], &bin[17], &bin[18], &bin[19],
127 &bin[20], &bin[21], &bin[22], &bin[23], &bin[24],
128 &bin[25], &bin[26], &bin[27], &bin[28], &bin[29],
129 &bin[30], &bin[31]);
130 return ret == 32;
133 void curve25519_alloc_or_maybe_die(struct curve25519_struct *curve)
135 curve->enc_buf_size = curve->dec_buf_size = TUNBUFF_SIZ;
137 curve->enc_buf = xmalloc_aligned(curve->enc_buf_size, 16);
138 curve->dec_buf = xmalloc_aligned(curve->dec_buf_size, 16);
140 spinlock_init(&curve->enc_lock);
141 spinlock_init(&curve->dec_lock);
144 void curve25519_free(void *curvep)
146 struct curve25519_struct *curve = curvep;
148 memset(curve->enc_buf, 0, curve->enc_buf_size);
149 memset(curve->dec_buf, 0, curve->dec_buf_size);
151 xfree(curve->enc_buf);
152 xfree(curve->dec_buf);
154 spinlock_destroy(&curve->enc_lock);
155 spinlock_destroy(&curve->dec_lock);
158 int curve25519_proto_init(struct curve25519_proto *proto, unsigned char *pubkey_remote,
159 size_t len, char *home, int server)
161 int fd;
162 ssize_t ret;
163 char path[PATH_MAX];
164 unsigned char secretkey_own[crypto_box_curve25519xsalsa20poly1305_SECRETKEYBYTES];
165 unsigned char publickey_own[crypto_box_curve25519xsalsa20poly1305_PUBLICKEYBYTES];
167 fmemset(secretkey_own, 0, sizeof(secretkey_own));
168 fmemset(publickey_own, 0, sizeof(publickey_own));
170 if (!pubkey_remote || len != sizeof(publickey_own))
171 return -EINVAL;
173 slprintf(path, sizeof(path), "%s/%s", home, FILE_PRIVKEY);
174 fd = open_or_die(path, O_RDONLY);
176 ret = read(fd, secretkey_own, sizeof(secretkey_own));
177 if (ret != sizeof(secretkey_own)) {
178 xmemset(secretkey_own, 0, sizeof(secretkey_own));
179 panic("Cannot read private key!\n");
182 close(fd);
184 crypto_scalarmult_curve25519_base(publickey_own, secretkey_own);
186 if (!crypto_verify_32(publickey_own, pubkey_remote)) {
187 xmemset(secretkey_own, 0, sizeof(secretkey_own));
188 xmemset(publickey_own, 0, sizeof(publickey_own));
189 panic("PANIC: remote end has same public key as you have!!!\n");
192 crypto_box_beforenm(proto->key, pubkey_remote, secretkey_own);
194 xmemset(proto->enonce, 0, sizeof(proto->enonce));
195 xmemset(proto->dnonce, 0, sizeof(proto->dnonce));
197 xmemset(secretkey_own, 0, sizeof(secretkey_own));
198 xmemset(publickey_own, 0, sizeof(publickey_own));
200 return 0;
203 ssize_t curve25519_encode(struct curve25519_struct *curve, struct curve25519_proto *proto,
204 unsigned char *plaintext, size_t size, unsigned char **chipertext)
206 int ret, i;
207 ssize_t done = size;
208 struct taia packet_taia;
210 spinlock_lock(&curve->enc_lock);
212 if (unlikely(size > curve->enc_buf_size)) {
213 done = -ENOMEM;
214 goto out;
217 taia_now(&packet_taia);
218 taia_pack(proto->enonce + NONCE_OFFSET, &packet_taia);
220 memset(curve->enc_buf, 0, curve->enc_buf_size);
221 ret = crypto_box_afternm(curve->enc_buf, plaintext, size, proto->enonce, proto->key);
222 if (unlikely(ret)) {
223 done = -EIO;
224 goto out;
227 fmemcpy(curve->enc_buf + crypto_box_boxzerobytes - NONCE_LENGTH,
228 proto->enonce + NONCE_OFFSET, NONCE_LENGTH);
230 for (i = 0; i < crypto_box_boxzerobytes - NONCE_LENGTH; ++i)
231 curve->enc_buf[i] = (uint8_t) secrand();
233 (*chipertext) = curve->enc_buf;
234 out:
235 spinlock_unlock(&curve->enc_lock);
236 return done;
239 ssize_t curve25519_decode(struct curve25519_struct *curve, struct curve25519_proto *proto,
240 unsigned char *chipertext, size_t size, unsigned char **plaintext,
241 struct taia *arrival_taia)
243 int ret;
244 ssize_t done = size;
245 struct taia packet_taia, arrival_taia2;
247 spinlock_lock(&curve->dec_lock);
249 if (unlikely(size > curve->dec_buf_size)) {
250 done = -ENOMEM;
251 goto out;
253 if (unlikely(size < crypto_box_boxzerobytes + NONCE_LENGTH)) {
254 done = 0;
255 goto out;
257 if (arrival_taia == NULL) {
258 taia_now(&arrival_taia2);
259 arrival_taia = &arrival_taia2;
262 taia_unpack(chipertext + crypto_box_boxzerobytes - NONCE_LENGTH, &packet_taia);
263 if (is_good_taia(arrival_taia, &packet_taia) == 0) {
264 syslog(LOG_ERR, "Bad packet time! Dropping connection!\n");
265 done = 0;
266 goto out;
269 memcpy(proto->dnonce + NONCE_OFFSET, chipertext + crypto_box_boxzerobytes - NONCE_LENGTH, NONCE_LENGTH);
270 memset(curve->dec_buf, 0, curve->dec_buf_size);
272 ret = crypto_box_open_afternm(curve->dec_buf, chipertext, size, proto->dnonce, proto->key);
273 if (unlikely(ret)) {
274 done = -EIO;
275 goto out;
278 (*plaintext) = curve->dec_buf;
279 out:
280 spinlock_unlock(&curve->dec_lock);
281 return done;