123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122 |
- #include "drivers/Timer.h"
- #include "hal/ticker_api.h"
- #include "hal/us_ticker_api.h"
- #include "platform/mbed_critical.h"
- #include "hal/lp_ticker_api.h"
- namespace mbed {
- Timer::Timer() : _running(), _start(), _time(), _ticker_data(get_us_ticker_data()), _lock_deepsleep(true)
- {
- reset();
- }
- Timer::Timer(const ticker_data_t *data) : _running(), _start(), _time(), _ticker_data(data), _lock_deepsleep(true)
- {
- reset();
- #if DEVICE_LPTICKER
- _lock_deepsleep = (data != get_lp_ticker_data());
- #endif
- }
- Timer::~Timer()
- {
- core_util_critical_section_enter();
- if (_running) {
- if (_lock_deepsleep) {
- sleep_manager_unlock_deep_sleep();
- }
- }
- _running = 0;
- core_util_critical_section_exit();
- }
- void Timer::start()
- {
- core_util_critical_section_enter();
- if (!_running) {
- if (_lock_deepsleep) {
- sleep_manager_lock_deep_sleep();
- }
- _start = ticker_read_us(_ticker_data);
- _running = 1;
- }
- core_util_critical_section_exit();
- }
- void Timer::stop()
- {
- core_util_critical_section_enter();
- _time += slicetime();
- if (_running) {
- if (_lock_deepsleep) {
- sleep_manager_unlock_deep_sleep();
- }
- }
- _running = 0;
- core_util_critical_section_exit();
- }
- int Timer::read_us()
- {
- return read_high_resolution_us();
- }
- float Timer::read()
- {
- return (float)read_us() / 1000000.0f;
- }
- int Timer::read_ms()
- {
- return read_high_resolution_us() / 1000;
- }
- us_timestamp_t Timer::read_high_resolution_us()
- {
- core_util_critical_section_enter();
- us_timestamp_t time = _time + slicetime();
- core_util_critical_section_exit();
- return time;
- }
- us_timestamp_t Timer::slicetime()
- {
- us_timestamp_t ret = 0;
- core_util_critical_section_enter();
- if (_running) {
- ret = ticker_read_us(_ticker_data) - _start;
- }
- core_util_critical_section_exit();
- return ret;
- }
- void Timer::reset()
- {
- core_util_critical_section_enter();
- _start = ticker_read_us(_ticker_data);
- _time = 0;
- core_util_critical_section_exit();
- }
- Timer::operator float()
- {
- return read();
- }
- }
|