| 1 | |
| 2 |
|
| 3 | use super::HasHrTimer;
|
| 4 | use super::HrTimer;
|
| 5 | use super::HrTimerCallback;
|
| 6 | use super::HrTimerCallbackContext;
|
| 7 | use super::HrTimerHandle;
|
| 8 | use super::HrTimerMode;
|
| 9 | use super::RawHrTimerCallback;
|
| 10 | use super::UnsafeHrTimerPointer;
|
| 11 | use core::pin::Pin;
|
| 12 |
|
| 13 | |
| 14 | |
| 15 | pub struct PinHrTimerHandle<'a, T>
|
| 16 | where
|
| 17 | T: HasHrTimer<T>,
|
| 18 | {
|
| 19 | pub(crate) inner: Pin<&'a T>,
|
| 20 | }
|
| 21 |
|
| 22 | |
| 23 | |
| 24 | unsafe impl<'a, T> HrTimerHandle for PinHrTimerHandle<'a, T>
|
| 25 | where
|
| 26 | T: HasHrTimer<T>,
|
| 27 | {
|
| 28 | fn cancel(&mut self) -> bool {
|
| 29 | let self_ptr: *const T = self.inner.get_ref();
|
| 30 |
|
| 31 | |
| 32 | |
| 33 | let timer_ptr = unsafe { <T as HasHrTimer<T>>::raw_get_timer(self_ptr) };
|
| 34 |
|
| 35 | |
| 36 | |
| 37 | unsafe { HrTimer::<T>::raw_cancel(timer_ptr) }
|
| 38 | }
|
| 39 | }
|
| 40 |
|
| 41 | impl<'a, T> Drop for PinHrTimerHandle<'a, T>
|
| 42 | where
|
| 43 | T: HasHrTimer<T>,
|
| 44 | {
|
| 45 | fn drop(&mut self) {
|
| 46 | self.cancel();
|
| 47 | }
|
| 48 | }
|
| 49 |
|
| 50 | |
| 51 | |
| 52 | unsafe impl<'a, T> UnsafeHrTimerPointer for Pin<&'a T>
|
| 53 | where
|
| 54 | T: Send + Sync,
|
| 55 | T: HasHrTimer<T>,
|
| 56 | T: HrTimerCallback<Pointer<'a> = Self>,
|
| 57 | {
|
| 58 | type TimerMode = <T as HasHrTimer<T>>::TimerMode;
|
| 59 | type TimerHandle = PinHrTimerHandle<'a, T>;
|
| 60 |
|
| 61 | unsafe fn start(
|
| 62 | self,
|
| 63 | expires: <<T as HasHrTimer<T>>::TimerMode as HrTimerMode>::Expires,
|
| 64 | ) -> Self::TimerHandle {
|
| 65 | |
| 66 | let self_ptr: *const T = self.get_ref();
|
| 67 |
|
| 68 | |
| 69 | |
| 70 | |
| 71 | |
| 72 | unsafe { T::start(self_ptr, expires) };
|
| 73 |
|
| 74 | PinHrTimerHandle { inner: self }
|
| 75 | }
|
| 76 | }
|
| 77 |
|
| 78 | impl<'a, T> RawHrTimerCallback for Pin<&'a T>
|
| 79 | where
|
| 80 | T: HasHrTimer<T>,
|
| 81 | T: HrTimerCallback<Pointer<'a> = Self>,
|
| 82 | {
|
| 83 | type CallbackTarget<'b> = Self;
|
| 84 |
|
| 85 | unsafe extern "C" fn run(ptr: *mut bindings::hrtimer) -> bindings::hrtimer_restart {
|
| 86 | |
| 87 | let timer_ptr = ptr.cast::<HrTimer<T>>();
|
| 88 |
|
| 89 | |
| 90 | |
| 91 | let receiver_ptr = unsafe { T::timer_container_of(timer_ptr) };
|
| 92 |
|
| 93 | |
| 94 | |
| 95 | |
| 96 | |
| 97 | |
| 98 | |
| 99 | |
| 100 | |
| 101 | let receiver_ref = unsafe { &*receiver_ptr };
|
| 102 |
|
| 103 | |
| 104 | |
| 105 | let receiver_pin = unsafe { Pin::new_unchecked(receiver_ref) };
|
| 106 |
|
| 107 | |
| 108 | |
| 109 | |
| 110 | |
| 111 | let context = unsafe { HrTimerCallbackContext::from_raw(timer_ptr) };
|
| 112 |
|
| 113 | T::run(receiver_pin, context).into_c()
|
| 114 | }
|
| 115 | }
|