1 // Copyright 2020 The Pigweed Authors 2 // 3 // Licensed under the Apache License, Version 2.0 (the "License"); you may not 4 // use this file except in compliance with the License. You may obtain a copy of 5 // the License at 6 // 7 // https://www.apache.org/licenses/LICENSE-2.0 8 // 9 // Unless required by applicable law or agreed to in writing, software 10 // distributed under the License is distributed on an "AS IS" BASIS, WITHOUT 11 // WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the 12 // License for the specific language governing permissions and limitations under 13 // the License. 14 15 #include "pw_thread/sleep.h" 16 17 #include <algorithm> 18 19 #include "pw_assert/assert.h" 20 #include "pw_chrono/system_clock.h" 21 #include "pw_chrono_threadx/system_clock_constants.h" 22 #include "pw_thread/id.h" 23 #include "tx_api.h" 24 25 using pw::chrono::SystemClock; 26 27 namespace pw::this_thread { 28 sleep_for(chrono::SystemClock::duration for_at_least)29void sleep_for(chrono::SystemClock::duration for_at_least) { 30 PW_DCHECK(get_id() != thread::Id()); 31 32 // Yield for negative and zero length durations. 33 if (for_at_least <= chrono::SystemClock::duration::zero()) { 34 tx_thread_relinquish(); 35 return; 36 } 37 38 // On a tick based kernel we cannot tell how far along we are on the current 39 // tick, ergo we add one whole tick to the final duration. 40 constexpr SystemClock::duration kMaxTimeoutMinusOne = 41 pw::chrono::threadx::kMaxTimeout - SystemClock::duration(1); 42 while (for_at_least > kMaxTimeoutMinusOne) { 43 const UINT result = 44 tx_thread_sleep(static_cast<ULONG>(kMaxTimeoutMinusOne.count())); 45 PW_CHECK_UINT_EQ(TX_SUCCESS, result); 46 for_at_least -= kMaxTimeoutMinusOne; 47 } 48 const UINT result = 49 tx_thread_sleep(static_cast<ULONG>(for_at_least.count() + 1)); 50 PW_CHECK_UINT_EQ(TX_SUCCESS, result); 51 } 52 53 } // namespace pw::this_thread 54