|
| 1 | +/* |
| 2 | + * Copyright (c) 2018 ARM Limited |
| 3 | + * |
| 4 | + * Licensed under the Apache License Version 2.0 (the "License"); |
| 5 | + * you may not use this file except in compliance with the License. |
| 6 | + * You may obtain a copy of the License at |
| 7 | + * |
| 8 | + * http://www.apache.org/licenses/LICENSE-2.0 |
| 9 | + * |
| 10 | + * Unless required by applicable law or agreed to in writing software |
| 11 | + * distributed under the License is distributed on an "AS IS" BASIS |
| 12 | + * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND either express or implied. |
| 13 | + * See the License for the specific language governing permissions and |
| 14 | + * limitations under the License. |
| 15 | + */ |
| 16 | + |
| 17 | +/** |
| 18 | + * \file cmsdk_ticker.c |
| 19 | + * Two abstracted functionalities for CMSDK APB Timers |
| 20 | + * 1. Measure elapsed time |
| 21 | + * 2. Timer interval interrupt |
| 22 | + * |
| 23 | + * Passed \ref tick_drv_data_t should be initialized by the caller |
| 24 | + * for using these services accordingly. |
| 25 | + * See details \ref tick_cfg_t and \ref tick_data_t. |
| 26 | + */ |
| 27 | + |
| 28 | +#include "cmsdk_ticker.h" |
| 29 | + |
| 30 | +void cmsdk_ticker_init(const struct tick_drv_data_t* timer_data) |
| 31 | +{ |
| 32 | + if (!timer_data->data->is_initialized) { |
| 33 | + timer_cmsdk_init(timer_data->cfg->timer_driver); |
| 34 | + timer_cmsdk_set_reload_value(timer_data->cfg->timer_driver, |
| 35 | + TIMER_CMSDK_MAX_RELOAD); |
| 36 | + timer_cmsdk_enable_interrupt(timer_data->cfg->timer_driver); |
| 37 | + NVIC_EnableIRQ(timer_data->cfg->irq_n); |
| 38 | + |
| 39 | + timer_data->data->max_interval_time = |
| 40 | + timer_data->cfg->convert_tick_to_time(TIMER_CMSDK_MAX_RELOAD); |
| 41 | + timer_data->data->reload_time = timer_data->data->max_interval_time; |
| 42 | + timer_data->data->is_initialized = true; |
| 43 | + timer_cmsdk_enable(timer_data->cfg->timer_driver); |
| 44 | + } |
| 45 | +} |
| 46 | + |
| 47 | +uint32_t cmsdk_ticker_read(const struct tick_drv_data_t* timer_data) |
| 48 | +{ |
| 49 | + uint32_t current_elapsed = 0; |
| 50 | + |
| 51 | + if (!timer_data->data->is_initialized) { |
| 52 | + cmsdk_ticker_init(timer_data); |
| 53 | + } |
| 54 | + current_elapsed = timer_cmsdk_get_elapsed_value(timer_data->cfg->timer_driver); |
| 55 | + /* |
| 56 | + * If for the same reload cycle (ie. cumulated_time is the same) the |
| 57 | + * current elapsed time is lower than the previous one, it means that the |
| 58 | + * timer has wrapped around without the system logging it. To ensure that |
| 59 | + * we are always returning an increasing time in those condition, we return |
| 60 | + * the time perviously read. |
| 61 | + */ |
| 62 | + if ((timer_data->data->previous_cumulated_time == |
| 63 | + timer_data->data->cumulated_time) && |
| 64 | + (current_elapsed < timer_data->data->previous_elapsed)) { |
| 65 | + current_elapsed = timer_data->data->previous_elapsed; |
| 66 | + } |
| 67 | + |
| 68 | + timer_data->data->previous_elapsed = current_elapsed; |
| 69 | + timer_data->data->previous_cumulated_time = |
| 70 | + timer_data->data->cumulated_time; |
| 71 | + |
| 72 | + return (timer_data->data->cumulated_time + |
| 73 | + timer_data->cfg->convert_tick_to_time(current_elapsed)); |
| 74 | +} |
| 75 | + |
| 76 | +void cmsdk_ticker_set_interrupt(const struct tick_drv_data_t* timer_data, |
| 77 | + uint32_t timestamp) |
| 78 | +{ |
| 79 | + uint32_t interval = 0; |
| 80 | + uint32_t interval_reload_tick = 0; |
| 81 | + |
| 82 | + /* Stop before read to avoid race condition with IRQ. */ |
| 83 | + timer_cmsdk_disable(timer_data->cfg->timer_driver); |
| 84 | + uint32_t current_time = cmsdk_ticker_read(timer_data); |
| 85 | + |
| 86 | + timer_data->data->interval_callback_enabled = true; |
| 87 | + |
| 88 | + /* |
| 89 | + * We always assume that the event is in the future, even if this |
| 90 | + * substraction underflows it is still corect. |
| 91 | + */ |
| 92 | + interval = (timestamp - current_time); |
| 93 | + |
| 94 | + if (interval >= timer_data->data->max_interval_time) { |
| 95 | + /* Event will be in the future but the time is too big: set max */ |
| 96 | + interval_reload_tick = TIMER_CMSDK_MAX_RELOAD; |
| 97 | + timer_data->data->reload_time = timer_data->data->max_interval_time; |
| 98 | + } else { |
| 99 | + /* Event will be in the future in a time that can be set */ |
| 100 | + interval_reload_tick = |
| 101 | + timer_data->cfg->convert_time_to_tick(interval); |
| 102 | + timer_data->data->reload_time = interval; |
| 103 | + } |
| 104 | + |
| 105 | + /* Store the current elapsed time, before reset the timer */ |
| 106 | + timer_data->data->cumulated_time = current_time; |
| 107 | + /* Reset the timer with new reload value */ |
| 108 | + timer_cmsdk_set_reload_value(timer_data->cfg->timer_driver, |
| 109 | + interval_reload_tick); |
| 110 | + timer_cmsdk_reset(timer_data->cfg->timer_driver); |
| 111 | + |
| 112 | + timer_cmsdk_enable(timer_data->cfg->timer_driver); |
| 113 | +} |
| 114 | + |
| 115 | +void cmsdk_ticker_disable_interrupt(const struct tick_drv_data_t* timer_data) |
| 116 | +{ |
| 117 | + if (!timer_data->data->is_initialized) { |
| 118 | + cmsdk_ticker_init(timer_data); |
| 119 | + } |
| 120 | + |
| 121 | + timer_data->data->interval_callback_enabled = false; |
| 122 | + |
| 123 | + /* Stop before read to avoid race condition with IRQ. */ |
| 124 | + timer_cmsdk_disable(timer_data->cfg->timer_driver); |
| 125 | + /* If interval interrupt is disabled, restore the default max interval, |
| 126 | + * but save the current elapsed time before changing the timer. */ |
| 127 | + timer_data->data->cumulated_time = cmsdk_ticker_read(timer_data); |
| 128 | + /* Reset the timer with default reload value */ |
| 129 | + timer_cmsdk_set_reload_value(timer_data->cfg->timer_driver, |
| 130 | + TIMER_CMSDK_MAX_RELOAD); |
| 131 | + timer_data->data->reload_time = timer_data->data->max_interval_time; |
| 132 | + |
| 133 | + timer_cmsdk_reset(timer_data->cfg->timer_driver); |
| 134 | + timer_cmsdk_enable(timer_data->cfg->timer_driver); |
| 135 | +} |
| 136 | + |
| 137 | +void cmsdk_ticker_clear_interrupt(const struct tick_drv_data_t* timer_data) |
| 138 | +{ |
| 139 | + timer_cmsdk_clear_interrupt(timer_data->cfg->timer_driver); |
| 140 | +} |
| 141 | + |
| 142 | +void cmsdk_ticker_fire_interrupt(const struct tick_drv_data_t* timer_data) |
| 143 | +{ |
| 144 | + NVIC_SetPendingIRQ(timer_data->cfg->irq_n); |
| 145 | +} |
| 146 | + |
| 147 | +void cmsdk_ticker_irq_handler(const struct tick_drv_data_t* timer_data) |
| 148 | +{ |
| 149 | + uint32_t reload_val = 0; |
| 150 | + /* If timer's internal interrupt status is not active, then not overflow, |
| 151 | + * but explicit interrupt request was fired by cmsdk_ticker_fire_interrupt. |
| 152 | + */ |
| 153 | + if (timer_cmsdk_is_interrupt_active(timer_data->cfg->timer_driver)) { |
| 154 | + /* 1. Calculate cumulated time by overflow */ |
| 155 | + timer_cmsdk_clear_interrupt(timer_data->cfg->timer_driver); |
| 156 | + reload_val = timer_cmsdk_get_reload_value(timer_data->cfg->timer_driver); |
| 157 | + timer_data->data->cumulated_time += |
| 158 | + timer_data->cfg->convert_tick_to_time(reload_val); |
| 159 | + } |
| 160 | + |
| 161 | + /* 2. Call mbed interval interrupt handler if it's required */ |
| 162 | + if (timer_data->data->interval_callback_enabled) { |
| 163 | + cmsdk_ticker_disable_interrupt(timer_data); |
| 164 | + timer_data->cfg->interval_callback(); |
| 165 | + } |
| 166 | +} |
0 commit comments