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 484 485 486 487
	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 ||
		i == DTLS1_HM_FRAGMENT_RETRY)  /* bad fragment received */
		goto again;
	else if ( i <= 0 && !*ok)
		return i;
B
Ben Laurie 已提交
488

D
Dr. Stephen Henson 已提交
489 490 491 492 493 494 495 496 497 498 499 500 501
	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 已提交
502

D
Dr. Stephen Henson 已提交
503 504 505 506 507 508 509 510
	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 已提交
511 512 513 514
	/* Don't change sequence numbers while listening */
	if (!s->d1->listen)
		s->d1->handshake_read_seq++;

D
Dr. Stephen Henson 已提交
515 516
	s->init_msg = s->init_buf->data + DTLS1_HM_HEADER_LENGTH;
	return s->init_num;
B
Ben Laurie 已提交
517 518 519 520 521 522 523 524

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


A
Andy Polyakov 已提交
525 526 527 528 529 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
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 已提交
574
static int
A
Andy Polyakov 已提交
575
dtls1_retrieve_buffered_fragment(SSL *s, long max, int *ok)
A
Andy Polyakov 已提交
576 577 578 579 580 581 582 583
	{
	/* (0) check whether the desired fragment is available
	 * 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 已提交
584
	int al;
A
Andy Polyakov 已提交
585

A
Andy Polyakov 已提交
586
	*ok = 0;
A
Andy Polyakov 已提交
587 588 589 590 591
	item = pqueue_peek(s->d1->buffered_messages);
	if ( item == NULL)
		return 0;

	frag = (hm_fragment *)item->data;
D
Dr. Stephen Henson 已提交
592 593 594 595
	
	/* Don't return if reassembly still in progress */
	if (frag->reassembly != NULL)
		return 0;
A
Andy Polyakov 已提交
596

A
Andy Polyakov 已提交
597
	if ( s->d1->handshake_read_seq == frag->msg_header.seq)
A
Andy Polyakov 已提交
598
		{
D
Dr. Stephen Henson 已提交
599
		unsigned long frag_len = frag->msg_header.frag_len;
A
Andy Polyakov 已提交
600 601
		pqueue_pop(s->d1->buffered_messages);

A
Andy Polyakov 已提交
602 603 604 605
		al=dtls1_preprocess_fragment(s,&frag->msg_header,max);

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

A
Andy Polyakov 已提交
611
		dtls1_hm_fragment_free(frag);
A
Andy Polyakov 已提交
612 613
		pitem_free(item);

A
Andy Polyakov 已提交
614 615 616
		if (al==0)
			{
			*ok = 1;
D
Dr. Stephen Henson 已提交
617
			return frag_len;
A
Andy Polyakov 已提交
618 619 620 621 622 623
			}

		ssl3_send_alert(s,SSL3_AL_FATAL,al);
		s->init_num = 0;
		*ok = 0;
		return -1;
A
Andy Polyakov 已提交
624 625 626 627
		}
	else
		return 0;
	}
B
Ben Laurie 已提交
628

629 630 631 632 633 634 635 636 637 638
/* 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 已提交
639

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

649 650
	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 已提交
651 652
		goto err;

653 654 655
	if (frag_len == 0)
		return DTLS1_HM_FRAGMENT_RETRY;

D
Dr. Stephen Henson 已提交
656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671
	/* 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 已提交
672
		{
D
Dr. Stephen Henson 已提交
673
		frag = (hm_fragment*) item->data;
D
Dr. Stephen Henson 已提交
674 675 676 677 678 679 680 681
		if (frag->msg_header.msg_len != msg_hdr->msg_len)
			{
			item = NULL;
			frag = NULL;
			goto err;
			}
		}

D
Dr. Stephen Henson 已提交
682 683

	/* If message is already reassembled, this must be a
684 685
	 * retransmit and can be dropped. In this case item != NULL and so frag
	 * does not need to be freed.
D
Dr. Stephen Henson 已提交
686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704
	 */
	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);
705 706 707
	if ((unsigned long)i!=frag_len)
		i=-1;
	if (i<=0)
D
Dr. Stephen Henson 已提交
708 709
		goto err;

D
Dr. Stephen Henson 已提交
710 711
	RSMBLY_BITMASK_MARK(frag->reassembly, (long)msg_hdr->frag_off,
	                    (long)(msg_hdr->frag_off + frag_len));
D
Dr. Stephen Henson 已提交
712

D
Dr. Stephen Henson 已提交
713 714
	RSMBLY_BITMASK_IS_COMPLETE(frag->reassembly, (long)msg_hdr->msg_len,
	                           is_complete);
D
Dr. Stephen Henson 已提交
715 716 717 718 719 720 721 722 723 724 725 726 727

	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 已提交
728
			goto err;
D
Dr. Stephen Henson 已提交
729 730
			}

731 732 733 734 735 736
		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 已提交
737 738 739 740 741
		}

	return DTLS1_HM_FRAGMENT_RETRY;

err:
742
	if (frag != NULL && item == NULL) dtls1_hm_fragment_free(frag);
D
Dr. Stephen Henson 已提交
743 744 745 746 747
	*ok = 0;
	return i;
	}


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

A
Andy Polyakov 已提交
757
	if ((msg_hdr->frag_off+frag_len) > msg_hdr->msg_len)
A
Andy Polyakov 已提交
758
		goto err;
B
Ben Laurie 已提交
759

D
Dr. Stephen Henson 已提交
760 761 762 763 764
	/* 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 已提交
765 766 767 768

	/* 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 已提交
769
	if (item != NULL && frag_len != msg_hdr->msg_len)
D
Dr. Stephen Henson 已提交
770 771
		item = NULL;

D
Dr. Stephen Henson 已提交
772
	/* Discard the message if sequence number was already there, is
D
Dr. Stephen Henson 已提交
773 774 775 776
	 * 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 已提交
777
	if (msg_hdr->seq <= s->d1->handshake_read_seq ||
D
Dr. Stephen Henson 已提交
778 779
		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 已提交
780 781 782 783 784 785 786 787 788 789 790 791
		{
		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 已提交
792
	else
A
Andy Polyakov 已提交
793
		{
A
Adam Langley 已提交
794
		if (frag_len != msg_hdr->msg_len)
D
Dr. Stephen Henson 已提交
795 796
			return dtls1_reassemble_fragment(s, msg_hdr, ok);

797 798 799
		if (frag_len > dtls1_max_handshake_message_len(s))
			goto err;

D
Dr. Stephen Henson 已提交
800
		frag = dtls1_hm_fragment_new(frag_len, 0);
D
Dr. Stephen Henson 已提交
801 802 803 804 805
		if ( frag == NULL)
			goto err;

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

D
Dr. Stephen Henson 已提交
806 807 808 809 810
		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);
811 812 813
			if ((unsigned long)i!=frag_len)
				i = -1;
			if (i<=0)
D
Dr. Stephen Henson 已提交
814 815
				goto err;
			}
A
Andy Polyakov 已提交
816

D
Dr. Stephen Henson 已提交
817 818 819 820
		item = pitem_new(seq64be, frag);
		if ( item == NULL)
			goto err;

821 822 823 824 825 826 827 828 829
		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 已提交
830
		}
B
Ben Laurie 已提交
831

A
Andy Polyakov 已提交
832
	return DTLS1_HM_FRAGMENT_RETRY;
B
Ben Laurie 已提交
833 834

err:
835
	if (frag != NULL && item == NULL) dtls1_hm_fragment_free(frag);
A
Andy Polyakov 已提交
836
	*ok = 0;
A
Andy Polyakov 已提交
837
	return i;
A
Andy Polyakov 已提交
838
	}
B
Ben Laurie 已提交
839 840


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

D
Dr. Stephen Henson 已提交
849
	redo:
A
Andy Polyakov 已提交
850
	/* see if we have the required fragment already */
A
Andy Polyakov 已提交
851 852
	if ((frag_len = dtls1_retrieve_buffered_fragment(s,max,ok)) || *ok)
		{
D
Dr. Stephen Henson 已提交
853
		if (*ok)	s->init_num = frag_len;
A
Andy Polyakov 已提交
854 855
		return frag_len;
		}
B
Ben Laurie 已提交
856

A
Andy Polyakov 已提交
857
	/* read handshake message header */
A
Andy Polyakov 已提交
858
	i=s->method->ssl_read_bytes(s,SSL3_RT_HANDSHAKE,wire,
B
Ben Laurie 已提交
859 860 861 862 863 864 865
		DTLS1_HM_HEADER_LENGTH, 0);
	if (i <= 0) 	/* nbio, or an error */
		{
		s->rwstate=SSL_READING;
		*ok = 0;
		return i;
		}
D
Dr. Stephen Henson 已提交
866 867 868 869 870 871 872
	/* 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 已提交
873

A
Andy Polyakov 已提交
874
	/* parse the message fragment header */
A
Andy Polyakov 已提交
875
	dtls1_get_message_header(wire, &msg_hdr);
A
Andy Polyakov 已提交
876 877 878

	/* 
	 * if this is a future (or stale) message it gets buffered
D
Dr. Stephen Henson 已提交
879 880 881
	 * (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 已提交
882
	 */
D
Dr. Stephen Henson 已提交
883
	if (msg_hdr.seq != s->d1->handshake_read_seq && !(s->d1->listen && msg_hdr.seq == 1))
A
Andy Polyakov 已提交
884 885
		return dtls1_process_out_of_seq_message(s, &msg_hdr, ok);

D
Dr. Stephen Henson 已提交
886
	len = msg_hdr.msg_len;
A
Andy Polyakov 已提交
887
	frag_off = msg_hdr.frag_off;
B
Ben Laurie 已提交
888 889
	frag_len = msg_hdr.frag_len;

D
Dr. Stephen Henson 已提交
890 891 892
	if (frag_len && frag_len < len)
		return dtls1_reassemble_fragment(s, &msg_hdr, ok);

B
Ben Laurie 已提交
893
	if (!s->server && s->d1->r_msg_hdr.frag_off == 0 &&
A
Andy Polyakov 已提交
894
		wire[0] == SSL3_MT_HELLO_REQUEST)
A
Andy Polyakov 已提交
895 896 897 898 899
		{
		/* 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 已提交
900
		if (wire[1] == 0 && wire[2] == 0 && wire[3] == 0)
A
Andy Polyakov 已提交
901 902 903
			{
			if (s->msg_callback)
				s->msg_callback(0, s->version, SSL3_RT_HANDSHAKE, 
A
Andy Polyakov 已提交
904
					wire, DTLS1_HM_HEADER_LENGTH, s, 
A
Andy Polyakov 已提交
905 906 907
					s->msg_callback_arg);
			
			s->init_num = 0;
D
Dr. Stephen Henson 已提交
908
			goto redo;
A
Andy Polyakov 已提交
909 910 911 912 913 914 915 916 917
			}
		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 已提交
918
	if ((al=dtls1_preprocess_fragment(s,&msg_hdr,max)))
A
Andy Polyakov 已提交
919
		goto f_err;
B
Ben Laurie 已提交
920 921 922

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

B
Ben Laurie 已提交
924 925
	if ( frag_len > 0)
		{
926
		unsigned char *p=(unsigned char *)s->init_buf->data+DTLS1_HM_HEADER_LENGTH;
A
Andy Polyakov 已提交
927

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

A
Andy Polyakov 已提交
941 942
	/* XDTLS:  an incorrectly formatted fragment should cause the 
	 * handshake to fail */
D
Dr. Stephen Henson 已提交
943 944 945 946 947 948
	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 已提交
949

A
Andy Polyakov 已提交
950
	*ok = 1;
B
Ben Laurie 已提交
951

A
Andy Polyakov 已提交
952 953 954 955
	/* 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 已提交
956
	s->init_num = frag_len;
A
Andy Polyakov 已提交
957
	return frag_len;
B
Ben Laurie 已提交
958 959 960

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

B
Ben Laurie 已提交
963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984
	*ok=0;
	return(-1);
	}

/* for these 2 messages, we need to
 * 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;
985 986 987 988 989 990 991

		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 已提交
992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007
		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 已提交
1008 1009 1010 1011 1012 1013 1014
	{
	if ( code > 0)
		{
		fprintf( stderr, "invalid state reached %s:%d", __FILE__, __LINE__);
		return 1;
		}

D
Dr. Stephen Henson 已提交
1015
	if (!dtls1_is_timer_expired(s))
A
Andy Polyakov 已提交
1016 1017 1018 1019 1020 1021
		{
		/* 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 已提交
1022 1023 1024 1025 1026
#ifndef OPENSSL_NO_HEARTBEATS
	if (!SSL_in_init(s) && !s->tlsext_hb_pending)  /* done, no need to send a retransmit */
#else
	if (!SSL_in_init(s))  /* done, no need to send a retransmit */
#endif
A
Andy Polyakov 已提交
1027 1028 1029 1030 1031
		{
		BIO_set_flags(SSL_get_rbio(s), BIO_FLAGS_READ);
		return code;
		}

B
Ben Laurie 已提交
1032
#if 0 /* for now, each alert contains only one record number */
A
Andy Polyakov 已提交
1033 1034 1035 1036 1037 1038
	item = pqueue_peek(state->rcvd_records);
	if ( item )
		{
		/* send an alert immediately for all the missing records */
		}
	else
B
Ben Laurie 已提交
1039 1040 1041
#endif

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

D
Dr. Stephen Henson 已提交
1047
	return dtls1_handle_timeout(s);
A
Andy Polyakov 已提交
1048
	}
B
Ben Laurie 已提交
1049

D
Dr. Stephen Henson 已提交
1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062
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 已提交
1063

D
Dr. Stephen Henson 已提交
1064
int
B
Ben Laurie 已提交
1065
dtls1_retransmit_buffered_messages(SSL *s)
A
Andy Polyakov 已提交
1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077
	{
	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 已提交
1078
			if ( dtls1_retransmit_message(s,
1079
				(unsigned short)dtls1_get_queue_priority(frag->msg_header.seq, frag->msg_header.is_ccs),
D
Dr. Stephen Henson 已提交
1080
				0, &found) <= 0 && found)
A
Andy Polyakov 已提交
1081 1082 1083 1084 1085 1086 1087 1088
			{
			fprintf(stderr, "dtls1_retransmit_message() failed\n");
			return -1;
			}
		}

	return 1;
	}
B
Ben Laurie 已提交
1089 1090 1091

int
dtls1_buffer_message(SSL *s, int is_ccs)
A
Andy Polyakov 已提交
1092 1093 1094 1095 1096 1097 1098 1099 1100
	{
	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 已提交
1101
	frag = dtls1_hm_fragment_new(s->init_num, 0);
D
Dr. Stephen Henson 已提交
1102 1103
	if (!frag)
		return 0;
A
Andy Polyakov 已提交
1104 1105 1106 1107 1108 1109

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

	if ( is_ccs)
		{
		OPENSSL_assert(s->d1->w_msg_hdr.msg_len + 
1110
			       DTLS1_CCS_HEADER_LENGTH == (unsigned int)s->init_num);
A
Andy Polyakov 已提交
1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124
		}
	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 已提交
1125 1126 1127 1128 1129 1130 1131
	/* 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 已提交
1132
	memset(seq64be,0,sizeof(seq64be));
D
Dr. Stephen Henson 已提交
1133 1134 1135 1136
	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 已提交
1137 1138 1139 1140 1141 1142 1143

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

#if 0
A
Andy Polyakov 已提交
1146 1147 1148
	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 已提交
1149 1150
#endif

A
Andy Polyakov 已提交
1151 1152 1153
	pqueue_insert(s->d1->sent_messages, item);
	return 1;
	}
B
Ben Laurie 已提交
1154 1155 1156

int
dtls1_retransmit_message(SSL *s, unsigned short seq, unsigned long frag_off,
A
Andy Polyakov 已提交
1157 1158 1159 1160 1161 1162 1163 1164
	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 已提交
1165 1166
	struct dtls1_retransmit_state saved_state;
	unsigned char save_write_sequence[8];
A
Andy Polyakov 已提交
1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201

	/*
	  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 已提交
1202 1203 1204 1205 1206 1207 1208 1209
	/* 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 已提交
1210
	s->d1->retransmitting = 1;
D
Dr. Stephen Henson 已提交
1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224
	
	/* 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 已提交
1225
	ret = dtls1_do_write(s, frag->msg_header.is_ccs ? 
D
Dr. Stephen Henson 已提交
1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240
						 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 已提交
1241 1242 1243 1244 1245
	s->d1->retransmitting = 0;

	(void)BIO_flush(SSL_get_wbio(s));
	return ret;
	}
B
Ben Laurie 已提交
1246 1247 1248 1249

/* call this function when the buffered messages are no longer needed */
void
dtls1_clear_record_buffer(SSL *s)
A
Andy Polyakov 已提交
1250 1251 1252 1253 1254 1255 1256 1257 1258 1259
	{
	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 已提交
1260 1261 1262 1263


unsigned char *
dtls1_set_message_header(SSL *s, unsigned char *p, unsigned char mt,
A
Andy Polyakov 已提交
1264 1265
			unsigned long len, unsigned long frag_off, unsigned long frag_len)
	{
D
Dr. Stephen Henson 已提交
1266 1267
	/* Don't change sequence numbers while listening */
	if (frag_off == 0 && !s->d1->listen)
A
Andy Polyakov 已提交
1268 1269 1270 1271 1272 1273 1274 1275 1276 1277
		{
		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 已提交
1278 1279 1280 1281 1282


/* 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 已提交
1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293
			    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 已提交
1294 1295 1296

static void
dtls1_fix_message_header(SSL *s, unsigned long frag_off,
A
Andy Polyakov 已提交
1297 1298 1299 1300 1301 1302 1303
			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 已提交
1304 1305 1306

static unsigned char *
dtls1_write_message_header(SSL *s, unsigned char *p)
A
Andy Polyakov 已提交
1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318
	{
	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 已提交
1319

1320 1321
unsigned int
dtls1_link_min_mtu(void)
A
Andy Polyakov 已提交
1322 1323 1324 1325
	{
	return (g_probable_mtu[(sizeof(g_probable_mtu) / 
		sizeof(g_probable_mtu[0])) - 1]);
	}
B
Ben Laurie 已提交
1326

1327 1328
unsigned int
dtls1_min_mtu(SSL *s)
B
Ben Laurie 已提交
1329
	{
1330 1331
	return dtls1_link_min_mtu()-BIO_dgram_get_mtu_overhead(SSL_get_wbio(s));
	}
B
Ben Laurie 已提交
1332 1333 1334 1335


void
dtls1_get_message_header(unsigned char *data, struct hm_header_st *msg_hdr)
A
Andy Polyakov 已提交
1336 1337 1338 1339 1340 1341 1342 1343 1344
	{
	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 已提交
1345 1346 1347

void
dtls1_get_ccs_header(unsigned char *data, struct ccs_header_st *ccs_hdr)
A
Andy Polyakov 已提交
1348 1349 1350 1351 1352
	{
	memset(ccs_hdr, 0x00, sizeof(struct ccs_header_st));

	ccs_hdr->type = *(data++);
	}
D
Dr. Stephen Henson 已提交
1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373

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 已提交
1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388

#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);

1389 1390 1391
	/* Read type and payload length first */
	if (1 + 2 + 16 > s->s3->rrec.length)
		return 0; /* silently discard */
1392 1393 1394
	if (s->s3->rrec.length > SSL3_RT_MAX_PLAIN_LENGTH)
		return 0; /* silently discard per RFC 6520 sec. 4 */

1395 1396 1397 1398 1399 1400
	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 已提交
1401 1402 1403
	if (hbtype == TLS1_HB_REQUEST)
		{
		unsigned char *buffer, *bp;
1404 1405 1406
		unsigned int write_length = 1 /* heartbeat type */ +
					    2 /* heartbeat length */ +
					    payload + padding;
D
Dr. Stephen Henson 已提交
1407 1408
		int r;

1409 1410 1411
		if (write_length > SSL3_RT_MAX_PLAIN_LENGTH)
			return 0;

D
Dr. Stephen Henson 已提交
1412 1413 1414 1415
		/* Allocate memory for the response, size is 1 byte
		 * message type, plus 2 bytes payload length, plus
		 * payload, plus padding
		 */
1416
		buffer = OPENSSL_malloc(write_length);
1417 1418
		if (buffer == NULL)
			return -1;
D
Dr. Stephen Henson 已提交
1419 1420 1421 1422 1423 1424
		bp = buffer;

		/* Enter response type, length and copy payload */
		*bp++ = TLS1_HB_RESPONSE;
		s2n(payload, bp);
		memcpy(bp, pl, payload);
D
Dr. Stephen Henson 已提交
1425
		bp += payload;
D
Dr. Stephen Henson 已提交
1426
		/* Random padding */
D
Dr. Stephen Henson 已提交
1427
		RAND_pseudo_bytes(bp, padding);
D
Dr. Stephen Henson 已提交
1428

1429
		r = dtls1_write_bytes(s, TLS1_RT_HEARTBEAT, buffer, write_length);
D
Dr. Stephen Henson 已提交
1430 1431 1432

		if (r >= 0 && s->msg_callback)
			s->msg_callback(1, s->version, TLS1_RT_HEARTBEAT,
1433
				buffer, write_length,
D
Dr. Stephen Henson 已提交
1434 1435 1436 1437 1438 1439 1440 1441 1442 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 1505
				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);

	/* Create HeartBeat message, we just use a sequence number
	 * 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);
1506 1507 1508 1509 1510
	if (buf == NULL)
		{
		SSLerr(SSL_F_DTLS1_HEARTBEAT, ERR_R_MALLOC_FAILURE);
		return -1;
		}
D
Dr. Stephen Henson 已提交
1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540
	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