blob: 32ec08f84e4b96ce249580fc528a6129b7ab38d6 (
plain)
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
|
/*
* Thread Dispatch Wrapper Implmentation
*
* COPYRIGHT (c) 1989-2013.
* On-Line Applications Research Corporation (OAR).
*
* The license and distribution terms for this file may be
* found in the file LICENSE in this distribution or at
* http://www.rtems.com/license/LICENSE.
*/
#include "shell.h"
#include <schedsim_shell.h>
#include <stdlib.h>
#include <stdio.h>
#include <rtems.h>
typedef Thread_Control * Thread_Control_ptr;
uint32_t Schedsim_Current_cpu = 0;
Thread_Control_ptr *last_heir = NULL;
Thread_Control_ptr *last_executing = NULL;
extern void __real__Thread_Dispatch(void);
#if RTEMS_SMP
#define MAX_CPUS _SMP_Processor_count
#else
#define MAX_CPUS 1
#endif
void Init__wrap__Thread_Dispatch()
{
last_heir = (Thread_Control_ptr *) calloc(
sizeof( Thread_Control_ptr ),
MAX_CPUS
);
last_executing = (Thread_Control_ptr *) calloc(
sizeof( Thread_Control_ptr ),
MAX_CPUS
);
}
void check_heir_and_executing(void)
{
uint32_t level;
_ISR_Disable_without_giant( level );
if ( last_heir[Schedsim_Current_cpu] != _Thread_Heir )
PRINT_HEIR();
if ( last_executing[Schedsim_Current_cpu] != _Thread_Executing )
PRINT_EXECUTING();
last_heir[Schedsim_Current_cpu] = _Thread_Heir;
last_executing[Schedsim_Current_cpu] = _Thread_Executing;
_ISR_Enable_without_giant( level );
}
void __wrap__Thread_Dispatch(void)
{
uint32_t cpu;
uint32_t current_cpu;
if ( !schedsim_is_dispatch_allowed() )
return;
current_cpu = Schedsim_Current_cpu;
for ( cpu=0 ; cpu < MAX_CPUS ; cpu++ ) {
Schedsim_Current_cpu = cpu;
check_heir_and_executing();
__real__Thread_Dispatch();
check_heir_and_executing();
}
Schedsim_Current_cpu = current_cpu;
}
|