inport from local
Dependents: Hobbyking_Cheetah_0511
platform/mbed_wait_api_rtos.cpp@0:85b3fd62ea1a, 2020-03-16 (annotated)
- Committer:
- NYX
- Date:
- Mon Mar 16 06:35:48 2020 +0000
- Revision:
- 0:85b3fd62ea1a
reinport to mbed;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
NYX | 0:85b3fd62ea1a | 1 | /* mbed Microcontroller Library |
NYX | 0:85b3fd62ea1a | 2 | * Copyright (c) 2006-2013 ARM Limited |
NYX | 0:85b3fd62ea1a | 3 | * |
NYX | 0:85b3fd62ea1a | 4 | * Licensed under the Apache License, Version 2.0 (the "License"); |
NYX | 0:85b3fd62ea1a | 5 | * you may not use this file except in compliance with the License. |
NYX | 0:85b3fd62ea1a | 6 | * You may obtain a copy of the License at |
NYX | 0:85b3fd62ea1a | 7 | * |
NYX | 0:85b3fd62ea1a | 8 | * http://www.apache.org/licenses/LICENSE-2.0 |
NYX | 0:85b3fd62ea1a | 9 | * |
NYX | 0:85b3fd62ea1a | 10 | * Unless required by applicable law or agreed to in writing, software |
NYX | 0:85b3fd62ea1a | 11 | * distributed under the License is distributed on an "AS IS" BASIS, |
NYX | 0:85b3fd62ea1a | 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
NYX | 0:85b3fd62ea1a | 13 | * See the License for the specific language governing permissions and |
NYX | 0:85b3fd62ea1a | 14 | * limitations under the License. |
NYX | 0:85b3fd62ea1a | 15 | */ |
NYX | 0:85b3fd62ea1a | 16 | |
NYX | 0:85b3fd62ea1a | 17 | // This implementation of the wait functions will be compiled only |
NYX | 0:85b3fd62ea1a | 18 | // if the RTOS is present. |
NYX | 0:85b3fd62ea1a | 19 | #ifdef MBED_CONF_RTOS_PRESENT |
NYX | 0:85b3fd62ea1a | 20 | |
NYX | 0:85b3fd62ea1a | 21 | #include "platform/mbed_wait_api.h" |
NYX | 0:85b3fd62ea1a | 22 | #include "hal/us_ticker_api.h" |
NYX | 0:85b3fd62ea1a | 23 | #include "rtos/rtos.h" |
NYX | 0:85b3fd62ea1a | 24 | #include "platform/mbed_critical.h" |
NYX | 0:85b3fd62ea1a | 25 | #include "platform/mbed_sleep.h" |
NYX | 0:85b3fd62ea1a | 26 | |
NYX | 0:85b3fd62ea1a | 27 | void wait(float s) { |
NYX | 0:85b3fd62ea1a | 28 | wait_us(s * 1000000.0f); |
NYX | 0:85b3fd62ea1a | 29 | } |
NYX | 0:85b3fd62ea1a | 30 | |
NYX | 0:85b3fd62ea1a | 31 | void wait_ms(int ms) { |
NYX | 0:85b3fd62ea1a | 32 | wait_us(ms * 1000); |
NYX | 0:85b3fd62ea1a | 33 | } |
NYX | 0:85b3fd62ea1a | 34 | |
NYX | 0:85b3fd62ea1a | 35 | void wait_us(int us) { |
NYX | 0:85b3fd62ea1a | 36 | const ticker_data_t *const ticker = get_us_ticker_data(); |
NYX | 0:85b3fd62ea1a | 37 | |
NYX | 0:85b3fd62ea1a | 38 | uint32_t start = ticker_read(ticker); |
NYX | 0:85b3fd62ea1a | 39 | // Use the RTOS to wait for millisecond delays if possible |
NYX | 0:85b3fd62ea1a | 40 | int ms = us / 1000; |
NYX | 0:85b3fd62ea1a | 41 | if ((ms > 0) && core_util_are_interrupts_enabled()) { |
NYX | 0:85b3fd62ea1a | 42 | sleep_manager_lock_deep_sleep(); |
NYX | 0:85b3fd62ea1a | 43 | Thread::wait((uint32_t)ms); |
NYX | 0:85b3fd62ea1a | 44 | sleep_manager_unlock_deep_sleep(); |
NYX | 0:85b3fd62ea1a | 45 | } |
NYX | 0:85b3fd62ea1a | 46 | // Use busy waiting for sub-millisecond delays, or for the whole |
NYX | 0:85b3fd62ea1a | 47 | // interval if interrupts are not enabled |
NYX | 0:85b3fd62ea1a | 48 | while ((ticker_read(ticker) - start) < (uint32_t)us); |
NYX | 0:85b3fd62ea1a | 49 | } |
NYX | 0:85b3fd62ea1a | 50 | |
NYX | 0:85b3fd62ea1a | 51 | #endif // #if MBED_CONF_RTOS_PRESENT |
NYX | 0:85b3fd62ea1a | 52 |