|
@@ -573,6 +573,7 @@ rt_err_t rt_thread_delay_until(rt_tick_t *tick, rt_tick_t inc_tick)
|
|
|
{
|
|
|
register rt_base_t level;
|
|
|
struct rt_thread *thread;
|
|
|
+ rt_tick_t cur_tick;
|
|
|
|
|
|
RT_ASSERT(tick != RT_NULL);
|
|
|
|
|
@@ -584,15 +585,19 @@ rt_err_t rt_thread_delay_until(rt_tick_t *tick, rt_tick_t inc_tick)
|
|
|
/* disable interrupt */
|
|
|
level = rt_hw_interrupt_disable();
|
|
|
|
|
|
- if (rt_tick_get() - *tick < inc_tick)
|
|
|
+ cur_tick = rt_tick_get();
|
|
|
+ if (cur_tick - *tick < inc_tick)
|
|
|
{
|
|
|
- *tick = *tick + inc_tick - rt_tick_get();
|
|
|
+ rt_tick_t left_tick;
|
|
|
+
|
|
|
+ *tick += inc_tick;
|
|
|
+ left_tick = *tick - cur_tick;
|
|
|
|
|
|
/* suspend thread */
|
|
|
rt_thread_suspend(thread);
|
|
|
|
|
|
/* reset the timeout of thread timer and start it */
|
|
|
- rt_timer_control(&(thread->thread_timer), RT_TIMER_CTRL_SET_TIME, tick);
|
|
|
+ rt_timer_control(&(thread->thread_timer), RT_TIMER_CTRL_SET_TIME, &left_tick);
|
|
|
rt_timer_start(&(thread->thread_timer));
|
|
|
|
|
|
/* enable interrupt */
|
|
@@ -608,12 +613,10 @@ rt_err_t rt_thread_delay_until(rt_tick_t *tick, rt_tick_t inc_tick)
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
+ *tick = cur_tick;
|
|
|
rt_hw_interrupt_enable(level);
|
|
|
}
|
|
|
|
|
|
- /* get the wakeup tick */
|
|
|
- *tick = rt_tick_get();
|
|
|
-
|
|
|
return RT_EOK;
|
|
|
}
|
|
|
RTM_EXPORT(rt_thread_delay_until);
|