| 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 | // bits/locks.hfa -- Fast internal locks.
|
|---|
| 8 | //
|
|---|
| 9 | // Author : Thierry Delisle
|
|---|
| 10 | // Created On : Tue Oct 31 15:14:38 2017
|
|---|
| 11 | // Last Modified By : Peter A. Buhr
|
|---|
| 12 | // Last Modified On : Tue Feb 4 13:03:19 2020
|
|---|
| 13 | // Update Count : 11
|
|---|
| 14 | //
|
|---|
| 15 |
|
|---|
| 16 | #pragma once
|
|---|
| 17 |
|
|---|
| 18 | #include "bits/debug.hfa"
|
|---|
| 19 | #include "bits/defs.hfa"
|
|---|
| 20 | #include <assert.h>
|
|---|
| 21 |
|
|---|
| 22 | #ifdef __cforall
|
|---|
| 23 | extern "C" {
|
|---|
| 24 | #include <pthread.h>
|
|---|
| 25 | }
|
|---|
| 26 | #endif
|
|---|
| 27 |
|
|---|
| 28 | // pause to prevent excess processor bus usage
|
|---|
| 29 | #if defined( __sparc )
|
|---|
| 30 | #define Pause() __asm__ __volatile__ ( "rd %ccr,%g0" )
|
|---|
| 31 | #elif defined( __i386 ) || defined( __x86_64 )
|
|---|
| 32 | #define Pause() __asm__ __volatile__ ( "pause" : : : )
|
|---|
| 33 | #elif defined( __ARM_ARCH )
|
|---|
| 34 | #define Pause() __asm__ __volatile__ ( "nop" : : : )
|
|---|
| 35 | #else
|
|---|
| 36 | #error unsupported architecture
|
|---|
| 37 | #endif
|
|---|
| 38 |
|
|---|
| 39 | struct __spinlock_t {
|
|---|
| 40 | // Wrap in struct to prevent false sharing with debug info
|
|---|
| 41 | volatile bool lock;
|
|---|
| 42 | #ifdef __CFA_DEBUG__
|
|---|
| 43 | // previous function to acquire the lock
|
|---|
| 44 | const char * prev_name;
|
|---|
| 45 | // previous thread to acquire the lock
|
|---|
| 46 | void* prev_thrd;
|
|---|
| 47 | #endif
|
|---|
| 48 | };
|
|---|
| 49 |
|
|---|
| 50 | #ifdef __cforall
|
|---|
| 51 | extern "C" {
|
|---|
| 52 | extern void disable_interrupts() OPTIONAL_THREAD;
|
|---|
| 53 | extern void enable_interrupts_noPoll() OPTIONAL_THREAD;
|
|---|
| 54 |
|
|---|
| 55 | #ifdef __CFA_DEBUG__
|
|---|
| 56 | void __cfaabi_dbg_record_lock(__spinlock_t & this, const char prev_name[]);
|
|---|
| 57 | #else
|
|---|
| 58 | #define __cfaabi_dbg_record_lock(x, y)
|
|---|
| 59 | #endif
|
|---|
| 60 | }
|
|---|
| 61 |
|
|---|
| 62 | static inline void ?{}( __spinlock_t & this ) {
|
|---|
| 63 | this.lock = 0;
|
|---|
| 64 | }
|
|---|
| 65 |
|
|---|
| 66 | // Lock the spinlock, return false if already acquired
|
|---|
| 67 | static inline bool try_lock ( __spinlock_t & this __cfaabi_dbg_ctx_param2 ) {
|
|---|
| 68 | disable_interrupts();
|
|---|
| 69 | bool result = (this.lock == 0) && (__atomic_test_and_set( &this.lock, __ATOMIC_ACQUIRE ) == 0);
|
|---|
| 70 | if( result ) {
|
|---|
| 71 | __cfaabi_dbg_record_lock( this, caller );
|
|---|
| 72 | } else {
|
|---|
| 73 | enable_interrupts_noPoll();
|
|---|
| 74 | }
|
|---|
| 75 | return result;
|
|---|
| 76 | }
|
|---|
| 77 |
|
|---|
| 78 | // Lock the spinlock, spin if already acquired
|
|---|
| 79 | static inline void lock( __spinlock_t & this __cfaabi_dbg_ctx_param2 ) {
|
|---|
| 80 | #ifndef NOEXPBACK
|
|---|
| 81 | enum { SPIN_START = 4, SPIN_END = 64 * 1024, };
|
|---|
| 82 | unsigned int spin = SPIN_START;
|
|---|
| 83 | #endif
|
|---|
| 84 |
|
|---|
| 85 | disable_interrupts();
|
|---|
| 86 | for ( unsigned int i = 1;; i += 1 ) {
|
|---|
| 87 | if ( (this.lock == 0) && (__atomic_test_and_set( &this.lock, __ATOMIC_ACQUIRE ) == 0) ) break;
|
|---|
| 88 | #ifndef NOEXPBACK
|
|---|
| 89 | // exponential spin
|
|---|
| 90 | for ( volatile unsigned int s = 0; s < spin; s += 1 ) Pause();
|
|---|
| 91 |
|
|---|
| 92 | // slowly increase by powers of 2
|
|---|
| 93 | if ( i % 64 == 0 ) spin += spin;
|
|---|
| 94 |
|
|---|
| 95 | // prevent overflow
|
|---|
| 96 | if ( spin > SPIN_END ) spin = SPIN_START;
|
|---|
| 97 | #else
|
|---|
| 98 | Pause();
|
|---|
| 99 | #endif
|
|---|
| 100 | }
|
|---|
| 101 | __cfaabi_dbg_record_lock( this, caller );
|
|---|
| 102 | }
|
|---|
| 103 |
|
|---|
| 104 | static inline void unlock( __spinlock_t & this ) {
|
|---|
| 105 | __atomic_clear( &this.lock, __ATOMIC_RELEASE );
|
|---|
| 106 | enable_interrupts_noPoll();
|
|---|
| 107 | }
|
|---|
| 108 |
|
|---|
| 109 |
|
|---|
| 110 | #ifdef __CFA_WITH_VERIFY__
|
|---|
| 111 | extern bool __cfaabi_dbg_in_kernel();
|
|---|
| 112 | #endif
|
|---|
| 113 |
|
|---|
| 114 | extern "C" {
|
|---|
| 115 | char * strerror(int);
|
|---|
| 116 | }
|
|---|
| 117 | #define CHECKED(x) { int err = x; if( err != 0 ) abort("KERNEL ERROR: Operation \"" #x "\" return error %d - %s\n", err, strerror(err)); }
|
|---|
| 118 |
|
|---|
| 119 | struct __bin_sem_t {
|
|---|
| 120 | pthread_mutex_t lock;
|
|---|
| 121 | pthread_cond_t cond;
|
|---|
| 122 | int val;
|
|---|
| 123 | };
|
|---|
| 124 |
|
|---|
| 125 | static inline void ?{}(__bin_sem_t & this) with( this ) {
|
|---|
| 126 | // Create the mutex with error checking
|
|---|
| 127 | pthread_mutexattr_t mattr;
|
|---|
| 128 | pthread_mutexattr_init( &mattr );
|
|---|
| 129 | pthread_mutexattr_settype( &mattr, PTHREAD_MUTEX_ERRORCHECK_NP);
|
|---|
| 130 | pthread_mutex_init(&lock, &mattr);
|
|---|
| 131 |
|
|---|
| 132 | pthread_cond_init (&cond, 0p);
|
|---|
| 133 | val = 0;
|
|---|
| 134 | }
|
|---|
| 135 |
|
|---|
| 136 | static inline void ^?{}(__bin_sem_t & this) with( this ) {
|
|---|
| 137 | CHECKED( pthread_mutex_destroy(&lock) );
|
|---|
| 138 | CHECKED( pthread_cond_destroy (&cond) );
|
|---|
| 139 | }
|
|---|
| 140 |
|
|---|
| 141 | static inline void wait(__bin_sem_t & this) with( this ) {
|
|---|
| 142 | verify(__cfaabi_dbg_in_kernel());
|
|---|
| 143 | CHECKED( pthread_mutex_lock(&lock) );
|
|---|
| 144 | while(val < 1) {
|
|---|
| 145 | pthread_cond_wait(&cond, &lock);
|
|---|
| 146 | }
|
|---|
| 147 | val -= 1;
|
|---|
| 148 | CHECKED( pthread_mutex_unlock(&lock) );
|
|---|
| 149 | }
|
|---|
| 150 |
|
|---|
| 151 | static inline bool post(__bin_sem_t & this) with( this ) {
|
|---|
| 152 | bool needs_signal = false;
|
|---|
| 153 |
|
|---|
| 154 | CHECKED( pthread_mutex_lock(&lock) );
|
|---|
| 155 | if(val < 1) {
|
|---|
| 156 | val += 1;
|
|---|
| 157 | pthread_cond_signal(&cond);
|
|---|
| 158 | needs_signal = true;
|
|---|
| 159 | }
|
|---|
| 160 | CHECKED( pthread_mutex_unlock(&lock) );
|
|---|
| 161 |
|
|---|
| 162 | return needs_signal;
|
|---|
| 163 | }
|
|---|
| 164 |
|
|---|
| 165 | #undef CHECKED
|
|---|
| 166 | #endif
|
|---|