source: libcfa/src/concurrency/kernel/startup.cfa @ 4994d67

ADTast-experimentalpthread-emulationqualifiedEnum
Last change on this file since 4994d67 was 0c3aa67, checked in by Thierry Delisle <tdelisle@…>, 3 years ago

Fixed missing initialization.

  • Property mode set to 100644
File size: 26.3 KB
Line 
1//
2// Cforall Version 1.0.0 Copyright (C) 2020 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// kernel/startup.cfa --
8//
9// Author           : Thierry Delisle
10// Created On       : Thu Jul 30 15:12:54 2020
11// Last Modified By :
12// Last Modified On :
13// Update Count     :
14//
15
16#define __cforall_thread__
17#define _GNU_SOURCE
18
19// C Includes
20#include <errno.h>                                      // errno
21#include <signal.h>
22#include <string.h>                                     // strerror
23#include <unistd.h>                                     // sysconf
24
25extern "C" {
26        #include <limits.h>                             // PTHREAD_STACK_MIN
27        #include <unistd.h>                             // syscall
28        #include <sys/eventfd.h>                        // eventfd
29        #include <sys/mman.h>                           // mprotect
30        #include <sys/resource.h>                       // getrlimit
31}
32
33// CFA Includes
34#include "kernel/private.hfa"
35#include "iofwd.hfa"
36#include "startup.hfa"                                  // STARTUP_PRIORITY_XXX
37#include "limits.hfa"
38#include "math.hfa"
39
40#define CFA_PROCESSOR_USE_MMAP 0
41
42//-----------------------------------------------------------------------------
43// Some assembly required
44#if defined( __i386 )
45        #define CtxGet( ctx ) __asm__ volatile ( \
46                "movl %%esp,%0\n" \
47                "movl %%ebp,%1\n" \
48                : "=rm" (ctx.SP), \
49                  "=rm" (ctx.FP) \
50        )
51#elif defined( __x86_64 )
52        #define CtxGet( ctx ) __asm__ volatile ( \
53                "movq %%rsp,%0\n" \
54                "movq %%rbp,%1\n" \
55                : "=rm" (ctx.SP), \
56                  "=rm" (ctx.FP) \
57        )
58#elif defined( __aarch64__ )
59        #define CtxGet( ctx ) __asm__ volatile ( \
60                "mov %0, sp\n" \
61                "mov %1, fp\n" \
62                : "=rm" (ctx.SP), \
63                  "=rm" (ctx.FP) \
64        )
65#else
66        #error unknown hardware architecture
67#endif
68
69//-----------------------------------------------------------------------------
70// Start and stop routine for the kernel, declared first to make sure they run first
71static void __kernel_startup (void) __attribute__(( constructor( STARTUP_PRIORITY_KERNEL ) ));
72static void __kernel_shutdown(void) __attribute__(( destructor ( STARTUP_PRIORITY_KERNEL ) ));
73
74//-----------------------------------------------------------------------------
75// Static Forward Declarations
76struct current_stack_info_t;
77
78static void * __invoke_processor(void * arg);
79static void __kernel_first_resume( processor * this );
80static void __kernel_last_resume ( processor * this );
81static void init(processor & this, const char name[], cluster & _cltr, thread$ * initT);
82static void deinit(processor & this);
83static void doregister( struct cluster & cltr );
84static void unregister( struct cluster & cltr );
85static void register_tls( processor * this );
86static void unregister_tls( processor * this );
87static void ?{}( coroutine$ & this, current_stack_info_t * info);
88static void ?{}( thread$ & this, current_stack_info_t * info);
89static void ?{}(processorCtx_t & this) {}
90static void ?{}(processorCtx_t & this, processor * proc, current_stack_info_t * info);
91
92#if defined(__CFA_WITH_VERIFY__)
93        static bool verify_fwd_bck_rng(void);
94#endif
95
96//-----------------------------------------------------------------------------
97// Forward Declarations for other modules
98extern void __kernel_alarm_startup(void);
99extern void __kernel_alarm_shutdown(void);
100extern void __cfa_io_start( processor * );
101extern void __cfa_io_stop ( processor * );
102
103//-----------------------------------------------------------------------------
104// Other Forward Declarations
105extern void __wake_proc(processor *);
106extern int cfa_main_returned;                                                   // from interpose.cfa
107uint32_t __global_random_prime = 4_294_967_291u, __global_random_mask = false;
108
109//-----------------------------------------------------------------------------
110// Kernel storage
111KERNEL_STORAGE(cluster,              mainCluster);
112KERNEL_STORAGE(processor,            mainProcessor);
113KERNEL_STORAGE(thread$,              mainThread);
114KERNEL_STORAGE(__stack_t,            mainThreadCtx);
115KERNEL_STORAGE(__scheduler_RWLock_t, __scheduler_lock);
116KERNEL_STORAGE(eventfd_t,            mainIdleEventFd);
117KERNEL_STORAGE(io_future_t,          mainIdleFuture);
118#if !defined(__CFA_NO_STATISTICS__)
119KERNEL_STORAGE(__stats_t, mainProcStats);
120#endif
121
122cluster              * mainCluster;
123processor            * mainProcessor;
124thread$              * mainThread;
125__scheduler_RWLock_t * __scheduler_lock;
126
127extern "C" {
128        struct { __dllist_t(cluster) list; __spinlock_t lock; } __cfa_dbg_global_clusters;
129}
130
131extern size_t __page_size;
132extern int __map_prot;
133
134//-----------------------------------------------------------------------------
135// Global state
136thread_local struct KernelThreadData __cfaabi_tls __attribute__ ((tls_model ( "initial-exec" ))) @= {
137        NULL,                                                                                           // cannot use 0p
138        NULL,
139        false,
140        { 1, false, false },
141        0,
142        { 0, 0 },
143        NULL,
144        #ifdef __CFA_WITH_VERIFY__
145                false,
146                0,
147        #endif
148};
149
150#if   defined(CFA_HAVE_LINUX_LIBRSEQ)
151        // No data needed
152#elif defined(CFA_HAVE_LINUX_RSEQ_H)
153        extern "Cforall" {
154                __attribute__((aligned(128))) thread_local volatile struct rseq __cfaabi_rseq @= {
155                        .cpu_id : RSEQ_CPU_ID_UNINITIALIZED,
156                };
157        }
158#else
159        // No data needed
160#endif
161
162//-----------------------------------------------------------------------------
163// Struct to steal stack
164struct current_stack_info_t {
165        __stack_t * storage;  // pointer to stack object
166        void * base;          // base of stack
167        void * limit;         // stack grows towards stack limit
168        void * context;       // address of cfa_context_t
169};
170
171void ?{}( current_stack_info_t & this ) {
172        __stack_context_t ctx;
173        CtxGet( ctx );
174        this.base = ctx.FP;
175
176        rlimit r;
177        getrlimit( RLIMIT_STACK, &r);
178        size_t size = r.rlim_cur;
179
180        this.limit = (void *)(((intptr_t)this.base) - size);
181        this.context = &storage_mainThreadCtx;
182}
183
184
185//=============================================================================================
186// Kernel Setup logic
187//=============================================================================================
188//-----------------------------------------------------------------------------
189// Kernel boot procedures
190static void __kernel_startup(void) {
191        /* paranoid */ verify( ! __preemption_enabled() );
192        __cfadbg_print_safe(runtime_core, "Kernel : Starting\n");
193
194        __cfa_dbg_global_clusters.list{ __get };
195        __cfa_dbg_global_clusters.lock{};
196
197        /* paranoid */ verify( verify_fwd_bck_rng() );
198
199        // Initialize the global scheduler lock
200        __scheduler_lock = (__scheduler_RWLock_t*)&storage___scheduler_lock;
201        (*__scheduler_lock){};
202
203        // Initialize the main cluster
204        mainCluster = (cluster *)&storage_mainCluster;
205        (*mainCluster){"Main Cluster", 0};
206
207        __cfadbg_print_safe(runtime_core, "Kernel : Main cluster ready\n");
208
209        // Construct the processor context of the main processor
210        void ?{}(processorCtx_t & this, processor * proc) {
211                (this.__cor){ "Processor" };
212                this.__cor.starter = 0p;
213                this.proc = proc;
214        }
215
216        void ?{}(processor & this) with( this ) {
217                ( this.terminated ){};
218                ( this.runner ){};
219                init( this, "Main Processor", *mainCluster, 0p );
220                kernel_thread = pthread_self();
221
222                runner{ &this };
223                __cfadbg_print_safe(runtime_core, "Kernel : constructed main processor context %p\n", &runner);
224        }
225
226        // Initialize the main processor and the main processor ctx
227        // (the coroutine that contains the processing control flow)
228        mainProcessor = (processor *)&storage_mainProcessor;
229        (*mainProcessor){};
230
231        mainProcessor->idle_wctx.rdbuf = &storage_mainIdleEventFd;
232        mainProcessor->idle_wctx.ftr   = (io_future_t*)&storage_mainIdleFuture;
233        /* paranoid */ verify( sizeof(storage_mainIdleEventFd) == sizeof(eventfd_t) );
234
235        __cfa_io_start( mainProcessor );
236        register_tls( mainProcessor );
237
238        // Start by initializing the main thread
239        // SKULLDUGGERY: the mainThread steals the process main thread
240        // which will then be scheduled by the mainProcessor normally
241        mainThread = (thread$ *)&storage_mainThread;
242        current_stack_info_t info;
243        info.storage = (__stack_t*)&storage_mainThreadCtx;
244        (*mainThread){ &info };
245
246        __cfadbg_print_safe(runtime_core, "Kernel : Main thread ready\n");
247
248        //initialize the global state variables
249        __cfaabi_tls.this_processor = mainProcessor;
250        __cfaabi_tls.this_thread    = mainThread;
251
252        #if !defined( __CFA_NO_STATISTICS__ )
253                __cfaabi_tls.this_stats = (__stats_t *)& storage_mainProcStats;
254                __init_stats( __cfaabi_tls.this_stats );
255        #endif
256        mainProcessor->local_data = &__cfaabi_tls;
257
258        // Enable preemption
259        __kernel_alarm_startup();
260
261        // Add the main thread to the ready queue
262        // once resume is called on mainProcessor->runner the mainThread needs to be scheduled like any normal thread
263        schedule_thread$(mainThread, UNPARK_LOCAL);
264
265        // SKULLDUGGERY: Force a context switch to the main processor to set the main thread's context to the current UNIX
266        // context. Hence, the main thread does not begin through __cfactx_invoke_thread, like all other threads. The trick here is that
267        // mainThread is on the ready queue when this call is made.
268        __kernel_first_resume( __cfaabi_tls.this_processor );
269
270
271        // THE SYSTEM IS NOW COMPLETELY RUNNING
272
273        __cfadbg_print_safe(runtime_core, "Kernel : Started\n--------------------------------------------------\n\n");
274
275        /* paranoid */ verify( ! __preemption_enabled() );
276        enable_interrupts();
277        /* paranoid */ verify( __preemption_enabled() );
278
279}
280
281static void __kernel_shutdown(void) {
282        if(!cfa_main_returned) return;
283        /* paranoid */ verify( __preemption_enabled() );
284        disable_interrupts();
285        /* paranoid */ verify( ! __preemption_enabled() );
286
287        __cfadbg_print_safe(runtime_core, "\n--------------------------------------------------\nKernel : Shutting down\n");
288
289        // SKULLDUGGERY: Notify the mainProcessor it needs to terminates.
290        // When its coroutine terminates, it return control to the mainThread
291        // which is currently here
292        /* paranoid */ verify( !__atomic_load_n(&mainProcessor->do_terminate, __ATOMIC_ACQUIRE) );
293        __atomic_store_n(&mainProcessor->do_terminate, true, __ATOMIC_RELEASE);
294        __wake_proc( mainProcessor );
295        __kernel_last_resume( __cfaabi_tls.this_processor );
296        mainThread->self_cor.state = Halted;
297
298        // THE SYSTEM IS NOW COMPLETELY STOPPED
299
300        // Disable preemption
301        __kernel_alarm_shutdown();
302
303        #if !defined( __CFA_NO_STATISTICS__ )
304                __stats_t * st = (__stats_t *)& storage_mainProcStats;
305                __tally_stats(mainCluster->stats, st);
306                if( 0 != mainProcessor->print_stats ) {
307                        __print_stats( st, mainProcessor->print_stats, "Processor ", mainProcessor->name, (void*)mainProcessor );
308                }
309                #if defined(CFA_STATS_ARRAY)
310                        __flush_stat( st, "Processor", mainProcessor );
311                #endif
312        #endif
313
314        mainProcessor->local_data = 0p;
315
316        unregister_tls( mainProcessor );
317        __cfa_io_stop( mainProcessor );
318
319        // Destroy the main processor and its context in reverse order of construction
320        // These were manually constructed so we need manually destroy them
321        void ^?{}(processor & this) with( this ){
322                deinit( this );
323
324                /* paranoid */ verify( this.do_terminate == true );
325                __cfaabi_dbg_print_safe("Kernel : destroyed main processor context %p\n", &runner);
326        }
327
328        ^(*mainProcessor){};
329
330        // Final step, destroy the main thread since it is no longer needed
331
332        // Since we provided a stack to this taxk it will not destroy anything
333        /* paranoid */ verify(mainThread->self_cor.stack.storage == (__stack_t*)(((uintptr_t)&storage_mainThreadCtx)| 0x1));
334        ^(*mainThread){};
335
336        ^(*mainCluster){};
337
338        ^(*__scheduler_lock){};
339
340        ^(__cfa_dbg_global_clusters.list){};
341        ^(__cfa_dbg_global_clusters.lock){};
342
343        __cfadbg_print_safe(runtime_core, "Kernel : Shutdown complete\n");
344}
345
346//=============================================================================================
347// Kernel Initial Scheduling logic
348//=============================================================================================
349
350// Context invoker for processors
351// This is the entry point for processors (kernel threads) *except* for the main processor
352// It effectively constructs a coroutine by stealing the pthread stack
353static void * __invoke_processor(void * arg) {
354        #if !defined( __CFA_NO_STATISTICS__ )
355                __stats_t local_stats;
356                __init_stats( &local_stats );
357                __cfaabi_tls.this_stats = &local_stats;
358        #endif
359
360        processor * proc = (processor *) arg;
361        __cfaabi_tls.this_processor = proc;
362        __cfaabi_tls.this_thread    = 0p;
363        __cfaabi_tls.preemption_state.[enabled, disable_count] = [false, 1];
364        proc->local_data = &__cfaabi_tls;
365
366        __cfa_io_start( proc );
367        register_tls( proc );
368
369        // used for idle sleep when io_uring is present
370        io_future_t future;
371        eventfd_t idle_buf;
372        proc->idle_wctx.ftr = &future;
373        proc->idle_wctx.rdbuf = &idle_buf;
374
375
376        // SKULLDUGGERY: We want to create a context for the processor coroutine
377        // which is needed for the 2-step context switch. However, there is no reason
378        // to waste the perfectly valid stack create by pthread.
379        current_stack_info_t info;
380        __stack_t ctx;
381        info.storage = &ctx;
382        (proc->runner){ proc, &info };
383
384        __cfaabi_dbg_print_safe("Coroutine : created stack %p\n", get_coroutine(proc->runner)->stack.storage);
385
386        //Set global state
387        __cfaabi_tls.this_thread = 0p;
388
389        //We now have a proper context from which to schedule threads
390        __cfadbg_print_safe(runtime_core, "Kernel : core %p created (%p, %p)\n", proc, &proc->runner, &ctx);
391
392        // SKULLDUGGERY: Since the coroutine doesn't have its own stack, we can't
393        // resume it to start it like it normally would, it will just context switch
394        // back to here. Instead directly call the main since we already are on the
395        // appropriate stack.
396        get_coroutine(proc->runner)->state = Active;
397        main( proc->runner );
398        get_coroutine(proc->runner)->state = Halted;
399
400        // Main routine of the core returned, the core is now fully terminated
401        __cfadbg_print_safe(runtime_core, "Kernel : core %p main ended (%p)\n", proc, &proc->runner);
402
403        #if !defined(__CFA_NO_STATISTICS__)
404                __tally_stats(proc->cltr->stats, &local_stats);
405                if( 0 != proc->print_stats ) {
406                        __print_stats( &local_stats, proc->print_stats, "Processor ", proc->name, (void*)proc );
407                }
408                #if defined(CFA_STATS_ARRAY)
409                        __flush_stat( &local_stats, "Processor", proc );
410                #endif
411        #endif
412
413        proc->local_data = 0p;
414
415        unregister_tls( proc );
416        __cfa_io_stop( proc );
417
418        return 0p;
419}
420
421static void __kernel_first_resume( processor * this ) {
422        thread$ * src = mainThread;
423        coroutine$ * dst = get_coroutine(this->runner);
424
425        /* paranoid */ verify( ! __preemption_enabled() );
426
427        __cfaabi_tls.this_thread->curr_cor = dst;
428        __stack_prepare( &dst->stack, DEFAULT_STACK_SIZE );
429        __cfactx_start(main, dst, this->runner, __cfactx_invoke_coroutine);
430
431        /* paranoid */ verify( ! __preemption_enabled() );
432
433        dst->last = &src->self_cor;
434        dst->starter = dst->starter ? dst->starter : &src->self_cor;
435
436        // make sure the current state is still correct
437        /* paranoid */ verify(src->state == Ready);
438        src->corctx_flag = true;
439
440        // context switch to specified coroutine
441        verify( dst->context.SP );
442        __cfactx_switch( &src->context, &dst->context );
443        // when __cfactx_switch returns we are back in the src coroutine
444
445        mainThread->curr_cor = &mainThread->self_cor;
446
447        // make sure the current state has been update
448        /* paranoid */ verify(src->state == Active);
449
450        /* paranoid */ verify( ! __preemption_enabled() );
451}
452
453// KERNEL_ONLY
454static void __kernel_last_resume( processor * this ) {
455        coroutine$ * src = &mainThread->self_cor;
456        coroutine$ * dst = get_coroutine(this->runner);
457
458        /* paranoid */ verify( ! __preemption_enabled() );
459        /* paranoid */ verify( dst->starter == src );
460        /* paranoid */ verify( dst->context.SP );
461
462        // SKULLDUGGERY in debug the processors check that the
463        // stack is still within the limit of the stack limits after running a thread.
464        // that check doesn't make sense if we context switch to the processor using the
465        // coroutine semantics. Since this is a special case, use the current context
466        // info to populate these fields.
467        __cfaabi_dbg_debug_do(
468                __stack_context_t ctx;
469                CtxGet( ctx );
470                mainThread->context.SP = ctx.SP;
471                mainThread->context.FP = ctx.FP;
472        )
473
474        // context switch to the processor
475        __cfactx_switch( &src->context, &dst->context );
476}
477
478
479//=============================================================================================
480// Kernel Object Constructors logic
481//=============================================================================================
482//-----------------------------------------------------------------------------
483// Main thread construction
484static void ?{}( coroutine$ & this, current_stack_info_t * info) with( this ) {
485        stack.storage = info->storage;
486        with(*stack.storage) {
487                limit     = info->limit;
488                base      = info->base;
489        }
490        __attribute__((may_alias)) intptr_t * istorage = (intptr_t*) &stack.storage;
491        *istorage |= 0x1;
492        name = "Main Thread";
493        state = Start;
494        starter = 0p;
495        last = 0p;
496        cancellation = 0p;
497}
498
499static void ?{}( thread$ & this, current_stack_info_t * info) with( this ) {
500        ticket = TICKET_RUNNING;
501        state = Start;
502        self_cor{ info };
503        curr_cor = &self_cor;
504        curr_cluster = mainCluster;
505        self_mon.owner = &this;
506        self_mon.recursion = 1;
507        self_mon_p = &self_mon;
508        link.next = 0p;
509        link.ts   = -1llu;
510        preferred = ready_queue_new_preferred();
511        last_proc = 0p;
512        random_state = __global_random_mask ? __global_random_prime : __global_random_prime ^ rdtscl();
513        #if defined( __CFA_WITH_VERIFY__ )
514                canary = 0x0D15EA5E0D15EA5Ep;
515        #endif
516
517        node.next = 0p;
518        node.prev = 0p;
519        doregister(curr_cluster, this);
520
521        monitors{ &self_mon_p, 1, (fptr_t)0 };
522}
523
524//-----------------------------------------------------------------------------
525// Processor
526// Construct the processor context of non-main processors
527static void ?{}(processorCtx_t & this, processor * proc, current_stack_info_t * info) {
528        (this.__cor){ info };
529        this.proc = proc;
530}
531
532static void init(processor & this, const char name[], cluster & _cltr, thread$ * initT) with( this ) {
533        this.name = name;
534        this.cltr = &_cltr;
535        this.rdq.its = 0;
536        this.rdq.itr = 0;
537        this.rdq.id  = 0;
538        this.rdq.target = MAX;
539        this.rdq.last = MAX;
540        this.rdq.cpu = 0;
541        // this.rdq.cutoff = 0ull;
542        do_terminate = false;
543        preemption_alarm = 0p;
544        pending_preemption = false;
545
546        this.io.ctx = 0p;
547        this.io.pending = false;
548        this.io.dirty   = false;
549
550        this.init.thrd = initT;
551
552        this.local_data = 0p;
553
554        idle_wctx.evfd = eventfd(0, 0);
555        if (idle_wctx.evfd < 0) {
556                abort("KERNEL ERROR: PROCESSOR EVENTFD - %s\n", strerror(errno));
557        }
558
559        idle_wctx.sem = 0;
560        idle_wctx.wake__time = 0;
561
562        // I'm assuming these two are reserved for standard input and output
563        // so I'm using them as sentinels with idle_wctx.
564        /* paranoid */ verify( idle_wctx.evfd != 0 );
565        /* paranoid */ verify( idle_wctx.evfd != 1 );
566
567        #if !defined(__CFA_NO_STATISTICS__)
568                print_stats = 0;
569                print_halts = false;
570        #endif
571
572        __cfadbg_print_safe(runtime_core, "Kernel : core %p created\n", &this);
573}
574
575// Not a ctor, it just preps the destruction but should not destroy members
576static void deinit(processor & this) {
577        close(this.idle_wctx.evfd);
578}
579
580void ?{}(processor & this, const char name[], cluster & _cltr, thread$ * initT) {
581        ( this.terminated ){};
582        ( this.runner ){};
583
584        disable_interrupts();
585                init( this, name, _cltr, initT );
586        enable_interrupts();
587
588        __cfadbg_print_safe(runtime_core, "Kernel : Starting core %p\n", &this);
589
590        this.stack = __create_pthread( &this.kernel_thread, __invoke_processor, (void *)&this );
591}
592
593void ?{}(processor & this, const char name[], cluster & _cltr) {
594        (this){name, _cltr, 0p};
595}
596
597extern size_t __page_size;
598void ^?{}(processor & this) with( this ){
599        /* paranoid */ verify( !__atomic_load_n(&do_terminate, __ATOMIC_ACQUIRE) );
600        __cfadbg_print_safe(runtime_core, "Kernel : core %p signaling termination\n", &this);
601
602        __atomic_store_n(&do_terminate, true, __ATOMIC_RELAXED);
603        __disable_interrupts_checked();
604                __wake_proc( &this );
605        __enable_interrupts_checked();
606
607        wait( terminated );
608        /* paranoid */ verify( active_processor() != &this);
609
610        __destroy_pthread( kernel_thread, this.stack, 0p );
611
612        disable_interrupts();
613                deinit( this );
614        enable_interrupts();
615}
616
617//-----------------------------------------------------------------------------
618// Cluster
619static void ?{}(__cluster_proc_list & this) {
620        this.fdw   = 0p;
621        this.idle  = 0;
622        this.total = 0;
623}
624
625void ?{}(cluster & this, const char name[], Duration preemption_rate, unsigned num_io, const io_context_params & io_params) with( this ) {
626        this.name = name;
627        this.preemption_rate = preemption_rate;
628        this.sched.readyQ.data = 0p;
629        this.sched.readyQ.tscs = 0p;
630        this.sched.readyQ.count = 0;
631        this.sched.io.tscs = 0p;
632        this.sched.io.data = 0p;
633        this.sched.caches = 0p;
634
635        #if !defined(__CFA_NO_STATISTICS__)
636                print_stats = 0;
637                stats = alloc();
638                __init_stats( stats );
639        #endif
640
641        threads{ __get };
642
643        io.arbiter = create();
644        io.params = io_params;
645
646        doregister(this);
647
648        // Lock the RWlock so no-one pushes/pops while we are changing the queue
649        disable_interrupts();
650        uint_fast32_t last_size = ready_mutate_lock();
651
652                // Adjust the ready queue size
653                ready_queue_grow( &this );
654
655        // Unlock the RWlock
656        ready_mutate_unlock( last_size );
657        enable_interrupts( false ); // Don't poll, could be in main cluster
658}
659
660void ^?{}(cluster & this) {
661        destroy(this.io.arbiter);
662
663        // Lock the RWlock so no-one pushes/pops while we are changing the queue
664        disable_interrupts();
665        uint_fast32_t last_size = ready_mutate_lock();
666
667                // Adjust the ready queue size
668                ready_queue_shrink( &this );
669
670        // Unlock the RWlock
671        ready_mutate_unlock( last_size );
672
673        ready_queue_close( &this );
674        /* paranoid */ verify( this.sched.readyQ.data == 0p );
675        /* paranoid */ verify( this.sched.readyQ.tscs == 0p );
676        /* paranoid */ verify( this.sched.readyQ.count == 0 );
677        /* paranoid */ verify( this.sched.io.tscs == 0p );
678        /* paranoid */ verify( this.sched.caches == 0p );
679
680        enable_interrupts( false ); // Don't poll, could be in main cluster
681
682
683        #if !defined(__CFA_NO_STATISTICS__)
684                if( 0 != this.print_stats ) {
685                        __print_stats( this.stats, this.print_stats, "Cluster", this.name, (void*)&this );
686                }
687                #if defined(CFA_STATS_ARRAY)
688                        __flush_stat( this.stats, "Cluster", &this );
689                #endif
690                free( this.stats );
691        #endif
692
693        unregister(this);
694}
695
696//=============================================================================================
697// Miscellaneous Initialization
698//=============================================================================================
699//-----------------------------------------------------------------------------
700// Global Queues
701static void doregister( cluster     & cltr ) {
702        lock      ( __cfa_dbg_global_clusters.lock __cfaabi_dbg_ctx2);
703        push_front( __cfa_dbg_global_clusters.list, cltr );
704        unlock    ( __cfa_dbg_global_clusters.lock );
705}
706
707static void unregister( cluster     & cltr ) {
708        lock  ( __cfa_dbg_global_clusters.lock __cfaabi_dbg_ctx2);
709        remove( __cfa_dbg_global_clusters.list, cltr );
710        unlock( __cfa_dbg_global_clusters.lock );
711}
712
713void doregister( cluster * cltr, thread$ & thrd ) {
714        lock      (cltr->thread_list_lock __cfaabi_dbg_ctx2);
715        cltr->nthreads += 1;
716        push_front(cltr->threads, thrd);
717        unlock    (cltr->thread_list_lock);
718}
719
720void unregister( cluster * cltr, thread$ & thrd ) {
721        lock  (cltr->thread_list_lock __cfaabi_dbg_ctx2);
722        remove(cltr->threads, thrd );
723        cltr->nthreads -= 1;
724        unlock(cltr->thread_list_lock);
725}
726
727static void register_tls( processor * this ) {
728        // Register and Lock the RWlock so no-one pushes/pops while we are changing the queue
729        uint_fast32_t last_size;
730        [this->unique_id, last_size] = ready_mutate_register();
731
732                this->rdq.cpu = __kernel_getcpu();
733
734                this->cltr->procs.total += 1u;
735                insert_last(this->cltr->procs.actives, *this);
736
737                // Adjust the ready queue size
738                ready_queue_grow( this->cltr );
739
740        // Unlock the RWlock
741        ready_mutate_unlock( last_size );
742}
743
744
745static void unregister_tls( processor * this ) {
746        // Lock the RWlock so no-one pushes/pops while we are changing the queue
747        uint_fast32_t last_size = ready_mutate_lock();
748                this->cltr->procs.total -= 1u;
749                remove(*this);
750
751                // clear the cluster so nothing gets pushed to local queues
752                cluster * cltr = this->cltr;
753                this->cltr = 0p;
754
755                // Adjust the ready queue size
756                ready_queue_shrink( cltr );
757
758        // Unlock the RWlock and unregister: we don't need the read_lock any more
759        ready_mutate_unregister( this->unique_id, last_size );
760}
761
762static void check( int ret, const char func[] ) {
763        if ( ret ) {                                                                            // pthread routines return errno values
764                abort( "%s : internal error, error(%d) %s.", func, ret, strerror( ret ) );
765        } // if
766} // Abort
767
768void * __create_pthread( pthread_t * pthread, void * (*start)(void *), void * arg ) {
769        pthread_attr_t attr;
770
771        check( pthread_attr_init( &attr ), "pthread_attr_init" ); // initialize attribute
772
773        size_t stacksize = max( PTHREAD_STACK_MIN, DEFAULT_STACK_SIZE );
774
775        void * stack;
776        #if CFA_PROCESSOR_USE_MMAP
777                stacksize = ceiling( stacksize, __page_size ) + __page_size;
778                stack = mmap(0p, stacksize, __map_prot, MAP_PRIVATE | MAP_ANONYMOUS, 0, 0);
779                if(stack == ((void*)-1)) {
780                        abort( "pthread stack creation : internal error, mmap failure, error(%d) %s.", errno, strerror( errno ) );
781                }
782                if ( mprotect( stack, __page_size, PROT_NONE ) == -1 ) {
783                        abort( "pthread stack creation : internal error, mprotect failure, error(%d) %s.", errno, strerror( errno ) );
784                } // if
785        #else
786                __cfaabi_dbg_debug_do(
787                        stack = memalign( __page_size, stacksize + __page_size );
788                        // pthread has no mechanism to create the guard page in user supplied stack.
789                        if ( mprotect( stack, __page_size, PROT_NONE ) == -1 ) {
790                                abort( "mprotect : internal error, mprotect failure, error(%d) %s.", errno, strerror( errno ) );
791                        } // if
792                );
793                __cfaabi_dbg_no_debug_do(
794                        stack = malloc( stacksize );
795                );
796        #endif
797
798        check( pthread_attr_setstack( &attr, stack, stacksize ), "pthread_attr_setstack" );
799        check( pthread_create( pthread, &attr, start, arg ), "pthread_create" );
800        return stack;
801}
802
803void __destroy_pthread( pthread_t pthread, void * stack, void ** retval ) {
804        int err = pthread_join( pthread, retval );
805        if( err != 0 ) abort("KERNEL ERROR: joining pthread %p caused error %s\n", (void*)pthread, strerror(err));
806
807        #if CFA_PROCESSOR_USE_MMAP
808                pthread_attr_t attr;
809
810                check( pthread_attr_init( &attr ), "pthread_attr_init" ); // initialize attribute
811
812                size_t stacksize;
813                // default stack size, normally defined by shell limit
814                check( pthread_attr_getstacksize( &attr, &stacksize ), "pthread_attr_getstacksize" );
815                assert( stacksize >= PTHREAD_STACK_MIN );
816                stacksize += __page_size;
817
818                if(munmap(stack, stacksize) == -1) {
819                        abort( "pthread stack destruction : internal error, munmap failure, error(%d) %s.", errno, strerror( errno ) );
820                }
821        #else
822                __cfaabi_dbg_debug_do(
823                        // pthread has no mechanism to create the guard page in user supplied stack.
824                        if ( mprotect( stack, __page_size, __map_prot ) == -1 ) {
825                                abort( "mprotect : internal error, mprotect failure, error(%d) %s.", errno, strerror( errno ) );
826                        } // if
827                );
828                free( stack );
829        #endif
830}
831
832#if defined(__CFA_WITH_VERIFY__)
833static bool verify_fwd_bck_rng(void) {
834        __cfaabi_tls.ready_rng.fwd_seed = 25214903917_l64u * (rdtscl() ^ (uintptr_t)&verify_fwd_bck_rng);
835
836        unsigned values[10];
837        for(i; 10) {
838                values[i] = __tls_rand_fwd();
839        }
840
841        __tls_rand_advance_bck();
842
843        for ( i; 9 -~= 0 ) {
844                if(values[i] != __tls_rand_bck()) {
845                        return false;
846                }
847        }
848
849        return true;
850}
851#endif
Note: See TracBrowser for help on using the repository browser.