mirror of
https://github.com/azure-rtos/threadx
synced 2025-01-30 08:02:57 +08:00
369 lines
10 KiB
C
369 lines
10 KiB
C
/* This test is designed to test queue full suspension of queue that supports 3 messages
|
|
that are each 2 ULONG in size. */
|
|
|
|
#include <stdio.h>
|
|
#include "tx_api.h"
|
|
|
|
static TX_THREAD thread_0;
|
|
|
|
static unsigned long thread_1_counter = 0;
|
|
static TX_THREAD thread_1;
|
|
|
|
static unsigned long thread_2_counter = 0;
|
|
static TX_THREAD thread_2;
|
|
|
|
static TX_QUEUE queue_0;
|
|
|
|
|
|
static unsigned long thread_1a_counter = 0;
|
|
static TX_THREAD thread_1a;
|
|
|
|
static unsigned long thread_2a_counter = 0;
|
|
static TX_THREAD thread_2a;
|
|
|
|
static TX_QUEUE queue_0a;
|
|
|
|
|
|
static ULONG queue_area[3];
|
|
|
|
|
|
/* Define thread prototypes. */
|
|
|
|
static void thread_0_entry(ULONG thread_input);
|
|
static void thread_1_entry(ULONG thread_input);
|
|
static void thread_2_entry(ULONG thread_input);
|
|
static void thread_1a_entry(ULONG thread_input);
|
|
static void thread_2a_entry(ULONG thread_input);
|
|
|
|
|
|
/* Prototype for test control return. */
|
|
|
|
void test_control_return(UINT status);
|
|
|
|
|
|
static void queue_notify(TX_QUEUE *queue_ptr)
|
|
{
|
|
|
|
}
|
|
|
|
|
|
/* Define what the initial system looks like. */
|
|
|
|
#ifdef CTEST
|
|
void test_application_define(void *first_unused_memory)
|
|
#else
|
|
void threadx_queue_full_suspension_application_define(void *first_unused_memory)
|
|
#endif
|
|
{
|
|
|
|
UINT status;
|
|
CHAR *pointer;
|
|
|
|
|
|
/* Put first available memory address into a character pointer. */
|
|
pointer = (CHAR *) first_unused_memory;
|
|
|
|
/* Put system definition stuff in here, e.g. thread creates and other assorted
|
|
create information. */
|
|
|
|
status = tx_thread_create(&thread_0, "thread 0", thread_0_entry, 1,
|
|
pointer, TEST_STACK_SIZE_PRINTF,
|
|
16, 16, 100, TX_AUTO_START);
|
|
pointer = pointer + TEST_STACK_SIZE_PRINTF;
|
|
|
|
/* Check for status. */
|
|
if (status != TX_SUCCESS)
|
|
{
|
|
|
|
printf("Running Queue Full Suspension Test.................................. ERROR #1\n");
|
|
test_control_return(1);
|
|
}
|
|
|
|
status = tx_thread_create(&thread_1, "thread 1", thread_1_entry, 1,
|
|
pointer, TEST_STACK_SIZE_PRINTF,
|
|
17, 16, 100, TX_DONT_START);
|
|
pointer = pointer + TEST_STACK_SIZE_PRINTF;
|
|
status += tx_thread_create(&thread_1a, "thread 1a", thread_1a_entry, 1,
|
|
pointer, TEST_STACK_SIZE_PRINTF,
|
|
17, 16, 100, TX_AUTO_START);
|
|
pointer = pointer + TEST_STACK_SIZE_PRINTF;
|
|
|
|
/* Check for status. */
|
|
if (status != TX_SUCCESS)
|
|
{
|
|
|
|
printf("Running Queue Full Suspension Test.................................. ERROR #2\n");
|
|
test_control_return(1);
|
|
}
|
|
|
|
status = tx_thread_create(&thread_2, "thread 2", thread_2_entry, 2,
|
|
pointer, TEST_STACK_SIZE_PRINTF,
|
|
16, 16, 100, TX_DONT_START);
|
|
pointer = pointer + TEST_STACK_SIZE_PRINTF;
|
|
status += tx_thread_create(&thread_2a, "thread 2a", thread_2a_entry, 2,
|
|
pointer, TEST_STACK_SIZE_PRINTF,
|
|
16, 16, 100, TX_DONT_START);
|
|
pointer = pointer + TEST_STACK_SIZE_PRINTF;
|
|
|
|
/* Check for status. */
|
|
if (status != TX_SUCCESS)
|
|
{
|
|
|
|
printf("Running Queue Full Suspension Test.................................. ERROR #3\n");
|
|
test_control_return(1);
|
|
}
|
|
|
|
/* Create the queue. */
|
|
status = tx_queue_create(&queue_0, "queue 0", TX_2_ULONG, pointer, 3*2*sizeof(ULONG));
|
|
pointer = pointer + 3*2*sizeof(ULONG);
|
|
status += tx_queue_create(&queue_0a, "queue 0a", TX_1_ULONG, pointer, 3*1*sizeof(ULONG));
|
|
pointer = pointer + 3*1*sizeof(ULONG);
|
|
|
|
/* Check for status. */
|
|
if (status != TX_SUCCESS)
|
|
{
|
|
|
|
printf("Running Queue Full Suspension Test.................................. ERROR #4\n");
|
|
test_control_return(1);
|
|
}
|
|
|
|
/* Setup queue send notification. */
|
|
status = tx_queue_send_notify(&queue_0, queue_notify);
|
|
|
|
#ifndef TX_DISABLE_NOTIFY_CALLBACKS
|
|
|
|
/* Check for status. */
|
|
if (status != TX_SUCCESS)
|
|
{
|
|
|
|
printf("Running Queue Full Suspension Test.................................. ERROR #5\n");
|
|
test_control_return(1);
|
|
}
|
|
#else
|
|
|
|
/* Check for status. */
|
|
if (status != TX_FEATURE_NOT_ENABLED)
|
|
{
|
|
|
|
printf("Running Queue Full Suspension Test.................................. ERROR #6\n");
|
|
test_control_return(1);
|
|
}
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Define the test threads. */
|
|
|
|
static void thread_0_entry(ULONG thread_input)
|
|
{
|
|
|
|
UINT status;
|
|
ULONG source_message[2] = {0x12345678, 0};
|
|
ULONG dest_message[2];
|
|
|
|
|
|
/* Inform user. */
|
|
printf("Running Queue Full Suspension Test.................................. ");
|
|
|
|
/* Perform the one word queue version. */
|
|
|
|
/* Suspend to get thread 1a to pend on the queue. */
|
|
tx_thread_suspend(&thread_0);
|
|
status = tx_queue_send(&queue_0a, &source_message[0], TX_NO_WAIT);
|
|
tx_thread_suspend(&thread_0);
|
|
tx_thread_resume(&thread_1a);
|
|
tx_thread_resume(&thread_2a);
|
|
tx_queue_delete(&queue_0a);
|
|
status += tx_queue_create(&queue_0a, "queue 0a", TX_1_ULONG, queue_area, sizeof(queue_area));
|
|
|
|
|
|
/* Fill the queue with an initial 3 messages! */
|
|
status += tx_queue_send(&queue_0a, &source_message[0], TX_NO_WAIT);
|
|
status += tx_queue_send(&queue_0a, &source_message[0], TX_NO_WAIT);
|
|
status += tx_queue_send(&queue_0a, &source_message[0], TX_NO_WAIT);
|
|
source_message[0]++;
|
|
|
|
/* Receive two of the messages back to put the first received message at the end
|
|
of the queue. */
|
|
status += tx_queue_receive(&queue_0a, &dest_message[0], TX_NO_WAIT);
|
|
status += tx_queue_receive(&queue_0a, &dest_message[0], TX_NO_WAIT);
|
|
status += tx_queue_send(&queue_0a, &source_message[0], TX_NO_WAIT);
|
|
source_message[0]++;
|
|
status += tx_queue_send(&queue_0a, &source_message[0], TX_NO_WAIT);
|
|
source_message[0]++;
|
|
|
|
/* Check status and run count of other thread. */
|
|
if ((status != TX_SUCCESS) || (thread_1a_counter != 0))
|
|
{
|
|
|
|
/* Queue error. */
|
|
printf("ERROR #6a\n");
|
|
test_control_return(1);
|
|
}
|
|
|
|
/* Send message that should cause this thread to suspend, until the
|
|
lower priority thread receives a message. */
|
|
status = tx_queue_send(&queue_0a, &source_message[0], TX_WAIT_FOREVER);
|
|
|
|
/* Check status and run count of other thread - it should have got the
|
|
message already even though its counter is still 0 (it was preempted
|
|
in the queue receive call. */
|
|
if ((status != TX_SUCCESS) || (thread_1a_counter != 5) || (thread_2a_counter != 1))
|
|
{
|
|
|
|
/* Queue error. */
|
|
printf("ERROR #7a\n");
|
|
test_control_return(1);
|
|
}
|
|
|
|
/* Perform the two word queue version. */
|
|
|
|
/* Reset the source message. */
|
|
source_message[0] = 0x12345678;
|
|
source_message[1] = 0;
|
|
|
|
/* Resume threads 1 and 2. */
|
|
tx_thread_resume(&thread_1);
|
|
tx_thread_resume(&thread_2);
|
|
|
|
/* Fill the queue with an initial 3 messages! */
|
|
status = tx_queue_send(&queue_0, &source_message[0], TX_NO_WAIT);
|
|
status += tx_queue_send(&queue_0, &source_message[0], TX_NO_WAIT);
|
|
status += tx_queue_send(&queue_0, &source_message[0], TX_NO_WAIT);
|
|
source_message[0]++;
|
|
|
|
/* Receive two of the messages back to put the first received message at the end
|
|
of the queue. */
|
|
status += tx_queue_receive(&queue_0, &dest_message[0], TX_NO_WAIT);
|
|
status += tx_queue_receive(&queue_0, &dest_message[0], TX_NO_WAIT);
|
|
status += tx_queue_send(&queue_0, &source_message[0], TX_NO_WAIT);
|
|
source_message[0]++;
|
|
status += tx_queue_send(&queue_0, &source_message[0], TX_NO_WAIT);
|
|
source_message[0]++;
|
|
|
|
/* Check status and run count of other thread. */
|
|
if ((status != TX_SUCCESS) || (thread_1_counter != 0))
|
|
{
|
|
|
|
/* Queue error. */
|
|
printf("ERROR #6\n");
|
|
test_control_return(1);
|
|
}
|
|
|
|
/* Send message that should cause this thread to suspend, until the
|
|
lower priority thread receives a message. */
|
|
status = tx_queue_send(&queue_0, &source_message[0], TX_WAIT_FOREVER);
|
|
|
|
/* Check status and run count of other thread - it should have got the
|
|
message already even though its counter is still 0 (it was preempted
|
|
in the queue receive call. */
|
|
if ((status != TX_SUCCESS) || (thread_1_counter != 5) || (thread_2_counter != 1))
|
|
{
|
|
|
|
/* Queue error. */
|
|
printf("ERROR #7\n");
|
|
test_control_return(1);
|
|
}
|
|
else
|
|
{
|
|
|
|
/* Successful test. */
|
|
printf("SUCCESS!\n");
|
|
test_control_return(0);
|
|
}
|
|
}
|
|
|
|
|
|
static void thread_1_entry(ULONG thread_input)
|
|
{
|
|
UINT status;
|
|
ULONG expected_message[2] = {0x12345678, 0};
|
|
ULONG dest_message[2];
|
|
UINT old_priority;
|
|
|
|
|
|
/* Loop forever! */
|
|
while(1)
|
|
{
|
|
|
|
/* Receive messages and suspend. */
|
|
status = tx_queue_receive(&queue_0, &dest_message[0], TX_WAIT_FOREVER);
|
|
|
|
if ((status != TX_SUCCESS) || (dest_message[0] != expected_message[0]++))
|
|
break;
|
|
|
|
/* Change thread 2 priority. */
|
|
tx_thread_priority_change(&thread_2, 15, &old_priority);
|
|
|
|
/* Increment the thread counter. */
|
|
thread_1_counter++;
|
|
}
|
|
}
|
|
|
|
|
|
static void thread_2_entry(ULONG thread_input)
|
|
{
|
|
|
|
ULONG source_message[2] = {0x1234567C, 0};
|
|
|
|
|
|
/* Send one message to the queue. */
|
|
tx_queue_send(&queue_0, &source_message[0], TX_WAIT_FOREVER);
|
|
|
|
/* Increment the thread counter. */
|
|
thread_2_counter++;
|
|
}
|
|
|
|
|
|
static void thread_1a_entry(ULONG thread_input)
|
|
{
|
|
UINT status;
|
|
ULONG expected_message[2] = {0x12345678, 0};
|
|
ULONG dest_message[2];
|
|
UINT old_priority;
|
|
|
|
|
|
/* Receive message and suspend. */
|
|
status = tx_thread_resume(&thread_0);
|
|
status += tx_queue_receive(&queue_0a, &dest_message[0], TX_WAIT_FOREVER);
|
|
status += tx_thread_resume(&thread_0);
|
|
status += tx_thread_suspend(&thread_1a);
|
|
|
|
if ((status != TX_SUCCESS) || (dest_message[0] != expected_message[0]))
|
|
return;
|
|
|
|
/* Loop forever! */
|
|
while(1)
|
|
{
|
|
|
|
/* Receive messages and suspend. */
|
|
status = tx_queue_receive(&queue_0a, &dest_message[0], TX_WAIT_FOREVER);
|
|
|
|
if ((status != TX_SUCCESS) || (dest_message[0] != expected_message[0]++))
|
|
break;
|
|
|
|
/* Change thread 2a priority. */
|
|
tx_thread_priority_change(&thread_2a, 15, &old_priority);
|
|
|
|
/* Increment the thread counter. */
|
|
thread_1a_counter++;
|
|
}
|
|
}
|
|
|
|
|
|
static void thread_2a_entry(ULONG thread_input)
|
|
{
|
|
|
|
ULONG source_message[2] = {0x1234567C, 0};
|
|
|
|
|
|
/* Send one message to the queue. */
|
|
tx_queue_send(&queue_0a, &source_message[0], TX_WAIT_FOREVER);
|
|
|
|
/* Increment the thread counter. */
|
|
thread_2a_counter++;
|
|
}
|