|
| 1 | +open Picos_std_awaitable |
| 2 | + |
| 3 | +type t = int Awaitable.t |
| 4 | + |
| 5 | +let sense_bit = 1 |
| 6 | +let parties_shift = 1 |
| 7 | +let parties_bits = (Sys.int_size - 2) / 2 |
| 8 | +let max_parties = (1 lsl parties_bits) - 1 |
| 9 | +let parties_mask = max_parties lsl parties_shift |
| 10 | +let awaiting_shift = parties_shift + parties_bits |
| 11 | +let awaiting_one = 1 lsl awaiting_shift |
| 12 | +let poisoned_bit = Int.min_int |
| 13 | + |
| 14 | +let create ?padded parties = |
| 15 | + if parties <= 0 || max_parties < parties then |
| 16 | + invalid_arg "invalid number of parties"; |
| 17 | + Awaitable.make ?padded |
| 18 | + ((parties lsl parties_shift) lor (parties lsl awaiting_shift)) |
| 19 | + |
| 20 | +exception Poisoned |
| 21 | + |
| 22 | +let rec poison t = |
| 23 | + let before = Awaitable.get t in |
| 24 | + if 0 < before then |
| 25 | + let after = |
| 26 | + let parties_shifted = before land parties_mask in |
| 27 | + let after_sense = lnot before land sense_bit in |
| 28 | + parties_shifted lor after_sense |
| 29 | + lor (max_parties lsl awaiting_shift) |
| 30 | + lor poisoned_bit |
| 31 | + in |
| 32 | + if Awaitable.compare_and_set t before after then Awaitable.broadcast t |
| 33 | + else poison t |
| 34 | + |
| 35 | +let await t = |
| 36 | + let[@inline never] poison_and_raise t = |
| 37 | + poison t; |
| 38 | + raise Poisoned |
| 39 | + in |
| 40 | + let prior = Awaitable.fetch_and_add t (-awaiting_one) in |
| 41 | + if awaiting_one < prior then begin |
| 42 | + let before = prior - awaiting_one in |
| 43 | + let after_sense = prior land sense_bit lxor sense_bit in |
| 44 | + if before < awaiting_one then |
| 45 | + let after = |
| 46 | + let parties_shifted = before land parties_mask in |
| 47 | + parties_shifted lor after_sense |
| 48 | + lor (parties_shifted lsl (awaiting_shift - parties_shift)) |
| 49 | + in |
| 50 | + if Awaitable.compare_and_set t before after then Awaitable.broadcast t |
| 51 | + else |
| 52 | + (* The barrier is being misused? Poison the barrier. *) |
| 53 | + poison_and_raise t |
| 54 | + else |
| 55 | + let state = ref before in |
| 56 | + match |
| 57 | + while !state land sense_bit <> after_sense do |
| 58 | + Awaitable.await t !state; |
| 59 | + state := Awaitable.get t |
| 60 | + done |
| 61 | + with |
| 62 | + | () -> if 0 <= !state then () else raise Poisoned |
| 63 | + | exception exn -> |
| 64 | + let bt = Printexc.get_raw_backtrace () in |
| 65 | + poison t; |
| 66 | + Printexc.raise_with_backtrace exn bt |
| 67 | + end |
| 68 | + else begin |
| 69 | + (* The barrier was poisoned. Undo the decrement. *) |
| 70 | + Awaitable.fetch_and_add t awaiting_one |> ignore; |
| 71 | + poison_and_raise t |
| 72 | + end |
| 73 | + |
| 74 | +let parties t = (Awaitable.get t land parties_mask) lsr parties_shift |
0 commit comments