Steve Kim / mbed-src-test

Fork of mbed-src by mbed official

Committer:
SteveKim
Date:
Tue Jul 14 10:20:51 2015 +0000
Revision:
590:0835b0fc9a03
Parent:
508:4f5903e025e6
.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mbed_official 52:a51c77007319 1 /* mbed Microcontroller Library
mbed_official 70:c1fbde68b492 2 * Copyright (c) 2014, STMicroelectronics
mbed_official 70:c1fbde68b492 3 * All rights reserved.
mbed_official 52:a51c77007319 4 *
mbed_official 70:c1fbde68b492 5 * Redistribution and use in source and binary forms, with or without
mbed_official 70:c1fbde68b492 6 * modification, are permitted provided that the following conditions are met:
mbed_official 52:a51c77007319 7 *
mbed_official 70:c1fbde68b492 8 * 1. Redistributions of source code must retain the above copyright notice,
mbed_official 70:c1fbde68b492 9 * this list of conditions and the following disclaimer.
mbed_official 70:c1fbde68b492 10 * 2. Redistributions in binary form must reproduce the above copyright notice,
mbed_official 70:c1fbde68b492 11 * this list of conditions and the following disclaimer in the documentation
mbed_official 70:c1fbde68b492 12 * and/or other materials provided with the distribution.
mbed_official 70:c1fbde68b492 13 * 3. Neither the name of STMicroelectronics nor the names of its contributors
mbed_official 70:c1fbde68b492 14 * may be used to endorse or promote products derived from this software
mbed_official 70:c1fbde68b492 15 * without specific prior written permission.
mbed_official 52:a51c77007319 16 *
mbed_official 70:c1fbde68b492 17 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
mbed_official 70:c1fbde68b492 18 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
mbed_official 70:c1fbde68b492 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
mbed_official 70:c1fbde68b492 20 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
mbed_official 70:c1fbde68b492 21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
mbed_official 70:c1fbde68b492 22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
mbed_official 70:c1fbde68b492 23 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
mbed_official 70:c1fbde68b492 24 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
mbed_official 70:c1fbde68b492 25 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
mbed_official 70:c1fbde68b492 26 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
mbed_official 52:a51c77007319 27 */
mbed_official 52:a51c77007319 28 #include <stddef.h>
mbed_official 52:a51c77007319 29 #include "us_ticker_api.h"
mbed_official 52:a51c77007319 30 #include "PeripheralNames.h"
mbed_official 52:a51c77007319 31
mbed_official 489:119543c9f674 32 // Timer selection
mbed_official 489:119543c9f674 33 #define TIM_MST TIM4
mbed_official 76:aeb1df146756 34
mbed_official 489:119543c9f674 35 static TIM_HandleTypeDef TimMasterHandle;
mbed_official 489:119543c9f674 36 static int us_ticker_inited = 0;
mbed_official 489:119543c9f674 37
mbed_official 489:119543c9f674 38 volatile uint32_t SlaveCounter = 0;
mbed_official 489:119543c9f674 39 volatile uint32_t oc_int_part = 0;
mbed_official 489:119543c9f674 40 volatile uint16_t oc_rem_part = 0;
mbed_official 91:0a39e62a0464 41
mbed_official 402:09075a3b15e3 42 void set_compare(uint16_t count)
mbed_official 402:09075a3b15e3 43 {
mbed_official 489:119543c9f674 44 TimMasterHandle.Instance = TIM_MST;
mbed_official 91:0a39e62a0464 45 // Set new output compare value
mbed_official 489:119543c9f674 46 __HAL_TIM_SetCompare(&TimMasterHandle, TIM_CHANNEL_1, count);
mbed_official 91:0a39e62a0464 47 // Enable IT
mbed_official 489:119543c9f674 48 __HAL_TIM_ENABLE_IT(&TimMasterHandle, TIM_IT_CC1);
mbed_official 84:f54042cbc282 49 }
mbed_official 76:aeb1df146756 50
mbed_official 402:09075a3b15e3 51 void us_ticker_init(void)
mbed_official 402:09075a3b15e3 52 {
mbed_official 52:a51c77007319 53 if (us_ticker_inited) return;
mbed_official 52:a51c77007319 54 us_ticker_inited = 1;
mbed_official 174:8bb9f3a33240 55
mbed_official 489:119543c9f674 56 HAL_InitTick(0); // The passed value is not used
mbed_official 52:a51c77007319 57 }
mbed_official 52:a51c77007319 58
mbed_official 402:09075a3b15e3 59 uint32_t us_ticker_read()
mbed_official 402:09075a3b15e3 60 {
mbed_official 54:24d77221bceb 61 uint32_t counter, counter2;
mbed_official 52:a51c77007319 62 if (!us_ticker_inited) us_ticker_init();
mbed_official 76:aeb1df146756 63 // A situation might appear when Master overflows right after Slave is read and before the
mbed_official 76:aeb1df146756 64 // new (overflowed) value of Master is read. Which would make the code below consider the
mbed_official 76:aeb1df146756 65 // previous (incorrect) value of Slave and the new value of Master, which would return a
mbed_official 54:24d77221bceb 66 // value in the past. Avoid this by computing consecutive values of the timer until they
mbed_official 54:24d77221bceb 67 // are properly ordered.
mbed_official 84:f54042cbc282 68 counter = (uint32_t)(SlaveCounter << 16);
mbed_official 91:0a39e62a0464 69 counter += TIM_MST->CNT;
mbed_official 54:24d77221bceb 70 while (1) {
mbed_official 84:f54042cbc282 71 counter2 = (uint32_t)(SlaveCounter << 16);
mbed_official 91:0a39e62a0464 72 counter2 += TIM_MST->CNT;
mbed_official 76:aeb1df146756 73 if (counter2 > counter) {
mbed_official 54:24d77221bceb 74 break;
mbed_official 76:aeb1df146756 75 }
mbed_official 54:24d77221bceb 76 counter = counter2;
mbed_official 54:24d77221bceb 77 }
mbed_official 54:24d77221bceb 78 return counter2;
mbed_official 52:a51c77007319 79 }
mbed_official 52:a51c77007319 80
mbed_official 402:09075a3b15e3 81 void us_ticker_set_interrupt(timestamp_t timestamp)
mbed_official 402:09075a3b15e3 82 {
mbed_official 304:89b9c3a9a045 83 int delta = (int)((uint32_t)timestamp - us_ticker_read());
mbed_official 91:0a39e62a0464 84 uint16_t cval = TIM_MST->CNT;
mbed_official 84:f54042cbc282 85
mbed_official 84:f54042cbc282 86 if (delta <= 0) { // This event was in the past
mbed_official 84:f54042cbc282 87 us_ticker_irq_handler();
mbed_official 174:8bb9f3a33240 88 } else {
mbed_official 91:0a39e62a0464 89 oc_int_part = (uint32_t)(delta >> 16);
mbed_official 91:0a39e62a0464 90 oc_rem_part = (uint16_t)(delta & 0xFFFF);
mbed_official 91:0a39e62a0464 91 if (oc_rem_part <= (0xFFFF - cval)) {
mbed_official 91:0a39e62a0464 92 set_compare(cval + oc_rem_part);
mbed_official 91:0a39e62a0464 93 oc_rem_part = 0;
mbed_official 84:f54042cbc282 94 } else {
mbed_official 91:0a39e62a0464 95 set_compare(0xFFFF);
mbed_official 91:0a39e62a0464 96 oc_rem_part = oc_rem_part - (0xFFFF - cval);
mbed_official 84:f54042cbc282 97 }
mbed_official 52:a51c77007319 98 }
mbed_official 52:a51c77007319 99 }
mbed_official 52:a51c77007319 100
mbed_official 402:09075a3b15e3 101 void us_ticker_disable_interrupt(void)
mbed_official 402:09075a3b15e3 102 {
mbed_official 489:119543c9f674 103 TimMasterHandle.Instance = TIM_MST;
mbed_official 489:119543c9f674 104 __HAL_TIM_DISABLE_IT(&TimMasterHandle, TIM_IT_CC1);
mbed_official 52:a51c77007319 105 }
mbed_official 52:a51c77007319 106
mbed_official 402:09075a3b15e3 107 void us_ticker_clear_interrupt(void)
mbed_official 402:09075a3b15e3 108 {
mbed_official 489:119543c9f674 109 TimMasterHandle.Instance = TIM_MST;
mbed_official 489:119543c9f674 110 if (__HAL_TIM_GET_FLAG(&TimMasterHandle, TIM_FLAG_CC1) == SET) {
mbed_official 489:119543c9f674 111 __HAL_TIM_CLEAR_FLAG(&TimMasterHandle, TIM_FLAG_CC1);
mbed_official 489:119543c9f674 112 }
mbed_official 52:a51c77007319 113 }