The prosthetic control(MIT)

Committer:
ganlikun
Date:
Thu Jun 23 05:23:34 2022 +0000
Revision:
0:20e0c61e0684
01

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ganlikun 0:20e0c61e0684 1 /* mbed Microcontroller Library
ganlikun 0:20e0c61e0684 2 * Copyright (c) 2017 ARM Limited
ganlikun 0:20e0c61e0684 3 *
ganlikun 0:20e0c61e0684 4 * Licensed under the Apache License, Version 2.0 (the "License");
ganlikun 0:20e0c61e0684 5 * you may not use this file except in compliance with the License.
ganlikun 0:20e0c61e0684 6 * You may obtain a copy of the License at
ganlikun 0:20e0c61e0684 7 *
ganlikun 0:20e0c61e0684 8 * http://www.apache.org/licenses/LICENSE-2.0
ganlikun 0:20e0c61e0684 9 *
ganlikun 0:20e0c61e0684 10 * Unless required by applicable law or agreed to in writing, software
ganlikun 0:20e0c61e0684 11 * distributed under the License is distributed on an "AS IS" BASIS,
ganlikun 0:20e0c61e0684 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
ganlikun 0:20e0c61e0684 13 * See the License for the specific language governing permissions and
ganlikun 0:20e0c61e0684 14 * limitations under the License.
ganlikun 0:20e0c61e0684 15 */
ganlikun 0:20e0c61e0684 16
ganlikun 0:20e0c61e0684 17 #include "mbed_sleep.h"
ganlikun 0:20e0c61e0684 18 #include "mbed_critical.h"
ganlikun 0:20e0c61e0684 19 #include "sleep_api.h"
ganlikun 0:20e0c61e0684 20 #include "mbed_error.h"
ganlikun 0:20e0c61e0684 21 #include <limits.h>
ganlikun 0:20e0c61e0684 22
ganlikun 0:20e0c61e0684 23 #if DEVICE_SLEEP
ganlikun 0:20e0c61e0684 24
ganlikun 0:20e0c61e0684 25 // deep sleep locking counter. A target is allowed to deep sleep if counter == 0
ganlikun 0:20e0c61e0684 26 static uint16_t deep_sleep_lock = 0U;
ganlikun 0:20e0c61e0684 27
ganlikun 0:20e0c61e0684 28 void sleep_manager_lock_deep_sleep(void)
ganlikun 0:20e0c61e0684 29 {
ganlikun 0:20e0c61e0684 30 core_util_critical_section_enter();
ganlikun 0:20e0c61e0684 31 if (deep_sleep_lock == USHRT_MAX) {
ganlikun 0:20e0c61e0684 32 core_util_critical_section_exit();
ganlikun 0:20e0c61e0684 33 error("Deep sleep lock would overflow (> USHRT_MAX)");
ganlikun 0:20e0c61e0684 34 }
ganlikun 0:20e0c61e0684 35 core_util_atomic_incr_u16(&deep_sleep_lock, 1);
ganlikun 0:20e0c61e0684 36 core_util_critical_section_exit();
ganlikun 0:20e0c61e0684 37 }
ganlikun 0:20e0c61e0684 38
ganlikun 0:20e0c61e0684 39 void sleep_manager_unlock_deep_sleep(void)
ganlikun 0:20e0c61e0684 40 {
ganlikun 0:20e0c61e0684 41 core_util_critical_section_enter();
ganlikun 0:20e0c61e0684 42 if (deep_sleep_lock == 0) {
ganlikun 0:20e0c61e0684 43 core_util_critical_section_exit();
ganlikun 0:20e0c61e0684 44 error("Deep sleep lock would underflow (< 0)");
ganlikun 0:20e0c61e0684 45 }
ganlikun 0:20e0c61e0684 46 core_util_atomic_decr_u16(&deep_sleep_lock, 1);
ganlikun 0:20e0c61e0684 47 core_util_critical_section_exit();
ganlikun 0:20e0c61e0684 48 }
ganlikun 0:20e0c61e0684 49
ganlikun 0:20e0c61e0684 50 bool sleep_manager_can_deep_sleep(void)
ganlikun 0:20e0c61e0684 51 {
ganlikun 0:20e0c61e0684 52 return deep_sleep_lock == 0 ? true : false;
ganlikun 0:20e0c61e0684 53 }
ganlikun 0:20e0c61e0684 54
ganlikun 0:20e0c61e0684 55 void sleep_manager_sleep_auto(void)
ganlikun 0:20e0c61e0684 56 {
ganlikun 0:20e0c61e0684 57 core_util_critical_section_enter();
ganlikun 0:20e0c61e0684 58 // debug profile should keep debuggers attached, no deep sleep allowed
ganlikun 0:20e0c61e0684 59 #ifdef MBED_DEBUG
ganlikun 0:20e0c61e0684 60 hal_sleep();
ganlikun 0:20e0c61e0684 61 #else
ganlikun 0:20e0c61e0684 62 if (sleep_manager_can_deep_sleep()) {
ganlikun 0:20e0c61e0684 63 hal_deepsleep();
ganlikun 0:20e0c61e0684 64 } else {
ganlikun 0:20e0c61e0684 65 hal_sleep();
ganlikun 0:20e0c61e0684 66 }
ganlikun 0:20e0c61e0684 67 #endif
ganlikun 0:20e0c61e0684 68 core_util_critical_section_exit();
ganlikun 0:20e0c61e0684 69 }
ganlikun 0:20e0c61e0684 70
ganlikun 0:20e0c61e0684 71 #else
ganlikun 0:20e0c61e0684 72
ganlikun 0:20e0c61e0684 73 // locking is valid only if DEVICE_SLEEP is defined
ganlikun 0:20e0c61e0684 74 // we provide empty implementation
ganlikun 0:20e0c61e0684 75
ganlikun 0:20e0c61e0684 76 void sleep_manager_lock_deep_sleep(void)
ganlikun 0:20e0c61e0684 77 {
ganlikun 0:20e0c61e0684 78
ganlikun 0:20e0c61e0684 79 }
ganlikun 0:20e0c61e0684 80
ganlikun 0:20e0c61e0684 81 void sleep_manager_unlock_deep_sleep(void)
ganlikun 0:20e0c61e0684 82 {
ganlikun 0:20e0c61e0684 83
ganlikun 0:20e0c61e0684 84 }
ganlikun 0:20e0c61e0684 85
ganlikun 0:20e0c61e0684 86 bool sleep_manager_can_deep_sleep(void)
ganlikun 0:20e0c61e0684 87 {
ganlikun 0:20e0c61e0684 88 // no sleep implemented
ganlikun 0:20e0c61e0684 89 return false;
ganlikun 0:20e0c61e0684 90 }
ganlikun 0:20e0c61e0684 91
ganlikun 0:20e0c61e0684 92 #endif
ganlikun 0:20e0c61e0684 93