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