Files
edgetx-gx12/radio/src/targets/common/arm/stm32/delays_driver.cpp
T

58 lines
1.5 KiB
C++

/*
* Copyright (C) EdgeTX
*
* Based on code named
* opentx - https://github.com/opentx/opentx
* th9x - http://code.google.com/p/th9x
* er9x - http://code.google.com/p/er9x
* gruvin9x - http://code.google.com/p/gruvin9x
*
* License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*/
#include "board.h"
void delaysInit()
{
CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;
DWT->CYCCNT = 0;
DWT->CTRL |= DWT_CTRL_CYCCNTENA_Msk;
}
void delay_01us(uint32_t count)
{
volatile uint32_t dwtStart = ticksNow();
volatile uint32_t dwtTotal = (SYSTEM_TICKS_01US * count) - 10;
while ((ticksNow() - dwtStart) < dwtTotal);
}
void delay_us(uint32_t count)
{
volatile uint32_t dwtStart = ticksNow();
volatile uint32_t dwtTotal = (SYSTEM_TICKS_1US * count) - 10;
while ((ticksNow() - dwtStart) < dwtTotal);
}
void delay_1ms()
{
volatile uint32_t dwtStart = ticksNow();
volatile uint32_t dwtTotal = SYSTEM_TICKS_1MS - 10;
while ((ticksNow() - dwtStart) < dwtTotal);
}
void delay_ms(uint32_t count)
{
while (count--) {
delay_1ms();
}
}