PES4 / Mbed OS Queue_02
Committer:
demayer
Date:
Sat Mar 28 15:28:19 2020 +0000
Revision:
0:6bf0743ece18
IMU Thread with an event-queue running parallel to handle tasks like a 5 times blinking LED. Button with interrupt detected.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
demayer 0:6bf0743ece18 1 /* mbed Microcontroller Library
demayer 0:6bf0743ece18 2 * Copyright (c) 2006-2013 ARM Limited
demayer 0:6bf0743ece18 3 *
demayer 0:6bf0743ece18 4 * Licensed under the Apache License, Version 2.0 (the "License");
demayer 0:6bf0743ece18 5 * you may not use this file except in compliance with the License.
demayer 0:6bf0743ece18 6 * You may obtain a copy of the License at
demayer 0:6bf0743ece18 7 *
demayer 0:6bf0743ece18 8 * http://www.apache.org/licenses/LICENSE-2.0
demayer 0:6bf0743ece18 9 *
demayer 0:6bf0743ece18 10 * Unless required by applicable law or agreed to in writing, software
demayer 0:6bf0743ece18 11 * distributed under the License is distributed on an "AS IS" BASIS,
demayer 0:6bf0743ece18 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
demayer 0:6bf0743ece18 13 * See the License for the specific language governing permissions and
demayer 0:6bf0743ece18 14 * limitations under the License.
demayer 0:6bf0743ece18 15 */
demayer 0:6bf0743ece18 16 #include "drivers/Timer.h"
demayer 0:6bf0743ece18 17 #include "hal/ticker_api.h"
demayer 0:6bf0743ece18 18 #include "hal/us_ticker_api.h"
demayer 0:6bf0743ece18 19 #include "platform/mbed_critical.h"
demayer 0:6bf0743ece18 20 #include "hal/lp_ticker_api.h"
demayer 0:6bf0743ece18 21
demayer 0:6bf0743ece18 22 namespace mbed {
demayer 0:6bf0743ece18 23
demayer 0:6bf0743ece18 24 Timer::Timer() : _running(), _start(), _time(), _ticker_data(get_us_ticker_data()), _lock_deepsleep(true) {
demayer 0:6bf0743ece18 25 reset();
demayer 0:6bf0743ece18 26 }
demayer 0:6bf0743ece18 27
demayer 0:6bf0743ece18 28 Timer::Timer(const ticker_data_t *data) : _running(), _start(), _time(), _ticker_data(data), _lock_deepsleep(true) {
demayer 0:6bf0743ece18 29 reset();
demayer 0:6bf0743ece18 30 #if DEVICE_LOWPOWERTIMER
demayer 0:6bf0743ece18 31 _lock_deepsleep = (data != get_lp_ticker_data());
demayer 0:6bf0743ece18 32 #endif
demayer 0:6bf0743ece18 33 }
demayer 0:6bf0743ece18 34
demayer 0:6bf0743ece18 35 Timer::~Timer() {
demayer 0:6bf0743ece18 36 core_util_critical_section_enter();
demayer 0:6bf0743ece18 37 if (_running) {
demayer 0:6bf0743ece18 38 if(_lock_deepsleep) {
demayer 0:6bf0743ece18 39 sleep_manager_unlock_deep_sleep();
demayer 0:6bf0743ece18 40 }
demayer 0:6bf0743ece18 41 }
demayer 0:6bf0743ece18 42 _running = 0;
demayer 0:6bf0743ece18 43 core_util_critical_section_exit();
demayer 0:6bf0743ece18 44 }
demayer 0:6bf0743ece18 45
demayer 0:6bf0743ece18 46 void Timer::start() {
demayer 0:6bf0743ece18 47 core_util_critical_section_enter();
demayer 0:6bf0743ece18 48 if (!_running) {
demayer 0:6bf0743ece18 49 if(_lock_deepsleep) {
demayer 0:6bf0743ece18 50 sleep_manager_lock_deep_sleep();
demayer 0:6bf0743ece18 51 }
demayer 0:6bf0743ece18 52 _start = ticker_read_us(_ticker_data);
demayer 0:6bf0743ece18 53 _running = 1;
demayer 0:6bf0743ece18 54 }
demayer 0:6bf0743ece18 55 core_util_critical_section_exit();
demayer 0:6bf0743ece18 56 }
demayer 0:6bf0743ece18 57
demayer 0:6bf0743ece18 58 void Timer::stop() {
demayer 0:6bf0743ece18 59 core_util_critical_section_enter();
demayer 0:6bf0743ece18 60 _time += slicetime();
demayer 0:6bf0743ece18 61 if (_running) {
demayer 0:6bf0743ece18 62 if(_lock_deepsleep) {
demayer 0:6bf0743ece18 63 sleep_manager_unlock_deep_sleep();
demayer 0:6bf0743ece18 64 }
demayer 0:6bf0743ece18 65 }
demayer 0:6bf0743ece18 66 _running = 0;
demayer 0:6bf0743ece18 67 core_util_critical_section_exit();
demayer 0:6bf0743ece18 68 }
demayer 0:6bf0743ece18 69
demayer 0:6bf0743ece18 70 int Timer::read_us() {
demayer 0:6bf0743ece18 71 return read_high_resolution_us();
demayer 0:6bf0743ece18 72 }
demayer 0:6bf0743ece18 73
demayer 0:6bf0743ece18 74 float Timer::read() {
demayer 0:6bf0743ece18 75 return (float)read_us() / 1000000.0f;
demayer 0:6bf0743ece18 76 }
demayer 0:6bf0743ece18 77
demayer 0:6bf0743ece18 78 int Timer::read_ms() {
demayer 0:6bf0743ece18 79 return read_high_resolution_us() / 1000;
demayer 0:6bf0743ece18 80 }
demayer 0:6bf0743ece18 81
demayer 0:6bf0743ece18 82 us_timestamp_t Timer::read_high_resolution_us() {
demayer 0:6bf0743ece18 83 core_util_critical_section_enter();
demayer 0:6bf0743ece18 84 us_timestamp_t time = _time + slicetime();
demayer 0:6bf0743ece18 85 core_util_critical_section_exit();
demayer 0:6bf0743ece18 86 return time;
demayer 0:6bf0743ece18 87 }
demayer 0:6bf0743ece18 88
demayer 0:6bf0743ece18 89 us_timestamp_t Timer::slicetime() {
demayer 0:6bf0743ece18 90 us_timestamp_t ret = 0;
demayer 0:6bf0743ece18 91 core_util_critical_section_enter();
demayer 0:6bf0743ece18 92 if (_running) {
demayer 0:6bf0743ece18 93 ret = ticker_read_us(_ticker_data) - _start;
demayer 0:6bf0743ece18 94 }
demayer 0:6bf0743ece18 95 core_util_critical_section_exit();
demayer 0:6bf0743ece18 96 return ret;
demayer 0:6bf0743ece18 97 }
demayer 0:6bf0743ece18 98
demayer 0:6bf0743ece18 99 void Timer::reset() {
demayer 0:6bf0743ece18 100 core_util_critical_section_enter();
demayer 0:6bf0743ece18 101 _start = ticker_read_us(_ticker_data);
demayer 0:6bf0743ece18 102 _time = 0;
demayer 0:6bf0743ece18 103 core_util_critical_section_exit();
demayer 0:6bf0743ece18 104 }
demayer 0:6bf0743ece18 105
demayer 0:6bf0743ece18 106 Timer::operator float() {
demayer 0:6bf0743ece18 107 return read();
demayer 0:6bf0743ece18 108 }
demayer 0:6bf0743ece18 109
demayer 0:6bf0743ece18 110 } // namespace mbed