/* * 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(); } }