314 lines
10 KiB
C
Executable File
314 lines
10 KiB
C
Executable File
/*
|
|
* Copyright (C) 2017 XRADIO TECHNOLOGY CO., LTD. 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
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the
|
|
* distribution.
|
|
* 3. Neither the name of XRADIO TECHNOLOGY CO., LTD. nor the names of
|
|
* its contributors may be used to endorse or promote products derived
|
|
* from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
* "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 COPYRIGHT
|
|
* OWNER 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.
|
|
*/
|
|
|
|
#if PRJCONF_NET_EN
|
|
|
|
#include "tls.h"
|
|
|
|
#if !defined(MBEDTLS_BIGNUM_C) || !defined(MBEDTLS_CERTS_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_PEM_PARSE_C)
|
|
|
|
void mbedtls_server(void *arg)
|
|
{
|
|
mbedtls_printf("MBEDTLS_BIGNUM_C and/or MBEDTLS_CERTS_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_PEM_PARSE_C not defined.\n");
|
|
}
|
|
#else
|
|
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include "mbedtls/entropy.h"
|
|
#include "mbedtls/ctr_drbg.h"
|
|
#include "mbedtls/certs.h"
|
|
#include "mbedtls/x509.h"
|
|
#include "mbedtls/ssl.h"
|
|
#include "mbedtls/net.h"
|
|
#include "mbedtls/error.h"
|
|
#include "mbedtls/debug.h"
|
|
|
|
#if defined(MBEDTLS_SSL_CACHE_C)
|
|
#include "mbedtls/ssl_cache.h"
|
|
#endif
|
|
|
|
extern volatile int mbedtls_string_mismatch;
|
|
|
|
static char tls_cal_checksum(void *buffer, int length)
|
|
{
|
|
unsigned char *cal = (unsigned char *)buffer;
|
|
unsigned char result = 0;
|
|
while (length != 0) {
|
|
result += cal[--length];
|
|
}
|
|
return result;
|
|
}
|
|
|
|
static void server_debug(void *ctx, int level,
|
|
const char *file, int line,
|
|
const char *str)
|
|
{
|
|
((void) level);
|
|
mbedtls_printf("%s:%04d: %s\n", file, line, str);
|
|
}
|
|
|
|
void mbedtls_server(void *arg)
|
|
{
|
|
mbedtls_test_param *param = (mbedtls_test_param *)arg;
|
|
unsigned int flags = param->flags;
|
|
int ret = 0, len = 0;
|
|
|
|
const char *pers = "ssl_server";
|
|
mbedtls_net_context listen_fd, client_fd;
|
|
mbedtls_entropy_context entropy;
|
|
mbedtls_ctr_drbg_context ctr_drbg;
|
|
mbedtls_ssl_context ssl;
|
|
mbedtls_ssl_config conf;
|
|
mbedtls_x509_crt srvcert;
|
|
mbedtls_pk_context pkey;
|
|
#if defined(MBEDTLS_SSL_CACHE_C)
|
|
mbedtls_ssl_cache_context cache;
|
|
#endif
|
|
unsigned char *buf = mbedtls_calloc(1, TLS_TEST_BUF_SIZE);
|
|
if (!buf) {
|
|
mbedtls_printf("[TLS SRV]Malloc failed...\n");
|
|
goto exit;
|
|
}
|
|
mbedtls_net_init(&listen_fd);
|
|
mbedtls_net_init(&client_fd);
|
|
mbedtls_ssl_init(&ssl);
|
|
mbedtls_ssl_config_init(&conf);
|
|
#if defined(MBEDTLS_SSL_CACHE_C)
|
|
mbedtls_ssl_cache_init(&cache);
|
|
#endif
|
|
mbedtls_x509_crt_init(&srvcert);
|
|
mbedtls_pk_init(&pkey);
|
|
mbedtls_entropy_init(&entropy);
|
|
mbedtls_ctr_drbg_init(&ctr_drbg);
|
|
|
|
#if defined(MBEDTLS_DEBUG_C)
|
|
mbedtls_debug_set_threshold(DEBUG_LEVEL);
|
|
#endif
|
|
/* load the certificates and private RSA key */
|
|
mbedtls_printf("Loading the server cert. and key...\n");
|
|
/*
|
|
* 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(&srvcert, (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;
|
|
}
|
|
|
|
ret = mbedtls_pk_parse_key(&pkey, (const unsigned char *) mbedtls_test_srv_key,
|
|
mbedtls_test_srv_key_len, NULL, 0);
|
|
if (ret != 0) {
|
|
mbedtls_printf(" failed\n ! mbedtls_pk_parse_key returned %d\n\n", ret);
|
|
goto exit;
|
|
}
|
|
mbedtls_printf(" ok\n");
|
|
/* Setup the listening TCP socket */
|
|
char *tcp_port = NULL;
|
|
if (flags & MBEDTLS_SSL_FLAG_SERVER_PORT)
|
|
tcp_port = param->server_port;
|
|
else
|
|
tcp_port = SERVER_PORT;
|
|
|
|
if ((ret = mbedtls_net_bind(&listen_fd, NULL, tcp_port, MBEDTLS_NET_PROTO_TCP)) != 0) {
|
|
mbedtls_printf(" failed\n ! mbedtls_net_bind returned %d\n\n", ret);
|
|
goto exit;
|
|
}
|
|
mbedtls_printf(" ok\n");
|
|
/* Seed the RNG */
|
|
mbedtls_printf("Seeding the random number generator...\n");
|
|
if ((ret = mbedtls_ctr_drbg_seed(&ctr_drbg, mbedtls_entropy_func, &entropy,
|
|
(const unsigned char *) pers,
|
|
strlen(pers))) != 0) {
|
|
mbedtls_printf(" failed\n ! mbedtls_ctr_drbg_seed returned %d\n", ret);
|
|
goto exit;
|
|
}
|
|
mbedtls_printf(" ok\n");
|
|
/* Setup stuff */
|
|
mbedtls_printf("Setting up the SSL data....\n");
|
|
if ((ret = mbedtls_ssl_config_defaults(&conf,
|
|
MBEDTLS_SSL_IS_SERVER,
|
|
MBEDTLS_SSL_TRANSPORT_STREAM,
|
|
MBEDTLS_SSL_PRESET_DEFAULT)) != 0) {
|
|
mbedtls_printf(" failed\n ! mbedtls_ssl_config_defaults returned %d\n\n", ret);
|
|
goto exit;
|
|
}
|
|
|
|
mbedtls_ssl_conf_rng(&conf, mbedtls_ctr_drbg_random, &ctr_drbg);
|
|
mbedtls_ssl_conf_dbg(&conf, server_debug, stdout);
|
|
|
|
#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, srvcert.next, 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;
|
|
}
|
|
|
|
if ((ret = mbedtls_ssl_setup(&ssl, &conf)) != 0) {
|
|
mbedtls_printf(" failed\n ! mbedtls_ssl_setup returned %d\n", ret);
|
|
goto exit;
|
|
}
|
|
mbedtls_printf(" ok\n");
|
|
reset:
|
|
if (ret != 0) {
|
|
mbedtls_printf("Last error was: %d\n", ret);
|
|
}
|
|
mbedtls_net_free(&client_fd);
|
|
mbedtls_ssl_session_reset(&ssl);
|
|
/* Wait until a client connects */
|
|
mbedtls_printf("Waiting for a remote connection.\n");
|
|
if ((ret = mbedtls_net_accept(&listen_fd, &client_fd,
|
|
NULL, 0, NULL)) != 0) {
|
|
mbedtls_printf(" failed\n ! mbedtls_net_accept returned %d\n", ret);
|
|
goto exit;
|
|
}
|
|
mbedtls_ssl_set_bio(&ssl, &client_fd, mbedtls_net_send, mbedtls_net_recv, NULL);
|
|
mbedtls_printf(" ok\n");
|
|
|
|
/* Handshake */
|
|
mbedtls_printf("Performing the SSL/TLS handshake.\n");
|
|
while ((ret = mbedtls_ssl_handshake(&ssl)) != 0) {
|
|
if (ret != MBEDTLS_ERR_SSL_WANT_READ && ret != MBEDTLS_ERR_SSL_WANT_WRITE) {
|
|
mbedtls_printf(" failed\n ! mbedtls_ssl_handshake returned %d\n", ret);
|
|
goto reset;
|
|
}
|
|
}
|
|
mbedtls_printf(" ok(%s)\n", mbedtls_ssl_get_ciphersuite(&ssl));
|
|
mbedtls_printf("Read from client.\n");
|
|
|
|
unsigned char checksum = 0;
|
|
mbedtls_string_mismatch = -1;
|
|
|
|
do {
|
|
len = TLS_TEST_BUF_SIZE;
|
|
memset(buf, 0, TLS_TEST_BUF_SIZE);
|
|
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(" connection was closed gracefully\n");
|
|
break;
|
|
case MBEDTLS_ERR_NET_CONN_RESET:
|
|
mbedtls_printf(" connection was reset by peer\n");
|
|
break;
|
|
default:
|
|
mbedtls_printf(" mbedtls_ssl_read returned -0x%x\n", -ret);
|
|
break;
|
|
}
|
|
break;
|
|
}
|
|
|
|
len = ret;
|
|
checksum += tls_cal_checksum(buf, len);
|
|
mbedtls_printf(" %d bytes read\n%s\n", len, (char *) buf);
|
|
} while (1);
|
|
|
|
if (checksum == 0xFF)
|
|
mbedtls_string_mismatch = 0;
|
|
else {
|
|
mbedtls_string_mismatch = -1;
|
|
mbedtls_printf("checksum: 0x%x\n", checksum);
|
|
}
|
|
#if 0
|
|
/* Write Response */
|
|
mbedtls_printf("Write to client:\n");
|
|
while ((ret = mbedtls_ssl_write(&ssl, buf, len)) <= 0) {
|
|
if (ret == MBEDTLS_ERR_NET_CONN_RESET) {
|
|
mbedtls_printf(" failed\n ! peer closed the connection\n");
|
|
goto reset;
|
|
}
|
|
if (ret != MBEDTLS_ERR_SSL_WANT_READ && ret != MBEDTLS_ERR_SSL_WANT_WRITE) {
|
|
mbedtls_printf(" failed\n ! mbedtls_ssl_write returned %d\n\n", ret);
|
|
goto exit;
|
|
}
|
|
}
|
|
#endif
|
|
mbedtls_printf("Closing the connection...\n");
|
|
while ((ret = mbedtls_ssl_close_notify(&ssl)) < 0) {
|
|
if (ret != MBEDTLS_ERR_SSL_WANT_READ &&
|
|
ret != MBEDTLS_ERR_SSL_WANT_WRITE) {
|
|
mbedtls_printf("Warn : mbedtls_ssl_close_notify returned %d\n\n", ret);
|
|
//goto reset;
|
|
break;
|
|
}
|
|
}
|
|
mbedtls_printf(" ok\n");
|
|
ret = 0;
|
|
|
|
exit:
|
|
if (ret != 0)
|
|
mbedtls_printf("Last error was: %d\n\n", ret);
|
|
|
|
mbedtls_net_free(&client_fd);
|
|
mbedtls_net_free(&listen_fd);
|
|
|
|
mbedtls_x509_crt_free(&srvcert);
|
|
mbedtls_pk_free(&pkey);
|
|
mbedtls_ssl_free(&ssl);
|
|
mbedtls_ssl_config_free(&conf);
|
|
#if defined(MBEDTLS_SSL_CACHE_C)
|
|
mbedtls_ssl_cache_free(&cache);
|
|
#endif
|
|
mbedtls_ctr_drbg_free(&ctr_drbg);
|
|
mbedtls_entropy_free(&entropy);
|
|
mbedtls_free(buf);
|
|
}
|
|
#endif /* MBEDTLS_BIGNUM_C && MBEDTLS_CERTS_C && MBEDTLS_ENTROPY_C &&
|
|
MBEDTLS_SSL_TLS_C && MBEDTLS_SSL_SRV_C && MBEDTLS_NET_C &&
|
|
MBEDTLS_RSA_C && MBEDTLS_CTR_DRBG_C && MBEDTLS_X509_CRT_PARSE_C
|
|
&& MBEDTLS_FS_IO && MBEDTLS_PEM_PARSE_C */
|
|
|
|
#endif /* PRJCONF_NET_EN */
|