/**
 * @file
 *
 * @ingroup raspberrypi
 *
 * @brief Benchmark timer support.
 */

/*
 * Copyright (c) 2013 by Alan Cudmore
 *
 *  The license and distribution terms for this file may be
 *  found in the file LICENSE in this distribution or at
 *
 *  http://www.rtems.org/license/LICENSE
 *
 */

#include <bsp.h>
#include <rtems.h>
#include <rtems/btimer.h>
#include <bsp/raspberrypi.h>

static bool benchmark_timer_find_average_overhead = false;

static uint64_t benchmark_timer_base;

void benchmark_timer_initialize( void )
{
  benchmark_timer_base = BCM2835_REG( BCM2835_GPU_TIMER_CLO );
}

benchmark_timer_t benchmark_timer_read( void )
{
  uint32_t delta = BCM2835_REG( BCM2835_GPU_TIMER_CLO ) - benchmark_timer_base;

  if ( benchmark_timer_find_average_overhead ) {
    return delta;
  } else {
    return BCM2835_REG( BCM2835_GPU_TIMER_CLO );
  }
}

void benchmark_timer_disable_subtracting_average_overhead(
  bool find_average_overhead )
{
  benchmark_timer_find_average_overhead = find_average_overhead;
}