inport from local
Dependents: Hobbyking_Cheetah_0511
targets/TARGET_STM/lp_ticker.c@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 | ******************************************************************************* |
NYX | 0:85b3fd62ea1a | 3 | * Copyright (c) 2016, STMicroelectronics |
NYX | 0:85b3fd62ea1a | 4 | * All rights reserved. |
NYX | 0:85b3fd62ea1a | 5 | * |
NYX | 0:85b3fd62ea1a | 6 | * Redistribution and use in source and binary forms, with or without |
NYX | 0:85b3fd62ea1a | 7 | * modification, are permitted provided that the following conditions are met: |
NYX | 0:85b3fd62ea1a | 8 | * |
NYX | 0:85b3fd62ea1a | 9 | * 1. Redistributions of source code must retain the above copyright notice, |
NYX | 0:85b3fd62ea1a | 10 | * this list of conditions and the following disclaimer. |
NYX | 0:85b3fd62ea1a | 11 | * 2. Redistributions in binary form must reproduce the above copyright notice, |
NYX | 0:85b3fd62ea1a | 12 | * this list of conditions and the following disclaimer in the documentation |
NYX | 0:85b3fd62ea1a | 13 | * and/or other materials provided with the distribution. |
NYX | 0:85b3fd62ea1a | 14 | * 3. Neither the name of STMicroelectronics nor the names of its contributors |
NYX | 0:85b3fd62ea1a | 15 | * may be used to endorse or promote products derived from this software |
NYX | 0:85b3fd62ea1a | 16 | * without specific prior written permission. |
NYX | 0:85b3fd62ea1a | 17 | * |
NYX | 0:85b3fd62ea1a | 18 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
NYX | 0:85b3fd62ea1a | 19 | * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
NYX | 0:85b3fd62ea1a | 20 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
NYX | 0:85b3fd62ea1a | 21 | * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE |
NYX | 0:85b3fd62ea1a | 22 | * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
NYX | 0:85b3fd62ea1a | 23 | * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR |
NYX | 0:85b3fd62ea1a | 24 | * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER |
NYX | 0:85b3fd62ea1a | 25 | * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, |
NYX | 0:85b3fd62ea1a | 26 | * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
NYX | 0:85b3fd62ea1a | 27 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
NYX | 0:85b3fd62ea1a | 28 | ******************************************************************************* |
NYX | 0:85b3fd62ea1a | 29 | */ |
NYX | 0:85b3fd62ea1a | 30 | #include "device.h" |
NYX | 0:85b3fd62ea1a | 31 | |
NYX | 0:85b3fd62ea1a | 32 | #if DEVICE_LOWPOWERTIMER |
NYX | 0:85b3fd62ea1a | 33 | |
NYX | 0:85b3fd62ea1a | 34 | #include "ticker_api.h" |
NYX | 0:85b3fd62ea1a | 35 | #include "lp_ticker_api.h" |
NYX | 0:85b3fd62ea1a | 36 | #include "rtc_api.h" |
NYX | 0:85b3fd62ea1a | 37 | #include "rtc_api_hal.h" |
NYX | 0:85b3fd62ea1a | 38 | |
NYX | 0:85b3fd62ea1a | 39 | static uint8_t lp_ticker_inited = 0; |
NYX | 0:85b3fd62ea1a | 40 | |
NYX | 0:85b3fd62ea1a | 41 | void lp_ticker_init(void) |
NYX | 0:85b3fd62ea1a | 42 | { |
NYX | 0:85b3fd62ea1a | 43 | if (lp_ticker_inited) return; |
NYX | 0:85b3fd62ea1a | 44 | lp_ticker_inited = 1; |
NYX | 0:85b3fd62ea1a | 45 | |
NYX | 0:85b3fd62ea1a | 46 | rtc_init(); |
NYX | 0:85b3fd62ea1a | 47 | rtc_set_irq_handler((uint32_t) lp_ticker_irq_handler); |
NYX | 0:85b3fd62ea1a | 48 | } |
NYX | 0:85b3fd62ea1a | 49 | |
NYX | 0:85b3fd62ea1a | 50 | uint32_t lp_ticker_read(void) |
NYX | 0:85b3fd62ea1a | 51 | { |
NYX | 0:85b3fd62ea1a | 52 | uint32_t usecs = 0; |
NYX | 0:85b3fd62ea1a | 53 | time_t time = 0; |
NYX | 0:85b3fd62ea1a | 54 | |
NYX | 0:85b3fd62ea1a | 55 | lp_ticker_init(); |
NYX | 0:85b3fd62ea1a | 56 | |
NYX | 0:85b3fd62ea1a | 57 | do { |
NYX | 0:85b3fd62ea1a | 58 | time = rtc_read(); |
NYX | 0:85b3fd62ea1a | 59 | usecs = rtc_read_subseconds(); |
NYX | 0:85b3fd62ea1a | 60 | } while (time != rtc_read()); |
NYX | 0:85b3fd62ea1a | 61 | |
NYX | 0:85b3fd62ea1a | 62 | return (time * 1000000) + usecs; |
NYX | 0:85b3fd62ea1a | 63 | } |
NYX | 0:85b3fd62ea1a | 64 | |
NYX | 0:85b3fd62ea1a | 65 | void lp_ticker_set_interrupt(timestamp_t timestamp) |
NYX | 0:85b3fd62ea1a | 66 | { |
NYX | 0:85b3fd62ea1a | 67 | uint32_t delta; |
NYX | 0:85b3fd62ea1a | 68 | |
NYX | 0:85b3fd62ea1a | 69 | delta = timestamp - lp_ticker_read(); |
NYX | 0:85b3fd62ea1a | 70 | rtc_set_wake_up_timer(delta); |
NYX | 0:85b3fd62ea1a | 71 | } |
NYX | 0:85b3fd62ea1a | 72 | |
NYX | 0:85b3fd62ea1a | 73 | void lp_ticker_fire_interrupt(void) |
NYX | 0:85b3fd62ea1a | 74 | { |
NYX | 0:85b3fd62ea1a | 75 | NVIC_SetPendingIRQ(RTC_WKUP_IRQn); |
NYX | 0:85b3fd62ea1a | 76 | } |
NYX | 0:85b3fd62ea1a | 77 | |
NYX | 0:85b3fd62ea1a | 78 | void lp_ticker_disable_interrupt(void) |
NYX | 0:85b3fd62ea1a | 79 | { |
NYX | 0:85b3fd62ea1a | 80 | rtc_deactivate_wake_up_timer(); |
NYX | 0:85b3fd62ea1a | 81 | } |
NYX | 0:85b3fd62ea1a | 82 | |
NYX | 0:85b3fd62ea1a | 83 | void lp_ticker_clear_interrupt(void) |
NYX | 0:85b3fd62ea1a | 84 | { |
NYX | 0:85b3fd62ea1a | 85 | |
NYX | 0:85b3fd62ea1a | 86 | } |
NYX | 0:85b3fd62ea1a | 87 | |
NYX | 0:85b3fd62ea1a | 88 | #endif |