test: queue: Add test for multiple threads using k_queue_get

This tests the situation when there are multiple threads calling
k_queue_get which was causing issues when using k_poll.

Jira: ZEP-2553

Signed-off-by: Luiz Augusto von Dentz <[email protected]>

Author: Vudentz

tests/kernel/queue/src/main.c

@@ -15,6 +15,7 @@
 extern void test_queue_thread2thread(void);
 extern void test_queue_thread2isr(void);
 extern void test_queue_isr2thread(void);
+extern void test_queue_get_2threads(void);
 extern void test_queue_get_fail(void);
 extern void test_queue_loop(void);
 
@@ -25,6 +26,7 @@ void test_main(void)
 			 ztest_unit_test(test_queue_thread2thread),
 			 ztest_unit_test(test_queue_thread2isr),
 			 ztest_unit_test(test_queue_isr2thread),
+			 ztest_unit_test(test_queue_get_2threads),
 			 ztest_unit_test(test_queue_get_fail),
 			 ztest_unit_test(test_queue_loop));
 	ztest_run_test_suite(test_queue_api);

tests/kernel/queue/src/test_queue_contexts.c

@@ -31,6 +31,8 @@ static qdata_t data_sl[LIST_LEN];
 
 static K_THREAD_STACK_DEFINE(tstack, STACK_SIZE);
 static struct k_thread tdata;
+static K_THREAD_STACK_DEFINE(tstack1, STACK_SIZE);
+static struct k_thread tdata1;
 static struct k_sem end_sema;
 
 static void tqueue_append(struct k_queue *pqueue)
@@ -164,3 +166,43 @@ void test_queue_isr2thread(void)
 	/**TESTPOINT: test K_QUEUE_DEFINE queue*/
 	tqueue_isr_thread(&kqueue);
 }
+
+static void tThread_get(void *p1, void *p2, void *p3)
+{
+	zassert_true(k_queue_get((struct k_queue *)p1, K_FOREVER) != NULL,
+		     NULL);
+	k_sem_give(&end_sema);
+}
+
+static void tqueue_get_2threads(struct k_queue *pqueue)
+{
+	k_sem_init(&end_sema, 0, 1);
+	k_tid_t tid = k_thread_create(&tdata, tstack, STACK_SIZE,
+				      tThread_get, pqueue, NULL, NULL,
+				      K_PRIO_PREEMPT(0), 0, 0);
+
+	k_tid_t tid1 = k_thread_create(&tdata1, tstack1, STACK_SIZE,
+				      tThread_get, pqueue, NULL, NULL,
+				      K_PRIO_PREEMPT(0), 0, 0);
+
+	/* Wait threads to initialize */
+	k_sleep(10);
+
+	k_queue_append(pqueue, (void *)&data[0]);
+	k_queue_append(pqueue, (void *)&data[1]);
+
+	/* Wait threads to finalize */
+	k_sem_take(&end_sema, K_FOREVER);
+	k_sem_take(&end_sema, K_FOREVER);
+
+	k_thread_abort(tid);
+	k_thread_abort(tid1);
+}
+
+void test_queue_get_2threads(void)
+{
+	/**TESTPOINT: test k_queue_init queue*/
+	k_queue_init(&queue);
+
+	tqueue_get_2threads(&queue);
+}