RTOS/rtems
1
0
Fork 0
forked from Imagelibrary/rtems
Code Pull Requests Activity

bsp/leon3: Use interrupt timestamping counter

Browse Source 
Use the interrupt controller timestamping counter for the CPU counter if
available since it runs with a high frequency.
This commit is contained in:
Sebastian Huber
2014-03-06 13:17:04 +01:00
parent ba15b92370
commit 6b115b3008
2 changed files with 71 additions and 26 deletions
Download Patch File Download Diff File Expand all files Collapse all files

7
c/src/lib/libbsp/sparc/leon3/include/leon.h
View File

@@ -399,6 +399,13 @@ static inline uint32_t leon3_get_data_cache_config_register(void)
return leon3_get_system_register(0xc); return leon3_get_system_register(0xc);
} }
static inline bool leon3_irqmp_has_timestamp(
volatile struct irqmp_timestamp_regs *irqmp_ts
)
{
return (irqmp_ts->control >> 27) > 0;
}
#endif /* !ASM */ #endif /* !ASM */
#ifdef __cplusplus #ifdef __cplusplus

38
c/src/lib/libbsp/sparc/leon3/startup/cpucounter.c
View File

@@ -21,6 +21,14 @@ static volatile struct gptimer_regs *adev_to_gpt(struct ambapp_dev *adev)
return (volatile struct gptimer_regs *) DEV_TO_APB(adev)->start; return (volatile struct gptimer_regs *) DEV_TO_APB(adev)->start;
} }
static CPU_Counter_ticks timestamp_counter_difference(
CPU_Counter_ticks second,
CPU_Counter_ticks first
)
{
return second - first;
}
static CPU_Counter_ticks free_counter_difference( static CPU_Counter_ticks free_counter_difference(
CPU_Counter_ticks second, CPU_Counter_ticks second,
CPU_Counter_ticks first CPU_Counter_ticks first
@@ -54,11 +62,40 @@ static void gpt_counter_initialize(
rtems_counter_initialize_converter(frequency); rtems_counter_initialize_converter(frequency);
} }
static unsigned int get_tstamp(volatile struct irqmp_timestamp_regs *irqmp_ts)
{
return irqmp_ts->control >> 27;
}
void leon3_cpu_counter_initialize(void) void leon3_cpu_counter_initialize(void)
{ {
volatile struct irqmp_timestamp_regs *irqmp_ts =
&LEON3_IrqCtrl_Regs->timestamp[0];
struct ambapp_dev *adev; struct ambapp_dev *adev;
int idx = 1; int idx = 1;
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(
(volatile const uint32_t *) &irqmp_ts->counter,
timestamp_counter_difference
);
/* Get and set the frequency */
adev = (void *) ambapp_for_each(
&ambapp_plb,
OPTIONS_ALL | OPTIONS_APB_SLVS,
VENDOR_GAISLER,
GAISLER_IRQMP,
ambapp_find_by_idx,
NULL
);
rtems_counter_initialize_converter(ambapp_freq_get(&ambapp_plb, adev));
} else {
adev = (void *) ambapp_for_each( adev = (void *) ambapp_for_each(
&ambapp_plb, &ambapp_plb,
OPTIONS_ALL | OPTIONS_APB_SLVS, OPTIONS_ALL | OPTIONS_APB_SLVS,
@@ -89,4 +126,5 @@ void leon3_cpu_counter_initialize(void)
clock_counter_difference clock_counter_difference
); );
} }
}
} }