| [1ed5e9e] | 1 | #include <thread.hfa> | 
|---|
| [ba0e1bc] | 2 | #include <locks.hfa> | 
|---|
|  | 3 | #include <list.hfa> | 
|---|
| [1ed5e9e] | 4 |  | 
|---|
|  | 5 | ////////////////////////////////////////////////////////////////////////////////////////// | 
|---|
|  | 6 | // cofor ( uC++ COFOR ) | 
|---|
| [e4c3819] | 7 | typedef void (*__cofor_body_t)( ssize_t ); | 
|---|
| [1ed5e9e] | 8 |  | 
|---|
| [11ab0b4a] | 9 | void __Cofor__( ssize_t low, ssize_t high, __cofor_body_t loop_body ); | 
|---|
| [1ed5e9e] | 10 |  | 
|---|
| [e4c3819] | 11 | #define COFOR( lidname, low, high, loopbody ) \ | 
|---|
|  | 12 | { \ | 
|---|
|  | 13 | void __CFA_loopLambda__( ssize_t lidname ) { \ | 
|---|
|  | 14 | loopbody \ | 
|---|
|  | 15 | } \ | 
|---|
| [11ab0b4a] | 16 | __Cofor__( low, high, __CFA_loopLambda__ ); \ | 
|---|
| [e4c3819] | 17 | } | 
|---|
| [334e0cf2] | 18 |  | 
|---|
| [ba0e1bc] | 19 | struct runner_node { | 
|---|
|  | 20 | void * value; | 
|---|
|  | 21 | inline dlink(runner_node); | 
|---|
|  | 22 | }; | 
|---|
|  | 23 | P9_EMBEDDED( runner_node, dlink(runner_node) ) | 
|---|
|  | 24 |  | 
|---|
|  | 25 | thread cofor_runner { | 
|---|
|  | 26 | go_mutex mutex_lock;              // MX lock | 
|---|
|  | 27 | dlist( runner_node ) items; | 
|---|
|  | 28 | void (*func)(void *); | 
|---|
|  | 29 | volatile bool done; | 
|---|
|  | 30 | }; | 
|---|
|  | 31 |  | 
|---|
|  | 32 | void ?{}( cofor_runner & this ) { this.done = false; } | 
|---|
|  | 33 |  | 
|---|
|  | 34 | void main( cofor_runner & this ) with(this) { | 
|---|
|  | 35 | while ( !done || !items`isEmpty ) { | 
|---|
|  | 36 | lock( mutex_lock ); | 
|---|
|  | 37 | runner_node * node = &try_pop_front( items ); | 
|---|
|  | 38 | unlock( mutex_lock ); | 
|---|
| [0da9475] | 39 | if ( !node ) | 
|---|
|  | 40 | continue; | 
|---|
| [ba0e1bc] | 41 | func( node->value ); | 
|---|
|  | 42 | free( node->value ); | 
|---|
|  | 43 | free( node ); | 
|---|
|  | 44 | } | 
|---|
|  | 45 | } | 
|---|
|  | 46 |  | 
|---|
|  | 47 | void start_runners( cofor_runner * thds, unsigned nprocs, void (*func)(void *) ) { | 
|---|
|  | 48 | for ( i; nprocs ) { | 
|---|
|  | 49 | thds[i].func = func; | 
|---|
|  | 50 | } | 
|---|
|  | 51 | } | 
|---|
|  | 52 |  | 
|---|
|  | 53 | void end_runners( cofor_runner * thds, unsigned nprocs ) { | 
|---|
|  | 54 | for ( i; nprocs ) { | 
|---|
|  | 55 | thds[i].done = true; | 
|---|
|  | 56 | } | 
|---|
|  | 57 | } | 
|---|
|  | 58 |  | 
|---|
|  | 59 | void send_work( cofor_runner * thds, unsigned nprocs, unsigned & curr_proc, void * value ) { | 
|---|
|  | 60 | runner_node * node = malloc(); | 
|---|
|  | 61 | (*node){}; | 
|---|
|  | 62 | node->value = value; | 
|---|
|  | 63 | lock( thds[curr_proc].mutex_lock ); | 
|---|
|  | 64 | insert_last( thds[curr_proc].items, *node ); | 
|---|
|  | 65 | unlock( thds[curr_proc].mutex_lock ); | 
|---|
|  | 66 | curr_proc = ( curr_proc + 1 ) % nprocs; | 
|---|
|  | 67 | } | 
|---|
|  | 68 |  | 
|---|
| [1ed5e9e] | 69 | ////////////////////////////////////////////////////////////////////////////////////////// | 
|---|
| [ee9ad40] | 70 | // corun | 
|---|
|  | 71 |  | 
|---|
|  | 72 | // | 
|---|
|  | 73 | typedef void (*__CFA_corun_lambda_t)( void ); | 
|---|
|  | 74 |  | 
|---|
|  | 75 | // used to run a corun statement in parallel | 
|---|
|  | 76 | thread co_runner { | 
|---|
|  | 77 | __CFA_corun_lambda_t body; | 
|---|
|  | 78 | }; | 
|---|
|  | 79 |  | 
|---|
|  | 80 | // wraps a co_runner to provide RAII deallocation | 
|---|
|  | 81 | struct runner_block { | 
|---|
|  | 82 | co_runner * runner; | 
|---|
|  | 83 | }; | 
|---|
|  | 84 | static inline void ?{}( co_runner & this, __CFA_corun_lambda_t body ) { this.body = body; } | 
|---|
|  | 85 |  | 
|---|
|  | 86 | void main( co_runner & this ) with( this ) { body(); } | 
|---|
|  | 87 |  | 
|---|
|  | 88 | static inline void ?{}( runner_block & this ) {} | 
|---|
|  | 89 | static inline void ?{}( runner_block & this, __CFA_corun_lambda_t body ) { | 
|---|
|  | 90 | (*(this.runner = malloc())){ body }; | 
|---|
|  | 91 | } | 
|---|
|  | 92 |  | 
|---|
|  | 93 | static inline void ^?{}( runner_block & this ) { | 
|---|
|  | 94 | delete( this.runner ); | 
|---|
|  | 95 | } | 
|---|