path: root/test/regression/mqtt_test/netx_mqtt_multiple_receive_test.c

/***************************************************************************/
/* Copyright (c) 2024 Microsoft Corporation                                */
/* Copyright (c) 2026 Eclipse ThreadX contributors                         */
/*                                                                         */
/* This program and the accompanying materials are made available under    */
/* the terms of the MIT License which is available at                      */
/* https://opensource.org/licenses/MIT.                                    */
/*                                                                         */
/* SPDX-License-Identifier: MIT                                            */
/***************************************************************************/

/* MQTT connect test.  This test case validates MQTT client connect without username/password. */

#include   "tx_api.h"
#include   "nx_api.h"
#include   "nxd_mqtt_client.h"
extern void    test_control_return(UINT status);
#define     DEMO_STACK_SIZE    2048

#define CLIENT_ID "1234"
#define TOPIC "topic"
#define MESSAGE_QOS0 "MESSAGE_QOS0"
#define MESSAGE_QOS1 "MESSAGE_QOS11"
#define MESSAGE_QOS2 "MESSAGE_QOS222"

static UINT packet_identifier = 0xbeef;


/* Define the ThreadX and NetX object control blocks...  */

static TX_THREAD               ntest_0;
static TX_THREAD               ntest_1;

static NX_PACKET_POOL          pool_0;
static NX_IP                   ip_0;
static NX_IP                   ip_1;
static NX_TCP_SOCKET           server_socket;


#define NUM_PACKETS                 24
#define PACKET_SIZE                 1536
#define PACKET_POOL_SIZE            (NUM_PACKETS * (PACKET_SIZE + sizeof(NX_PACKET)))

#ifdef NX_SECURE_ENABLE

#include "../web_test/test_device_cert.c"
#include "../web_test/test_ca_cert.c"

/* Declare external cryptosuites. */
extern const NX_SECURE_TLS_CRYPTO nx_crypto_tls_ciphers;

static NX_SECURE_TLS_SESSION tls_server_session;
static NX_SECURE_X509_CERT server_local_certificate;

/* Define crypto metadata buffer. */
static UCHAR client_metadata[5*4096];
static UCHAR server_metadata[5*4096];

/* For remote certificate. */
static NX_SECURE_X509_CERT remote_certificate, remote_issuer, ca_certificate;
static UCHAR remote_cert_buffer[2000];
static UCHAR remote_issuer_buffer[2000];
static UCHAR tls_packet_buffer[2][4096];

#define TEST_LOOP 2
#else
#define TEST_LOOP 1
#endif

static TX_SEMAPHORE semaphore_server_start;
static TX_SEMAPHORE semaphore_client_stop;

/* Define the counters used in the demo application...  */

static ULONG                   error_counter;

/* Define thread prototypes.  */

static void    ntest_0_entry(ULONG thread_input);
static void    ntest_1_entry(ULONG thread_input);
extern void    _nx_ram_network_driver_1500(struct NX_IP_DRIVER_STRUCT *driver_req);

extern void SET_ERROR_COUNTER(ULONG *error_counter, CHAR *filename, int line_number);

/* Define what the initial system looks like.  */
static NXD_MQTT_CLIENT *client_ptr;
//NXD_MQTT_CLIENT my_client;
static UCHAR *stack_ptr;
#ifdef CTEST
VOID test_application_define(void *first_unused_memory)
#else
void       netx_mqtt_client_multiple_receive_application_define(void *first_unused_memory)
#endif
{
CHAR       *pointer;
UINT       status;

    /* Setup the working pointer.  */
    pointer = (CHAR *) first_unused_memory;

    error_counter = 0;

    /* Create the main thread.  */
    tx_thread_create(&ntest_0, "thread 0", ntest_0_entry, 0,
                     pointer, DEMO_STACK_SIZE, 
                     4, 4, TX_NO_TIME_SLICE, TX_DONT_START);

    pointer = pointer + DEMO_STACK_SIZE;

    /* Create the main thread.  */
    tx_thread_create(&ntest_1, "thread 1", ntest_1_entry, 0,
                     pointer, DEMO_STACK_SIZE, 
                     4, 4, TX_NO_TIME_SLICE, TX_AUTO_START);

    pointer = pointer + DEMO_STACK_SIZE;

    tx_semaphore_create(&semaphore_server_start, "semaphore server start", 0);
    tx_semaphore_create(&semaphore_client_stop, "semaphore client stop", 0);

    /* Initialize the NetX system.  */
    nx_system_initialize();

    /* Create a packet pool.  */
    status = nx_packet_pool_create(&pool_0, "NetX Main Packet Pool", PACKET_SIZE, pointer, PACKET_POOL_SIZE);
    pointer = pointer + PACKET_POOL_SIZE;

    if(status)
        SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

    /* Create an IP instance.  */
    status = nx_ip_create(&ip_0, "NetX IP Instance 0", IP_ADDRESS(1, 2, 3, 4), 0xFFFFFF00UL, &pool_0, _nx_ram_network_driver_1500,
                          pointer, 2048, 1);
    pointer = pointer + 2048;

    /* Create another IP instance.  */
    status += nx_ip_create(&ip_1, "NetX IP Instance 1", IP_ADDRESS(1, 2, 3, 5), 0xFFFFFF00UL, &pool_0, _nx_ram_network_driver_1500,
                           pointer, 2048, 1);
    pointer = pointer + 2048;

    if(status)
        SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

    /* Enable ARP and supply ARP cache memory for IP Instance 0.  */
    status = nx_arp_enable(&ip_0, (void *) pointer, 1024);
    pointer = pointer + 1024;

    /* Enable ARP and supply ARP cache memory for IP Instance 1.  */
    status += nx_arp_enable(&ip_1, (void *) pointer, 1024);
    pointer = pointer + 1024;

    /* Check ARP enable status.  */
    if(status)
        SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

    /* Enable TCP processing for both IP instances.  */
    status = nx_tcp_enable(&ip_0);
    status += nx_tcp_enable(&ip_1);

    /* Check TCP enable status.  */
    if(status)
        SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

    stack_ptr = pointer;
    pointer += DEMO_STACK_SIZE;
    client_ptr = (NXD_MQTT_CLIENT*)pointer;
    //client_ptr = &my_client;

}


#ifdef NX_SECURE_ENABLE

/* Define the callback function for tls connection. */
static UINT client_tls_setup(NXD_MQTT_CLIENT* client_ptr, NX_SECURE_TLS_SESSION* tls_session,
                             NX_SECURE_X509_CERT* certificate, NX_SECURE_X509_CERT* trusted_certificate)
{
UINT status;

    /* Create a tls session. */
    status = nx_secure_tls_session_create(tls_session,
                                          &nx_crypto_tls_ciphers,
                                          client_metadata,
                                          sizeof(client_metadata));

    if (status)
    {
        return status;
    }
    
    nx_secure_tls_session_packet_buffer_set(tls_session, tls_packet_buffer[0], sizeof(tls_packet_buffer[0]));
    nx_secure_tls_remote_certificate_allocate(tls_session, &remote_certificate, remote_cert_buffer, sizeof(remote_cert_buffer));
    nx_secure_tls_remote_certificate_allocate(tls_session, &remote_issuer, remote_issuer_buffer, sizeof(remote_issuer_buffer));

    nx_secure_x509_certificate_initialize(&ca_certificate, test_ca_cert_der, test_ca_cert_der_len,
                                          NX_NULL, 0, NX_NULL, 0, NX_SECURE_X509_KEY_TYPE_NONE);
    nx_secure_tls_trusted_certificate_add(tls_session, &ca_certificate);

    return(NX_SUCCESS);
}

static UINT server_tls_setup(NX_SECURE_TLS_SESSION *tls_session)
{
UINT status;

    status = nx_secure_tls_session_create(tls_session,
                                          &nx_crypto_tls_ciphers,
                                          server_metadata,
                                          sizeof(server_metadata));
    if (status)
    {
        return status;
    }

    memset(&server_local_certificate, 0, sizeof(server_local_certificate));
    nx_secure_x509_certificate_initialize(&server_local_certificate,
                                          test_device_cert_der, test_device_cert_der_len,
                                          NX_NULL, 0, test_device_cert_key_der,
                                          test_device_cert_key_der_len, NX_SECURE_X509_KEY_TYPE_RSA_PKCS1_DER);

    nx_secure_tls_local_certificate_add(tls_session, &server_local_certificate);

    nx_secure_tls_session_packet_buffer_set(tls_session, tls_packet_buffer[1], sizeof(tls_packet_buffer[1]));

    return(NX_SUCCESS);
}
#endif

static UINT keepalive_value;
static UINT cleansession_value;
#define DEMO_TIMER_EVENT     1
#define DEMO_MESSAGE_EVENT   2
#define DEMO_ALL_EVENTS 3

TX_EVENT_FLAGS_GROUP mqtt_app_flag;

static VOID my_notify_func(NXD_MQTT_CLIENT* client_ptr, UINT number_of_messages)
{
  
    tx_event_flags_set(&mqtt_app_flag, DEMO_MESSAGE_EVENT, TX_OR);
    return;
  
}

static UCHAR topic[100], message[100];
#define MQTT_CLIENT_THREAD_PRIORITY  2
#ifdef CTEST
static
#else /* CTEST */
extern
#endif /* CTEST */
UCHAR mqtt_memory[8192];
/* Define the test threads.  */
/* This thread sets up MQTT client and makes a connect request without username/password. */
static void    ntest_0_entry(ULONG thread_input)
{
UINT       status;
NXD_ADDRESS server_address;
ULONG events;
UINT topic_length, message_length;
UINT i;

    /* Print out test information banner.  */
    printf("NetX Test:   MQTT Multiple Receive Test................................");

    status = tx_event_flags_create(&mqtt_app_flag, "my app event");
    if(status)
        SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

    /* Check for earlier error.  */
    if(error_counter)
    {
        printf("ERROR!\n");
        test_control_return(1);
    }

    status = nxd_mqtt_client_create(client_ptr, "my client", CLIENT_ID, strlen(CLIENT_ID), &ip_0, &pool_0,
                                    stack_ptr, DEMO_STACK_SIZE, MQTT_CLIENT_THREAD_PRIORITY, mqtt_memory, sizeof(mqtt_memory));
    if(status)
        SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);
    tx_thread_sleep(1);
    status = nxd_mqtt_client_receive_notify_set(client_ptr, my_notify_func);
    if(status)
        SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

    server_address.nxd_ip_version = 4;
    server_address.nxd_ip_address.v4 = IP_ADDRESS(1, 2, 3, 5);
    keepalive_value = 0;
    cleansession_value = 0;

    for (i = 0; i < TEST_LOOP; i++)
    {
        tx_semaphore_get(&semaphore_server_start, NX_WAIT_FOREVER);

        if (i == 0)
        {
            status = nxd_mqtt_client_connect(client_ptr, &server_address, NXD_MQTT_PORT,
                                             keepalive_value, cleansession_value, NX_IP_PERIODIC_RATE);
#ifdef NXD_MQTT_REQUIRE_TLS
            if (status != NXD_MQTT_CONNECT_FAILURE)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

            tx_semaphore_put(&semaphore_client_stop);
            continue;
#endif
        }
#ifdef NX_SECURE_ENABLE
        else
        {
            status = nxd_mqtt_client_secure_connect(client_ptr, &server_address, NXD_MQTT_PORT,
                                                    client_tls_setup,
                                                    keepalive_value, cleansession_value, NX_IP_PERIODIC_RATE);
        }
#endif

        if (status)
            SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

        /* Wait for incoming message. */
        tx_event_flags_get(&mqtt_app_flag, DEMO_ALL_EVENTS, TX_OR_CLEAR, &events, TX_WAIT_FOREVER);

        status = nxd_mqtt_client_message_get(client_ptr, topic, sizeof(topic), &topic_length, message, sizeof(message), &message_length);

        if (status)
            SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

        if (topic_length != strlen(TOPIC) || strncmp(TOPIC, topic, topic_length) || (message_length != strlen(MESSAGE_QOS0)) ||
            strncmp(message, MESSAGE_QOS0, message_length))
            SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

        /* Wait for incoming message. */
        tx_event_flags_get(&mqtt_app_flag, DEMO_ALL_EVENTS, TX_OR_CLEAR, &events, TX_WAIT_FOREVER);

        status = nxd_mqtt_client_message_get(client_ptr, topic, sizeof(topic), &topic_length, message, sizeof(message), &message_length);
        if (status)
            SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

        if (topic_length != strlen(TOPIC) || strncmp(TOPIC, topic, topic_length) || (message_length != strlen(MESSAGE_QOS1)) ||
            strncmp(message, MESSAGE_QOS1, message_length))
            SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

#if 0
        /* Wait for incoming message. */
        tx_event_flags_get(&mqtt_app_flag, DEMO_ALL_EVENTS, TX_OR_CLEAR, &events, TX_WAIT_FOREVER);


        status = nxd_mqtt_client_message_get(client_ptr, topic, sizeof(topic), &topic_length, message, sizeof(message), &message_length);

        if (status)
            SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

        if ((topic_length != strlen(TOPIC)) || strncmp(TOPIC, topic, topic_length) || (message_length != strlen(MESSAGE_QOS2)) ||
            strncmp(message, MESSAGE_QOS2, message_length))
        {
            SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);
        }
#endif

        nxd_mqtt_client_disconnect(client_ptr);

        tx_semaphore_put(&semaphore_client_stop);
    }

    nxd_mqtt_client_delete(client_ptr);

    /* Determine if the test was successful.  */
    if(error_counter)
    {
        printf("ERROR!\n");
        test_control_return(1);
    }
    else
    {
        printf("SUCCESS!\n");
        test_control_return(0);
    }
}

    /* Check for error.  */

static UCHAR content[100];

static UCHAR fixed_header[] = {0x10, 0x00, 0x00, 0x04, 'M', 'Q', 'T', 'T', 0x4, 0x0, 0x0, 0x0};

/* This thread acts as MQTT server, accepting the connection. */
static void    ntest_1_entry(ULONG thread_input)
{
UINT       status;
ULONG      actual_status;
NX_PACKET  *packet_ptr;
UCHAR      *byte;
UINT        index = 0;
UINT        i;

    /* Ensure the IP instance has been initialized.  */
    status = nx_ip_status_check(&ip_1, NX_IP_INITIALIZE_DONE, &actual_status, NX_IP_PERIODIC_RATE);

    /* Check for error.  */
    if(status)
        SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

    /* Create a socket.  */
    status = nx_tcp_socket_create(&ip_1, &server_socket, "Server Socket", 
                                  NX_IP_NORMAL, NX_FRAGMENT_OKAY, NX_IP_TIME_TO_LIVE, 1000,
                                  NX_NULL, NX_NULL);

    /* Check for error.  */
    if(status)
        SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

    /* Setup this thread to listen.  */
    status = nx_tcp_server_socket_listen(&ip_1, NXD_MQTT_PORT, &server_socket, 5, NX_NULL);

    /* Check for error.  */
    if(status)
        SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

#ifdef NX_SECURE_ENABLE
    /* Session setup.  */
    server_tls_setup(&tls_server_session);
#endif

    tx_thread_resume(&ntest_0);

    for (i = 0; i < TEST_LOOP; i++)
    {

        tx_semaphore_put(&semaphore_server_start);

        /* Accept a connection from client socket.  */
        status = nx_tcp_server_socket_accept(&server_socket, NX_IP_PERIODIC_RATE);

        /* Check for error.  */
        if (status)
        {
#ifdef NXD_MQTT_REQUIRE_TLS
            if (i == 1)
#endif
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);
        }

#ifdef NX_SECURE_ENABLE
        if (i == 1)
        {
            status = nx_secure_tls_session_start(&tls_server_session, &server_socket, NX_WAIT_FOREVER);
            if (status)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);
        }
#endif

        tx_thread_sleep(1);
        if (i == 0)
        {
            status = nx_tcp_socket_receive(&server_socket, &packet_ptr, 5 * NX_IP_PERIODIC_RATE);
        }
#ifdef NX_SECURE_ENABLE
        else
        {
            status = nx_secure_tls_session_receive(&tls_server_session, &packet_ptr, NX_WAIT_FOREVER);
        }
#endif

        if (status)
        {
#ifdef NXD_MQTT_REQUIRE_TLS
            if (i == 1)
#endif
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);
        }
        else
        {

            /* construct the connect message. */
            memcpy(content, fixed_header, sizeof(fixed_header));
            /* Append client ID */
            content[sizeof(fixed_header)] = (strlen(CLIENT_ID) >> 8) & 0xf;
            content[sizeof(fixed_header) + 1] = (strlen(CLIENT_ID) & 0xf);
            memcpy(content + sizeof(fixed_header) + 2, CLIENT_ID, strlen(CLIENT_ID));

            content[1] = (UCHAR)(sizeof(fixed_header) + strlen(CLIENT_ID));

            /* Fill in the connection_flag, keepalive, and cleansession flags. */
            content[10] = keepalive_value >> 8;
            content[11] = keepalive_value & 0xFF;
            if (cleansession_value)
                content[9] = content[9] | 2;

            /* Validate the MQTT connect request. */
            if (memcmp(packet_ptr->nx_packet_prepend_ptr, content, sizeof(fixed_header) + strlen(CLIENT_ID)))
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

#ifdef NX_SECURE_ENABLE
            if (i == 1)
            {
                nx_packet_release(packet_ptr);
                status = nx_secure_tls_packet_allocate(&tls_server_session, &pool_0, &packet_ptr, NX_NO_WAIT);
                if (status)
                    SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);
            }
#endif

            /* Response with SUCCESS */
            byte = packet_ptr->nx_packet_prepend_ptr;
            byte[0] = 0x20;
            byte[1] = 0x02;
            byte[2] = 0;
            byte[3] = 0;

            packet_ptr->nx_packet_append_ptr = packet_ptr->nx_packet_prepend_ptr + 4;
            packet_ptr->nx_packet_length = 4;

            if (i == 0)
            {
                status = nx_tcp_socket_send(&server_socket, packet_ptr, 1);
            }
#ifdef NX_SECURE_ENABLE
            else
            {
                status = nx_secure_tls_session_send(&tls_server_session, packet_ptr, NX_WAIT_FOREVER);
            }
#endif
            if (status)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

            tx_thread_sleep(50);

            /* Send a publish message with QoS 0 */
            if (i == 0)
            {
                status = nx_packet_allocate(&pool_0, &packet_ptr, NX_TCP_PACKET, 0);
            }
#ifdef NX_SECURE_ENABLE
            else
            {
                status = nx_secure_tls_packet_allocate(&tls_server_session, &pool_0, &packet_ptr, NX_NO_WAIT);
            }
#endif
            if (status)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

            byte = packet_ptr->nx_packet_prepend_ptr;
            byte[0] = 0x30;

            index = 2;
            byte[index++] = ((strlen(TOPIC)) >> 8) & 0xFF;
            byte[index++] = (strlen(TOPIC)) & 0xFF;
            memcpy(byte + index, TOPIC, strlen(TOPIC));

            index += strlen(TOPIC);

            memcpy(byte + index, MESSAGE_QOS0, strlen(MESSAGE_QOS0));
            index += strlen(MESSAGE_QOS0);

            byte[1] = index - 2;
            packet_ptr->nx_packet_length = index;
            packet_ptr->nx_packet_append_ptr = packet_ptr->nx_packet_prepend_ptr + index;

            if (i == 0)
            {
                status = nx_tcp_socket_send(&server_socket, packet_ptr, 1);
            }
#ifdef NX_SECURE_ENABLE
            else
            {
                status = nx_secure_tls_session_send(&tls_server_session, packet_ptr, NX_WAIT_FOREVER);
            }
#endif
            if (status)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);
            tx_thread_sleep(5);
            /* We dont expect anything back for QoS 0. */

            /* Send a publish message with QoS 1 */
            if (i == 0)
            {
                status = nx_packet_allocate(&pool_0, &packet_ptr, NX_TCP_PACKET, 0);
            }
#ifdef NX_SECURE_ENABLE
            else
            {
                status = nx_secure_tls_packet_allocate(&tls_server_session, &pool_0, &packet_ptr, NX_NO_WAIT);
            }
#endif
            if (status)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

            byte = packet_ptr->nx_packet_prepend_ptr;
            byte[0] = 0x32;

            index = 2;
            byte[index++] = (strlen(TOPIC) >> 8) & 0xFF;
            byte[index++] = strlen(TOPIC) & 0xFF;
            memcpy(byte + index, TOPIC, strlen(TOPIC));

            index += strlen(TOPIC);
            byte[index++] = packet_identifier >> 8;
            byte[index++] = packet_identifier & 0xFF;

            memcpy(byte + index, MESSAGE_QOS1, strlen(MESSAGE_QOS1));
            index += strlen(MESSAGE_QOS1);

            byte[1] = index - 2;
            packet_ptr->nx_packet_length = index;
            packet_ptr->nx_packet_append_ptr = packet_ptr->nx_packet_prepend_ptr + index;

            if (i == 0)
            {
                status = nx_tcp_socket_send(&server_socket, packet_ptr, 1);
                if (status)
                    SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

                /* Expect PUBBACK */
                status = nx_tcp_socket_receive(&server_socket, &packet_ptr, 50);
            }
#ifdef NX_SECURE_ENABLE
            else
            {
                status = nx_secure_tls_session_send(&tls_server_session, packet_ptr, NX_WAIT_FOREVER);
                if (status)
                    SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

                /* Expect PUBBACK */
                status = nx_secure_tls_session_receive(&tls_server_session, &packet_ptr, NX_WAIT_FOREVER);

            }
#endif
            if (status)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

            byte = packet_ptr->nx_packet_prepend_ptr;
            if (packet_ptr->nx_packet_length != 4)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

            if ((byte[0] != 0x40) || (byte[1] != 2) || (byte[2] != (packet_identifier >> 8)) || (byte[3] != (packet_identifier & 0xFF)))
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

            /* All deon, release the packet. */
            status = nx_packet_release(packet_ptr);

            /* Increment the packet id */
            packet_identifier++;

#if 0
            /* Send a publish message with QoS 2 */
            status = nx_packet_allocate(&pool_0, &packet_ptr, NX_TCP_PACKET, 0);
            if (status)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

            byte = packet_ptr->nx_packet_prepend_ptr;
            byte[0] = 0x34;

            index = 2;
            byte[index++] = (strlen(TOPIC) >> 8) & 0xFF;
            byte[index++] = strlen(TOPIC) & 0xFF;
            memcpy(byte + index, TOPIC, strlen(TOPIC));

            index += strlen(TOPIC);
            byte[index++] = packet_identifier >> 8;
            byte[index++] = packet_identifier & 0xFF;

            memcpy(byte + index, MESSAGE_QOS2, strlen(MESSAGE_QOS2));
            index += strlen(MESSAGE_QOS2);

            byte[1] = index - 2;
            packet_ptr->nx_packet_length = index;
            packet_ptr->nx_packet_append_ptr = packet_ptr->nx_packet_prepend_ptr + index;

            status = nx_tcp_socket_send(&server_socket, packet_ptr, 1);
            if (status)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

            /* Expect PUBBACK */
            status = nx_tcp_socket_receive(&server_socket, &packet_ptr, 5);
            if (status)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

            byte = packet_ptr->nx_packet_prepend_ptr;
            if (packet_ptr->nx_packet_length != 4)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

            if ((byte[0] != 0x50) || (byte[1] != 2) || (byte[2] != (packet_identifier >> 8)) || (byte[3] != (packet_identifier & 0xFF)))
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);


            /* Respond with PUBREL */
            byte[0] = 0x60;
            status = nx_tcp_socket_send(&server_socket, packet_ptr, 1);
            if (status)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

            /* Expect PUBCOMP */
            status = nx_tcp_socket_receive(&server_socket, &packet_ptr, 5);
            if (status)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

            byte = packet_ptr->nx_packet_prepend_ptr;
            if (packet_ptr->nx_packet_length != 4)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

            if ((byte[0] != 0x70) || (byte[1] != 2) || (byte[2] != (packet_identifier >> 8)) || (byte[3] != (packet_identifier & 0xFF)))
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

            /* All deon, release the packet. */
            status = nx_packet_release(packet_ptr);

#endif

            tx_thread_sleep(10);

#ifdef NX_SECURE_ENABLE
            if (i == 1)
            {
                /* End session.  */
                nx_secure_tls_session_end(&tls_server_session, NX_NO_WAIT);
            }
#endif

            /* Disconnect.  */
            status = nx_tcp_socket_disconnect(&server_socket, NX_IP_PERIODIC_RATE);

            /* Check for error.  */
            if (status)
                SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);
        }

        tx_semaphore_get(&semaphore_client_stop, NX_WAIT_FOREVER);


        /* Unaccept the server socket.  */
        status = nx_tcp_server_socket_unaccept(&server_socket);

        /* Check for error.  */
        if (status)
            SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

        /* Prepare to accept another connection. */
        status = nx_tcp_server_socket_relisten(&ip_1, NXD_MQTT_PORT, &server_socket);

        /* Check for error.  */
        if (status)
            SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);
    }

#ifdef NX_SECURE_ENABLE
    /* Delete the session.  */
    nx_secure_tls_session_delete(&tls_server_session);
#endif

    /* Unlisten on the server port.  */
    status =  nx_tcp_server_socket_unlisten(&ip_1, NXD_MQTT_PORT);

    /* Check for error.  */
    if (status)
        SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);

    /* Delete the socket.  */
    status = nx_tcp_socket_delete(&server_socket);

    /* Check for error.  */
    if(status)
        SET_ERROR_COUNTER(&error_counter, __FILE__, __LINE__);
}