/*
 * Copyright (c) 2014, 2016 embedded brains GmbH.  All rights reserved.
 *
 *  embedded brains GmbH
 *  Dornierstr. 4
 *  82178 Puchheim
 *  Germany
 *  <rtems@embedded-brains.de>
 *
 * 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 <leon.h>

#include <rtems/counter.h>
#include <rtems/sysinit.h>
#include <rtems/score/sparcimpl.h>

static void leon3_counter_initialize(void)
{
  volatile struct irqmp_timestamp_regs *irqmp_ts;
  volatile struct gptimer_regs *gpt;
  unsigned int freq;

  irqmp_ts = &LEON3_IrqCtrl_Regs->timestamp[0];
  gpt = LEON3_Timer_Regs;

  leon3_up_counter_enable();

  if (leon3_up_counter_is_available()) {
    /* Use the LEON4 up-counter if available */

    _SPARC_Counter_initialize(
      _SPARC_Counter_read_asr23,
      _SPARC_Counter_difference_normal,
      NULL
    );

    freq = leon3_up_counter_frequency();
    rtems_counter_initialize_converter(freq);
  } else if (leon3_irqmp_has_timestamp(irqmp_ts)) {
    /* Use the interrupt controller timestamp counter if available */

    /* Enable interrupt timestamping for an arbitrary interrupt line */
    irqmp_ts->control = 0x1;

    _SPARC_Counter_initialize(
      _SPARC_Counter_read_address,
      _SPARC_Counter_difference_normal,
      (volatile const uint32_t *) &irqmp_ts->counter
    );

    freq = ambapp_freq_get(&ambapp_plb, LEON3_IrqCtrl_Adev);
    rtems_counter_initialize_converter(freq);
  } else if (gpt != NULL) {
    /* Fall back to the first GPTIMER if available */

    /* Enable timer just in case no clock driver is configured */
    gpt->timer[LEON3_CLOCK_INDEX].ctrl |= GPTIMER_TIMER_CTRL_EN;

    _SPARC_Counter_initialize(
      _SPARC_Counter_read_address,
      _SPARC_Counter_difference_clock_period,
      (volatile const uint32_t *) &gpt->timer[LEON3_CLOCK_INDEX].value
    );

    freq = ambapp_freq_get(&ambapp_plb, LEON3_Timer_Adev);
    rtems_counter_initialize_converter(freq / (gpt->scaler_reload - 1));
  }
}

RTEMS_SYSINIT_ITEM(
  leon3_counter_initialize,
  RTEMS_SYSINIT_BSP_START,
  RTEMS_SYSINIT_ORDER_THIRD
);

SPARC_COUNTER_DEFINITION;