tests: msgq: add new test case for msgq
An intergration testing make use of message queue interfaces provided by kernel Signed-off-by: Meng xianglin <xianglinx.meng@intel.com>
This commit is contained in:
Meng xianglin
Anas Nashif
parent
a9edb1f46a
commit
f397f1774f
4 changed files with 296 additions and 0 deletions
8
tests/kernel/msgq/msgq_usage/CMakeLists.txt
Normal file
8
tests/kernel/msgq/msgq_usage/CMakeLists.txt
Normal file
|
|
@ -0,0 +1,8 @@
|
||||||
|
# SPDX-License-Identifier: Apache-2.0
|
||||||
|
|
||||||
|
cmake_minimum_required(VERSION 3.13.1)
|
||||||
|
find_package(Zephyr REQUIRED HINTS $ENV{ZEPHYR_BASE})
|
||||||
|
project(msgq_usage)
|
||||||
|
|
||||||
|
FILE(GLOB app_sources src/*.c)
|
||||||
|
target_sources(app PRIVATE ${app_sources})
|
||||||
1
tests/kernel/msgq/msgq_usage/prj.conf
Normal file
1
tests/kernel/msgq/msgq_usage/prj.conf
Normal file
|
|
@ -0,0 +1 @@
|
||||||
|
CONFIG_ZTEST=y
|
||||||
284
tests/kernel/msgq/msgq_usage/src/main.c
Normal file
284
tests/kernel/msgq/msgq_usage/src/main.c
Normal file
|
|
@ -0,0 +1,284 @@
|
||||||
|
/*
|
||||||
|
* Copyright (c) 2021 Intel Corporation
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: Apache-2.0
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <zephyr.h>
|
||||||
|
#include <irq_offload.h>
|
||||||
|
#include <ztest.h>
|
||||||
|
#include <limits.h>
|
||||||
|
|
||||||
|
#define MSGQ_LEN (2)
|
||||||
|
#define STACK_SIZE (512 + CONFIG_TEST_EXTRA_STACKSIZE)
|
||||||
|
#define NUM_SERVICES 2
|
||||||
|
#define TIMEOUT K_MSEC(100)
|
||||||
|
|
||||||
|
K_MSGQ_DEFINE(manager_q, sizeof(unsigned long) * 2, 4, 4);
|
||||||
|
struct k_msgq service1_msgq;
|
||||||
|
struct k_msgq service2_msgq;
|
||||||
|
struct k_msgq client_msgq;
|
||||||
|
K_THREAD_STACK_DEFINE(service_manager_stack, STACK_SIZE);
|
||||||
|
K_THREAD_STACK_DEFINE(service1_stack, STACK_SIZE);
|
||||||
|
K_THREAD_STACK_DEFINE(service2_stack, STACK_SIZE);
|
||||||
|
K_THREAD_STACK_DEFINE(client_stack, STACK_SIZE);
|
||||||
|
K_SEM_DEFINE(service_sema, 2, 2);
|
||||||
|
K_SEM_DEFINE(test_continue, 0, 1);
|
||||||
|
struct k_thread service_manager;
|
||||||
|
struct k_thread service1;
|
||||||
|
struct k_thread service2;
|
||||||
|
struct k_thread client;
|
||||||
|
static ZTEST_DMEM unsigned long __aligned(4) service1_buf[MSGQ_LEN];
|
||||||
|
static ZTEST_DMEM unsigned long __aligned(4) service2_buf[MSGQ_LEN];
|
||||||
|
static ZTEST_DMEM unsigned long __aligned(4) client_buf[MSGQ_LEN * 2];
|
||||||
|
static ZTEST_DMEM struct k_msgq *services[NUM_SERVICES];
|
||||||
|
static ZTEST_DMEM struct k_msgq *pclient;
|
||||||
|
static ZTEST_DMEM bool service1_run;
|
||||||
|
static ZTEST_DMEM bool service2_run;
|
||||||
|
static ZTEST_DMEM k_tid_t tservice_manager, tservice1, tservice2, tclient;
|
||||||
|
|
||||||
|
enum message_info {
|
||||||
|
QUERRY_SERVICE = 1,
|
||||||
|
REGISTER_SERVICE1,
|
||||||
|
REGISTER_SERVICE2,
|
||||||
|
GET_SERVICE,
|
||||||
|
SERVICE1_RUNNING,
|
||||||
|
SERVICE2_RUNNING,
|
||||||
|
SERVICE_QUIT
|
||||||
|
};
|
||||||
|
|
||||||
|
static void service_manager_entry(void *p1, void *p2, void *p3)
|
||||||
|
{
|
||||||
|
unsigned long data[2];
|
||||||
|
|
||||||
|
while (1) {
|
||||||
|
k_msgq_get(&manager_q, data, K_FOREVER);
|
||||||
|
switch (data[0]) {
|
||||||
|
case QUERRY_SERVICE:
|
||||||
|
pclient = (struct k_msgq *)data[1];
|
||||||
|
k_msgq_put(pclient, services, K_NO_WAIT);
|
||||||
|
break;
|
||||||
|
case REGISTER_SERVICE1:
|
||||||
|
services[0] = (struct k_msgq *)data[1];
|
||||||
|
break;
|
||||||
|
case REGISTER_SERVICE2:
|
||||||
|
services[1] = (struct k_msgq *)data[1];
|
||||||
|
break;
|
||||||
|
case SERVICE_QUIT:
|
||||||
|
for (int i = 0; i < NUM_SERVICES; i++) {
|
||||||
|
if (services[i] == (struct k_msgq *)data[1]) {
|
||||||
|
services[i] = NULL;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/* wake up threads waiting for this queue */
|
||||||
|
k_msgq_purge((struct k_msgq *)data[1]);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
TC_PRINT("Unknown message %ld\n", data[0]);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
k_msleep(10);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void start_service_manager(void)
|
||||||
|
{
|
||||||
|
int pri = k_thread_priority_get(k_current_get());
|
||||||
|
|
||||||
|
tservice_manager = k_thread_create(&service_manager,
|
||||||
|
service_manager_stack, STACK_SIZE,
|
||||||
|
service_manager_entry, NULL, NULL,
|
||||||
|
NULL, pri, 0, K_NO_WAIT);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void service1_entry(void *p1, void *p2, void *p3)
|
||||||
|
{
|
||||||
|
unsigned long service_data[2];
|
||||||
|
struct k_msgq *client;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
service_data[0] = REGISTER_SERVICE1;
|
||||||
|
service_data[1] = (unsigned long)&service1_msgq;
|
||||||
|
|
||||||
|
k_msgq_init(&service1_msgq, (char *)service1_buf,
|
||||||
|
sizeof(service1_buf), 1);
|
||||||
|
ret = k_msgq_put(&manager_q, service_data, K_NO_WAIT);
|
||||||
|
zassert_equal(ret, 0, "Can't register service");
|
||||||
|
|
||||||
|
k_sem_take(&service_sema, K_NO_WAIT);
|
||||||
|
while (service1_run) {
|
||||||
|
k_msgq_get(&service1_msgq, service_data, K_FOREVER);
|
||||||
|
if (service_data[0] == GET_SERVICE) {
|
||||||
|
client = (struct k_msgq *)service_data[1];
|
||||||
|
service_data[0] = SERVICE1_RUNNING;
|
||||||
|
k_msgq_put(client, service_data, K_NO_WAIT);
|
||||||
|
}
|
||||||
|
k_msleep(10);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* inform services manager */
|
||||||
|
service_data[0] = SERVICE_QUIT;
|
||||||
|
service_data[1] = (unsigned long)&service1_msgq;
|
||||||
|
k_msgq_put(&manager_q, service_data, K_NO_WAIT);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void service2_entry(void *p1, void *p2, void *p3)
|
||||||
|
{
|
||||||
|
unsigned long service_data[2];
|
||||||
|
struct k_msgq *client;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
service_data[0] = REGISTER_SERVICE2;
|
||||||
|
service_data[1] = (unsigned long)&service2_msgq;
|
||||||
|
|
||||||
|
k_msgq_init(&service2_msgq, (char *)service2_buf,
|
||||||
|
sizeof(service2_buf), 1);
|
||||||
|
ret = k_msgq_put(&manager_q, service_data, K_NO_WAIT);
|
||||||
|
zassert_equal(ret, 0, "Can't register service");
|
||||||
|
|
||||||
|
k_sem_take(&service_sema, K_NO_WAIT);
|
||||||
|
while (service2_run) {
|
||||||
|
k_msgq_get(&service2_msgq, service_data, K_FOREVER);
|
||||||
|
if (service_data[0] == GET_SERVICE) {
|
||||||
|
client = (struct k_msgq *)service_data[1];
|
||||||
|
service_data[0] = SERVICE2_RUNNING;
|
||||||
|
k_msgq_put(client, service_data, K_NO_WAIT);
|
||||||
|
}
|
||||||
|
k_msleep(10);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* inform services manager */
|
||||||
|
service_data[0] = SERVICE_QUIT;
|
||||||
|
service_data[1] = (unsigned long)&service2_msgq;
|
||||||
|
k_msgq_put(&manager_q, service_data, K_NO_WAIT);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void register_service(void)
|
||||||
|
{
|
||||||
|
|
||||||
|
int pri = k_thread_priority_get(k_current_get());
|
||||||
|
|
||||||
|
service1_run = true;
|
||||||
|
tservice1 = k_thread_create(&service1, service1_stack, STACK_SIZE,
|
||||||
|
service1_entry, NULL, NULL, NULL, pri,
|
||||||
|
0, K_NO_WAIT);
|
||||||
|
|
||||||
|
service2_run = true;
|
||||||
|
tservice2 = k_thread_create(&service2, service2_stack, STACK_SIZE,
|
||||||
|
service2_entry, NULL, NULL, NULL, pri,
|
||||||
|
0, K_NO_WAIT);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void client_entry(void *p1, void *p2, void *p3)
|
||||||
|
{
|
||||||
|
unsigned long client_data[2];
|
||||||
|
unsigned long service_data[2];
|
||||||
|
struct k_msgq *service1q;
|
||||||
|
struct k_msgq *service2q;
|
||||||
|
bool query_service = false;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
|
||||||
|
k_msgq_init(&client_msgq, (char *)client_buf,
|
||||||
|
sizeof(unsigned long) * 2, 2);
|
||||||
|
client_data[0] = QUERRY_SERVICE;
|
||||||
|
client_data[1] = (unsigned long)&client_msgq;
|
||||||
|
|
||||||
|
/* query services */
|
||||||
|
k_msgq_put(&manager_q, client_data, K_NO_WAIT);
|
||||||
|
ret = k_msgq_get(&client_msgq, service_data, K_FOREVER);
|
||||||
|
zassert_equal(ret, 0, NULL);
|
||||||
|
|
||||||
|
service1q = (struct k_msgq *)service_data[0];
|
||||||
|
service2q = (struct k_msgq *)service_data[1];
|
||||||
|
/* all services should be running */
|
||||||
|
zassert_equal(service1q, &service1_msgq, NULL);
|
||||||
|
zassert_equal(service2q, &service2_msgq, NULL);
|
||||||
|
/* let the test thread continue */
|
||||||
|
k_sem_give(&test_continue);
|
||||||
|
|
||||||
|
while (1) {
|
||||||
|
/* service might quit */
|
||||||
|
if (query_service) {
|
||||||
|
client_data[0] = QUERRY_SERVICE;
|
||||||
|
client_data[1] = (unsigned long)&client_msgq;
|
||||||
|
k_msgq_put(&manager_q, client_data, K_NO_WAIT);
|
||||||
|
k_msgq_get(&client_msgq, service_data, K_FOREVER);
|
||||||
|
service1q = (struct k_msgq *)service_data[0];
|
||||||
|
service2q = (struct k_msgq *)service_data[1];
|
||||||
|
query_service = false;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (!service1q && !service2q) {
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
client_data[0] = GET_SERVICE;
|
||||||
|
client_data[1] = (unsigned long)&client_msgq;
|
||||||
|
|
||||||
|
if (service1q) {
|
||||||
|
k_msgq_put(service1q, client_data, K_NO_WAIT);
|
||||||
|
ret = k_msgq_get(&client_msgq, service_data, TIMEOUT);
|
||||||
|
if (!ret) {
|
||||||
|
zassert_equal(service_data[0],
|
||||||
|
SERVICE1_RUNNING, NULL);
|
||||||
|
} else {
|
||||||
|
/* service might down, query in next loop */
|
||||||
|
query_service = true;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (service2q) {
|
||||||
|
k_msgq_put(service2q, client_data, K_NO_WAIT);
|
||||||
|
ret = k_msgq_get(&client_msgq, service_data, TIMEOUT);
|
||||||
|
if (!ret) {
|
||||||
|
zassert_equal(service_data[0],
|
||||||
|
SERVICE2_RUNNING, NULL);
|
||||||
|
} else {
|
||||||
|
query_service = true;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
k_msleep(10);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void start_client(void)
|
||||||
|
{
|
||||||
|
|
||||||
|
int pri = k_thread_priority_get(k_current_get());
|
||||||
|
|
||||||
|
tclient = k_thread_create(&client, client_stack, STACK_SIZE,
|
||||||
|
client_entry, NULL, NULL, NULL, pri,
|
||||||
|
0, K_NO_WAIT);
|
||||||
|
}
|
||||||
|
|
||||||
|
void test_msgq_usage(void)
|
||||||
|
{
|
||||||
|
start_service_manager();
|
||||||
|
register_service();
|
||||||
|
start_client();
|
||||||
|
/* waiting to continue */
|
||||||
|
k_sem_take(&test_continue, K_FOREVER);
|
||||||
|
|
||||||
|
/* rather than schedule this thread by k_msleep(), use semaphor with
|
||||||
|
* a timeout value, so there is no give operation over service_sema
|
||||||
|
*/
|
||||||
|
TC_PRINT("try to kill service1\n");
|
||||||
|
k_sem_take(&service_sema, Z_TIMEOUT_MS(500));
|
||||||
|
service1_run = false;
|
||||||
|
|
||||||
|
TC_PRINT("try to kill service2\n");
|
||||||
|
k_sem_take(&service_sema, Z_TIMEOUT_MS(500));
|
||||||
|
service2_run = false;
|
||||||
|
|
||||||
|
k_thread_join(tservice1, K_FOREVER);
|
||||||
|
k_thread_join(tservice2, K_FOREVER);
|
||||||
|
k_thread_join(tclient, K_FOREVER);
|
||||||
|
k_thread_abort(tservice_manager);
|
||||||
|
}
|
||||||
|
|
||||||
|
void test_main(void)
|
||||||
|
{
|
||||||
|
ztest_test_suite(msgq_usage, ztest_unit_test(test_msgq_usage));
|
||||||
|
ztest_run_test_suite(msgq_usage);
|
||||||
|
}
|
||||||
3
tests/kernel/msgq/msgq_usage/testcase.yaml
Normal file
3
tests/kernel/msgq/msgq_usage/testcase.yaml
Normal file
|
|
@ -0,0 +1,3 @@
|
||||||
|
tests:
|
||||||
|
kernel.message_queue_usage:
|
||||||
|
tags: kernel
|
||||||
Loading…
Add table
Add a link
Reference in a new issue