mirror of https://github.com/openssl/openssl.git
				
				
				
			
		
			
				
	
	
		
			705 lines
		
	
	
		
			20 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			705 lines
		
	
	
		
			20 KiB
		
	
	
	
		
			C
		
	
	
	
| /*
 | |
|  * Copyright 2016 The OpenSSL Project Authors. All Rights Reserved.
 | |
|  *
 | |
|  * Licensed under the OpenSSL license (the "License").  You may not use
 | |
|  * this file except in compliance with the License.  You can obtain a copy
 | |
|  * in the file LICENSE in the source distribution or at
 | |
|  * https://www.openssl.org/source/license.html
 | |
|  */
 | |
| 
 | |
| #include <string.h>
 | |
| 
 | |
| #include "e_os.h"
 | |
| #include "ssltestlib.h"
 | |
| 
 | |
| static int tls_dump_new(BIO *bi);
 | |
| static int tls_dump_free(BIO *a);
 | |
| static int tls_dump_read(BIO *b, char *out, int outl);
 | |
| static int tls_dump_write(BIO *b, const char *in, int inl);
 | |
| static long tls_dump_ctrl(BIO *b, int cmd, long num, void *ptr);
 | |
| static int tls_dump_gets(BIO *bp, char *buf, int size);
 | |
| static int tls_dump_puts(BIO *bp, const char *str);
 | |
| 
 | |
| /* Choose a sufficiently large type likely to be unused for this custom BIO */
 | |
| # define BIO_TYPE_TLS_DUMP_FILTER  (0x80 | BIO_TYPE_FILTER)
 | |
| 
 | |
| # define BIO_TYPE_MEMPACKET_TEST      0x81
 | |
| 
 | |
| static BIO_METHOD *method_tls_dump = NULL;
 | |
| static BIO_METHOD *method_mempacket_test = NULL;
 | |
| 
 | |
| /* Note: Not thread safe! */
 | |
| const BIO_METHOD *bio_f_tls_dump_filter(void)
 | |
| {
 | |
|     if (method_tls_dump == NULL) {
 | |
|         method_tls_dump = BIO_meth_new(BIO_TYPE_TLS_DUMP_FILTER,
 | |
|                                         "TLS dump filter");
 | |
|         if (   method_tls_dump == NULL
 | |
|             || !BIO_meth_set_write(method_tls_dump, tls_dump_write)
 | |
|             || !BIO_meth_set_read(method_tls_dump, tls_dump_read)
 | |
|             || !BIO_meth_set_puts(method_tls_dump, tls_dump_puts)
 | |
|             || !BIO_meth_set_gets(method_tls_dump, tls_dump_gets)
 | |
|             || !BIO_meth_set_ctrl(method_tls_dump, tls_dump_ctrl)
 | |
|             || !BIO_meth_set_create(method_tls_dump, tls_dump_new)
 | |
|             || !BIO_meth_set_destroy(method_tls_dump, tls_dump_free))
 | |
|             return NULL;
 | |
|     }
 | |
|     return method_tls_dump;
 | |
| }
 | |
| 
 | |
| void bio_f_tls_dump_filter_free(void)
 | |
| {
 | |
|     BIO_meth_free(method_tls_dump);
 | |
| }
 | |
| 
 | |
| static int tls_dump_new(BIO *bio)
 | |
| {
 | |
|     BIO_set_init(bio, 1);
 | |
|     return 1;
 | |
| }
 | |
| 
 | |
| static int tls_dump_free(BIO *bio)
 | |
| {
 | |
|     BIO_set_init(bio, 0);
 | |
| 
 | |
|     return 1;
 | |
| }
 | |
| 
 | |
| static void copy_flags(BIO *bio)
 | |
| {
 | |
|     int flags;
 | |
|     BIO *next = BIO_next(bio);
 | |
| 
 | |
|     flags = BIO_test_flags(next, BIO_FLAGS_SHOULD_RETRY | BIO_FLAGS_RWS);
 | |
|     BIO_clear_flags(bio, BIO_FLAGS_SHOULD_RETRY | BIO_FLAGS_RWS);
 | |
|     BIO_set_flags(bio, flags);
 | |
| }
 | |
| 
 | |
| #define RECORD_CONTENT_TYPE     0
 | |
| #define RECORD_VERSION_HI       1
 | |
| #define RECORD_VERSION_LO       2
 | |
| #define RECORD_EPOCH_HI         3
 | |
| #define RECORD_EPOCH_LO         4
 | |
| #define RECORD_SEQUENCE_START   5
 | |
| #define RECORD_SEQUENCE_END     10
 | |
| #define RECORD_LEN_HI           11
 | |
| #define RECORD_LEN_LO           12
 | |
| 
 | |
| #define MSG_TYPE                0
 | |
| #define MSG_LEN_HI              1
 | |
| #define MSG_LEN_MID             2
 | |
| #define MSG_LEN_LO              3
 | |
| #define MSG_SEQ_HI              4
 | |
| #define MSG_SEQ_LO              5
 | |
| #define MSG_FRAG_OFF_HI         6
 | |
| #define MSG_FRAG_OFF_MID        7
 | |
| #define MSG_FRAG_OFF_LO         8
 | |
| #define MSG_FRAG_LEN_HI         9
 | |
| #define MSG_FRAG_LEN_MID        10
 | |
| #define MSG_FRAG_LEN_LO         11
 | |
| 
 | |
| 
 | |
| static void dump_data(const char *data, int len)
 | |
| {
 | |
|     int rem, i, content, reclen, msglen, fragoff, fraglen, epoch;
 | |
|     unsigned char *rec;
 | |
| 
 | |
|     printf("---- START OF PACKET ----\n");
 | |
| 
 | |
|     rem = len;
 | |
|     rec = (unsigned char *)data;
 | |
| 
 | |
|     while (rem > 0) {
 | |
|         if (rem != len)
 | |
|             printf("*\n");
 | |
|         printf("*---- START OF RECORD ----\n");
 | |
|         if (rem < DTLS1_RT_HEADER_LENGTH) {
 | |
|             printf("*---- RECORD TRUNCATED ----\n");
 | |
|             break;
 | |
|         }
 | |
|         content = rec[RECORD_CONTENT_TYPE];
 | |
|         printf("** Record Content-type: %d\n", content);
 | |
|         printf("** Record Version: %02x%02x\n",
 | |
|                rec[RECORD_VERSION_HI], rec[RECORD_VERSION_LO]);
 | |
|         epoch = (rec[RECORD_EPOCH_HI] << 8) | rec[RECORD_EPOCH_LO];
 | |
|         printf("** Record Epoch: %d\n", epoch);
 | |
|         printf("** Record Sequence: ");
 | |
|         for (i = RECORD_SEQUENCE_START; i <= RECORD_SEQUENCE_END; i++)
 | |
|             printf("%02x", rec[i]);
 | |
|         reclen = (rec[RECORD_LEN_HI] << 8) | rec[RECORD_LEN_LO];
 | |
|         printf("\n** Record Length: %d\n", reclen);
 | |
| 
 | |
|         /* Now look at message */
 | |
|         rec += DTLS1_RT_HEADER_LENGTH;
 | |
|         rem -= DTLS1_RT_HEADER_LENGTH;
 | |
|         if (content == SSL3_RT_HANDSHAKE) {
 | |
|             printf("**---- START OF HANDSHAKE MESSAGE FRAGMENT ----\n");
 | |
|             if (epoch > 0) {
 | |
|                 printf("**---- HANDSHAKE MESSAGE FRAGMENT ENCRYPTED ----\n");
 | |
|             } else if (rem < DTLS1_HM_HEADER_LENGTH
 | |
|                     || reclen < DTLS1_HM_HEADER_LENGTH) {
 | |
|                 printf("**---- HANDSHAKE MESSAGE FRAGMENT TRUNCATED ----\n");
 | |
|             } else {
 | |
|                 printf("*** Message Type: %d\n", rec[MSG_TYPE]);
 | |
|                 msglen = (rec[MSG_LEN_HI] << 16) | (rec[MSG_LEN_MID] << 8)
 | |
|                          | rec[MSG_LEN_LO];
 | |
|                 printf("*** Message Length: %d\n", msglen);
 | |
|                 printf("*** Message sequence: %d\n",
 | |
|                        (rec[MSG_SEQ_HI] << 8) | rec[MSG_SEQ_LO]);
 | |
|                 fragoff = (rec[MSG_FRAG_OFF_HI] << 16)
 | |
|                           | (rec[MSG_FRAG_OFF_MID] << 8)
 | |
|                           | rec[MSG_FRAG_OFF_LO];
 | |
|                 printf("*** Message Fragment offset: %d\n", fragoff);
 | |
|                 fraglen = (rec[MSG_FRAG_LEN_HI] << 16)
 | |
|                           | (rec[MSG_FRAG_LEN_MID] << 8)
 | |
|                           | rec[MSG_FRAG_LEN_LO];
 | |
|                 printf("*** Message Fragment len: %d\n", fraglen);
 | |
|                 if (fragoff + fraglen > msglen)
 | |
|                     printf("***---- HANDSHAKE MESSAGE FRAGMENT INVALID ----\n");
 | |
|                 else if (reclen < fraglen)
 | |
|                     printf("**---- HANDSHAKE MESSAGE FRAGMENT TRUNCATED ----\n");
 | |
|                 else
 | |
|                     printf("**---- END OF HANDSHAKE MESSAGE FRAGMENT ----\n");
 | |
|             }
 | |
|         }
 | |
|         if (rem < reclen) {
 | |
|             printf("*---- RECORD TRUNCATED ----\n");
 | |
|             rem = 0;
 | |
|         } else {
 | |
|             rec += reclen;
 | |
|             rem -= reclen;
 | |
|             printf("*---- END OF RECORD ----\n");
 | |
|         }
 | |
|     }
 | |
|     printf("---- END OF PACKET ----\n\n");
 | |
|     fflush(stdout);
 | |
| }
 | |
| 
 | |
| static int tls_dump_read(BIO *bio, char *out, int outl)
 | |
| {
 | |
|     int ret;
 | |
|     BIO *next = BIO_next(bio);
 | |
| 
 | |
|     ret = BIO_read(next, out, outl);
 | |
|     copy_flags(bio);
 | |
| 
 | |
|     if (ret > 0) {
 | |
|         dump_data(out, ret);
 | |
|     }
 | |
| 
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| static int tls_dump_write(BIO *bio, const char *in, int inl)
 | |
| {
 | |
|     int ret;
 | |
|     BIO *next = BIO_next(bio);
 | |
| 
 | |
|     ret = BIO_write(next, in, inl);
 | |
|     copy_flags(bio);
 | |
| 
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| static long tls_dump_ctrl(BIO *bio, int cmd, long num, void *ptr)
 | |
| {
 | |
|     long ret;
 | |
|     BIO *next = BIO_next(bio);
 | |
| 
 | |
|     if (next == NULL)
 | |
|         return 0;
 | |
| 
 | |
|     switch (cmd) {
 | |
|     case BIO_CTRL_DUP:
 | |
|         ret = 0L;
 | |
|         break;
 | |
|     default:
 | |
|         ret = BIO_ctrl(next, cmd, num, ptr);
 | |
|         break;
 | |
|     }
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| static int tls_dump_gets(BIO *bio, char *buf, int size)
 | |
| {
 | |
|     /* We don't support this - not needed anyway */
 | |
|     return -1;
 | |
| }
 | |
| 
 | |
| static int tls_dump_puts(BIO *bio, const char *str)
 | |
| {
 | |
|     return tls_dump_write(bio, str, strlen(str));
 | |
| }
 | |
| 
 | |
| 
 | |
| struct mempacket_st {
 | |
|     unsigned char *data;
 | |
|     int len;
 | |
|     unsigned int num;
 | |
|     unsigned int type;
 | |
| };
 | |
| 
 | |
| static void mempacket_free(MEMPACKET *pkt)
 | |
| {
 | |
|     if (pkt->data != NULL)
 | |
|         OPENSSL_free(pkt->data);
 | |
|     OPENSSL_free(pkt);
 | |
| }
 | |
| 
 | |
| typedef struct mempacket_test_ctx_st {
 | |
|     STACK_OF(MEMPACKET) *pkts;
 | |
|     unsigned int epoch;
 | |
|     unsigned int currrec;
 | |
|     unsigned int currpkt;
 | |
|     unsigned int lastpkt;
 | |
|     unsigned int noinject;
 | |
| } MEMPACKET_TEST_CTX;
 | |
| 
 | |
| static int mempacket_test_new(BIO *bi);
 | |
| static int mempacket_test_free(BIO *a);
 | |
| static int mempacket_test_read(BIO *b, char *out, int outl);
 | |
| static int mempacket_test_write(BIO *b, const char *in, int inl);
 | |
| static long mempacket_test_ctrl(BIO *b, int cmd, long num, void *ptr);
 | |
| static int mempacket_test_gets(BIO *bp, char *buf, int size);
 | |
| static int mempacket_test_puts(BIO *bp, const char *str);
 | |
| 
 | |
| const BIO_METHOD *bio_s_mempacket_test(void)
 | |
| {
 | |
|     if (method_mempacket_test == NULL) {
 | |
|         method_mempacket_test = BIO_meth_new(BIO_TYPE_MEMPACKET_TEST,
 | |
|                                              "Mem Packet Test");
 | |
|         if (   method_mempacket_test == NULL
 | |
|             || !BIO_meth_set_write(method_mempacket_test, mempacket_test_write)
 | |
|             || !BIO_meth_set_read(method_mempacket_test, mempacket_test_read)
 | |
|             || !BIO_meth_set_puts(method_mempacket_test, mempacket_test_puts)
 | |
|             || !BIO_meth_set_gets(method_mempacket_test, mempacket_test_gets)
 | |
|             || !BIO_meth_set_ctrl(method_mempacket_test, mempacket_test_ctrl)
 | |
|             || !BIO_meth_set_create(method_mempacket_test, mempacket_test_new)
 | |
|             || !BIO_meth_set_destroy(method_mempacket_test, mempacket_test_free))
 | |
|             return NULL;
 | |
|     }
 | |
|     return method_mempacket_test;
 | |
| }
 | |
| 
 | |
| void bio_s_mempacket_test_free(void)
 | |
| {
 | |
|     BIO_meth_free(method_mempacket_test);
 | |
| }
 | |
| 
 | |
| static int mempacket_test_new(BIO *bio)
 | |
| {
 | |
|     MEMPACKET_TEST_CTX *ctx = OPENSSL_zalloc(sizeof(*ctx));
 | |
|     if (ctx == NULL)
 | |
|         return 0;
 | |
|     ctx->pkts = sk_MEMPACKET_new_null();
 | |
|     if (ctx->pkts == NULL) {
 | |
|         OPENSSL_free(ctx);
 | |
|         return 0;
 | |
|     }
 | |
|     BIO_set_init(bio, 1);
 | |
|     BIO_set_data(bio, ctx);
 | |
|     return 1;
 | |
| }
 | |
| 
 | |
| static int mempacket_test_free(BIO *bio)
 | |
| {
 | |
|     MEMPACKET_TEST_CTX *ctx = BIO_get_data(bio);
 | |
| 
 | |
|     sk_MEMPACKET_pop_free(ctx->pkts, mempacket_free);
 | |
|     OPENSSL_free(ctx);
 | |
|     BIO_set_data(bio, NULL);
 | |
|     BIO_set_init(bio, 0);
 | |
| 
 | |
|     return 1;
 | |
| }
 | |
| 
 | |
| /* Record Header values */
 | |
| #define EPOCH_HI        4
 | |
| #define EPOCH_LO        5
 | |
| #define RECORD_SEQUENCE 10
 | |
| #define RECORD_LEN_HI   11
 | |
| #define RECORD_LEN_LO   12
 | |
| 
 | |
| #define STANDARD_PACKET                 0
 | |
| 
 | |
| static int mempacket_test_read(BIO *bio, char *out, int outl)
 | |
| {
 | |
|     MEMPACKET_TEST_CTX *ctx = BIO_get_data(bio);
 | |
|     MEMPACKET *thispkt;
 | |
|     unsigned char *rec;
 | |
|     int rem;
 | |
|     unsigned int seq, offset, len, epoch;
 | |
| 
 | |
|     BIO_clear_retry_flags(bio);
 | |
| 
 | |
|     thispkt = sk_MEMPACKET_value(ctx->pkts, 0);
 | |
|     if (thispkt == NULL || thispkt->num != ctx->currpkt) {
 | |
|         /* Probably run out of data */
 | |
|         BIO_set_retry_read(bio);
 | |
|         return -1;
 | |
|     }
 | |
|     (void)sk_MEMPACKET_shift(ctx->pkts);
 | |
|     ctx->currpkt++;
 | |
| 
 | |
|     if (outl > thispkt->len)
 | |
|         outl = thispkt->len;
 | |
| 
 | |
|     if (thispkt->type != INJECT_PACKET_IGNORE_REC_SEQ) {
 | |
|         /*
 | |
|          * Overwrite the record sequence number. We strictly number them in
 | |
|          * the order received. Since we are actually a reliable transport
 | |
|          * we know that there won't be any re-ordering. We overwrite to deal
 | |
|          * with any packets that have been injected
 | |
|          */
 | |
|         rem = thispkt->len;
 | |
|         rec = thispkt->data;
 | |
|         while (rem > 0) {
 | |
|             if (rem < DTLS1_RT_HEADER_LENGTH) {
 | |
|                 return -1;
 | |
|             }
 | |
|             epoch = (rec[EPOCH_HI] << 8) | rec[EPOCH_LO];
 | |
|             if (epoch != ctx->epoch) {
 | |
|                 ctx->epoch = epoch;
 | |
|                 ctx->currrec = 0;
 | |
|             }
 | |
|             seq = ctx->currrec;
 | |
|             offset = 0;
 | |
|             do {
 | |
|                 rec[RECORD_SEQUENCE - offset] = seq & 0xFF;
 | |
|                 seq >>= 8;
 | |
|                 offset++;
 | |
|             } while (seq > 0);
 | |
|             ctx->currrec++;
 | |
| 
 | |
|             len = ((rec[RECORD_LEN_HI] << 8) | rec[RECORD_LEN_LO])
 | |
|                   + DTLS1_RT_HEADER_LENGTH;
 | |
| 
 | |
|             rec += len;
 | |
|             rem -= len;
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     memcpy(out, thispkt->data, outl);
 | |
| 
 | |
|     mempacket_free(thispkt);
 | |
| 
 | |
|     return outl;
 | |
| }
 | |
| 
 | |
| int mempacket_test_inject(BIO *bio, const char *in, int inl, int pktnum,
 | |
|                           int type)
 | |
| {
 | |
|     MEMPACKET_TEST_CTX *ctx = BIO_get_data(bio);
 | |
|     MEMPACKET *thispkt, *looppkt, *nextpkt;
 | |
|     int i;
 | |
| 
 | |
|     if (ctx == NULL)
 | |
|         return -1;
 | |
| 
 | |
|     /* We only allow injection before we've started writing any data */
 | |
|     if (pktnum >= 0) {
 | |
|         if (ctx->noinject)
 | |
|             return -1;
 | |
|     } else {
 | |
|         ctx->noinject = 1;
 | |
|     }
 | |
| 
 | |
|     thispkt = OPENSSL_malloc(sizeof(MEMPACKET));
 | |
|     if (thispkt == NULL)
 | |
|         return -1;
 | |
| 
 | |
|     thispkt->data = OPENSSL_malloc(inl);
 | |
|     if (thispkt->data == NULL) {
 | |
|         mempacket_free(thispkt);
 | |
|         return -1;
 | |
|     }
 | |
| 
 | |
|     memcpy(thispkt->data, in, inl);
 | |
|     thispkt->len = inl;
 | |
|     thispkt->num = (pktnum >= 0) ? (unsigned int)pktnum : ctx->lastpkt;
 | |
|     thispkt->type = type;
 | |
| 
 | |
|     for(i = 0; (looppkt = sk_MEMPACKET_value(ctx->pkts, i)) != NULL; i++) {
 | |
|         /* Check if we found the right place to insert this packet */
 | |
|         if (looppkt->num > thispkt->num) {
 | |
|             if (sk_MEMPACKET_insert(ctx->pkts, thispkt, i) == 0) {
 | |
|                 mempacket_free(thispkt);
 | |
|                 return -1;
 | |
|             }
 | |
|             /* If we're doing up front injection then we're done */
 | |
|             if (pktnum >= 0)
 | |
|                 return inl;
 | |
|             /*
 | |
|              * We need to do some accounting on lastpkt. We increment it first,
 | |
|              * but it might now equal the value of injected packets, so we need
 | |
|              * to skip over those
 | |
|              */
 | |
|             ctx->lastpkt++;
 | |
|             do {
 | |
|                 i++;
 | |
|                 nextpkt = sk_MEMPACKET_value(ctx->pkts, i);
 | |
|                 if (nextpkt != NULL && nextpkt->num == ctx->lastpkt)
 | |
|                     ctx->lastpkt++;
 | |
|                 else
 | |
|                     return inl;
 | |
|             } while(1);
 | |
|         } else if (looppkt->num == thispkt->num) {
 | |
|             if (!ctx->noinject) {
 | |
|                 /* We injected two packets with the same packet number! */
 | |
|                 return -1;
 | |
|             }
 | |
|             ctx->lastpkt++;
 | |
|             thispkt->num++;
 | |
|         }
 | |
|     }
 | |
|     /*
 | |
|      * We didn't find any packets with a packet number equal to or greater than
 | |
|      * this one, so we just add it onto the end
 | |
|      */
 | |
|     if (!sk_MEMPACKET_push(ctx->pkts, thispkt)) {
 | |
|         mempacket_free(thispkt);
 | |
|         return -1;
 | |
|     }
 | |
| 
 | |
|     if (pktnum < 0)
 | |
|         ctx->lastpkt++;
 | |
| 
 | |
|     return inl;
 | |
| }
 | |
| 
 | |
| static int mempacket_test_write(BIO *bio, const char *in, int inl)
 | |
| {
 | |
|     return mempacket_test_inject(bio, in, inl, -1, STANDARD_PACKET);
 | |
| }
 | |
| 
 | |
| static long mempacket_test_ctrl(BIO *bio, int cmd, long num, void *ptr)
 | |
| {
 | |
|     long ret = 1;
 | |
|     MEMPACKET_TEST_CTX *ctx = BIO_get_data(bio);
 | |
|     MEMPACKET *thispkt;
 | |
| 
 | |
|     switch (cmd) {
 | |
|     case BIO_CTRL_EOF:
 | |
|         ret = (long)(sk_MEMPACKET_num(ctx->pkts) == 0);
 | |
|         break;
 | |
|     case BIO_CTRL_GET_CLOSE:
 | |
|         ret = BIO_get_shutdown(bio);
 | |
|         break;
 | |
|     case BIO_CTRL_SET_CLOSE:
 | |
|         BIO_set_shutdown(bio, (int)num);
 | |
|         break;
 | |
|     case BIO_CTRL_WPENDING:
 | |
|         ret = 0L;
 | |
|         break;
 | |
|     case BIO_CTRL_PENDING:
 | |
|         thispkt = sk_MEMPACKET_value(ctx->pkts, 0);
 | |
|         if (thispkt == NULL)
 | |
|             ret = 0;
 | |
|         else
 | |
|             ret = thispkt->len;
 | |
|         break;
 | |
|     case BIO_CTRL_FLUSH:
 | |
|         ret = 1;
 | |
|         break;
 | |
|     case BIO_CTRL_RESET:
 | |
|     case BIO_CTRL_DUP:
 | |
|     case BIO_CTRL_PUSH:
 | |
|     case BIO_CTRL_POP:
 | |
|     default:
 | |
|         ret = 0;
 | |
|         break;
 | |
|     }
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| static int mempacket_test_gets(BIO *bio, char *buf, int size)
 | |
| {
 | |
|     /* We don't support this - not needed anyway */
 | |
|     return -1;
 | |
| }
 | |
| 
 | |
| static int mempacket_test_puts(BIO *bio, const char *str)
 | |
| {
 | |
|     return mempacket_test_write(bio, str, strlen(str));
 | |
| }
 | |
| 
 | |
| int create_ssl_ctx_pair(const SSL_METHOD *sm, const SSL_METHOD *cm,
 | |
|                         SSL_CTX **sctx, SSL_CTX **cctx, char *certfile,
 | |
|                         char *privkeyfile)
 | |
| {
 | |
|     SSL_CTX *serverctx = NULL;
 | |
|     SSL_CTX *clientctx = NULL;
 | |
| 
 | |
|     serverctx = SSL_CTX_new(sm);
 | |
|     clientctx = SSL_CTX_new(cm);
 | |
|     if (serverctx == NULL || clientctx == NULL) {
 | |
|         printf("Failed to create SSL_CTX\n");
 | |
|         goto err;
 | |
|     }
 | |
| 
 | |
|     if (SSL_CTX_use_certificate_file(serverctx, certfile,
 | |
|                                      SSL_FILETYPE_PEM) <= 0) {
 | |
|         printf("Failed to load server certificate\n");
 | |
|         goto err;
 | |
|     }
 | |
|     if (SSL_CTX_use_PrivateKey_file(serverctx, privkeyfile,
 | |
|                                     SSL_FILETYPE_PEM) <= 0) {
 | |
|         printf("Failed to load server private key\n");
 | |
|     }
 | |
|     if (SSL_CTX_check_private_key(serverctx) <= 0) {
 | |
|         printf("Failed to check private key\n");
 | |
|         goto err;
 | |
|     }
 | |
| 
 | |
| #ifndef OPENSSL_NO_DH
 | |
|     SSL_CTX_set_dh_auto(serverctx, 1);
 | |
| #endif
 | |
| 
 | |
|     *sctx = serverctx;
 | |
|     *cctx = clientctx;
 | |
| 
 | |
|     return 1;
 | |
|  err:
 | |
|     SSL_CTX_free(serverctx);
 | |
|     SSL_CTX_free(clientctx);
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| #define MAXLOOPS    1000000
 | |
| 
 | |
| /*
 | |
|  * NOTE: Transfers control of the BIOs - this function will free them on error
 | |
|  */
 | |
| int create_ssl_objects(SSL_CTX *serverctx, SSL_CTX *clientctx, SSL **sssl,
 | |
|                           SSL **cssl, BIO *s_to_c_fbio, BIO *c_to_s_fbio)
 | |
| {
 | |
|     SSL *serverssl, *clientssl;
 | |
|     BIO *s_to_c_bio = NULL, *c_to_s_bio = NULL;
 | |
| 
 | |
|     if (*sssl == NULL)
 | |
|         serverssl = SSL_new(serverctx);
 | |
|     else
 | |
|         serverssl = *sssl;
 | |
|     if (*cssl == NULL)
 | |
|         clientssl = SSL_new(clientctx);
 | |
|     else
 | |
|         clientssl = *cssl;
 | |
| 
 | |
|     if (serverssl == NULL || clientssl == NULL) {
 | |
|         printf("Failed to create SSL object\n");
 | |
|         goto error;
 | |
|     }
 | |
| 
 | |
|     if (SSL_is_dtls(clientssl)) {
 | |
|         s_to_c_bio = BIO_new(bio_s_mempacket_test());
 | |
|         c_to_s_bio = BIO_new(bio_s_mempacket_test());
 | |
|     } else {
 | |
|         s_to_c_bio = BIO_new(BIO_s_mem());
 | |
|         c_to_s_bio = BIO_new(BIO_s_mem());
 | |
|     }
 | |
|     if (s_to_c_bio == NULL || c_to_s_bio == NULL) {
 | |
|         printf("Failed to create mem BIOs\n");
 | |
|         goto error;
 | |
|     }
 | |
| 
 | |
|     if (s_to_c_fbio != NULL)
 | |
|         s_to_c_bio = BIO_push(s_to_c_fbio, s_to_c_bio);
 | |
|     if (c_to_s_fbio != NULL)
 | |
|         c_to_s_bio = BIO_push(c_to_s_fbio, c_to_s_bio);
 | |
|     if (s_to_c_bio == NULL || c_to_s_bio == NULL) {
 | |
|         printf("Failed to create chained BIOs\n");
 | |
|         goto error;
 | |
|     }
 | |
| 
 | |
|     /* Set Non-blocking IO behaviour */
 | |
|     BIO_set_mem_eof_return(s_to_c_bio, -1);
 | |
|     BIO_set_mem_eof_return(c_to_s_bio, -1);
 | |
| 
 | |
|     /* Up ref these as we are passing them to two SSL objects */
 | |
|     BIO_up_ref(s_to_c_bio);
 | |
|     BIO_up_ref(c_to_s_bio);
 | |
| 
 | |
|     SSL_set_bio(serverssl, c_to_s_bio, s_to_c_bio);
 | |
|     SSL_set_bio(clientssl, s_to_c_bio, c_to_s_bio);
 | |
| 
 | |
|     /* BIOs will now be freed when SSL objects are freed */
 | |
|     s_to_c_bio = c_to_s_bio = NULL;
 | |
|     s_to_c_fbio = c_to_s_fbio = NULL;
 | |
| 
 | |
|     *sssl = serverssl;
 | |
|     *cssl = clientssl;
 | |
| 
 | |
|     return 1;
 | |
| 
 | |
|  error:
 | |
|     SSL_free(serverssl);
 | |
|     SSL_free(clientssl);
 | |
|     BIO_free(s_to_c_bio);
 | |
|     BIO_free(c_to_s_bio);
 | |
|     BIO_free(s_to_c_fbio);
 | |
|     BIO_free(c_to_s_fbio);
 | |
| 
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| int create_ssl_connection(SSL *serverssl, SSL *clientssl, int want)
 | |
| {
 | |
|     int retc = -1, rets = -1, err, abortctr = 0;
 | |
|     int clienterr = 0, servererr = 0;
 | |
|     unsigned char buf;
 | |
|     size_t readbytes;
 | |
| 
 | |
|     do {
 | |
|         err = SSL_ERROR_WANT_WRITE;
 | |
|         while (!clienterr && retc <= 0 && err == SSL_ERROR_WANT_WRITE) {
 | |
|             retc = SSL_connect(clientssl);
 | |
|             if (retc <= 0)
 | |
|                 err = SSL_get_error(clientssl, retc);
 | |
|         }
 | |
| 
 | |
|         if (!clienterr && retc <= 0 && err != SSL_ERROR_WANT_READ) {
 | |
|             printf("SSL_connect() failed %d, %d\n", retc, err);
 | |
|             clienterr = 1;
 | |
|         }
 | |
|         if (want != SSL_ERROR_NONE && err == want)
 | |
|             return 0;
 | |
| 
 | |
|         err = SSL_ERROR_WANT_WRITE;
 | |
|         while (!servererr && rets <= 0 && err == SSL_ERROR_WANT_WRITE) {
 | |
|             rets = SSL_accept(serverssl);
 | |
|             if (rets <= 0)
 | |
|                 err = SSL_get_error(serverssl, rets);
 | |
|         }
 | |
| 
 | |
|         if (!servererr && rets <= 0 && err != SSL_ERROR_WANT_READ) {
 | |
|             printf("SSL_accept() failed %d, %d\n", rets, err);
 | |
|             servererr = 1;
 | |
|         }
 | |
|         if (want != SSL_ERROR_NONE && err == want)
 | |
|             return 0;
 | |
|         if (clienterr && servererr)
 | |
|             return 0;
 | |
|         if (++abortctr == MAXLOOPS) {
 | |
|             printf("No progress made\n");
 | |
|             return 0;
 | |
|         }
 | |
|     } while (retc <=0 || rets <= 0);
 | |
| 
 | |
|     /*
 | |
|      * We attempt to read some data on the client side which we expect to fail.
 | |
|      * This will ensure we have received the NewSessionTicket in TLSv1.3 where
 | |
|      * appropriate.
 | |
|      */
 | |
|     if (SSL_read_ex(clientssl, &buf, sizeof(buf), &readbytes) > 0) {
 | |
|         if (readbytes != 0) {
 | |
|             printf("Unexpected success reading data %"OSSLzu"\n", readbytes);
 | |
|             return 0;
 | |
|         }
 | |
|     } else if (SSL_get_error(clientssl, 0) != SSL_ERROR_WANT_READ) {
 | |
|         printf("SSL_read_ex() failed\n");
 | |
|         return 0;
 | |
|     }
 | |
| 
 | |
|     return 1;
 | |
| }
 |