[13c5e19] | 1 | #pragma once |
---|
| 2 | |
---|
| 3 | #define __CFA_NO_SCHED_STATS__ |
---|
| 4 | |
---|
[7a2972b9] | 5 | #include "containers/queueLockFree.hfa" |
---|
| 6 | |
---|
[f6fdfb14] | 7 | // Intrusives lanes which are used by the relaxed ready queue |
---|
| 8 | struct __attribute__((aligned(128))) __intrusive_lane_t { |
---|
[e84ab3d] | 9 | struct thread$ * prev; |
---|
[2b96031] | 10 | |
---|
[f6fdfb14] | 11 | // spin lock protecting the queue |
---|
| 12 | volatile bool lock; |
---|
[13c5e19] | 13 | |
---|
[353aaba] | 14 | __thread_desc_link anchor; |
---|
| 15 | |
---|
[16fd826] | 16 | #if !defined(__CFA_NO_STATISTICS__) |
---|
| 17 | unsigned cnt; |
---|
| 18 | #endif |
---|
[f6fdfb14] | 19 | }; |
---|
[2b96031] | 20 | |
---|
[f6fdfb14] | 21 | // Get the head pointer (one before the first element) from the anchor |
---|
[e84ab3d] | 22 | static inline thread$ * mock_head(const __intrusive_lane_t & this) { |
---|
| 23 | thread$ * rhead = (thread$ *)( |
---|
| 24 | (uintptr_t)( &this.anchor ) - __builtin_offsetof( thread$, link ) |
---|
[f6fdfb14] | 25 | ); |
---|
| 26 | return rhead; |
---|
| 27 | } |
---|
| 28 | |
---|
| 29 | // Push a thread onto this lane |
---|
| 30 | // returns true of lane was empty before push, false otherwise |
---|
[e84ab3d] | 31 | static inline void push( __intrusive_lane_t & this, thread$ * node ) { |
---|
[16fd826] | 32 | /* paranoid */ verify( this.lock ); |
---|
[f6fdfb14] | 33 | /* paranoid */ verify( node->link.next == 0p ); |
---|
[ef94ae7] | 34 | /* paranoid */ verify( node->link.ts == -1llu ); |
---|
[f6fdfb14] | 35 | /* paranoid */ verify( this.prev->link.next == 0p ); |
---|
[ef94ae7] | 36 | /* paranoid */ verify( this.prev->link.ts == -1llu ); |
---|
[f6fdfb14] | 37 | if( this.anchor.next == 0p ) { |
---|
[2b96031] | 38 | /* paranoid */ verify( this.anchor.next == 0p ); |
---|
[ef94ae7] | 39 | /* paranoid */ verify( this.anchor.ts == -1llu ); |
---|
| 40 | /* paranoid */ verify( this.anchor.ts != 0 ); |
---|
[f6fdfb14] | 41 | /* paranoid */ verify( this.prev == mock_head( this ) ); |
---|
| 42 | } else { |
---|
[2b96031] | 43 | /* paranoid */ verify( this.anchor.next != 0p ); |
---|
[ef94ae7] | 44 | /* paranoid */ verify( this.anchor.ts != -1llu ); |
---|
[2b96031] | 45 | /* paranoid */ verify( this.anchor.ts != 0 ); |
---|
[f6fdfb14] | 46 | /* paranoid */ verify( this.prev != mock_head( this ) ); |
---|
[2b96031] | 47 | } |
---|
| 48 | |
---|
[f6fdfb14] | 49 | // Get the relevant nodes locally |
---|
| 50 | this.prev->link.next = node; |
---|
| 51 | this.prev->link.ts = rdtscl(); |
---|
| 52 | this.prev = node; |
---|
[16fd826] | 53 | #if !defined(__CFA_NO_STATISTICS__) |
---|
| 54 | this.cnt++; |
---|
| 55 | #endif |
---|
[f6fdfb14] | 56 | } |
---|
| 57 | |
---|
| 58 | // Pop a thread from this lane (must be non-empty) |
---|
| 59 | // returns popped |
---|
| 60 | // returns true of lane was empty before push, false otherwise |
---|
[e84ab3d] | 61 | static inline [* thread$, unsigned long long] pop( __intrusive_lane_t & this ) { |
---|
[16fd826] | 62 | /* paranoid */ verify( this.lock ); |
---|
[f6fdfb14] | 63 | /* paranoid */ verify( this.anchor.next != 0p ); |
---|
[ef94ae7] | 64 | /* paranoid */ verify( this.anchor.ts != -1llu ); |
---|
[f6fdfb14] | 65 | /* paranoid */ verify( this.anchor.ts != 0 ); |
---|
| 66 | |
---|
| 67 | // Get the relevant nodes locally |
---|
[e84ab3d] | 68 | thread$ * node = this.anchor.next; |
---|
[f6fdfb14] | 69 | this.anchor.next = node->link.next; |
---|
| 70 | this.anchor.ts = node->link.ts; |
---|
[ef94ae7] | 71 | bool is_empty = this.anchor.next == 0p; |
---|
[f6fdfb14] | 72 | node->link.next = 0p; |
---|
[ef94ae7] | 73 | node->link.ts = -1llu; |
---|
[16fd826] | 74 | #if !defined(__CFA_NO_STATISTICS__) |
---|
| 75 | this.cnt--; |
---|
| 76 | #endif |
---|
[f6fdfb14] | 77 | |
---|
| 78 | // Update head time stamp |
---|
| 79 | if(is_empty) this.prev = mock_head( this ); |
---|
| 80 | |
---|
| 81 | /* paranoid */ verify( node->link.next == 0p ); |
---|
[ef94ae7] | 82 | /* paranoid */ verify( node->link.ts == -1llu ); |
---|
| 83 | /* paranoid */ verify( node->link.ts != 0 ); |
---|
| 84 | /* paranoid */ verify( this.anchor.ts != 0 ); |
---|
[cf78319] | 85 | return [node, this.anchor.ts]; |
---|
[f6fdfb14] | 86 | } |
---|
| 87 | |
---|
| 88 | // Check whether or not list is empty |
---|
| 89 | static inline bool is_empty(__intrusive_lane_t & this) { |
---|
[ef94ae7] | 90 | return this.anchor.next == 0p; |
---|
[f6fdfb14] | 91 | } |
---|
| 92 | |
---|
| 93 | // Return the timestamp |
---|
| 94 | static inline unsigned long long ts(__intrusive_lane_t & this) { |
---|
| 95 | // Cannot verify here since it may not be locked |
---|
[ef94ae7] | 96 | /* paranoid */ verify(this.anchor.ts != 0); |
---|
[f6fdfb14] | 97 | return this.anchor.ts; |
---|
[8cd40bf] | 98 | } |
---|