src/main/common/stopwatch.c

   1 /*
   2  * This file is part of Betaflight.
   3  *
   4  * Betaflight is free software. You can redistribute this software
   5  * and/or modify this software under the terms of the GNU General
   6  * Public License as published by the Free Software Foundation,
   7  * either version 3 of the License, or (at your option) any later
   8  * version.
   9  *
  10  * Betaflight is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
  13  *
  14  * See the GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public
  17  * License along with this software.
  18  *
  19  * If not, see <http://www.gnu.org/licenses/>.
  20  */
  21
  22 #include "platform.h"
  23
  24 #include "common/time.h"
  25
  26 #include "drivers/system.h"
  27
  28 #include "stopwatch.h"
  29
  30 void stopwatchInit(stopwatch_t *watch)
  31 {
  32     watch->start = 0;
  33     watch->stop = 0;
  34     stopwatchReset(watch);
  35 }
  36
  37 void stopwatchReset(stopwatch_t *watch)
  38 {
  39     watch->isRunning = false;
  40     watch->elapsed = 0;
  41 }
  42
  43 uint32_t stopwatchStart(stopwatch_t *watch)
  44 {
  45     if (watch->isRunning == false) {
  46         watch->isRunning = true;
  47         watch->start = getCycleCounter();
  48     }
  49     return watch->start;
  50 }
  51
  52 uint32_t stopwatchStop(stopwatch_t *watch)
  53 {
  54     if (watch->isRunning == true) {
  55         watch->stop = getCycleCounter();
  56         watch->elapsed += cmpTimeCycles(watch->stop, watch->start);
  57         watch->isRunning = false;
  58     }
  59     return watch->stop;
  60 }
  61
  62 uint32_t stopwatchGetCycles(stopwatch_t *watch)
  63 {
  64     if (watch->isRunning == true) {
  65         return watch->elapsed + cmpTimeCycles(getCycleCounter(), watch->start);
  66     } else {
  67         return watch->elapsed;
  68     }
  69 }
  70
  71 uint32_t stopwatchGetMicros(stopwatch_t *watch)
  72 {
  73     return clockCyclesToMicros(stopwatchGetCycles(watch));
  74 }
  75
  76 float stopwatchGetMicrosf(stopwatch_t *watch)
  77 {
  78     return clockCyclesToMicrosf(stopwatchGetCycles(watch));
  79 }