1 | // -*- Mode: CFA -*- |
---|
2 | // |
---|
3 | // Cforall Version 1.0.0 Copyright (C) 2016 University of Waterloo |
---|
4 | // |
---|
5 | // The contents of this file are covered under the licence agreement in the |
---|
6 | // file "LICENCE" distributed with Cforall. |
---|
7 | // |
---|
8 | // signal.c -- |
---|
9 | // |
---|
10 | // Author : Thierry Delisle |
---|
11 | // Created On : Mon Jun 5 14:20:42 2017 |
---|
12 | // Last Modified By : Thierry Delisle |
---|
13 | // Last Modified On : -- |
---|
14 | // Update Count : 0 |
---|
15 | // |
---|
16 | |
---|
17 | #include "preemption.h" |
---|
18 | |
---|
19 | extern "C" { |
---|
20 | #include <signal.h> |
---|
21 | } |
---|
22 | |
---|
23 | #define __CFA_DEFAULT_PREEMPTION__ 10 |
---|
24 | |
---|
25 | __attribute__((weak)) unsigned int default_preemption() { |
---|
26 | return __CFA_DEFAULT_PREEMPTION__; |
---|
27 | } |
---|
28 | |
---|
29 | static void preempt( processor * this ); |
---|
30 | static void timeout( thread_desc * this ); |
---|
31 | |
---|
32 | //============================================================================================= |
---|
33 | // Kernel Preemption logic |
---|
34 | //============================================================================================= |
---|
35 | |
---|
36 | void kernel_start_preemption() { |
---|
37 | |
---|
38 | } |
---|
39 | |
---|
40 | void tick_preemption() { |
---|
41 | alarm_list_t * alarms = &systemProcessor->alarms; |
---|
42 | __cfa_time_t currtime = __kernel_get_time(); |
---|
43 | while( alarms->head && alarms->head->alarm < currtime ) { |
---|
44 | alarm_node_t * node = pop(alarms); |
---|
45 | if( node->kernel_alarm ) { |
---|
46 | preempt( node->proc ); |
---|
47 | } |
---|
48 | else { |
---|
49 | timeout( node->thrd ); |
---|
50 | } |
---|
51 | |
---|
52 | if( node->period > 0 ) { |
---|
53 | node->alarm += node->period; |
---|
54 | insert( alarms, node ); |
---|
55 | } |
---|
56 | else { |
---|
57 | node->set = false; |
---|
58 | } |
---|
59 | } |
---|
60 | |
---|
61 | if( alarms->head ) { |
---|
62 | __kernel_set_timer( alarms->head->alarm - currtime ); |
---|
63 | } |
---|
64 | } |
---|
65 | |
---|
66 | void update_preemption( processor * this, __cfa_time_t duration ) { |
---|
67 | // assert( THREAD_GETMEM( disableInt ) && THREAD_GETMEM( disableIntCnt ) == 1 ); |
---|
68 | alarm_node_t * alarm = this->preemption_alarm; |
---|
69 | |
---|
70 | // Alarms need to be enabled |
---|
71 | if ( duration > 0 && !alarm->set ) { |
---|
72 | alarm->alarm = __kernel_get_time() + duration; |
---|
73 | alarm->period = duration; |
---|
74 | register_self( alarm ); |
---|
75 | } |
---|
76 | // Zero duraction but alarm is set |
---|
77 | else if ( duration == 0 && alarm->set ) { |
---|
78 | unregister_self( alarm ); |
---|
79 | alarm->alarm = 0; |
---|
80 | alarm->period = 0; |
---|
81 | } |
---|
82 | // If alarm is different from previous, change it |
---|
83 | else if ( duration > 0 && alarm->period != duration ) { |
---|
84 | unregister_self( alarm ); |
---|
85 | alarm->alarm = __kernel_get_time() + duration; |
---|
86 | alarm->period = duration; |
---|
87 | register_self( alarm ); |
---|
88 | } |
---|
89 | } |
---|
90 | |
---|
91 | void ?{}( preemption_scope * this, processor * proc ) { |
---|
92 | (&this->alarm){ proc }; |
---|
93 | this->proc = proc; |
---|
94 | this->proc->preemption_alarm = &this->alarm; |
---|
95 | update_preemption( this->proc, this->proc->preemption ); |
---|
96 | } |
---|
97 | |
---|
98 | void ^?{}( preemption_scope * this ) { |
---|
99 | update_preemption( this->proc, 0 ); |
---|
100 | } |
---|
101 | |
---|
102 | //============================================================================================= |
---|
103 | // Kernel Signal logic |
---|
104 | //============================================================================================= |
---|
105 | |
---|
106 | static inline bool preemption_ready() { |
---|
107 | return this_processor->disable_preempt_count == 0; |
---|
108 | } |
---|
109 | |
---|
110 | static inline void defer_ctxSwitch() { |
---|
111 | this_processor->pending_preemption = true; |
---|
112 | } |
---|
113 | |
---|
114 | static inline void defer_alarm() { |
---|
115 | systemProcessor->pending_alarm = true; |
---|
116 | } |
---|
117 | |
---|
118 | void sigHandler_ctxSwitch( __attribute__((unused)) int sig ) { |
---|
119 | if( preemption_ready() ) { |
---|
120 | ScheduleInternal( this_processor->current_thread ); |
---|
121 | } |
---|
122 | else { |
---|
123 | defer_ctxSwitch(); |
---|
124 | } |
---|
125 | } |
---|
126 | |
---|
127 | void sigHandler_alarm( __attribute__((unused)) int sig ) { |
---|
128 | if( try_lock( &systemProcessor->alarm_lock ) ) { |
---|
129 | tick_preemption(); |
---|
130 | unlock( &systemProcessor->alarm_lock ); |
---|
131 | } |
---|
132 | else { |
---|
133 | defer_alarm(); |
---|
134 | } |
---|
135 | } |
---|
136 | |
---|
137 | static void preempt( processor * this ) { |
---|
138 | pthread_kill( this->kernel_thread, SIGUSR1 ); |
---|
139 | } |
---|
140 | |
---|
141 | static void timeout( thread_desc * this ) { |
---|
142 | //TODO : implement waking threads |
---|
143 | } |
---|