1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
|
/*
* Copyright (c) 2006-2021, RT-Thread Development Team
*
* SPDX-License-Identifier: Apache-2.0
*
* Email: [email protected]
*
* Change Logs:
* Date Author Notes
* 2024/07/15 zhangyan first commit
*/
#include "rtconfig.h"
#ifdef RT_USING_SMP
#include <rtthread.h>
#include <rtdevice.h>
#include <string.h>
#include "fparameters.h"
#include "ftypes.h"
#include "board.h"
#include <rtdbg.h>
#include "interrupt.h"
#include <rtdef.h>
#include "rtatomic.h"
#define RT_TEST_IPI 3
struct rt_thread core_test_thread[RT_CPUS_NR];
static char *core_thread_name[] =
{
"core0_sgi_test",
"core1_sgi_test",
"core2_sgi_test",
"core3_sgi_test",
"core4_sgi_test",
"core5_sgi_test",
"core6_sgi_test",
"core7_sgi_test",
};
static rt_uint8_t core_stack[RT_CPUS_NR][4096];
static void smp_test_ipi_handle(int vector, void *param)
{
rt_int32_t cpu_id = rt_hw_cpu_id();
rt_kprintf("smp_test_ipi_handle, cpu_id = %d\n", cpu_id);
}
static void core_thread(void *parameter)
{
rt_base_t level;
rt_int32_t cpu_id = rt_hw_cpu_id();
/* code */
level = rt_cpus_lock();
rt_hw_ipi_handler_install(RT_TEST_IPI, smp_test_ipi_handle);
rt_hw_interrupt_umask(RT_TEST_IPI);
rt_kprintf("core%d, rt_hw_interrupt_umask(RT_TEST_IPI) successfully.\n", cpu_id);
rt_cpus_unlock(level);
}
void demo_core_test(void)
{
rt_ubase_t i;
rt_ubase_t cpu_id = 0;
rt_kprintf("demo_core%d \n", rt_hw_cpu_id());
for (i = 0; i < RT_CPUS_NR; i++)
{
cpu_id = i;
rt_thread_init(&core_test_thread[i],
core_thread_name[i],
core_thread,
RT_NULL,
&core_stack[i],
2048,
20,
32);
rt_thread_control(&core_test_thread[i], RT_THREAD_CTRL_BIND_CPU, (void *)cpu_id);
rt_thread_startup(&core_test_thread[i]);
rt_thread_mdelay(100);
}
}
/* this function will toggle output pin and test intr of input pin */
static void smp_sgi_test_thread(void *parameter)
{
rt_uint32_t cpu_mask = 0;
for (rt_uint32_t i = 0; i < RT_CPUS_NR; i++)
{
cpu_mask = (1 << i);
rt_hw_ipi_send(RT_TEST_IPI, cpu_mask);
rt_thread_mdelay(10);
}
}
void smp_sgi_sample(int argc, char *argv[])
{
rt_thread_t thread;
rt_err_t res;
demo_core_test();
rt_thread_mdelay(100);
thread = rt_thread_create("smp_test_thread", smp_sgi_test_thread, RT_NULL, 4096, 25, 10);
res = rt_thread_startup(thread);
RT_ASSERT(res == RT_EOK);
}
MSH_CMD_EXPORT(smp_sgi_sample, smp toggle sgi sample.);
#endif
|
