1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62

use core::num::NonZeroUsize;
use r3_core::kernel::{
    raw_cfg::{CfgSemaphore, SemaphoreDescriptor},
    SemaphoreValue,
};

use crate::{cfg::CfgBuilder, klock::CpuLockCell, semaphore, wait, KernelTraits, Port};

unsafe impl<Traits: KernelTraits> const CfgSemaphore for CfgBuilder<Traits> {
    fn semaphore_define<Properties: ~const r3_core::bag::Bag>(
        &mut self,
        SemaphoreDescriptor {
            phantom: _,
            initial,
            maximum,
            queue_order,
        }: SemaphoreDescriptor<Self::System>,
        _properties: Properties,
    ) -> semaphore::SemaphoreId {
        assert!(
            initial <= maximum,
            "`initial` must be less than or equal to `maximum`"
        );

        self.semaphores.push(CfgBuilderSemaphore {
            initial,
            maximum,
            queue_order: wait::QueueOrder::from(queue_order),
        });

        unsafe { NonZeroUsize::new_unchecked(self.semaphores.len()) }
    }
}

#[doc(hidden)]
pub struct CfgBuilderSemaphore {
    initial: SemaphoreValue,
    maximum: SemaphoreValue,
    queue_order: wait::QueueOrder,
}

impl Clone for CfgBuilderSemaphore {
    fn clone(&self) -> Self {
        Self {
            initial: self.initial,
            maximum: self.maximum,
            queue_order: self.queue_order,
        }
    }
}

impl Copy for CfgBuilderSemaphore {}

impl CfgBuilderSemaphore {
    pub const fn to_state<System: Port>(&self) -> semaphore::SemaphoreCb<System> {
        semaphore::SemaphoreCb {
            value: CpuLockCell::new(self.initial),
            max_value: self.maximum,
            wait_queue: wait::WaitQueue::new(self.queue_order),
        }
    }
}