source: src/libcfa/concurrency/preemption.c@ 0c674e8

ADT aaron-thesis arm-eh ast-experimental cleanup-dtors deferred_resn demangler enum forall-pointer-decay jacob/cs343-translation jenkins-sandbox new-ast new-ast-unique-expr new-env no_list persistent-indexer pthread-emulation qualifiedEnum with_gc
Last change on this file since 0c674e8 was 1f81d61, checked in by Thierry Delisle <tdelisle@…>, 7 years ago

Fixed several build failures for 32-bit

  • Property mode set to 100644
File size: 16.6 KB
Line 
1//
2// Cforall Version 1.0.0 Copyright (C) 2016 University of Waterloo
3//
4// The contents of this file are covered under the licence agreement in the
5// file "LICENCE" distributed with Cforall.
6//
7// signal.c --
8//
9// Author : Thierry Delisle
10// Created On : Mon Jun 5 14:20:42 2017
11// Last Modified By : Peter A. Buhr
12// Last Modified On : Mon Apr 9 13:52:39 2018
13// Update Count : 36
14//
15
16#include "preemption.h"
17#include <assert.h>
18
19extern "C" {
20#include <errno.h>
21#include <stdio.h>
22#include <string.h>
23#include <unistd.h>
24}
25
26#include "bits/signal.h"
27
28#if !defined(__CFA_DEFAULT_PREEMPTION__)
29#define __CFA_DEFAULT_PREEMPTION__ 10`ms
30#endif
31
32Duration default_preemption() __attribute__((weak)) {
33 return __CFA_DEFAULT_PREEMPTION__;
34}
35
36// FwdDeclarations : timeout handlers
37static void preempt( processor * this );
38static void timeout( thread_desc * this );
39
40// FwdDeclarations : Signal handlers
41void sigHandler_ctxSwitch( __CFA_SIGPARMS__ );
42void sigHandler_segv ( __CFA_SIGPARMS__ );
43void sigHandler_ill ( __CFA_SIGPARMS__ );
44void sigHandler_fpe ( __CFA_SIGPARMS__ );
45void sigHandler_abort ( __CFA_SIGPARMS__ );
46
47// FwdDeclarations : alarm thread main
48void * alarm_loop( __attribute__((unused)) void * args );
49
50// Machine specific register name
51#if defined( __i386 )
52#define CFA_REG_IP gregs[REG_EIP]
53#elif defined( __x86_64 )
54#define CFA_REG_IP gregs[REG_RIP]
55#elif defined( __ARM_ARCH )
56#define CFA_REG_IP arm_pc
57#else
58#error unknown hardware architecture
59#endif
60
61KERNEL_STORAGE(event_kernel_t, event_kernel); // private storage for event kernel
62event_kernel_t * event_kernel; // kernel public handle to even kernel
63static pthread_t alarm_thread; // pthread handle to alarm thread
64
65void ?{}(event_kernel_t & this) with( this ) {
66 alarms{};
67 lock{};
68}
69
70enum {
71 PREEMPT_NORMAL = 0,
72 PREEMPT_TERMINATE = 1,
73};
74
75//=============================================================================================
76// Kernel Preemption logic
77//=============================================================================================
78
79// Get next expired node
80static inline alarm_node_t * get_expired( alarm_list_t * alarms, Time currtime ) {
81 if( !alarms->head ) return NULL; // If no alarms return null
82 if( alarms->head->alarm >= currtime ) return NULL; // If alarms head not expired return null
83 return pop(alarms); // Otherwise just pop head
84}
85
86// Tick one frame of the Discrete Event Simulation for alarms
87void tick_preemption() {
88 alarm_node_t * node = NULL; // Used in the while loop but cannot be declared in the while condition
89 alarm_list_t * alarms = &event_kernel->alarms; // Local copy for ease of reading
90 Time currtime = __kernel_get_time(); // Check current time once so we everything "happens at once"
91
92 //Loop throught every thing expired
93 while( node = get_expired( alarms, currtime ) ) {
94 // __cfaabi_dbg_print_buffer_decl( " KERNEL: preemption tick.\n" );
95
96 // Check if this is a kernel
97 if( node->kernel_alarm ) {
98 preempt( node->proc );
99 }
100 else {
101 timeout( node->thrd );
102 }
103
104 // Check if this is a periodic alarm
105 Duration period = node->period;
106 if( period > 0 ) {
107 // __cfaabi_dbg_print_buffer_local( " KERNEL: alarm period is %lu.\n", period.tv );
108 node->alarm = currtime + period; // Alarm is periodic, add currtime to it (used cached current time)
109 insert( alarms, node ); // Reinsert the node for the next time it triggers
110 }
111 else {
112 node->set = false; // Node is one-shot, just mark it as not pending
113 }
114 }
115
116 // If there are still alarms pending, reset the timer
117 if( alarms->head ) {
118 __cfaabi_dbg_print_buffer_decl( " KERNEL: @%lu(%lu) resetting alarm to %lu.\n", currtime.tv, __kernel_get_time().tv, (alarms->head->alarm - currtime).tv);
119 Duration delta = alarms->head->alarm - currtime;
120 Duration caped = max(delta, 50`us);
121 // itimerval tim = { caped };
122 // __cfaabi_dbg_print_buffer_local( " Values are %lu, %lu, %lu %lu.\n", delta.tv, caped.tv, tim.it_value.tv_sec, tim.it_value.tv_usec);
123
124 __kernel_set_timer( caped );
125 }
126}
127
128// Update the preemption of a processor and notify interested parties
129void update_preemption( processor * this, Duration duration ) {
130 alarm_node_t * alarm = this->preemption_alarm;
131
132 // Alarms need to be enabled
133 if ( duration > 0 && ! alarm->set ) {
134 alarm->alarm = __kernel_get_time() + duration;
135 alarm->period = duration;
136 register_self( alarm );
137 }
138 // Zero duration but alarm is set
139 else if ( duration == 0 && alarm->set ) {
140 unregister_self( alarm );
141 alarm->alarm = 0;
142 alarm->period = 0;
143 }
144 // If alarm is different from previous, change it
145 else if ( duration > 0 && alarm->period != duration ) {
146 unregister_self( alarm );
147 alarm->alarm = __kernel_get_time() + duration;
148 alarm->period = duration;
149 register_self( alarm );
150 }
151}
152
153//=============================================================================================
154// Kernel Signal Tools
155//=============================================================================================
156
157__cfaabi_dbg_debug_do( static thread_local void * last_interrupt = 0; )
158
159extern "C" {
160 // Disable interrupts by incrementing the counter
161 void disable_interrupts() {
162 with( kernelTLS.preemption_state ) {
163 #if GCC_VERSION > 50000
164 static_assert(__atomic_always_lock_free(sizeof(enabled), &enabled), "Must be lock-free");
165 #endif
166
167 // Set enabled flag to false
168 // should be atomic to avoid preemption in the middle of the operation.
169 // use memory order RELAXED since there is no inter-thread on this variable requirements
170 __atomic_store_n(&enabled, false, __ATOMIC_RELAXED);
171
172 // Signal the compiler that a fence is needed but only for signal handlers
173 __atomic_signal_fence(__ATOMIC_ACQUIRE);
174
175 __attribute__((unused)) unsigned short new_val = disable_count + 1;
176 disable_count = new_val;
177 verify( new_val < 65_000u ); // If this triggers someone is disabling interrupts without enabling them
178 }
179 }
180
181 // Enable interrupts by decrementing the counter
182 // If counter reaches 0, execute any pending CtxSwitch
183 void enable_interrupts( __cfaabi_dbg_ctx_param ) {
184 processor * proc = kernelTLS.this_processor; // Cache the processor now since interrupts can start happening after the atomic store
185 thread_desc * thrd = kernelTLS.this_thread; // Cache the thread now since interrupts can start happening after the atomic store
186
187 with( kernelTLS.preemption_state ){
188 unsigned short prev = disable_count;
189 disable_count -= 1;
190 verify( prev != 0u ); // If this triggers someone is enabled already enabled interruptsverify( prev != 0u );
191
192 // Check if we need to prempt the thread because an interrupt was missed
193 if( prev == 1 ) {
194 #if GCC_VERSION > 50000
195 static_assert(__atomic_always_lock_free(sizeof(enabled), &enabled), "Must be lock-free");
196 #endif
197
198 // Set enabled flag to true
199 // should be atomic to avoid preemption in the middle of the operation.
200 // use memory order RELAXED since there is no inter-thread on this variable requirements
201 __atomic_store_n(&enabled, true, __ATOMIC_RELAXED);
202
203 // Signal the compiler that a fence is needed but only for signal handlers
204 __atomic_signal_fence(__ATOMIC_RELEASE);
205 if( proc->pending_preemption ) {
206 proc->pending_preemption = false;
207 BlockInternal( thrd );
208 }
209 }
210 }
211
212 // For debugging purposes : keep track of the last person to enable the interrupts
213 __cfaabi_dbg_debug_do( proc->last_enable = caller; )
214 }
215
216 // Disable interrupts by incrementint the counter
217 // Don't execute any pending CtxSwitch even if counter reaches 0
218 void enable_interrupts_noPoll() {
219 unsigned short prev = kernelTLS.preemption_state.disable_count;
220 kernelTLS.preemption_state.disable_count -= 1;
221 verifyf( prev != 0u, "Incremented from %u\n", prev ); // If this triggers someone is enabled already enabled interrupts
222 if( prev == 1 ) {
223 #if GCC_VERSION > 50000
224 static_assert(__atomic_always_lock_free(sizeof(kernelTLS.preemption_state.enabled), &kernelTLS.preemption_state.enabled), "Must be lock-free");
225 #endif
226 // Set enabled flag to true
227 // should be atomic to avoid preemption in the middle of the operation.
228 // use memory order RELAXED since there is no inter-thread on this variable requirements
229 __atomic_store_n(&kernelTLS.preemption_state.enabled, true, __ATOMIC_RELAXED);
230
231 // Signal the compiler that a fence is needed but only for signal handlers
232 __atomic_signal_fence(__ATOMIC_RELEASE);
233 }
234 }
235}
236
237// sigprocmask wrapper : unblock a single signal
238static inline void signal_unblock( int sig ) {
239 sigset_t mask;
240 sigemptyset( &mask );
241 sigaddset( &mask, sig );
242
243 if ( pthread_sigmask( SIG_UNBLOCK, &mask, NULL ) == -1 ) {
244 abort( "internal error, pthread_sigmask" );
245 }
246}
247
248// sigprocmask wrapper : block a single signal
249static inline void signal_block( int sig ) {
250 sigset_t mask;
251 sigemptyset( &mask );
252 sigaddset( &mask, sig );
253
254 if ( pthread_sigmask( SIG_BLOCK, &mask, NULL ) == -1 ) {
255 abort( "internal error, pthread_sigmask" );
256 }
257}
258
259// kill wrapper : signal a processor
260static void preempt( processor * this ) {
261 sigval_t value = { PREEMPT_NORMAL };
262 pthread_sigqueue( this->kernel_thread, SIGUSR1, value );
263}
264
265// kill wrapper : signal a processor
266void terminate(processor * this) {
267 this->do_terminate = true;
268 sigval_t value = { PREEMPT_TERMINATE };
269 pthread_sigqueue( this->kernel_thread, SIGUSR1, value );
270}
271
272// reserved for future use
273static void timeout( thread_desc * this ) {
274 //TODO : implement waking threads
275}
276
277// KERNEL ONLY
278// Check if a CtxSwitch signal handler shoud defer
279// If true : preemption is safe
280// If false : preemption is unsafe and marked as pending
281static inline bool preemption_ready() {
282 // Check if preemption is safe
283 bool ready = kernelTLS.preemption_state.enabled && ! kernelTLS.preemption_state.in_progress;
284
285 // Adjust the pending flag accordingly
286 kernelTLS.this_processor->pending_preemption = !ready;
287 return ready;
288}
289
290//=============================================================================================
291// Kernel Signal Startup/Shutdown logic
292//=============================================================================================
293
294// Startup routine to activate preemption
295// Called from kernel_startup
296void kernel_start_preemption() {
297 __cfaabi_dbg_print_safe( "Kernel : Starting preemption\n" );
298
299 // Start with preemption disabled until ready
300 kernelTLS.preemption_state.enabled = false;
301 kernelTLS.preemption_state.disable_count = 1;
302
303 // Initialize the event kernel
304 event_kernel = (event_kernel_t *)&storage_event_kernel;
305 (*event_kernel){};
306
307 // Setup proper signal handlers
308 __cfaabi_sigaction( SIGUSR1, sigHandler_ctxSwitch, SA_SIGINFO | SA_RESTART ); // CtxSwitch handler
309
310 signal_block( SIGALRM );
311
312 pthread_create( &alarm_thread, NULL, alarm_loop, NULL );
313}
314
315// Shutdown routine to deactivate preemption
316// Called from kernel_shutdown
317void kernel_stop_preemption() {
318 __cfaabi_dbg_print_safe( "Kernel : Preemption stopping\n" );
319
320 // Block all signals since we are already shutting down
321 sigset_t mask;
322 sigfillset( &mask );
323 sigprocmask( SIG_BLOCK, &mask, NULL );
324
325 // Notify the alarm thread of the shutdown
326 sigval val = { 1 };
327 pthread_sigqueue( alarm_thread, SIGALRM, val );
328
329 // Wait for the preemption thread to finish
330 pthread_join( alarm_thread, NULL );
331
332 // Preemption is now fully stopped
333
334 __cfaabi_dbg_print_safe( "Kernel : Preemption stopped\n" );
335}
336
337// Raii ctor/dtor for the preemption_scope
338// Used by thread to control when they want to receive preemption signals
339void ?{}( preemption_scope & this, processor * proc ) {
340 (this.alarm){ proc, (Time){ 0 }, 0`s };
341 this.proc = proc;
342 this.proc->preemption_alarm = &this.alarm;
343
344 update_preemption( this.proc, this.proc->cltr->preemption_rate );
345}
346
347void ^?{}( preemption_scope & this ) {
348 disable_interrupts();
349
350 update_preemption( this.proc, 0`s );
351}
352
353//=============================================================================================
354// Kernel Signal Handlers
355//=============================================================================================
356
357// Context switch signal handler
358// Receives SIGUSR1 signal and causes the current thread to yield
359void sigHandler_ctxSwitch( __CFA_SIGPARMS__ ) {
360 __cfaabi_dbg_debug_do( last_interrupt = (void *)(cxt->uc_mcontext.CFA_REG_IP); )
361
362 // SKULLDUGGERY: if a thread creates a processor and the immediately deletes it,
363 // the interrupt that is supposed to force the kernel thread to preempt might arrive
364 // before the kernel thread has even started running. When that happens an iterrupt
365 // we a null 'this_processor' will be caught, just ignore it.
366 if(! kernelTLS.this_processor ) return;
367
368 choose(sfp->si_value.sival_int) {
369 case PREEMPT_NORMAL : ;// Normal case, nothing to do here
370 case PREEMPT_TERMINATE: verify( kernelTLS.this_processor->do_terminate);
371 default:
372 abort( "internal error, signal value is %d", sfp->si_value.sival_int );
373 }
374
375 // Check if it is safe to preempt here
376 if( !preemption_ready() ) { return; }
377
378 __cfaabi_dbg_print_buffer_decl( " KERNEL: preempting core %p (%p @ %p).\n", kernelTLS.this_processor, kernelTLS.this_thread, (void *)(cxt->uc_mcontext.CFA_REG_IP) );
379
380 // Sync flag : prevent recursive calls to the signal handler
381 kernelTLS.preemption_state.in_progress = true;
382
383 // Clear sighandler mask before context switching.
384 #if GCC_VERSION > 50000
385 static_assert( sizeof( sigset_t ) == sizeof( cxt->uc_sigmask ), "Expected cxt->uc_sigmask to be of sigset_t" );
386 #endif
387 if ( pthread_sigmask( SIG_SETMASK, (sigset_t *)&(cxt->uc_sigmask), NULL ) == -1 ) {
388 abort( "internal error, sigprocmask" );
389 }
390
391 // TODO: this should go in finish action
392 // Clear the in progress flag
393 kernelTLS.preemption_state.in_progress = false;
394
395 // Preemption can occur here
396
397 BlockInternal( kernelTLS.this_thread ); // Do the actual CtxSwitch
398}
399
400// Main of the alarm thread
401// Waits on SIGALRM and send SIGUSR1 to whom ever needs it
402void * alarm_loop( __attribute__((unused)) void * args ) {
403 // Block sigalrms to control when they arrive
404 sigset_t mask;
405 sigfillset(&mask);
406 if ( pthread_sigmask( SIG_BLOCK, &mask, NULL ) == -1 ) {
407 abort( "internal error, pthread_sigmask" );
408 }
409
410 sigemptyset( &mask );
411 sigaddset( &mask, SIGALRM );
412
413 // Main loop
414 while( true ) {
415 // Wait for a sigalrm
416 siginfo_t info;
417 int sig = sigwaitinfo( &mask, &info );
418
419 if( sig < 0 ) {
420 //Error!
421 int err = errno;
422 switch( err ) {
423 case EAGAIN :
424 case EINTR :
425 {__cfaabi_dbg_print_buffer_decl( " KERNEL: Spurious wakeup %d.\n", err );}
426 continue;
427 case EINVAL :
428 abort( "Timeout was invalid." );
429 default:
430 abort( "Unhandled error %d", err);
431 }
432 }
433
434 // If another signal arrived something went wrong
435 assertf(sig == SIGALRM, "Kernel Internal Error, sigwait: Unexpected signal %d (%d : %d)\n", sig, info.si_code, info.si_value.sival_int);
436
437 // __cfaabi_dbg_print_safe( "Kernel : Caught alarm from %d with %d\n", info.si_code, info.si_value.sival_int );
438 // Switch on the code (a.k.a. the sender) to
439 switch( info.si_code )
440 {
441 // Timers can apparently be marked as sent for the kernel
442 // In either case, tick preemption
443 case SI_TIMER:
444 case SI_KERNEL:
445 // __cfaabi_dbg_print_safe( "Kernel : Preemption thread tick\n" );
446 lock( event_kernel->lock __cfaabi_dbg_ctx2 );
447 tick_preemption();
448 unlock( event_kernel->lock );
449 break;
450 // Signal was not sent by the kernel but by an other thread
451 case SI_QUEUE:
452 // For now, other thread only signal the alarm thread to shut it down
453 // If this needs to change use info.si_value and handle the case here
454 goto EXIT;
455 }
456 }
457
458EXIT:
459 __cfaabi_dbg_print_safe( "Kernel : Preemption thread stopping\n" );
460 return NULL;
461}
462
463//=============================================================================================
464// Kernel Signal Debug
465//=============================================================================================
466
467void __cfaabi_check_preemption() {
468 bool ready = kernelTLS.preemption_state.enabled;
469 if(!ready) { abort("Preemption should be ready"); }
470
471 sigset_t oldset;
472 int ret;
473 ret = pthread_sigmask(0, NULL, &oldset);
474 if(ret != 0) { abort("ERROR sigprocmask returned %d", ret); }
475
476 ret = sigismember(&oldset, SIGUSR1);
477 if(ret < 0) { abort("ERROR sigismember returned %d", ret); }
478 if(ret == 1) { abort("ERROR SIGUSR1 is disabled"); }
479
480 ret = sigismember(&oldset, SIGALRM);
481 if(ret < 0) { abort("ERROR sigismember returned %d", ret); }
482 if(ret == 0) { abort("ERROR SIGALRM is enabled"); }
483
484 ret = sigismember(&oldset, SIGTERM);
485 if(ret < 0) { abort("ERROR sigismember returned %d", ret); }
486 if(ret == 1) { abort("ERROR SIGTERM is disabled"); }
487}
488
489// Local Variables: //
490// mode: c //
491// tab-width: 4 //
492// End: //
Note: See TracBrowser for help on using the repository browser.