d1_both.c 42.3 KB
Newer Older
B
Ben Laurie 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13
/* ssl/d1_both.c */
/* 
 * DTLS implementation written by Nagendra Modadugu
 * (nagendra@cs.stanford.edu) for the OpenSSL project 2005.  
 */
/* ====================================================================
 * Copyright (c) 1998-2005 The OpenSSL Project.  All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * 1. Redistributions of source code must retain the above copyright
A
Andy Polyakov 已提交
14
 *    notice, this list of conditions and the following disclaimer. 
B
Ben Laurie 已提交
15 16
 *
 * 2. Redistributions in binary form must reproduce the above copyright
A
Andy Polyakov 已提交
17 18 19
 *    notice, this list of conditions and the following disclaimer in
 *    the documentation and/or other materials provided with the
 *    distribution.
B
Ben Laurie 已提交
20 21
 *
 * 3. All advertising materials mentioning features or use of this
A
Andy Polyakov 已提交
22 23 24
 *    software must display the following acknowledgment:
 *    "This product includes software developed by the OpenSSL Project
 *    for use in the OpenSSL Toolkit. (http://www.openssl.org/)"
B
Ben Laurie 已提交
25 26
 *
 * 4. The names "OpenSSL Toolkit" and "OpenSSL Project" must not be used to
A
Andy Polyakov 已提交
27 28 29
 *    endorse or promote products derived from this software without
 *    prior written permission. For written permission, please contact
 *    openssl-core@openssl.org.
B
Ben Laurie 已提交
30 31
 *
 * 5. Products derived from this software may not be called "OpenSSL"
A
Andy Polyakov 已提交
32 33
 *    nor may "OpenSSL" appear in their names without prior written
 *    permission of the OpenSSL Project.
B
Ben Laurie 已提交
34 35
 *
 * 6. Redistributions of any form whatsoever must retain the following
A
Andy Polyakov 已提交
36 37 38
 *    acknowledgment:
 *    "This product includes software developed by the OpenSSL Project
 *    for use in the OpenSSL Toolkit (http://www.openssl.org/)"
B
Ben Laurie 已提交
39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83
 *
 * THIS SOFTWARE IS PROVIDED BY THE OpenSSL PROJECT ``AS IS'' AND ANY
 * EXPRESSED OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE OpenSSL PROJECT OR
 * ITS CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
 * OF THE POSSIBILITY OF SUCH DAMAGE.
 * ====================================================================
 *
 * This product includes cryptographic software written by Eric Young
 * (eay@cryptsoft.com).  This product includes software written by Tim
 * Hudson (tjh@cryptsoft.com).
 *
 */
/* Copyright (C) 1995-1998 Eric Young (eay@cryptsoft.com)
 * All rights reserved.
 *
 * This package is an SSL implementation written
 * by Eric Young (eay@cryptsoft.com).
 * The implementation was written so as to conform with Netscapes SSL.
 * 
 * This library is free for commercial and non-commercial use as long as
 * the following conditions are aheared to.  The following conditions
 * apply to all code found in this distribution, be it the RC4, RSA,
 * lhash, DES, etc., code; not just the SSL code.  The SSL documentation
 * included with this distribution is covered by the same copyright terms
 * except that the holder is Tim Hudson (tjh@cryptsoft.com).
 * 
 * Copyright remains Eric Young's, and as such any Copyright notices in
 * the code are not to be removed.
 * If this package is used in a product, Eric Young should be given attribution
 * as the author of the parts of the library used.
 * This can be in the form of a textual message at program startup or
 * in documentation (online or textual) provided with the package.
 * 
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the copyright
A
Andy Polyakov 已提交
84
 *    notice, this list of conditions and the following disclaimer.
B
Ben Laurie 已提交
85
 * 2. Redistributions in binary form must reproduce the above copyright
A
Andy Polyakov 已提交
86 87
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
B
Ben Laurie 已提交
88
 * 3. All advertising materials mentioning features or use of this software
A
Andy Polyakov 已提交
89 90 91 92 93
 *    must display the following acknowledgement:
 *    "This product includes cryptographic software written by
 *     Eric Young (eay@cryptsoft.com)"
 *    The word 'cryptographic' can be left out if the rouines from the library
 *    being used are not cryptographic related :-).
B
Ben Laurie 已提交
94
 * 4. If you include any Windows specific code (or a derivative thereof) from 
A
Andy Polyakov 已提交
95 96
 *    the apps directory (application code) you must include an acknowledgement:
 *    "This product includes software written by Tim Hudson (tjh@cryptsoft.com)"
B
Ben Laurie 已提交
97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125
 * 
 * THIS SOFTWARE IS PROVIDED BY ERIC YOUNG ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 * 
 * The licence and distribution terms for any publically available version or
 * derivative of this code cannot be changed.  i.e. this code cannot simply be
 * copied and put under another distribution licence
 * [including the GNU Public Licence.]
 */

#include <limits.h>
#include <string.h>
#include <stdio.h>
#include "ssl_locl.h"
#include <openssl/buffer.h>
#include <openssl/rand.h>
#include <openssl/objects.h>
#include <openssl/evp.h>
#include <openssl/x509.h>

D
Dr. Stephen Henson 已提交
126 127 128 129
#define RSMBLY_BITMASK_SIZE(msg_len) (((msg_len) + 7) / 8)

#define RSMBLY_BITMASK_MARK(bitmask, start, end) { \
			if ((end) - (start) <= 8) { \
D
Dr. Stephen Henson 已提交
130
				long ii; \
D
Dr. Stephen Henson 已提交
131 132
				for (ii = (start); ii < (end); ii++) bitmask[((ii) >> 3)] |= (1 << ((ii) & 7)); \
			} else { \
D
Dr. Stephen Henson 已提交
133
				long ii; \
D
Dr. Stephen Henson 已提交
134
				bitmask[((start) >> 3)] |= bitmask_start_values[((start) & 7)]; \
D
Dr. Stephen Henson 已提交
135 136
				for (ii = (((start) >> 3) + 1); ii < ((((end) - 1)) >> 3); ii++) bitmask[ii] = 0xff; \
				bitmask[(((end) - 1) >> 3)] |= bitmask_end_values[((end) & 7)]; \
D
Dr. Stephen Henson 已提交
137 138 139
			} }

#define RSMBLY_BITMASK_IS_COMPLETE(bitmask, msg_len, is_complete) { \
D
Dr. Stephen Henson 已提交
140 141
			long ii; \
			OPENSSL_assert((msg_len) > 0); \
D
Dr. Stephen Henson 已提交
142
			is_complete = 1; \
D
Dr. Stephen Henson 已提交
143 144 145
			if (bitmask[(((msg_len) - 1) >> 3)] != bitmask_end_values[((msg_len) & 7)]) is_complete = 0; \
			if (is_complete) for (ii = (((msg_len) - 1) >> 3) - 1; ii >= 0 ; ii--) \
				if (bitmask[ii] != 0xff) { is_complete = 0; break; } }
D
Dr. Stephen Henson 已提交
146 147 148

#if 0
#define RSMBLY_BITMASK_PRINT(bitmask, msg_len) { \
D
Dr. Stephen Henson 已提交
149
			long ii; \
D
Dr. Stephen Henson 已提交
150 151 152 153 154 155
			printf("bitmask: "); for (ii = 0; ii < (msg_len); ii++) \
			printf("%d ", (bitmask[ii >> 3] & (1 << (ii & 7))) >> (ii & 7)); \
			printf("\n"); }
#endif

static unsigned char bitmask_start_values[] = {0xff, 0xfe, 0xfc, 0xf8, 0xf0, 0xe0, 0xc0, 0x80};
D
Dr. Stephen Henson 已提交
156
static unsigned char bitmask_end_values[]   = {0xff, 0x01, 0x03, 0x07, 0x0f, 0x1f, 0x3f, 0x7f};
B
Ben Laurie 已提交
157 158

/* XDTLS:  figure out the right values */
159
static const unsigned int g_probable_mtu[] = {1500, 512, 256};
B
Ben Laurie 已提交
160 161 162 163 164 165 166 167 168

static void dtls1_fix_message_header(SSL *s, unsigned long frag_off, 
	unsigned long frag_len);
static unsigned char *dtls1_write_message_header(SSL *s,
	unsigned char *p);
static void dtls1_set_message_header_int(SSL *s, unsigned char mt,
	unsigned long len, unsigned short seq_num, unsigned long frag_off, 
	unsigned long frag_len);
static long dtls1_get_message_fragment(SSL *s, int st1, int stn, 
A
Andy Polyakov 已提交
169
	long max, int *ok);
B
Ben Laurie 已提交
170 171

static hm_fragment *
D
Dr. Stephen Henson 已提交
172
dtls1_hm_fragment_new(unsigned long frag_len, int reassembly)
A
Andy Polyakov 已提交
173 174 175
	{
	hm_fragment *frag = NULL;
	unsigned char *buf = NULL;
D
Dr. Stephen Henson 已提交
176
	unsigned char *bitmask = NULL;
A
Andy Polyakov 已提交
177 178 179 180 181

	frag = (hm_fragment *)OPENSSL_malloc(sizeof(hm_fragment));
	if ( frag == NULL)
		return NULL;

A
Andy Polyakov 已提交
182
	if (frag_len)
A
Andy Polyakov 已提交
183
		{
A
Andy Polyakov 已提交
184 185 186 187 188 189
		buf = (unsigned char *)OPENSSL_malloc(frag_len);
		if ( buf == NULL)
			{
			OPENSSL_free(frag);
			return NULL;
			}
A
Andy Polyakov 已提交
190 191
		}

A
Andy Polyakov 已提交
192
	/* zero length fragment gets zero frag->fragment */
A
Andy Polyakov 已提交
193 194
	frag->fragment = buf;

D
Dr. Stephen Henson 已提交
195 196 197 198 199 200 201 202 203 204 205 206 207 208 209
	/* Initialize reassembly bitmask if necessary */
	if (reassembly)
		{
		bitmask = (unsigned char *)OPENSSL_malloc(RSMBLY_BITMASK_SIZE(frag_len));
		if (bitmask == NULL)
			{
			if (buf != NULL) OPENSSL_free(buf);
			OPENSSL_free(frag);
			return NULL;
			}
		memset(bitmask, 0, RSMBLY_BITMASK_SIZE(frag_len));
		}

	frag->reassembly = bitmask;

A
Andy Polyakov 已提交
210 211
	return frag;
	}
B
Ben Laurie 已提交
212

213
void dtls1_hm_fragment_free(hm_fragment *frag)
A
Andy Polyakov 已提交
214
	{
215 216 217 218 219 220

	if (frag->msg_header.is_ccs)
		{
		EVP_CIPHER_CTX_free(frag->msg_header.saved_retransmit_state.enc_write_ctx);
		EVP_MD_CTX_destroy(frag->msg_header.saved_retransmit_state.write_hash);
		}
A
Andy Polyakov 已提交
221
	if (frag->fragment) OPENSSL_free(frag->fragment);
D
Dr. Stephen Henson 已提交
222
	if (frag->reassembly) OPENSSL_free(frag->reassembly);
A
Andy Polyakov 已提交
223 224
	OPENSSL_free(frag);
	}
B
Ben Laurie 已提交
225

226
static int dtls1_query_mtu(SSL *s)
227
{
228 229 230 231 232 233
	if(s->d1->link_mtu)
		{
		s->d1->mtu = s->d1->link_mtu-BIO_dgram_get_mtu_overhead(SSL_get_wbio(s));
		s->d1->link_mtu = 0;
		}

B
Ben Laurie 已提交
234
	/* AHA!  Figure out the MTU, and stick to the right size */
235
	if (s->d1->mtu < dtls1_min_mtu(s))
A
Andy Polyakov 已提交
236
		{
237
		if(!(SSL_get_options(s) & SSL_OP_NO_QUERY_MTU))
B
Ben Laurie 已提交
238
			{
239 240 241 242 243 244 245 246 247 248 249 250
			s->d1->mtu =
				BIO_ctrl(SSL_get_wbio(s), BIO_CTRL_DGRAM_QUERY_MTU, 0, NULL);

			/* I've seen the kernel return bogus numbers when it doesn't know
			 * (initial write), so just make sure we have a reasonable number */
			if (s->d1->mtu < dtls1_min_mtu(s))
				{
				/* Set to min mtu */
				s->d1->mtu = dtls1_min_mtu(s);
				BIO_ctrl(SSL_get_wbio(s), BIO_CTRL_DGRAM_SET_MTU,
					s->d1->mtu, NULL);
				}
B
Ben Laurie 已提交
251
			}
252 253
		else
			return 0;
B
Ben Laurie 已提交
254
		}
255
	return 1;
256 257 258 259 260 261
}

/* send s->init_buf in records of type 'type' (SSL3_RT_HANDSHAKE or SSL3_RT_CHANGE_CIPHER_SPEC) */
int dtls1_do_write(SSL *s, int type)
	{
	int ret;
262
	unsigned int curr_mtu;
263
	int retry = 1;
264
	unsigned int len, frag_off, mac_size, blocksize, used_len;
265

266 267
	if(!dtls1_query_mtu(s))
		return -1;
B
Ben Laurie 已提交
268

269
	OPENSSL_assert(s->d1->mtu >= dtls1_min_mtu(s));  /* should have something reasonable now */
D
Dr. Stephen Henson 已提交
270

B
Ben Laurie 已提交
271 272
	if ( s->init_off == 0  && type == SSL3_RT_HANDSHAKE)
		OPENSSL_assert(s->init_num == 
273
			(int)s->d1->w_msg_hdr.msg_len + DTLS1_HM_HEADER_LENGTH);
B
Ben Laurie 已提交
274

D
Dr. Stephen Henson 已提交
275
	if (s->write_hash)
276 277 278 279 280 281
		{
		if (s->enc_write_ctx && EVP_CIPHER_CTX_mode(s->enc_write_ctx) == EVP_CIPH_GCM_MODE)
			mac_size = 0;
		else
			mac_size = EVP_MD_CTX_size(s->write_hash);
		}
D
Dr. Stephen Henson 已提交
282 283 284 285
	else
		mac_size = 0;

	if (s->enc_write_ctx && 
286
		(EVP_CIPHER_CTX_mode(s->enc_write_ctx) == EVP_CIPH_CBC_MODE))
D
Dr. Stephen Henson 已提交
287 288 289 290
		blocksize = 2 * EVP_CIPHER_block_size(s->enc_write_ctx->cipher);
	else
		blocksize = 0;

B
Ben Laurie 已提交
291
	frag_off = 0;
292
	/* s->init_num shouldn't ever be < 0...but just in case */
293
	while(s->init_num > 0)
B
Ben Laurie 已提交
294
		{
295 296 297 298 299 300
		used_len = BIO_wpending(SSL_get_wbio(s)) +  DTLS1_RT_HEADER_LENGTH
			+ mac_size + blocksize;
		if(s->d1->mtu > used_len)
			curr_mtu = s->d1->mtu - used_len;
		else
			curr_mtu = 0;
B
Ben Laurie 已提交
301 302 303 304 305 306 307

		if ( curr_mtu <= DTLS1_HM_HEADER_LENGTH)
			{
			/* grr.. we could get an error if MTU picked was wrong */
			ret = BIO_flush(SSL_get_wbio(s));
			if ( ret <= 0)
				return ret;
308 309
			used_len = DTLS1_RT_HEADER_LENGTH + mac_size + blocksize;
			if(s->d1->mtu > used_len + DTLS1_HM_HEADER_LENGTH)
310
				{
311
				curr_mtu = s->d1->mtu - used_len;
312
				}
313
			else
314
				{
315 316
				/* Shouldn't happen */
				return -1;
317
				}
B
Ben Laurie 已提交
318 319
			}

320 321
		/* We just checked that s->init_num > 0 so this cast should be safe */
		if (((unsigned int)s->init_num) > curr_mtu)
B
Ben Laurie 已提交
322 323 324 325
			len = curr_mtu;
		else
			len = s->init_num;

326 327 328
		/* Shouldn't ever happen */
		if(len > INT_MAX)
			len = INT_MAX;
B
Ben Laurie 已提交
329 330 331 332 333 334 335 336 337 338

		/* XDTLS: this function is too long.  split out the CCS part */
		if ( type == SSL3_RT_HANDSHAKE)
			{
			if ( s->init_off != 0)
				{
				OPENSSL_assert(s->init_off > DTLS1_HM_HEADER_LENGTH);
				s->init_off -= DTLS1_HM_HEADER_LENGTH;
				s->init_num += DTLS1_HM_HEADER_LENGTH;

339 340
				/* We just checked that s->init_num > 0 so this cast should be safe */
				if (((unsigned int)s->init_num) > curr_mtu)
341 342 343
					len = curr_mtu;
				else
					len = s->init_num;
B
Ben Laurie 已提交
344
				}
A
Andy Polyakov 已提交
345

346 347 348 349
			/* Shouldn't ever happen */
			if(len > INT_MAX)
				len = INT_MAX;

350 351 352 353 354 355 356 357
			if ( len < DTLS1_HM_HEADER_LENGTH )
				{
				/*
				 * len is so small that we really can't do anything sensible
				 * so fail
				 */
				return -1;
				}
B
Ben Laurie 已提交
358 359 360
			dtls1_fix_message_header(s, frag_off, 
				len - DTLS1_HM_HEADER_LENGTH);

361
			dtls1_write_message_header(s, (unsigned char *)&s->init_buf->data[s->init_off]);
B
Ben Laurie 已提交
362 363 364 365 366 367 368 369 370 371 372 373
			}

		ret=dtls1_write_bytes(s,type,&s->init_buf->data[s->init_off],
			len);
		if (ret < 0)
			{
			/* might need to update MTU here, but we don't know
			 * which previous packet caused the failure -- so can't
			 * really retransmit anything.  continue as if everything
			 * is fine and wait for an alert to handle the
			 * retransmit 
			 */
374
			if ( retry && BIO_ctrl(SSL_get_wbio(s),
D
Dr. Stephen Henson 已提交
375
				BIO_CTRL_DGRAM_MTU_EXCEEDED, 0, NULL) > 0 )
376 377
				{
				if(!(SSL_get_options(s) & SSL_OP_NO_QUERY_MTU))
378 379 380
					{
					if(!dtls1_query_mtu(s))
						return -1;
381 382
					/* Have one more go */
					retry = 0;
383
					}
384 385 386
				else
					return -1;
				}
B
Ben Laurie 已提交
387
			else
388
				{
B
Ben Laurie 已提交
389
				return(-1);
390
				}
B
Ben Laurie 已提交
391 392 393
			}
		else
			{
A
Andy Polyakov 已提交
394

B
Ben Laurie 已提交
395 396
			/* bad if this assert fails, only part of the handshake
			 * message got sent.  but why would this happen? */
A
Andy Polyakov 已提交
397
			OPENSSL_assert(len == (unsigned int)ret);
A
Andy Polyakov 已提交
398

B
Ben Laurie 已提交
399
			if (type == SSL3_RT_HANDSHAKE && ! s->d1->retransmitting)
A
Andy Polyakov 已提交
400
				{
B
Ben Laurie 已提交
401 402
				/* should not be done for 'Hello Request's, but in that case
				 * we'll ignore the result anyway */
403
				unsigned char *p = (unsigned char *)&s->init_buf->data[s->init_off];
A
Andy Polyakov 已提交
404
				const struct hm_header_st *msg_hdr = &s->d1->w_msg_hdr;
405
				int xlen;
A
Andy Polyakov 已提交
406

407
				if (frag_off == 0 && s->version != DTLS1_BAD_VER)
A
Andy Polyakov 已提交
408 409 410 411 412 413 414 415 416
					{
					/* reconstruct message header is if it
					 * is being sent in single fragment */
					*p++ = msg_hdr->type;
					l2n3(msg_hdr->msg_len,p);
					s2n (msg_hdr->seq,p);
					l2n3(0,p);
					l2n3(msg_hdr->msg_len,p);
					p  -= DTLS1_HM_HEADER_LENGTH;
417
					xlen = ret;
A
Andy Polyakov 已提交
418 419 420 421
					}
				else
					{
					p  += DTLS1_HM_HEADER_LENGTH;
422
					xlen = ret - DTLS1_HM_HEADER_LENGTH;
A
Andy Polyakov 已提交
423 424
					}

425
				ssl3_finish_mac(s, p, xlen);
A
Andy Polyakov 已提交
426 427
				}

B
Ben Laurie 已提交
428 429 430 431 432 433 434 435 436
			if (ret == s->init_num)
				{
				if (s->msg_callback)
					s->msg_callback(1, s->version, type, s->init_buf->data, 
						(size_t)(s->init_off + s->init_num), s, 
						s->msg_callback_arg);

				s->init_off = 0;  /* done writing this message */
				s->init_num = 0;
A
Andy Polyakov 已提交
437

B
Ben Laurie 已提交
438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453
				return(1);
				}
			s->init_off+=ret;
			s->init_num-=ret;
			frag_off += (ret -= DTLS1_HM_HEADER_LENGTH);
			}
		}
	return(0);
	}


/* Obtain handshake message of message type 'mt' (any if mt == -1),
 * maximum acceptable body length 'max'.
 * Read an entire handshake message.  Handshake messages arrive in
 * fragments.
 */
B
Bodo Möller 已提交
454
long dtls1_get_message(SSL *s, int st1, int stn, int mt, long max, int *ok)
B
Ben Laurie 已提交
455 456
	{
	int i, al;
A
Andy Polyakov 已提交
457
	struct hm_header_st *msg_hdr;
D
Dr. Stephen Henson 已提交
458 459
	unsigned char *p;
	unsigned long msg_len;
B
Ben Laurie 已提交
460 461 462 463 464 465 466 467 468

	/* s3->tmp is used to store messages that are unexpected, caused
	 * by the absence of an optional handshake message */
	if (s->s3->tmp.reuse_message)
		{
		s->s3->tmp.reuse_message=0;
		if ((mt >= 0) && (s->s3->tmp.message_type != mt))
			{
			al=SSL_AD_UNEXPECTED_MESSAGE;
B
Bodo Möller 已提交
469
			SSLerr(SSL_F_DTLS1_GET_MESSAGE,SSL_R_UNEXPECTED_MESSAGE);
B
Ben Laurie 已提交
470 471 472 473 474 475 476
			goto f_err;
			}
		*ok=1;
		s->init_msg = s->init_buf->data + DTLS1_HM_HEADER_LENGTH;
		s->init_num = (int)s->s3->tmp.message_size;
		return s->init_num;
		}
A
Andy Polyakov 已提交
477

A
Andy Polyakov 已提交
478
	msg_hdr = &s->d1->r_msg_hdr;
D
Dr. Stephen Henson 已提交
479 480 481 482 483
	memset(msg_hdr, 0x00, sizeof(struct hm_header_st));

again:
	i = dtls1_get_message_fragment(s, st1, stn, max, ok);
	if ( i == DTLS1_HM_BAD_FRAGMENT ||
484 485 486
		i == DTLS1_HM_FRAGMENT_RETRY)
		{
		/* bad fragment received */
D
Dr. Stephen Henson 已提交
487
		goto again;
488
		}
D
Dr. Stephen Henson 已提交
489
	else if ( i <= 0 && !*ok)
490
		{
D
Dr. Stephen Henson 已提交
491
		return i;
492
		}
B
Ben Laurie 已提交
493

D
Dr. Stephen Henson 已提交
494 495 496 497 498 499 500 501 502 503 504 505 506
	p = (unsigned char *)s->init_buf->data;
	msg_len = msg_hdr->msg_len;

	/* reconstruct message header */
	*(p++) = msg_hdr->type;
	l2n3(msg_len,p);
	s2n (msg_hdr->seq,p);
	l2n3(0,p);
	l2n3(msg_len,p);
	if (s->version != DTLS1_BAD_VER) {
		p       -= DTLS1_HM_HEADER_LENGTH;
		msg_len += DTLS1_HM_HEADER_LENGTH;
	}
B
Ben Laurie 已提交
507

D
Dr. Stephen Henson 已提交
508 509 510 511 512 513 514 515
	ssl3_finish_mac(s, p, msg_len);
	if (s->msg_callback)
		s->msg_callback(0, s->version, SSL3_RT_HANDSHAKE,
			p, msg_len,
			s, s->msg_callback_arg);

	memset(msg_hdr, 0x00, sizeof(struct hm_header_st));

D
Dr. Stephen Henson 已提交
516 517 518 519
	/* Don't change sequence numbers while listening */
	if (!s->d1->listen)
		s->d1->handshake_read_seq++;

D
Dr. Stephen Henson 已提交
520 521
	s->init_msg = s->init_buf->data + DTLS1_HM_HEADER_LENGTH;
	return s->init_num;
B
Ben Laurie 已提交
522 523 524 525 526 527 528 529

f_err:
	ssl3_send_alert(s,SSL3_AL_FATAL,al);
	*ok = 0;
	return -1;
	}


A
Andy Polyakov 已提交
530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578
static int dtls1_preprocess_fragment(SSL *s,struct hm_header_st *msg_hdr,int max)
	{
	size_t frag_off,frag_len,msg_len;

	msg_len  = msg_hdr->msg_len;
	frag_off = msg_hdr->frag_off;
	frag_len = msg_hdr->frag_len;

	/* sanity checking */
	if ( (frag_off+frag_len) > msg_len)
		{
		SSLerr(SSL_F_DTLS1_PREPROCESS_FRAGMENT,SSL_R_EXCESSIVE_MESSAGE_SIZE);
		return SSL_AD_ILLEGAL_PARAMETER;
		}

	if ( (frag_off+frag_len) > (unsigned long)max)
		{
		SSLerr(SSL_F_DTLS1_PREPROCESS_FRAGMENT,SSL_R_EXCESSIVE_MESSAGE_SIZE);
		return SSL_AD_ILLEGAL_PARAMETER;
		}

	if ( s->d1->r_msg_hdr.frag_off == 0) /* first fragment */
		{
		/* msg_len is limited to 2^24, but is effectively checked
		 * against max above */
		if (!BUF_MEM_grow_clean(s->init_buf,msg_len+DTLS1_HM_HEADER_LENGTH))
			{
			SSLerr(SSL_F_DTLS1_PREPROCESS_FRAGMENT,ERR_R_BUF_LIB);
			return SSL_AD_INTERNAL_ERROR;
			}

		s->s3->tmp.message_size  = msg_len;
		s->d1->r_msg_hdr.msg_len = msg_len;
		s->s3->tmp.message_type  = msg_hdr->type;
		s->d1->r_msg_hdr.type    = msg_hdr->type;
		s->d1->r_msg_hdr.seq     = msg_hdr->seq;
		}
	else if (msg_len != s->d1->r_msg_hdr.msg_len)
		{
		/* They must be playing with us! BTW, failure to enforce
		 * upper limit would open possibility for buffer overrun. */
		SSLerr(SSL_F_DTLS1_PREPROCESS_FRAGMENT,SSL_R_EXCESSIVE_MESSAGE_SIZE);
		return SSL_AD_ILLEGAL_PARAMETER;
		}

	return 0; /* no error */
	}


B
Ben Laurie 已提交
579
static int
A
Andy Polyakov 已提交
580
dtls1_retrieve_buffered_fragment(SSL *s, long max, int *ok)
A
Andy Polyakov 已提交
581
	{
582 583
	/*-
	 * (0) check whether the desired fragment is available
A
Andy Polyakov 已提交
584 585 586 587 588 589
	 * if so:
	 * (1) copy over the fragment to s->init_buf->data[]
	 * (2) update s->init_num
	 */
	pitem *item;
	hm_fragment *frag;
A
Andy Polyakov 已提交
590
	int al;
A
Andy Polyakov 已提交
591

A
Andy Polyakov 已提交
592
	*ok = 0;
A
Andy Polyakov 已提交
593 594 595 596 597
	item = pqueue_peek(s->d1->buffered_messages);
	if ( item == NULL)
		return 0;

	frag = (hm_fragment *)item->data;
D
Dr. Stephen Henson 已提交
598 599 600 601
	
	/* Don't return if reassembly still in progress */
	if (frag->reassembly != NULL)
		return 0;
A
Andy Polyakov 已提交
602

A
Andy Polyakov 已提交
603
	if ( s->d1->handshake_read_seq == frag->msg_header.seq)
A
Andy Polyakov 已提交
604
		{
D
Dr. Stephen Henson 已提交
605
		unsigned long frag_len = frag->msg_header.frag_len;
A
Andy Polyakov 已提交
606 607
		pqueue_pop(s->d1->buffered_messages);

A
Andy Polyakov 已提交
608 609 610 611
		al=dtls1_preprocess_fragment(s,&frag->msg_header,max);

		if (al==0) /* no alert */
			{
612
			unsigned char *p = (unsigned char *)s->init_buf->data+DTLS1_HM_HEADER_LENGTH;
A
Andy Polyakov 已提交
613 614 615
			memcpy(&p[frag->msg_header.frag_off],
				frag->fragment,frag->msg_header.frag_len);
			}
A
Andy Polyakov 已提交
616

A
Andy Polyakov 已提交
617
		dtls1_hm_fragment_free(frag);
A
Andy Polyakov 已提交
618 619
		pitem_free(item);

A
Andy Polyakov 已提交
620 621 622
		if (al==0)
			{
			*ok = 1;
D
Dr. Stephen Henson 已提交
623
			return frag_len;
A
Andy Polyakov 已提交
624 625 626 627 628 629
			}

		ssl3_send_alert(s,SSL3_AL_FATAL,al);
		s->init_num = 0;
		*ok = 0;
		return -1;
A
Andy Polyakov 已提交
630 631 632 633
		}
	else
		return 0;
	}
B
Ben Laurie 已提交
634

635 636 637 638 639 640 641 642 643 644
/* dtls1_max_handshake_message_len returns the maximum number of bytes
 * permitted in a DTLS handshake message for |s|. The minimum is 16KB, but may
 * be greater if the maximum certificate list size requires it. */
static unsigned long dtls1_max_handshake_message_len(const SSL *s)
	{
	unsigned long max_len = DTLS1_HM_HEADER_LENGTH + SSL3_RT_MAX_ENCRYPTED_LENGTH;
	if (max_len < (unsigned long)s->max_cert_list)
		return s->max_cert_list;
	return max_len;
	}
B
Ben Laurie 已提交
645

D
Dr. Stephen Henson 已提交
646
static int
A
Adam Langley 已提交
647
dtls1_reassemble_fragment(SSL *s, const struct hm_header_st* msg_hdr, int *ok)
D
Dr. Stephen Henson 已提交
648 649 650 651 652
	{
	hm_fragment *frag = NULL;
	pitem *item = NULL;
	int i = -1, is_complete;
	unsigned char seq64be[8];
653
	unsigned long frag_len = msg_hdr->frag_len;
D
Dr. Stephen Henson 已提交
654

655 656
	if ((msg_hdr->frag_off+frag_len) > msg_hdr->msg_len ||
	    msg_hdr->msg_len > dtls1_max_handshake_message_len(s))
D
Dr. Stephen Henson 已提交
657 658
		goto err;

659 660 661
	if (frag_len == 0)
		return DTLS1_HM_FRAGMENT_RETRY;

D
Dr. Stephen Henson 已提交
662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677
	/* Try to find item in queue */
	memset(seq64be,0,sizeof(seq64be));
	seq64be[6] = (unsigned char) (msg_hdr->seq>>8);
	seq64be[7] = (unsigned char) msg_hdr->seq;
	item = pqueue_find(s->d1->buffered_messages, seq64be);

	if (item == NULL)
		{
		frag = dtls1_hm_fragment_new(msg_hdr->msg_len, 1);
		if ( frag == NULL)
			goto err;
		memcpy(&(frag->msg_header), msg_hdr, sizeof(*msg_hdr));
		frag->msg_header.frag_len = frag->msg_header.msg_len;
		frag->msg_header.frag_off = 0;
		}
	else
D
Dr. Stephen Henson 已提交
678
		{
D
Dr. Stephen Henson 已提交
679
		frag = (hm_fragment*) item->data;
D
Dr. Stephen Henson 已提交
680 681 682 683 684 685 686 687
		if (frag->msg_header.msg_len != msg_hdr->msg_len)
			{
			item = NULL;
			frag = NULL;
			goto err;
			}
		}

D
Dr. Stephen Henson 已提交
688 689

	/* If message is already reassembled, this must be a
690 691
	 * retransmit and can be dropped. In this case item != NULL and so frag
	 * does not need to be freed.
D
Dr. Stephen Henson 已提交
692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710
	 */
	if (frag->reassembly == NULL)
		{
		unsigned char devnull [256];

		while (frag_len)
			{
			i = s->method->ssl_read_bytes(s,SSL3_RT_HANDSHAKE,
				devnull,
				frag_len>sizeof(devnull)?sizeof(devnull):frag_len,0);
			if (i<=0) goto err;
			frag_len -= i;
			}
		return DTLS1_HM_FRAGMENT_RETRY;
		}

	/* read the body of the fragment (header has already been read */
	i = s->method->ssl_read_bytes(s,SSL3_RT_HANDSHAKE,
		frag->fragment + msg_hdr->frag_off,frag_len,0);
711 712 713
	if ((unsigned long)i!=frag_len)
		i=-1;
	if (i<=0)
D
Dr. Stephen Henson 已提交
714 715
		goto err;

D
Dr. Stephen Henson 已提交
716 717
	RSMBLY_BITMASK_MARK(frag->reassembly, (long)msg_hdr->frag_off,
	                    (long)(msg_hdr->frag_off + frag_len));
D
Dr. Stephen Henson 已提交
718

D
Dr. Stephen Henson 已提交
719 720
	RSMBLY_BITMASK_IS_COMPLETE(frag->reassembly, (long)msg_hdr->msg_len,
	                           is_complete);
D
Dr. Stephen Henson 已提交
721 722 723 724 725 726 727 728 729 730 731 732 733

	if (is_complete)
		{
		OPENSSL_free(frag->reassembly);
		frag->reassembly = NULL;
		}

	if (item == NULL)
		{
		item = pitem_new(seq64be, frag);
		if (item == NULL)
			{
			i = -1;
S
Sami Farin 已提交
734
			goto err;
D
Dr. Stephen Henson 已提交
735 736
			}

737 738 739 740 741 742
		item = pqueue_insert(s->d1->buffered_messages, item);
		/* pqueue_insert fails iff a duplicate item is inserted.
		 * However, |item| cannot be a duplicate. If it were,
		 * |pqueue_find|, above, would have returned it and control
		 * would never have reached this branch. */
		OPENSSL_assert(item != NULL);
D
Dr. Stephen Henson 已提交
743 744 745 746 747
		}

	return DTLS1_HM_FRAGMENT_RETRY;

err:
748
	if (frag != NULL && item == NULL) dtls1_hm_fragment_free(frag);
D
Dr. Stephen Henson 已提交
749 750 751 752 753
	*ok = 0;
	return i;
	}


B
Ben Laurie 已提交
754
static int
A
Adam Langley 已提交
755
dtls1_process_out_of_seq_message(SSL *s, const struct hm_header_st* msg_hdr, int *ok)
B
Ben Laurie 已提交
756
{
A
Andy Polyakov 已提交
757
	int i=-1;
A
Andy Polyakov 已提交
758 759 760
	hm_fragment *frag = NULL;
	pitem *item = NULL;
	unsigned char seq64be[8];
A
Andy Polyakov 已提交
761
	unsigned long frag_len = msg_hdr->frag_len;
B
Ben Laurie 已提交
762

A
Andy Polyakov 已提交
763
	if ((msg_hdr->frag_off+frag_len) > msg_hdr->msg_len)
A
Andy Polyakov 已提交
764
		goto err;
B
Ben Laurie 已提交
765

D
Dr. Stephen Henson 已提交
766 767 768 769 770
	/* Try to find item in queue, to prevent duplicate entries */
	memset(seq64be,0,sizeof(seq64be));
	seq64be[6] = (unsigned char) (msg_hdr->seq>>8);
	seq64be[7] = (unsigned char) msg_hdr->seq;
	item = pqueue_find(s->d1->buffered_messages, seq64be);
D
Dr. Stephen Henson 已提交
771 772 773 774

	/* If we already have an entry and this one is a fragment,
	 * don't discard it and rather try to reassemble it.
	 */
A
Adam Langley 已提交
775
	if (item != NULL && frag_len != msg_hdr->msg_len)
D
Dr. Stephen Henson 已提交
776 777
		item = NULL;

D
Dr. Stephen Henson 已提交
778
	/* Discard the message if sequence number was already there, is
D
Dr. Stephen Henson 已提交
779 780 781 782
	 * too far in the future, already in the queue or if we received
	 * a FINISHED before the SERVER_HELLO, which then must be a stale
	 * retransmit.
	 */
D
Dr. Stephen Henson 已提交
783
	if (msg_hdr->seq <= s->d1->handshake_read_seq ||
D
Dr. Stephen Henson 已提交
784 785
		msg_hdr->seq > s->d1->handshake_read_seq + 10 || item != NULL ||
		(s->d1->handshake_read_seq == 0 && msg_hdr->type == SSL3_MT_FINISHED))
A
Andy Polyakov 已提交
786 787 788 789 790 791 792 793 794 795 796 797
		{
		unsigned char devnull [256];

		while (frag_len)
			{
			i = s->method->ssl_read_bytes(s,SSL3_RT_HANDSHAKE,
				devnull,
				frag_len>sizeof(devnull)?sizeof(devnull):frag_len,0);
			if (i<=0) goto err;
			frag_len -= i;
			}
		}
D
Dr. Stephen Henson 已提交
798
	else
A
Andy Polyakov 已提交
799
		{
A
Adam Langley 已提交
800
		if (frag_len != msg_hdr->msg_len)
D
Dr. Stephen Henson 已提交
801 802
			return dtls1_reassemble_fragment(s, msg_hdr, ok);

803 804 805
		if (frag_len > dtls1_max_handshake_message_len(s))
			goto err;

D
Dr. Stephen Henson 已提交
806
		frag = dtls1_hm_fragment_new(frag_len, 0);
D
Dr. Stephen Henson 已提交
807 808 809 810 811
		if ( frag == NULL)
			goto err;

		memcpy(&(frag->msg_header), msg_hdr, sizeof(*msg_hdr));

D
Dr. Stephen Henson 已提交
812 813 814 815 816
		if (frag_len)
			{
			/* read the body of the fragment (header has already been read */
			i = s->method->ssl_read_bytes(s,SSL3_RT_HANDSHAKE,
				frag->fragment,frag_len,0);
817 818 819
			if ((unsigned long)i!=frag_len)
				i = -1;
			if (i<=0)
D
Dr. Stephen Henson 已提交
820 821
				goto err;
			}
A
Andy Polyakov 已提交
822

D
Dr. Stephen Henson 已提交
823 824 825 826
		item = pitem_new(seq64be, frag);
		if ( item == NULL)
			goto err;

827 828 829 830 831 832 833 834 835
		item = pqueue_insert(s->d1->buffered_messages, item);
		/* pqueue_insert fails iff a duplicate item is inserted.
		 * However, |item| cannot be a duplicate. If it were,
		 * |pqueue_find|, above, would have returned it. Then, either
		 * |frag_len| != |msg_hdr->msg_len| in which case |item| is set
		 * to NULL and it will have been processed with
		 * |dtls1_reassemble_fragment|, above, or the record will have
		 * been discarded. */
		OPENSSL_assert(item != NULL);
D
Dr. Stephen Henson 已提交
836
		}
B
Ben Laurie 已提交
837

A
Andy Polyakov 已提交
838
	return DTLS1_HM_FRAGMENT_RETRY;
B
Ben Laurie 已提交
839 840

err:
841
	if (frag != NULL && item == NULL) dtls1_hm_fragment_free(frag);
A
Andy Polyakov 已提交
842
	*ok = 0;
A
Andy Polyakov 已提交
843
	return i;
A
Andy Polyakov 已提交
844
	}
B
Ben Laurie 已提交
845 846


B
Bodo Möller 已提交
847
static long
B
Ben Laurie 已提交
848 849
dtls1_get_message_fragment(SSL *s, int st1, int stn, long max, int *ok)
	{
A
Andy Polyakov 已提交
850
	unsigned char wire[DTLS1_HM_HEADER_LENGTH];
D
Dr. Stephen Henson 已提交
851
	unsigned long len, frag_off, frag_len;
B
Ben Laurie 已提交
852 853
	int i,al;
	struct hm_header_st msg_hdr;
A
Andy Polyakov 已提交
854

D
Dr. Stephen Henson 已提交
855
	redo:
A
Andy Polyakov 已提交
856
	/* see if we have the required fragment already */
A
Andy Polyakov 已提交
857 858
	if ((frag_len = dtls1_retrieve_buffered_fragment(s,max,ok)) || *ok)
		{
D
Dr. Stephen Henson 已提交
859
		if (*ok)	s->init_num = frag_len;
A
Andy Polyakov 已提交
860 861
		return frag_len;
		}
B
Ben Laurie 已提交
862

A
Andy Polyakov 已提交
863
	/* read handshake message header */
A
Andy Polyakov 已提交
864
	i=s->method->ssl_read_bytes(s,SSL3_RT_HANDSHAKE,wire,
B
Ben Laurie 已提交
865 866 867 868 869 870 871
		DTLS1_HM_HEADER_LENGTH, 0);
	if (i <= 0) 	/* nbio, or an error */
		{
		s->rwstate=SSL_READING;
		*ok = 0;
		return i;
		}
D
Dr. Stephen Henson 已提交
872 873 874 875 876 877 878
	/* Handshake fails if message header is incomplete */
	if (i != DTLS1_HM_HEADER_LENGTH)
		{
		al=SSL_AD_UNEXPECTED_MESSAGE;
		SSLerr(SSL_F_DTLS1_GET_MESSAGE_FRAGMENT,SSL_R_UNEXPECTED_MESSAGE);
		goto f_err;
		}
B
Ben Laurie 已提交
879

A
Andy Polyakov 已提交
880
	/* parse the message fragment header */
A
Andy Polyakov 已提交
881
	dtls1_get_message_header(wire, &msg_hdr);
A
Andy Polyakov 已提交
882 883 884

	/* 
	 * if this is a future (or stale) message it gets buffered
D
Dr. Stephen Henson 已提交
885 886 887
	 * (or dropped)--no further processing at this time
	 * While listening, we accept seq 1 (ClientHello with cookie)
	 * although we're still expecting seq 0 (ClientHello)
A
Andy Polyakov 已提交
888
	 */
D
Dr. Stephen Henson 已提交
889
	if (msg_hdr.seq != s->d1->handshake_read_seq && !(s->d1->listen && msg_hdr.seq == 1))
A
Andy Polyakov 已提交
890 891
		return dtls1_process_out_of_seq_message(s, &msg_hdr, ok);

D
Dr. Stephen Henson 已提交
892
	len = msg_hdr.msg_len;
A
Andy Polyakov 已提交
893
	frag_off = msg_hdr.frag_off;
B
Ben Laurie 已提交
894 895
	frag_len = msg_hdr.frag_len;

D
Dr. Stephen Henson 已提交
896 897 898
	if (frag_len && frag_len < len)
		return dtls1_reassemble_fragment(s, &msg_hdr, ok);

B
Ben Laurie 已提交
899
	if (!s->server && s->d1->r_msg_hdr.frag_off == 0 &&
A
Andy Polyakov 已提交
900
		wire[0] == SSL3_MT_HELLO_REQUEST)
A
Andy Polyakov 已提交
901 902 903 904 905
		{
		/* The server may always send 'Hello Request' messages --
		 * we are doing a handshake anyway now, so ignore them
		 * if their format is correct. Does not count for
		 * 'Finished' MAC. */
A
Andy Polyakov 已提交
906
		if (wire[1] == 0 && wire[2] == 0 && wire[3] == 0)
A
Andy Polyakov 已提交
907 908 909
			{
			if (s->msg_callback)
				s->msg_callback(0, s->version, SSL3_RT_HANDSHAKE, 
A
Andy Polyakov 已提交
910
					wire, DTLS1_HM_HEADER_LENGTH, s, 
A
Andy Polyakov 已提交
911 912 913
					s->msg_callback_arg);
			
			s->init_num = 0;
D
Dr. Stephen Henson 已提交
914
			goto redo;
A
Andy Polyakov 已提交
915 916 917 918 919 920 921 922 923
			}
		else /* Incorrectly formated Hello request */
			{
			al=SSL_AD_UNEXPECTED_MESSAGE;
			SSLerr(SSL_F_DTLS1_GET_MESSAGE_FRAGMENT,SSL_R_UNEXPECTED_MESSAGE);
			goto f_err;
			}
		}

A
Andy Polyakov 已提交
924
	if ((al=dtls1_preprocess_fragment(s,&msg_hdr,max)))
A
Andy Polyakov 已提交
925
		goto f_err;
B
Ben Laurie 已提交
926 927 928

	/* XDTLS:  ressurect this when restart is in place */
	s->state=stn;
A
Andy Polyakov 已提交
929

B
Ben Laurie 已提交
930 931
	if ( frag_len > 0)
		{
932
		unsigned char *p=(unsigned char *)s->init_buf->data+DTLS1_HM_HEADER_LENGTH;
A
Andy Polyakov 已提交
933

B
Ben Laurie 已提交
934
		i=s->method->ssl_read_bytes(s,SSL3_RT_HANDSHAKE,
A
Andy Polyakov 已提交
935
			&p[frag_off],frag_len,0);
A
Andy Polyakov 已提交
936
		/* XDTLS:  fix this--message fragments cannot span multiple packets */
B
Ben Laurie 已提交
937 938 939 940 941 942 943 944 945 946
		if (i <= 0)
			{
			s->rwstate=SSL_READING;
			*ok = 0;
			return i;
			}
		}
	else
		i = 0;

A
Andy Polyakov 已提交
947 948
	/* XDTLS:  an incorrectly formatted fragment should cause the 
	 * handshake to fail */
D
Dr. Stephen Henson 已提交
949 950 951 952 953 954
	if (i != (int)frag_len)
		{
		al=SSL3_AD_ILLEGAL_PARAMETER;
		SSLerr(SSL_F_DTLS1_GET_MESSAGE_FRAGMENT,SSL3_AD_ILLEGAL_PARAMETER);
		goto f_err;
		}
B
Ben Laurie 已提交
955

A
Andy Polyakov 已提交
956
	*ok = 1;
B
Ben Laurie 已提交
957

A
Andy Polyakov 已提交
958 959 960 961
	/* Note that s->init_num is *not* used as current offset in
	 * s->init_buf->data, but as a counter summing up fragments'
	 * lengths: as soon as they sum up to handshake packet
	 * length, we assume we have got all the fragments. */
D
Dr. Stephen Henson 已提交
962
	s->init_num = frag_len;
A
Andy Polyakov 已提交
963
	return frag_len;
B
Ben Laurie 已提交
964 965 966

f_err:
	ssl3_send_alert(s,SSL3_AL_FATAL,al);
A
Andy Polyakov 已提交
967
	s->init_num = 0;
A
Andy Polyakov 已提交
968

B
Ben Laurie 已提交
969 970 971 972
	*ok=0;
	return(-1);
	}

973 974
/*-
 * for these 2 messages, we need to
B
Ben Laurie 已提交
975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991
 * ssl->enc_read_ctx			re-init
 * ssl->s3->read_sequence		zero
 * ssl->s3->read_mac_secret		re-init
 * ssl->session->read_sym_enc		assign
 * ssl->session->read_compression	assign
 * ssl->session->read_hash		assign
 */
int dtls1_send_change_cipher_spec(SSL *s, int a, int b)
	{ 
	unsigned char *p;

	if (s->state == a)
		{
		p=(unsigned char *)s->init_buf->data;
		*p++=SSL3_MT_CCS;
		s->d1->handshake_write_seq = s->d1->next_handshake_write_seq;
		s->init_num=DTLS1_CCS_HEADER_LENGTH;
992 993 994 995 996 997 998

		if (s->version == DTLS1_BAD_VER) {
			s->d1->next_handshake_write_seq++;
			s2n(s->d1->handshake_write_seq,p);
			s->init_num+=2;
		}

B
Ben Laurie 已提交
999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014
		s->init_off=0;

		dtls1_set_message_header_int(s, SSL3_MT_CCS, 0, 
			s->d1->handshake_write_seq, 0, 0);

		/* buffer the message to handle re-xmits */
		dtls1_buffer_message(s, 1);

		s->state=b;
		}

	/* SSL3_ST_CW_CHANGE_B */
	return(dtls1_do_write(s,SSL3_RT_CHANGE_CIPHER_SPEC));
	}

int dtls1_read_failed(SSL *s, int code)
A
Andy Polyakov 已提交
1015 1016 1017 1018 1019 1020 1021
	{
	if ( code > 0)
		{
		fprintf( stderr, "invalid state reached %s:%d", __FILE__, __LINE__);
		return 1;
		}

D
Dr. Stephen Henson 已提交
1022
	if (!dtls1_is_timer_expired(s))
A
Andy Polyakov 已提交
1023 1024 1025 1026 1027 1028
		{
		/* not a timeout, none of our business, 
		   let higher layers handle this.  in fact it's probably an error */
		return code;
		}

D
Dr. Stephen Henson 已提交
1029
#ifndef OPENSSL_NO_HEARTBEATS
1030 1031
	/* done, no need to send a retransmit */
	if (!SSL_in_init(s) && !s->tlsext_hb_pending)
D
Dr. Stephen Henson 已提交
1032
#else
1033 1034
	/* done, no need to send a retransmit */
	if (!SSL_in_init(s))
D
Dr. Stephen Henson 已提交
1035
#endif
A
Andy Polyakov 已提交
1036 1037 1038 1039 1040
		{
		BIO_set_flags(SSL_get_rbio(s), BIO_FLAGS_READ);
		return code;
		}

B
Ben Laurie 已提交
1041
#if 0 /* for now, each alert contains only one record number */
A
Andy Polyakov 已提交
1042 1043 1044 1045 1046 1047
	item = pqueue_peek(state->rcvd_records);
	if ( item )
		{
		/* send an alert immediately for all the missing records */
		}
	else
B
Ben Laurie 已提交
1048 1049 1050
#endif

#if 0  /* no more alert sending, just retransmit the last set of messages */
D
Dr. Stephen Henson 已提交
1051 1052 1053
	if ( state->timeout.read_timeouts >= DTLS1_TMO_READ_COUNT)
		ssl3_send_alert(s,SSL3_AL_WARNING,
			DTLS1_AD_MISSING_HANDSHAKE_MESSAGE);
B
Ben Laurie 已提交
1054 1055
#endif

D
Dr. Stephen Henson 已提交
1056
	return dtls1_handle_timeout(s);
A
Andy Polyakov 已提交
1057
	}
B
Ben Laurie 已提交
1058

D
Dr. Stephen Henson 已提交
1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071
int
dtls1_get_queue_priority(unsigned short seq, int is_ccs)
	{
	/* The index of the retransmission queue actually is the message sequence number,
	 * since the queue only contains messages of a single handshake. However, the
	 * ChangeCipherSpec has no message sequence number and so using only the sequence
	 * will result in the CCS and Finished having the same index. To prevent this,
	 * the sequence number is multiplied by 2. In case of a CCS 1 is subtracted.
	 * This does not only differ CSS and Finished, it also maintains the order of the
	 * index (important for priority queues) and fits in the unsigned short variable.
	 */	
	return seq * 2 - is_ccs;
	}
B
Ben Laurie 已提交
1072

D
Dr. Stephen Henson 已提交
1073
int
B
Ben Laurie 已提交
1074
dtls1_retransmit_buffered_messages(SSL *s)
A
Andy Polyakov 已提交
1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086
	{
	pqueue sent = s->d1->sent_messages;
	piterator iter;
	pitem *item;
	hm_fragment *frag;
	int found = 0;

	iter = pqueue_iterator(sent);

	for ( item = pqueue_next(&iter); item != NULL; item = pqueue_next(&iter))
		{
		frag = (hm_fragment *)item->data;
D
Dr. Stephen Henson 已提交
1087
			if ( dtls1_retransmit_message(s,
1088
				(unsigned short)dtls1_get_queue_priority(frag->msg_header.seq, frag->msg_header.is_ccs),
D
Dr. Stephen Henson 已提交
1089
				0, &found) <= 0 && found)
A
Andy Polyakov 已提交
1090 1091 1092 1093 1094 1095 1096 1097
			{
			fprintf(stderr, "dtls1_retransmit_message() failed\n");
			return -1;
			}
		}

	return 1;
	}
B
Ben Laurie 已提交
1098 1099 1100

int
dtls1_buffer_message(SSL *s, int is_ccs)
A
Andy Polyakov 已提交
1101 1102 1103 1104 1105 1106 1107 1108 1109
	{
	pitem *item;
	hm_fragment *frag;
	unsigned char seq64be[8];

	/* this function is called immediately after a message has 
	 * been serialized */
	OPENSSL_assert(s->init_off == 0);

D
Dr. Stephen Henson 已提交
1110
	frag = dtls1_hm_fragment_new(s->init_num, 0);
D
Dr. Stephen Henson 已提交
1111 1112
	if (!frag)
		return 0;
A
Andy Polyakov 已提交
1113 1114 1115 1116 1117 1118

	memcpy(frag->fragment, s->init_buf->data, s->init_num);

	if ( is_ccs)
		{
		OPENSSL_assert(s->d1->w_msg_hdr.msg_len + 
1119
			       DTLS1_CCS_HEADER_LENGTH == (unsigned int)s->init_num);
A
Andy Polyakov 已提交
1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133
		}
	else
		{
		OPENSSL_assert(s->d1->w_msg_hdr.msg_len + 
			DTLS1_HM_HEADER_LENGTH == (unsigned int)s->init_num);
		}

	frag->msg_header.msg_len = s->d1->w_msg_hdr.msg_len;
	frag->msg_header.seq = s->d1->w_msg_hdr.seq;
	frag->msg_header.type = s->d1->w_msg_hdr.type;
	frag->msg_header.frag_off = 0;
	frag->msg_header.frag_len = s->d1->w_msg_hdr.msg_len;
	frag->msg_header.is_ccs = is_ccs;

D
Dr. Stephen Henson 已提交
1134 1135 1136 1137 1138 1139 1140
	/* save current state*/
	frag->msg_header.saved_retransmit_state.enc_write_ctx = s->enc_write_ctx;
	frag->msg_header.saved_retransmit_state.write_hash = s->write_hash;
	frag->msg_header.saved_retransmit_state.compress = s->compress;
	frag->msg_header.saved_retransmit_state.session = s->session;
	frag->msg_header.saved_retransmit_state.epoch = s->d1->w_epoch;
	
A
Andy Polyakov 已提交
1141
	memset(seq64be,0,sizeof(seq64be));
D
Dr. Stephen Henson 已提交
1142 1143 1144 1145
	seq64be[6] = (unsigned char)(dtls1_get_queue_priority(frag->msg_header.seq,
														  frag->msg_header.is_ccs)>>8);
	seq64be[7] = (unsigned char)(dtls1_get_queue_priority(frag->msg_header.seq,
														  frag->msg_header.is_ccs));
A
Andy Polyakov 已提交
1146 1147 1148 1149 1150 1151 1152

	item = pitem_new(seq64be, frag);
	if ( item == NULL)
		{
		dtls1_hm_fragment_free(frag);
		return 0;
		}
B
Ben Laurie 已提交
1153 1154

#if 0
A
Andy Polyakov 已提交
1155 1156 1157
	fprintf( stderr, "buffered messge: \ttype = %xx\n", msg_buf->type);
	fprintf( stderr, "\t\t\t\t\tlen = %d\n", msg_buf->len);
	fprintf( stderr, "\t\t\t\t\tseq_num = %d\n", msg_buf->seq_num);
B
Ben Laurie 已提交
1158 1159
#endif

A
Andy Polyakov 已提交
1160 1161 1162
	pqueue_insert(s->d1->sent_messages, item);
	return 1;
	}
B
Ben Laurie 已提交
1163 1164 1165

int
dtls1_retransmit_message(SSL *s, unsigned short seq, unsigned long frag_off,
A
Andy Polyakov 已提交
1166 1167 1168 1169 1170 1171 1172 1173
	int *found)
	{
	int ret;
	/* XDTLS: for now assuming that read/writes are blocking */
	pitem *item;
	hm_fragment *frag ;
	unsigned long header_length;
	unsigned char seq64be[8];
D
Dr. Stephen Henson 已提交
1174 1175
	struct dtls1_retransmit_state saved_state;
	unsigned char save_write_sequence[8];
A
Andy Polyakov 已提交
1176

1177
	/*-
A
Andy Polyakov 已提交
1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210
	  OPENSSL_assert(s->init_num == 0);
	  OPENSSL_assert(s->init_off == 0);
	 */

	/* XDTLS:  the requested message ought to be found, otherwise error */
	memset(seq64be,0,sizeof(seq64be));
	seq64be[6] = (unsigned char)(seq>>8);
	seq64be[7] = (unsigned char)seq;

	item = pqueue_find(s->d1->sent_messages, seq64be);
	if ( item == NULL)
		{
		fprintf(stderr, "retransmit:  message %d non-existant\n", seq);
		*found = 0;
		return 0;
		}

	*found = 1;
	frag = (hm_fragment *)item->data;

	if ( frag->msg_header.is_ccs)
		header_length = DTLS1_CCS_HEADER_LENGTH;
	else
		header_length = DTLS1_HM_HEADER_LENGTH;

	memcpy(s->init_buf->data, frag->fragment, 
		frag->msg_header.msg_len + header_length);
		s->init_num = frag->msg_header.msg_len + header_length;

	dtls1_set_message_header_int(s, frag->msg_header.type, 
		frag->msg_header.msg_len, frag->msg_header.seq, 0, 
		frag->msg_header.frag_len);

D
Dr. Stephen Henson 已提交
1211 1212 1213 1214 1215 1216 1217 1218
	/* save current state */
	saved_state.enc_write_ctx = s->enc_write_ctx;
	saved_state.write_hash = s->write_hash;
	saved_state.compress = s->compress;
	saved_state.session = s->session;
	saved_state.epoch = s->d1->w_epoch;
	saved_state.epoch = s->d1->w_epoch;
	
A
Andy Polyakov 已提交
1219
	s->d1->retransmitting = 1;
D
Dr. Stephen Henson 已提交
1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233
	
	/* restore state in which the message was originally sent */
	s->enc_write_ctx = frag->msg_header.saved_retransmit_state.enc_write_ctx;
	s->write_hash = frag->msg_header.saved_retransmit_state.write_hash;
	s->compress = frag->msg_header.saved_retransmit_state.compress;
	s->session = frag->msg_header.saved_retransmit_state.session;
	s->d1->w_epoch = frag->msg_header.saved_retransmit_state.epoch;
	
	if (frag->msg_header.saved_retransmit_state.epoch == saved_state.epoch - 1)
	{
		memcpy(save_write_sequence, s->s3->write_sequence, sizeof(s->s3->write_sequence));
		memcpy(s->s3->write_sequence, s->d1->last_write_sequence, sizeof(s->s3->write_sequence));
	}
	
A
Andy Polyakov 已提交
1234
	ret = dtls1_do_write(s, frag->msg_header.is_ccs ? 
D
Dr. Stephen Henson 已提交
1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249
						 SSL3_RT_CHANGE_CIPHER_SPEC : SSL3_RT_HANDSHAKE);
	
	/* restore current state */
	s->enc_write_ctx = saved_state.enc_write_ctx;
	s->write_hash = saved_state.write_hash;
	s->compress = saved_state.compress;
	s->session = saved_state.session;
	s->d1->w_epoch = saved_state.epoch;
	
	if (frag->msg_header.saved_retransmit_state.epoch == saved_state.epoch - 1)
	{
		memcpy(s->d1->last_write_sequence, s->s3->write_sequence, sizeof(s->s3->write_sequence));
		memcpy(s->s3->write_sequence, save_write_sequence, sizeof(s->s3->write_sequence));
	}

A
Andy Polyakov 已提交
1250 1251 1252 1253 1254
	s->d1->retransmitting = 0;

	(void)BIO_flush(SSL_get_wbio(s));
	return ret;
	}
B
Ben Laurie 已提交
1255 1256 1257 1258

/* call this function when the buffered messages are no longer needed */
void
dtls1_clear_record_buffer(SSL *s)
A
Andy Polyakov 已提交
1259 1260 1261 1262 1263 1264 1265 1266 1267 1268
	{
	pitem *item;

	for(item = pqueue_pop(s->d1->sent_messages);
		item != NULL; item = pqueue_pop(s->d1->sent_messages))
		{
		dtls1_hm_fragment_free((hm_fragment *)item->data);
		pitem_free(item);
		}
	}
B
Ben Laurie 已提交
1269 1270 1271 1272


unsigned char *
dtls1_set_message_header(SSL *s, unsigned char *p, unsigned char mt,
A
Andy Polyakov 已提交
1273 1274
			unsigned long len, unsigned long frag_off, unsigned long frag_len)
	{
D
Dr. Stephen Henson 已提交
1275 1276
	/* Don't change sequence numbers while listening */
	if (frag_off == 0 && !s->d1->listen)
A
Andy Polyakov 已提交
1277 1278 1279 1280 1281 1282 1283 1284 1285 1286
		{
		s->d1->handshake_write_seq = s->d1->next_handshake_write_seq;
		s->d1->next_handshake_write_seq++;
		}

	dtls1_set_message_header_int(s, mt, len, s->d1->handshake_write_seq,
		frag_off, frag_len);

	return p += DTLS1_HM_HEADER_LENGTH;
	}
B
Ben Laurie 已提交
1287 1288 1289 1290 1291


/* don't actually do the writing, wait till the MTU has been retrieved */
static void
dtls1_set_message_header_int(SSL *s, unsigned char mt,
A
Andy Polyakov 已提交
1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302
			    unsigned long len, unsigned short seq_num, unsigned long frag_off,
			    unsigned long frag_len)
	{
	struct hm_header_st *msg_hdr = &s->d1->w_msg_hdr;

	msg_hdr->type = mt;
	msg_hdr->msg_len = len;
	msg_hdr->seq = seq_num;
	msg_hdr->frag_off = frag_off;
	msg_hdr->frag_len = frag_len;
	}
B
Ben Laurie 已提交
1303 1304 1305

static void
dtls1_fix_message_header(SSL *s, unsigned long frag_off,
A
Andy Polyakov 已提交
1306 1307 1308 1309 1310 1311 1312
			unsigned long frag_len)
	{
	struct hm_header_st *msg_hdr = &s->d1->w_msg_hdr;

	msg_hdr->frag_off = frag_off;
	msg_hdr->frag_len = frag_len;
	}
B
Ben Laurie 已提交
1313 1314 1315

static unsigned char *
dtls1_write_message_header(SSL *s, unsigned char *p)
A
Andy Polyakov 已提交
1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327
	{
	struct hm_header_st *msg_hdr = &s->d1->w_msg_hdr;

	*p++ = msg_hdr->type;
	l2n3(msg_hdr->msg_len, p);

	s2n(msg_hdr->seq, p);
	l2n3(msg_hdr->frag_off, p);
	l2n3(msg_hdr->frag_len, p);

	return p;
	}
B
Ben Laurie 已提交
1328

1329 1330
unsigned int
dtls1_link_min_mtu(void)
A
Andy Polyakov 已提交
1331 1332 1333 1334
	{
	return (g_probable_mtu[(sizeof(g_probable_mtu) / 
		sizeof(g_probable_mtu[0])) - 1]);
	}
B
Ben Laurie 已提交
1335

1336 1337
unsigned int
dtls1_min_mtu(SSL *s)
B
Ben Laurie 已提交
1338
	{
1339 1340
	return dtls1_link_min_mtu()-BIO_dgram_get_mtu_overhead(SSL_get_wbio(s));
	}
B
Ben Laurie 已提交
1341 1342 1343 1344


void
dtls1_get_message_header(unsigned char *data, struct hm_header_st *msg_hdr)
A
Andy Polyakov 已提交
1345 1346 1347 1348 1349 1350 1351 1352 1353
	{
	memset(msg_hdr, 0x00, sizeof(struct hm_header_st));
	msg_hdr->type = *(data++);
	n2l3(data, msg_hdr->msg_len);

	n2s(data, msg_hdr->seq);
	n2l3(data, msg_hdr->frag_off);
	n2l3(data, msg_hdr->frag_len);
	}
B
Ben Laurie 已提交
1354 1355 1356

void
dtls1_get_ccs_header(unsigned char *data, struct ccs_header_st *ccs_hdr)
A
Andy Polyakov 已提交
1357 1358 1359 1360 1361
	{
	memset(ccs_hdr, 0x00, sizeof(struct ccs_header_st));

	ccs_hdr->type = *(data++);
	}
D
Dr. Stephen Henson 已提交
1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382

int dtls1_shutdown(SSL *s)
	{
	int ret;
#ifndef OPENSSL_NO_SCTP
	if (BIO_dgram_is_sctp(SSL_get_wbio(s)) &&
	    !(s->shutdown & SSL_SENT_SHUTDOWN))
		{
		ret = BIO_dgram_sctp_wait_for_dry(SSL_get_wbio(s));
		if (ret < 0) return -1;

		if (ret == 0)
			BIO_ctrl(SSL_get_wbio(s), BIO_CTRL_DGRAM_SCTP_SAVE_SHUTDOWN, 1, NULL);
		}
#endif
	ret = ssl3_shutdown(s);
#ifndef OPENSSL_NO_SCTP
	BIO_ctrl(SSL_get_wbio(s), BIO_CTRL_DGRAM_SCTP_SAVE_SHUTDOWN, 0, NULL);
#endif
	return ret;
	}
D
Dr. Stephen Henson 已提交
1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397

#ifndef OPENSSL_NO_HEARTBEATS
int
dtls1_process_heartbeat(SSL *s)
	{
	unsigned char *p = &s->s3->rrec.data[0], *pl;
	unsigned short hbtype;
	unsigned int payload;
	unsigned int padding = 16; /* Use minimum padding */

	if (s->msg_callback)
		s->msg_callback(0, s->version, TLS1_RT_HEARTBEAT,
			&s->s3->rrec.data[0], s->s3->rrec.length,
			s, s->msg_callback_arg);

1398 1399 1400
	/* Read type and payload length first */
	if (1 + 2 + 16 > s->s3->rrec.length)
		return 0; /* silently discard */
1401 1402 1403
	if (s->s3->rrec.length > SSL3_RT_MAX_PLAIN_LENGTH)
		return 0; /* silently discard per RFC 6520 sec. 4 */

1404 1405 1406 1407 1408 1409
	hbtype = *p++;
	n2s(p, payload);
	if (1 + 2 + payload + 16 > s->s3->rrec.length)
		return 0; /* silently discard per RFC 6520 sec. 4 */
	pl = p;

D
Dr. Stephen Henson 已提交
1410 1411 1412
	if (hbtype == TLS1_HB_REQUEST)
		{
		unsigned char *buffer, *bp;
1413 1414 1415
		unsigned int write_length = 1 /* heartbeat type */ +
					    2 /* heartbeat length */ +
					    payload + padding;
D
Dr. Stephen Henson 已提交
1416 1417
		int r;

1418 1419 1420
		if (write_length > SSL3_RT_MAX_PLAIN_LENGTH)
			return 0;

D
Dr. Stephen Henson 已提交
1421 1422 1423 1424
		/* Allocate memory for the response, size is 1 byte
		 * message type, plus 2 bytes payload length, plus
		 * payload, plus padding
		 */
1425
		buffer = OPENSSL_malloc(write_length);
1426 1427
		if (buffer == NULL)
			return -1;
D
Dr. Stephen Henson 已提交
1428 1429 1430 1431 1432 1433
		bp = buffer;

		/* Enter response type, length and copy payload */
		*bp++ = TLS1_HB_RESPONSE;
		s2n(payload, bp);
		memcpy(bp, pl, payload);
D
Dr. Stephen Henson 已提交
1434
		bp += payload;
D
Dr. Stephen Henson 已提交
1435
		/* Random padding */
D
Dr. Stephen Henson 已提交
1436
		RAND_pseudo_bytes(bp, padding);
D
Dr. Stephen Henson 已提交
1437

1438
		r = dtls1_write_bytes(s, TLS1_RT_HEARTBEAT, buffer, write_length);
D
Dr. Stephen Henson 已提交
1439 1440 1441

		if (r >= 0 && s->msg_callback)
			s->msg_callback(1, s->version, TLS1_RT_HEARTBEAT,
1442
				buffer, write_length,
D
Dr. Stephen Henson 已提交
1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504
				s, s->msg_callback_arg);

		OPENSSL_free(buffer);

		if (r < 0)
			return r;
		}
	else if (hbtype == TLS1_HB_RESPONSE)
		{
		unsigned int seq;

		/* We only send sequence numbers (2 bytes unsigned int),
		 * and 16 random bytes, so we just try to read the
		 * sequence number */
		n2s(pl, seq);

		if (payload == 18 && seq == s->tlsext_hb_seq)
			{
			dtls1_stop_timer(s);
			s->tlsext_hb_seq++;
			s->tlsext_hb_pending = 0;
			}
		}

	return 0;
	}

int
dtls1_heartbeat(SSL *s)
	{
	unsigned char *buf, *p;
	int ret;
	unsigned int payload = 18; /* Sequence number + random bytes */
	unsigned int padding = 16; /* Use minimum padding */

	/* Only send if peer supports and accepts HB requests... */
	if (!(s->tlsext_heartbeat & SSL_TLSEXT_HB_ENABLED) ||
	    s->tlsext_heartbeat & SSL_TLSEXT_HB_DONT_SEND_REQUESTS)
		{
		SSLerr(SSL_F_DTLS1_HEARTBEAT,SSL_R_TLS_HEARTBEAT_PEER_DOESNT_ACCEPT);
		return -1;
		}

	/* ...and there is none in flight yet... */
	if (s->tlsext_hb_pending)
		{
		SSLerr(SSL_F_DTLS1_HEARTBEAT,SSL_R_TLS_HEARTBEAT_PENDING);
		return -1;
		}

	/* ...and no handshake in progress. */
	if (SSL_in_init(s) || s->in_handshake)
		{
		SSLerr(SSL_F_DTLS1_HEARTBEAT,SSL_R_UNEXPECTED_MESSAGE);
		return -1;
		}

	/* Check if padding is too long, payload and padding
	 * must not exceed 2^14 - 3 = 16381 bytes in total.
	 */
	OPENSSL_assert(payload + padding <= 16381);

1505 1506
	/*-
	 * Create HeartBeat message, we just use a sequence number
D
Dr. Stephen Henson 已提交
1507 1508 1509 1510 1511 1512 1513 1514 1515
	 * as payload to distuingish different messages and add
	 * some random stuff.
	 *  - Message Type, 1 byte
	 *  - Payload Length, 2 bytes (unsigned int)
	 *  - Payload, the sequence number (2 bytes uint)
	 *  - Payload, random bytes (16 bytes uint)
	 *  - Padding
	 */
	buf = OPENSSL_malloc(1 + 2 + payload + padding);
1516 1517 1518 1519 1520
	if (buf == NULL)
		{
		SSLerr(SSL_F_DTLS1_HEARTBEAT, ERR_R_MALLOC_FAILURE);
		return -1;
		}
D
Dr. Stephen Henson 已提交
1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550
	p = buf;
	/* Message Type */
	*p++ = TLS1_HB_REQUEST;
	/* Payload length (18 bytes here) */
	s2n(payload, p);
	/* Sequence number */
	s2n(s->tlsext_hb_seq, p);
	/* 16 random bytes */
	RAND_pseudo_bytes(p, 16);
	p += 16;
	/* Random padding */
	RAND_pseudo_bytes(p, padding);

	ret = dtls1_write_bytes(s, TLS1_RT_HEARTBEAT, buf, 3 + payload + padding);
	if (ret >= 0)
		{
		if (s->msg_callback)
			s->msg_callback(1, s->version, TLS1_RT_HEARTBEAT,
				buf, 3 + payload + padding,
				s, s->msg_callback_arg);

		dtls1_start_timer(s);
		s->tlsext_hb_pending = 1;
		}

	OPENSSL_free(buf);

	return ret;
	}
#endif