123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237 |
- /* mbed Microcontroller Library
- * Copyright (c) 2017 ARM Limited
- *
- * 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 "mbed_assert.h"
- #include "mbed_power_mgmt.h"
- #include "mbed_critical.h"
- #include "sleep_api.h"
- #include "mbed_error.h"
- #include "mbed_debug.h"
- #include "mbed_stats.h"
- #include "lp_ticker_api.h"
- #include <limits.h>
- #include <stdio.h>
- #include "mbed_stats.h"
- #if DEVICE_SLEEP
- // deep sleep locking counter. A target is allowed to deep sleep if counter == 0
- static uint16_t deep_sleep_lock = 0U;
- static us_timestamp_t sleep_time = 0;
- static us_timestamp_t deep_sleep_time = 0;
- #if defined(MBED_CPU_STATS_ENABLED) && defined(DEVICE_LPTICKER)
- static ticker_data_t *sleep_ticker = NULL;
- #endif
- static inline us_timestamp_t read_us(void)
- {
- #if defined(MBED_CPU_STATS_ENABLED) && defined(DEVICE_LPTICKER)
- if (NULL == sleep_ticker) {
- sleep_ticker = (ticker_data_t *)get_lp_ticker_data();
- }
- return ticker_read_us(sleep_ticker);
- #else
- return 0;
- #endif
- }
- us_timestamp_t mbed_time_idle(void)
- {
- return (sleep_time + deep_sleep_time);
- }
- us_timestamp_t mbed_uptime(void)
- {
- return read_us();
- }
- us_timestamp_t mbed_time_sleep(void)
- {
- return sleep_time;
- }
- us_timestamp_t mbed_time_deepsleep(void)
- {
- return deep_sleep_time;
- }
- #ifdef MBED_SLEEP_TRACING_ENABLED
- // Number of drivers that can be stored in the structure
- #define STATISTIC_COUNT 10
- typedef struct sleep_statistic {
- const char *identifier;
- uint8_t count;
- } sleep_statistic_t;
- static sleep_statistic_t sleep_stats[STATISTIC_COUNT];
- static sleep_statistic_t *sleep_tracker_find(const char *const filename)
- {
- for (int i = 0; i < STATISTIC_COUNT; ++i) {
- if (sleep_stats[i].identifier == filename) {
- return &sleep_stats[i];
- }
- }
- return NULL;
- }
- static sleep_statistic_t *sleep_tracker_add(const char *const filename)
- {
- for (int i = 0; i < STATISTIC_COUNT; ++i) {
- if (sleep_stats[i].identifier == NULL) {
- sleep_stats[i].identifier = filename;
- return &sleep_stats[i];
- }
- }
- debug("No free indexes left to use in mbed sleep tracker.\r\n");
- return NULL;
- }
- static void sleep_tracker_print_stats(void)
- {
- debug("Sleep locks held:\r\n");
- for (int i = 0; i < STATISTIC_COUNT; ++i) {
- if (sleep_stats[i].count == 0) {
- continue;
- }
- if (sleep_stats[i].identifier == NULL) {
- return;
- }
- debug("[id: %s, count: %u]\r\n", sleep_stats[i].identifier,
- sleep_stats[i].count);
- }
- }
- void sleep_tracker_lock(const char *const filename, int line)
- {
- sleep_statistic_t *stat = sleep_tracker_find(filename);
- // Entry for this driver does not exist, create one.
- if (stat == NULL) {
- stat = sleep_tracker_add(filename);
- }
- core_util_atomic_incr_u8(&stat->count, 1);
- debug("LOCK: %s, ln: %i, lock count: %u\r\n", filename, line, deep_sleep_lock);
- }
- void sleep_tracker_unlock(const char *const filename, int line)
- {
- sleep_statistic_t *stat = sleep_tracker_find(filename);
- // Entry for this driver does not exist, something went wrong.
- if (stat == NULL) {
- debug("Unlocking sleep for driver that was not previously locked: %s, ln: %i\r\n", filename, line);
- return;
- }
- core_util_atomic_decr_u8(&stat->count, 1);
- debug("UNLOCK: %s, ln: %i, lock count: %u\r\n", filename, line, deep_sleep_lock);
- }
- #endif // MBED_SLEEP_TRACING_ENABLED
- void sleep_manager_lock_deep_sleep_internal(void)
- {
- core_util_critical_section_enter();
- if (deep_sleep_lock == USHRT_MAX) {
- core_util_critical_section_exit();
- MBED_ERROR1(MBED_MAKE_ERROR(MBED_MODULE_HAL, MBED_ERROR_CODE_OVERFLOW), "DeepSleepLock overflow (> USHRT_MAX)", deep_sleep_lock);
- }
- core_util_atomic_incr_u16(&deep_sleep_lock, 1);
- core_util_critical_section_exit();
- }
- void sleep_manager_unlock_deep_sleep_internal(void)
- {
- core_util_critical_section_enter();
- if (deep_sleep_lock == 0) {
- core_util_critical_section_exit();
- MBED_ERROR1(MBED_MAKE_ERROR(MBED_MODULE_HAL, MBED_ERROR_CODE_UNDERFLOW), "DeepSleepLock underflow (< 0)", deep_sleep_lock);
- }
- core_util_atomic_decr_u16(&deep_sleep_lock, 1);
- core_util_critical_section_exit();
- }
- bool sleep_manager_can_deep_sleep(void)
- {
- return deep_sleep_lock == 0 ? true : false;
- }
- void sleep_manager_sleep_auto(void)
- {
- #ifdef MBED_SLEEP_TRACING_ENABLED
- sleep_tracker_print_stats();
- #endif
- core_util_critical_section_enter();
- us_timestamp_t start = read_us();
- bool deep = false;
- // debug profile should keep debuggers attached, no deep sleep allowed
- #ifdef MBED_DEBUG
- hal_sleep();
- #else
- if (sleep_manager_can_deep_sleep()) {
- deep = true;
- hal_deepsleep();
- } else {
- hal_sleep();
- }
- #endif
- us_timestamp_t end = read_us();
- if (true == deep) {
- deep_sleep_time += end - start;
- } else {
- sleep_time += end - start;
- }
- core_util_critical_section_exit();
- }
- #else
- // locking is valid only if DEVICE_SLEEP is defined
- // we provide empty implementation
- void sleep_manager_lock_deep_sleep_internal(void)
- {
- }
- void sleep_manager_unlock_deep_sleep_internal(void)
- {
- }
- bool sleep_manager_can_deep_sleep(void)
- {
- // no sleep implemented
- return false;
- }
- #endif
|