mirror of
https://github.com/Mbed-TLS/mbedtls.git
synced 2024-12-29 09:21:19 +00:00
16799db69a
Signed-off-by: Dave Rodgman <dave.rodgman@arm.com>
490 lines
14 KiB
C
490 lines
14 KiB
C
/*
|
|
* SSL server demonstration program using pthread for handling multiple
|
|
* clients.
|
|
*
|
|
* Copyright The Mbed TLS Contributors
|
|
* SPDX-License-Identifier: Apache-2.0 OR GPL-2.0-or-later
|
|
*/
|
|
|
|
#include "mbedtls/build_info.h"
|
|
|
|
#include "mbedtls/platform.h"
|
|
|
|
#if !defined(MBEDTLS_BIGNUM_C) || !defined(MBEDTLS_ENTROPY_C) || \
|
|
!defined(MBEDTLS_SSL_TLS_C) || !defined(MBEDTLS_SSL_SRV_C) || \
|
|
!defined(MBEDTLS_NET_C) || !defined(MBEDTLS_RSA_C) || \
|
|
!defined(MBEDTLS_CTR_DRBG_C) || !defined(MBEDTLS_X509_CRT_PARSE_C) || \
|
|
!defined(MBEDTLS_FS_IO) || !defined(MBEDTLS_THREADING_C) || \
|
|
!defined(MBEDTLS_THREADING_PTHREAD) || !defined(MBEDTLS_PEM_PARSE_C)
|
|
int main(void)
|
|
{
|
|
mbedtls_printf("MBEDTLS_BIGNUM_C and/or MBEDTLS_ENTROPY_C "
|
|
"and/or MBEDTLS_SSL_TLS_C and/or MBEDTLS_SSL_SRV_C and/or "
|
|
"MBEDTLS_NET_C and/or MBEDTLS_RSA_C and/or "
|
|
"MBEDTLS_CTR_DRBG_C and/or MBEDTLS_X509_CRT_PARSE_C and/or "
|
|
"MBEDTLS_THREADING_C and/or MBEDTLS_THREADING_PTHREAD "
|
|
"and/or MBEDTLS_PEM_PARSE_C not defined.\n");
|
|
mbedtls_exit(0);
|
|
}
|
|
#else
|
|
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
|
|
#if defined(_WIN32)
|
|
#include <windows.h>
|
|
#endif
|
|
|
|
#include "mbedtls/entropy.h"
|
|
#include "mbedtls/ctr_drbg.h"
|
|
#include "mbedtls/x509.h"
|
|
#include "mbedtls/ssl.h"
|
|
#include "mbedtls/net_sockets.h"
|
|
#include "mbedtls/error.h"
|
|
#include "test/certs.h"
|
|
|
|
#if defined(MBEDTLS_SSL_CACHE_C)
|
|
#include "mbedtls/ssl_cache.h"
|
|
#endif
|
|
|
|
#if defined(MBEDTLS_MEMORY_BUFFER_ALLOC_C)
|
|
#include "mbedtls/memory_buffer_alloc.h"
|
|
#endif
|
|
|
|
|
|
#define HTTP_RESPONSE \
|
|
"HTTP/1.0 200 OK\r\nContent-Type: text/html\r\n\r\n" \
|
|
"<h2>Mbed TLS Test Server</h2>\r\n" \
|
|
"<p>Successful connection using: %s</p>\r\n"
|
|
|
|
#define DEBUG_LEVEL 0
|
|
|
|
#define MAX_NUM_THREADS 5
|
|
|
|
mbedtls_threading_mutex_t debug_mutex;
|
|
|
|
static void my_mutexed_debug(void *ctx, int level,
|
|
const char *file, int line,
|
|
const char *str)
|
|
{
|
|
long int thread_id = (long int) pthread_self();
|
|
|
|
mbedtls_mutex_lock(&debug_mutex);
|
|
|
|
((void) level);
|
|
mbedtls_fprintf((FILE *) ctx, "%s:%04d: [ #%ld ] %s",
|
|
file, line, thread_id, str);
|
|
fflush((FILE *) ctx);
|
|
|
|
mbedtls_mutex_unlock(&debug_mutex);
|
|
}
|
|
|
|
typedef struct {
|
|
mbedtls_net_context client_fd;
|
|
int thread_complete;
|
|
const mbedtls_ssl_config *config;
|
|
} thread_info_t;
|
|
|
|
typedef struct {
|
|
int active;
|
|
thread_info_t data;
|
|
pthread_t thread;
|
|
} pthread_info_t;
|
|
|
|
static thread_info_t base_info;
|
|
static pthread_info_t threads[MAX_NUM_THREADS];
|
|
|
|
static void *handle_ssl_connection(void *data)
|
|
{
|
|
int ret, len;
|
|
thread_info_t *thread_info = (thread_info_t *) data;
|
|
mbedtls_net_context *client_fd = &thread_info->client_fd;
|
|
long int thread_id = (long int) pthread_self();
|
|
unsigned char buf[1024];
|
|
mbedtls_ssl_context ssl;
|
|
|
|
/* Make sure memory references are valid */
|
|
mbedtls_ssl_init(&ssl);
|
|
|
|
mbedtls_printf(" [ #%ld ] Setting up SSL/TLS data\n", thread_id);
|
|
|
|
/*
|
|
* 4. Get the SSL context ready
|
|
*/
|
|
if ((ret = mbedtls_ssl_setup(&ssl, thread_info->config)) != 0) {
|
|
mbedtls_printf(" [ #%ld ] failed: mbedtls_ssl_setup returned -0x%04x\n",
|
|
thread_id, (unsigned int) -ret);
|
|
goto thread_exit;
|
|
}
|
|
|
|
mbedtls_ssl_set_bio(&ssl, client_fd, mbedtls_net_send, mbedtls_net_recv, NULL);
|
|
|
|
/*
|
|
* 5. Handshake
|
|
*/
|
|
mbedtls_printf(" [ #%ld ] Performing the SSL/TLS handshake\n", thread_id);
|
|
|
|
while ((ret = mbedtls_ssl_handshake(&ssl)) != 0) {
|
|
if (ret != MBEDTLS_ERR_SSL_WANT_READ && ret != MBEDTLS_ERR_SSL_WANT_WRITE) {
|
|
mbedtls_printf(" [ #%ld ] failed: mbedtls_ssl_handshake returned -0x%04x\n",
|
|
thread_id, (unsigned int) -ret);
|
|
goto thread_exit;
|
|
}
|
|
}
|
|
|
|
mbedtls_printf(" [ #%ld ] ok\n", thread_id);
|
|
|
|
/*
|
|
* 6. Read the HTTP Request
|
|
*/
|
|
mbedtls_printf(" [ #%ld ] < Read from client\n", thread_id);
|
|
|
|
do {
|
|
len = sizeof(buf) - 1;
|
|
memset(buf, 0, sizeof(buf));
|
|
ret = mbedtls_ssl_read(&ssl, buf, len);
|
|
|
|
if (ret == MBEDTLS_ERR_SSL_WANT_READ || ret == MBEDTLS_ERR_SSL_WANT_WRITE) {
|
|
continue;
|
|
}
|
|
|
|
if (ret <= 0) {
|
|
switch (ret) {
|
|
case MBEDTLS_ERR_SSL_PEER_CLOSE_NOTIFY:
|
|
mbedtls_printf(" [ #%ld ] connection was closed gracefully\n",
|
|
thread_id);
|
|
goto thread_exit;
|
|
|
|
case MBEDTLS_ERR_NET_CONN_RESET:
|
|
mbedtls_printf(" [ #%ld ] connection was reset by peer\n",
|
|
thread_id);
|
|
goto thread_exit;
|
|
|
|
default:
|
|
mbedtls_printf(" [ #%ld ] mbedtls_ssl_read returned -0x%04x\n",
|
|
thread_id, (unsigned int) -ret);
|
|
goto thread_exit;
|
|
}
|
|
}
|
|
|
|
len = ret;
|
|
mbedtls_printf(" [ #%ld ] %d bytes read\n=====\n%s\n=====\n",
|
|
thread_id, len, (char *) buf);
|
|
|
|
if (ret > 0) {
|
|
break;
|
|
}
|
|
} while (1);
|
|
|
|
/*
|
|
* 7. Write the 200 Response
|
|
*/
|
|
mbedtls_printf(" [ #%ld ] > Write to client:\n", thread_id);
|
|
|
|
len = sprintf((char *) buf, HTTP_RESPONSE,
|
|
mbedtls_ssl_get_ciphersuite(&ssl));
|
|
|
|
while ((ret = mbedtls_ssl_write(&ssl, buf, len)) <= 0) {
|
|
if (ret == MBEDTLS_ERR_NET_CONN_RESET) {
|
|
mbedtls_printf(" [ #%ld ] failed: peer closed the connection\n",
|
|
thread_id);
|
|
goto thread_exit;
|
|
}
|
|
|
|
if (ret != MBEDTLS_ERR_SSL_WANT_READ && ret != MBEDTLS_ERR_SSL_WANT_WRITE) {
|
|
mbedtls_printf(" [ #%ld ] failed: mbedtls_ssl_write returned -0x%04x\n",
|
|
thread_id, (unsigned int) ret);
|
|
goto thread_exit;
|
|
}
|
|
}
|
|
|
|
len = ret;
|
|
mbedtls_printf(" [ #%ld ] %d bytes written\n=====\n%s\n=====\n",
|
|
thread_id, len, (char *) buf);
|
|
|
|
mbedtls_printf(" [ #%ld ] . Closing the connection...", thread_id);
|
|
|
|
while ((ret = mbedtls_ssl_close_notify(&ssl)) < 0) {
|
|
if (ret != MBEDTLS_ERR_SSL_WANT_READ &&
|
|
ret != MBEDTLS_ERR_SSL_WANT_WRITE) {
|
|
mbedtls_printf(" [ #%ld ] failed: mbedtls_ssl_close_notify returned -0x%04x\n",
|
|
thread_id, (unsigned int) ret);
|
|
goto thread_exit;
|
|
}
|
|
}
|
|
|
|
mbedtls_printf(" ok\n");
|
|
|
|
ret = 0;
|
|
|
|
thread_exit:
|
|
|
|
#ifdef MBEDTLS_ERROR_C
|
|
if (ret != 0) {
|
|
char error_buf[100];
|
|
mbedtls_strerror(ret, error_buf, 100);
|
|
mbedtls_printf(" [ #%ld ] Last error was: -0x%04x - %s\n\n",
|
|
thread_id, (unsigned int) -ret, error_buf);
|
|
}
|
|
#endif
|
|
|
|
mbedtls_net_free(client_fd);
|
|
mbedtls_ssl_free(&ssl);
|
|
|
|
thread_info->thread_complete = 1;
|
|
|
|
return NULL;
|
|
}
|
|
|
|
static int thread_create(mbedtls_net_context *client_fd)
|
|
{
|
|
int ret, i;
|
|
|
|
/*
|
|
* Find in-active or finished thread slot
|
|
*/
|
|
for (i = 0; i < MAX_NUM_THREADS; i++) {
|
|
if (threads[i].active == 0) {
|
|
break;
|
|
}
|
|
|
|
if (threads[i].data.thread_complete == 1) {
|
|
mbedtls_printf(" [ main ] Cleaning up thread %d\n", i);
|
|
pthread_join(threads[i].thread, NULL);
|
|
memset(&threads[i], 0, sizeof(pthread_info_t));
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (i == MAX_NUM_THREADS) {
|
|
return -1;
|
|
}
|
|
|
|
/*
|
|
* Fill thread-info for thread
|
|
*/
|
|
memcpy(&threads[i].data, &base_info, sizeof(base_info));
|
|
threads[i].active = 1;
|
|
memcpy(&threads[i].data.client_fd, client_fd, sizeof(mbedtls_net_context));
|
|
|
|
if ((ret = pthread_create(&threads[i].thread, NULL, handle_ssl_connection,
|
|
&threads[i].data)) != 0) {
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int main(void)
|
|
{
|
|
int ret;
|
|
mbedtls_net_context listen_fd, client_fd;
|
|
const char pers[] = "ssl_pthread_server";
|
|
|
|
mbedtls_entropy_context entropy;
|
|
mbedtls_ctr_drbg_context ctr_drbg;
|
|
mbedtls_ssl_config conf;
|
|
mbedtls_x509_crt srvcert;
|
|
mbedtls_x509_crt cachain;
|
|
mbedtls_pk_context pkey;
|
|
#if defined(MBEDTLS_MEMORY_BUFFER_ALLOC_C)
|
|
unsigned char alloc_buf[100000];
|
|
#endif
|
|
#if defined(MBEDTLS_SSL_CACHE_C)
|
|
mbedtls_ssl_cache_context cache;
|
|
#endif
|
|
|
|
#if defined(MBEDTLS_MEMORY_BUFFER_ALLOC_C)
|
|
mbedtls_memory_buffer_alloc_init(alloc_buf, sizeof(alloc_buf));
|
|
#endif
|
|
|
|
#if defined(MBEDTLS_SSL_CACHE_C)
|
|
mbedtls_ssl_cache_init(&cache);
|
|
#endif
|
|
|
|
mbedtls_x509_crt_init(&srvcert);
|
|
mbedtls_x509_crt_init(&cachain);
|
|
|
|
mbedtls_ssl_config_init(&conf);
|
|
mbedtls_ctr_drbg_init(&ctr_drbg);
|
|
memset(threads, 0, sizeof(threads));
|
|
mbedtls_net_init(&listen_fd);
|
|
mbedtls_net_init(&client_fd);
|
|
|
|
mbedtls_mutex_init(&debug_mutex);
|
|
|
|
base_info.config = &conf;
|
|
|
|
/*
|
|
* We use only a single entropy source that is used in all the threads.
|
|
*/
|
|
mbedtls_entropy_init(&entropy);
|
|
|
|
#if defined(MBEDTLS_USE_PSA_CRYPTO)
|
|
psa_status_t status = psa_crypto_init();
|
|
if (status != PSA_SUCCESS) {
|
|
mbedtls_fprintf(stderr, "Failed to initialize PSA Crypto implementation: %d\n",
|
|
(int) status);
|
|
ret = MBEDTLS_ERR_SSL_HW_ACCEL_FAILED;
|
|
goto exit;
|
|
}
|
|
#endif /* MBEDTLS_USE_PSA_CRYPTO */
|
|
|
|
/*
|
|
* 1a. Seed the random number generator
|
|
*/
|
|
mbedtls_printf(" . Seeding the random number generator...");
|
|
|
|
if ((ret = mbedtls_ctr_drbg_seed(&ctr_drbg, mbedtls_entropy_func, &entropy,
|
|
(const unsigned char *) pers,
|
|
strlen(pers))) != 0) {
|
|
mbedtls_printf(" failed: mbedtls_ctr_drbg_seed returned -0x%04x\n",
|
|
(unsigned int) -ret);
|
|
goto exit;
|
|
}
|
|
|
|
mbedtls_printf(" ok\n");
|
|
|
|
/*
|
|
* 1b. Load the certificates and private RSA key
|
|
*/
|
|
mbedtls_printf("\n . Loading the server cert. and key...");
|
|
fflush(stdout);
|
|
|
|
/*
|
|
* This demonstration program uses embedded test certificates.
|
|
* Instead, you may want to use mbedtls_x509_crt_parse_file() to read the
|
|
* server and CA certificates, as well as mbedtls_pk_parse_keyfile().
|
|
*/
|
|
ret = mbedtls_x509_crt_parse(&srvcert, (const unsigned char *) mbedtls_test_srv_crt,
|
|
mbedtls_test_srv_crt_len);
|
|
if (ret != 0) {
|
|
mbedtls_printf(" failed\n ! mbedtls_x509_crt_parse returned %d\n\n", ret);
|
|
goto exit;
|
|
}
|
|
|
|
ret = mbedtls_x509_crt_parse(&cachain, (const unsigned char *) mbedtls_test_cas_pem,
|
|
mbedtls_test_cas_pem_len);
|
|
if (ret != 0) {
|
|
mbedtls_printf(" failed\n ! mbedtls_x509_crt_parse returned %d\n\n", ret);
|
|
goto exit;
|
|
}
|
|
|
|
mbedtls_pk_init(&pkey);
|
|
ret = mbedtls_pk_parse_key(&pkey, (const unsigned char *) mbedtls_test_srv_key,
|
|
mbedtls_test_srv_key_len, NULL, 0,
|
|
mbedtls_ctr_drbg_random, &ctr_drbg);
|
|
if (ret != 0) {
|
|
mbedtls_printf(" failed\n ! mbedtls_pk_parse_key returned %d\n\n", ret);
|
|
goto exit;
|
|
}
|
|
|
|
mbedtls_printf(" ok\n");
|
|
|
|
/*
|
|
* 1c. Prepare SSL configuration
|
|
*/
|
|
mbedtls_printf(" . Setting up the SSL data....");
|
|
|
|
if ((ret = mbedtls_ssl_config_defaults(&conf,
|
|
MBEDTLS_SSL_IS_SERVER,
|
|
MBEDTLS_SSL_TRANSPORT_STREAM,
|
|
MBEDTLS_SSL_PRESET_DEFAULT)) != 0) {
|
|
mbedtls_printf(" failed: mbedtls_ssl_config_defaults returned -0x%04x\n",
|
|
(unsigned int) -ret);
|
|
goto exit;
|
|
}
|
|
|
|
mbedtls_ssl_conf_rng(&conf, mbedtls_ctr_drbg_random, &ctr_drbg);
|
|
mbedtls_ssl_conf_dbg(&conf, my_mutexed_debug, stdout);
|
|
|
|
/* mbedtls_ssl_cache_get() and mbedtls_ssl_cache_set() are thread-safe if
|
|
* MBEDTLS_THREADING_C is set.
|
|
*/
|
|
#if defined(MBEDTLS_SSL_CACHE_C)
|
|
mbedtls_ssl_conf_session_cache(&conf, &cache,
|
|
mbedtls_ssl_cache_get,
|
|
mbedtls_ssl_cache_set);
|
|
#endif
|
|
|
|
mbedtls_ssl_conf_ca_chain(&conf, &cachain, NULL);
|
|
if ((ret = mbedtls_ssl_conf_own_cert(&conf, &srvcert, &pkey)) != 0) {
|
|
mbedtls_printf(" failed\n ! mbedtls_ssl_conf_own_cert returned %d\n\n", ret);
|
|
goto exit;
|
|
}
|
|
|
|
mbedtls_printf(" ok\n");
|
|
|
|
/*
|
|
* 2. Setup the listening TCP socket
|
|
*/
|
|
mbedtls_printf(" . Bind on https://localhost:4433/ ...");
|
|
fflush(stdout);
|
|
|
|
if ((ret = mbedtls_net_bind(&listen_fd, NULL, "4433", MBEDTLS_NET_PROTO_TCP)) != 0) {
|
|
mbedtls_printf(" failed\n ! mbedtls_net_bind returned %d\n\n", ret);
|
|
goto exit;
|
|
}
|
|
|
|
mbedtls_printf(" ok\n");
|
|
|
|
reset:
|
|
#ifdef MBEDTLS_ERROR_C
|
|
if (ret != 0) {
|
|
char error_buf[100];
|
|
mbedtls_strerror(ret, error_buf, 100);
|
|
mbedtls_printf(" [ main ] Last error was: -0x%04x - %s\n", (unsigned int) -ret,
|
|
error_buf);
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
* 3. Wait until a client connects
|
|
*/
|
|
mbedtls_printf(" [ main ] Waiting for a remote connection\n");
|
|
|
|
if ((ret = mbedtls_net_accept(&listen_fd, &client_fd,
|
|
NULL, 0, NULL)) != 0) {
|
|
mbedtls_printf(" [ main ] failed: mbedtls_net_accept returned -0x%04x\n",
|
|
(unsigned int) ret);
|
|
goto exit;
|
|
}
|
|
|
|
mbedtls_printf(" [ main ] ok\n");
|
|
mbedtls_printf(" [ main ] Creating a new thread\n");
|
|
|
|
if ((ret = thread_create(&client_fd)) != 0) {
|
|
mbedtls_printf(" [ main ] failed: thread_create returned %d\n", ret);
|
|
mbedtls_net_free(&client_fd);
|
|
goto reset;
|
|
}
|
|
|
|
ret = 0;
|
|
goto reset;
|
|
|
|
exit:
|
|
mbedtls_x509_crt_free(&srvcert);
|
|
mbedtls_pk_free(&pkey);
|
|
#if defined(MBEDTLS_SSL_CACHE_C)
|
|
mbedtls_ssl_cache_free(&cache);
|
|
#endif
|
|
mbedtls_ctr_drbg_free(&ctr_drbg);
|
|
mbedtls_entropy_free(&entropy);
|
|
mbedtls_ssl_config_free(&conf);
|
|
mbedtls_net_free(&listen_fd);
|
|
mbedtls_mutex_free(&debug_mutex);
|
|
#if defined(MBEDTLS_MEMORY_BUFFER_ALLOC_C)
|
|
mbedtls_memory_buffer_alloc_free();
|
|
#endif
|
|
#if defined(MBEDTLS_USE_PSA_CRYPTO)
|
|
mbedtls_psa_crypto_free();
|
|
#endif /* MBEDTLS_USE_PSA_CRYPTO */
|
|
|
|
mbedtls_exit(ret);
|
|
}
|
|
|
|
#endif /* MBEDTLS_BIGNUM_C && MBEDTLS_ENTROPY_C &&
|
|
MBEDTLS_SSL_TLS_C && MBEDTLS_SSL_SRV_C && MBEDTLS_NET_C &&
|
|
MBEDTLS_RSA_C && MBEDTLS_CTR_DRBG_C && MBEDTLS_THREADING_C &&
|
|
MBEDTLS_THREADING_PTHREAD && MBEDTLS_PEM_PARSE_C */
|