| /* |
| * Copyright (c) 1997-2016 Wind River Systems, Inc. |
| * |
| * Licensed under the Apache License, Version 2.0 (the "License"); |
| * you may not use this file except in compliance with the License. |
| * You may obtain a copy of the License at |
| * |
| * http://www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, software |
| * distributed under the License is distributed on an "AS IS" BASIS, |
| * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| * See the License for the specific language governing permissions and |
| * limitations under the License. |
| */ |
| |
| #include <kernel.h> |
| #include <misc/debug/object_tracing_common.h> |
| #include <wait_q.h> |
| |
| /** |
| * @brief Handle expiration of a kernel timer object. |
| * |
| * @param t Timeout used by the timer. |
| * |
| * @return N/A |
| */ |
| static void timer_expiration_handler(struct _timeout *t) |
| { |
| int key = irq_lock(); |
| struct k_timer *timer = CONTAINER_OF(t, struct k_timer, timeout); |
| struct k_thread *pending_thread; |
| |
| /* |
| * if the timer is periodic, start it again; don't add _TICK_ALIGN |
| * since we're already aligned to a tick boundary |
| */ |
| if (timer->period > 0) { |
| _add_timeout(NULL, &timer->timeout, &timer->wait_q, |
| timer->period); |
| } |
| |
| /* update timer's status */ |
| timer->status += 1; |
| |
| /* invoke timer expiry function */ |
| if (timer->expiry_fn) { |
| timer->expiry_fn(timer); |
| } |
| /* |
| * wake up the (only) thread waiting on the timer, if there is one; |
| * don't invoke _Swap() since the timeout ISR called us, not a thread |
| */ |
| pending_thread = _unpend_first_thread(&timer->wait_q); |
| if (pending_thread) { |
| _ready_thread(pending_thread); |
| _set_thread_return_value(pending_thread, 0); |
| } |
| |
| irq_unlock(key); |
| } |
| |
| |
| void k_timer_init(struct k_timer *timer, |
| void (*expiry_fn)(struct k_timer *), |
| void (*stop_fn)(struct k_timer *)) |
| { |
| timer->expiry_fn = expiry_fn; |
| timer->stop_fn = stop_fn; |
| timer->status = 0; |
| |
| sys_dlist_init(&timer->wait_q); |
| _init_timeout(&timer->timeout, timer_expiration_handler); |
| SYS_TRACING_OBJ_INIT(micro_timer, timer); |
| |
| timer->_legacy_data = NULL; |
| } |
| |
| |
| void k_timer_start(struct k_timer *timer, int32_t duration, int32_t period) |
| { |
| __ASSERT(duration >= 0 && period >= 0 && |
| (duration != 0 || period != 0), "invalid parameters\n"); |
| |
| unsigned int key = irq_lock(); |
| |
| if (timer->timeout.delta_ticks_from_prev != -1) { |
| _abort_timeout(&timer->timeout); |
| } |
| |
| timer->period = _ms_to_ticks(period); |
| _add_timeout(NULL, &timer->timeout, &timer->wait_q, |
| _TICK_ALIGN + _ms_to_ticks(duration)); |
| timer->status = 0; |
| irq_unlock(key); |
| } |
| |
| |
| void k_timer_stop(struct k_timer *timer) |
| { |
| __ASSERT(!_is_in_isr(), ""); |
| |
| int key = irq_lock(); |
| int stopped = _abort_timeout(&timer->timeout); |
| |
| irq_unlock(key); |
| |
| if (stopped == -1) { |
| return; |
| } |
| |
| if (timer->stop_fn) { |
| timer->stop_fn(timer); |
| } |
| |
| key = irq_lock(); |
| struct k_thread *pending_thread = _unpend_first_thread(&timer->wait_q); |
| |
| if (pending_thread) { |
| _ready_thread(pending_thread); |
| } |
| |
| if (_is_in_isr()) { |
| irq_unlock(key); |
| } else { |
| _reschedule_threads(key); |
| } |
| } |
| |
| |
| uint32_t k_timer_status_get(struct k_timer *timer) |
| { |
| unsigned int key = irq_lock(); |
| uint32_t result = timer->status; |
| |
| timer->status = 0; |
| irq_unlock(key); |
| |
| return result; |
| } |
| |
| |
| uint32_t k_timer_status_sync(struct k_timer *timer) |
| { |
| __ASSERT(!_is_in_isr(), ""); |
| |
| unsigned int key = irq_lock(); |
| uint32_t result = timer->status; |
| |
| if (result == 0) { |
| if (timer->timeout.delta_ticks_from_prev != -1) { |
| /* wait for timer to expire or stop */ |
| _pend_current_thread(&timer->wait_q, K_FOREVER); |
| _Swap(key); |
| |
| /* get updated timer status */ |
| key = irq_lock(); |
| result = timer->status; |
| } else { |
| /* timer is already stopped */ |
| } |
| } else { |
| /* timer has already expired at least once */ |
| } |
| |
| timer->status = 0; |
| irq_unlock(key); |
| |
| return result; |
| } |
| |
| |
| int32_t k_timer_remaining_get(struct k_timer *timer) |
| { |
| unsigned int key = irq_lock(); |
| int32_t remaining_ticks; |
| sys_dlist_t *timeout_q = &_nanokernel.timeout_q; |
| |
| if (timer->timeout.delta_ticks_from_prev == -1) { |
| remaining_ticks = 0; |
| } else { |
| /* |
| * compute remaining ticks by walking the timeout list |
| * and summing up the various tick deltas involved |
| */ |
| struct _timeout *t = |
| (struct _timeout *)sys_dlist_peek_head(timeout_q); |
| |
| remaining_ticks = t->delta_ticks_from_prev; |
| while (t != &timer->timeout) { |
| t = (struct _timeout *)sys_dlist_peek_next(timeout_q, |
| &t->node); |
| remaining_ticks += t->delta_ticks_from_prev; |
| } |
| } |
| |
| irq_unlock(key); |
| return _ticks_to_ms(remaining_ticks); |
| } |