Daiki Kato / mbed-os-lychee

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependents:   mbed-os-example-blinky-gr-lychee GR-Boads_Camera_sample GR-Boards_Audio_Recoder GR-Boads_Camera_DisplayApp ... more

targets/TARGET_RENESAS/TARGET_RZA1XX/us_ticker.c@0:f782d9c66c49, 2018-02-02 (annotated)

Committer:
dkato
Date:
Fri Feb 02 05:42:23 2018 +0000
Revision:
0:f782d9c66c49
mbed-os for GR-LYCHEE

Who changed what in which revision?

UserRevisionLine numberNew contents of line
dkato 0:f782d9c66c49 1 /* mbed Microcontroller Library
dkato 0:f782d9c66c49 2 * Copyright (c) 2006-2013 ARM Limited
dkato 0:f782d9c66c49 3 *
dkato 0:f782d9c66c49 4 * Licensed under the Apache License, Version 2.0 (the "License");
dkato 0:f782d9c66c49 5 * you may not use this file except in compliance with the License.
dkato 0:f782d9c66c49 6 * You may obtain a copy of the License at
dkato 0:f782d9c66c49 7 *
dkato 0:f782d9c66c49 8 * http://www.apache.org/licenses/LICENSE-2.0
dkato 0:f782d9c66c49 9 *
dkato 0:f782d9c66c49 10 * Unless required by applicable law or agreed to in writing, software
dkato 0:f782d9c66c49 11 * distributed under the License is distributed on an "AS IS" BASIS,
dkato 0:f782d9c66c49 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
dkato 0:f782d9c66c49 13 * See the License for the specific language governing permissions and
dkato 0:f782d9c66c49 14 * limitations under the License.
dkato 0:f782d9c66c49 15 */
dkato 0:f782d9c66c49 16 #include <stddef.h>
dkato 0:f782d9c66c49 17 #include "us_ticker_api.h"
dkato 0:f782d9c66c49 18 #include "PeripheralNames.h"
dkato 0:f782d9c66c49 19 #include "iodefine.h"
dkato 0:f782d9c66c49 20 #include "cmsis.h"
dkato 0:f782d9c66c49 21
dkato 0:f782d9c66c49 22 #include "RZ_A1_Init.h"
dkato 0:f782d9c66c49 23 #include "vfp_neon_push_pop.h"
dkato 0:f782d9c66c49 24
dkato 0:f782d9c66c49 25 #define US_TICKER_TIMER_IRQn (OSTMI1TINT_IRQn)
dkato 0:f782d9c66c49 26 #define CPG_STBCR5_BIT_MSTP50 (0x01u) /* OSTM1 */
dkato 0:f782d9c66c49 27
dkato 0:f782d9c66c49 28 #define US_TICKER_CLOCK_US_DEV (1000000)
dkato 0:f782d9c66c49 29
dkato 0:f782d9c66c49 30 int us_ticker_inited = 0;
dkato 0:f782d9c66c49 31 static double count_clock = 0;
dkato 0:f782d9c66c49 32 static uint32_t last_read = 0;
dkato 0:f782d9c66c49 33 static uint32_t wrap_arround = 0;
dkato 0:f782d9c66c49 34 static uint64_t ticker_us_last64 = 0;
dkato 0:f782d9c66c49 35 static uint64_t set_cmp_val64 = 0;
dkato 0:f782d9c66c49 36 static uint64_t timestamp64 = 0;
dkato 0:f782d9c66c49 37
dkato 0:f782d9c66c49 38 void us_ticker_interrupt(void) {
dkato 0:f782d9c66c49 39 us_ticker_irq_handler();
dkato 0:f782d9c66c49 40 }
dkato 0:f782d9c66c49 41
dkato 0:f782d9c66c49 42 void us_ticker_init(void) {
dkato 0:f782d9c66c49 43 if (us_ticker_inited) return;
dkato 0:f782d9c66c49 44 us_ticker_inited = 1;
dkato 0:f782d9c66c49 45
dkato 0:f782d9c66c49 46 /* set Counter Clock(us) */
dkato 0:f782d9c66c49 47 if (false == RZ_A1_IsClockMode0()) {
dkato 0:f782d9c66c49 48 count_clock = ((double)CM1_RENESAS_RZ_A1_P0_CLK / (double)US_TICKER_CLOCK_US_DEV);
dkato 0:f782d9c66c49 49 } else {
dkato 0:f782d9c66c49 50 count_clock = ((double)CM0_RENESAS_RZ_A1_P0_CLK / (double)US_TICKER_CLOCK_US_DEV);
dkato 0:f782d9c66c49 51 }
dkato 0:f782d9c66c49 52
dkato 0:f782d9c66c49 53 /* Power Control for Peripherals */
dkato 0:f782d9c66c49 54 CPGSTBCR5 &= ~(CPG_STBCR5_BIT_MSTP50); /* enable OSTM1 clock */
dkato 0:f782d9c66c49 55
dkato 0:f782d9c66c49 56 // timer settings
dkato 0:f782d9c66c49 57 OSTM1TT = 0x01; /* Stop the counter and clears the OSTM1TE bit. */
dkato 0:f782d9c66c49 58 OSTM1CTL = 0x02; /* Free running timer mode. Interrupt disabled when star counter */
dkato 0:f782d9c66c49 59
dkato 0:f782d9c66c49 60 OSTM1TS = 0x1; /* Start the counter and sets the OSTM0TE bit. */
dkato 0:f782d9c66c49 61
dkato 0:f782d9c66c49 62 // INTC settings
dkato 0:f782d9c66c49 63 InterruptHandlerRegister(US_TICKER_TIMER_IRQn, (void (*)(uint32_t))us_ticker_interrupt);
dkato 0:f782d9c66c49 64 GIC_SetPriority(US_TICKER_TIMER_IRQn, 5);
dkato 0:f782d9c66c49 65 GIC_EnableIRQ(US_TICKER_TIMER_IRQn);
dkato 0:f782d9c66c49 66 }
dkato 0:f782d9c66c49 67
dkato 0:f782d9c66c49 68 static uint64_t ticker_read_counter64(void) {
dkato 0:f782d9c66c49 69 uint32_t cnt_val;
dkato 0:f782d9c66c49 70 uint64_t cnt_val64;
dkato 0:f782d9c66c49 71
dkato 0:f782d9c66c49 72 if (!us_ticker_inited)
dkato 0:f782d9c66c49 73 us_ticker_init();
dkato 0:f782d9c66c49 74
dkato 0:f782d9c66c49 75 /* read counter */
dkato 0:f782d9c66c49 76 cnt_val = OSTM1CNT;
dkato 0:f782d9c66c49 77 if (last_read > cnt_val) {
dkato 0:f782d9c66c49 78 wrap_arround++;
dkato 0:f782d9c66c49 79 }
dkato 0:f782d9c66c49 80 last_read = cnt_val;
dkato 0:f782d9c66c49 81 cnt_val64 = ((uint64_t)wrap_arround << 32) + cnt_val;
dkato 0:f782d9c66c49 82
dkato 0:f782d9c66c49 83 return cnt_val64;
dkato 0:f782d9c66c49 84 }
dkato 0:f782d9c66c49 85
dkato 0:f782d9c66c49 86 static void us_ticker_read_last(void) {
dkato 0:f782d9c66c49 87 uint64_t cnt_val64;
dkato 0:f782d9c66c49 88
dkato 0:f782d9c66c49 89 cnt_val64 = ticker_read_counter64();
dkato 0:f782d9c66c49 90
dkato 0:f782d9c66c49 91 ticker_us_last64 = (cnt_val64 / count_clock);
dkato 0:f782d9c66c49 92 }
dkato 0:f782d9c66c49 93
dkato 0:f782d9c66c49 94 uint32_t us_ticker_read() {
dkato 0:f782d9c66c49 95 int check_irq_masked;
dkato 0:f782d9c66c49 96
dkato 0:f782d9c66c49 97 #if defined ( __ICCARM__)
dkato 0:f782d9c66c49 98 check_irq_masked = __disable_irq_iar();
dkato 0:f782d9c66c49 99 #else
dkato 0:f782d9c66c49 100 check_irq_masked = __disable_irq();
dkato 0:f782d9c66c49 101 #endif /* __ICCARM__ */
dkato 0:f782d9c66c49 102
dkato 0:f782d9c66c49 103 __vfp_neon_push();
dkato 0:f782d9c66c49 104 us_ticker_read_last();
dkato 0:f782d9c66c49 105 __vfp_neon_pop();
dkato 0:f782d9c66c49 106
dkato 0:f782d9c66c49 107 if (!check_irq_masked) {
dkato 0:f782d9c66c49 108 __enable_irq();
dkato 0:f782d9c66c49 109 }
dkato 0:f782d9c66c49 110
dkato 0:f782d9c66c49 111 /* clock to us */
dkato 0:f782d9c66c49 112 return (uint32_t)ticker_us_last64;
dkato 0:f782d9c66c49 113 }
dkato 0:f782d9c66c49 114
dkato 0:f782d9c66c49 115 static void us_ticker_calc_compare_match(void) {
dkato 0:f782d9c66c49 116 set_cmp_val64 = timestamp64 * count_clock;
dkato 0:f782d9c66c49 117 }
dkato 0:f782d9c66c49 118
dkato 0:f782d9c66c49 119 void us_ticker_set_interrupt(timestamp_t timestamp) {
dkato 0:f782d9c66c49 120 // set match value
dkato 0:f782d9c66c49 121 volatile uint32_t set_cmp_val;
dkato 0:f782d9c66c49 122 uint64_t count_val_64;
dkato 0:f782d9c66c49 123
dkato 0:f782d9c66c49 124 /* calc compare mach timestamp */
dkato 0:f782d9c66c49 125 timestamp64 = (ticker_us_last64 & 0xFFFFFFFF00000000) + timestamp;
dkato 0:f782d9c66c49 126 if (timestamp < (ticker_us_last64 & 0x00000000FFFFFFFF)) {
dkato 0:f782d9c66c49 127 /* This event is wrap arround */
dkato 0:f782d9c66c49 128 timestamp64 += 0x100000000;
dkato 0:f782d9c66c49 129 }
dkato 0:f782d9c66c49 130
dkato 0:f782d9c66c49 131 /* calc compare mach timestamp */
dkato 0:f782d9c66c49 132 __vfp_neon_push();
dkato 0:f782d9c66c49 133 us_ticker_calc_compare_match();
dkato 0:f782d9c66c49 134 __vfp_neon_pop();
dkato 0:f782d9c66c49 135
dkato 0:f782d9c66c49 136 set_cmp_val = (uint32_t)(set_cmp_val64 & 0x00000000FFFFFFFF);
dkato 0:f782d9c66c49 137 count_val_64 = ticker_read_counter64();
dkato 0:f782d9c66c49 138 if (set_cmp_val64 <= (count_val_64 + 500)) {
dkato 0:f782d9c66c49 139 GIC_SetPendingIRQ(US_TICKER_TIMER_IRQn);
dkato 0:f782d9c66c49 140 GIC_EnableIRQ(US_TICKER_TIMER_IRQn);
dkato 0:f782d9c66c49 141 return;
dkato 0:f782d9c66c49 142 }
dkato 0:f782d9c66c49 143 OSTM1CMP = set_cmp_val;
dkato 0:f782d9c66c49 144 GIC_EnableIRQ(US_TICKER_TIMER_IRQn);
dkato 0:f782d9c66c49 145 }
dkato 0:f782d9c66c49 146
dkato 0:f782d9c66c49 147 void us_ticker_disable_interrupt(void) {
dkato 0:f782d9c66c49 148 GIC_DisableIRQ(US_TICKER_TIMER_IRQn);
dkato 0:f782d9c66c49 149 }
dkato 0:f782d9c66c49 150
dkato 0:f782d9c66c49 151 void us_ticker_clear_interrupt(void) {
dkato 0:f782d9c66c49 152 GIC_ClearPendingIRQ(US_TICKER_TIMER_IRQn);
dkato 0:f782d9c66c49 153 }