sparc: Rework CPU counter support

Rework CPU counter support to enable use of the GR740 up-counter via
%asr22 and %asr23.

1 files changed, 31 insertions, 18 deletions

diff --git a/cpukit/score/cpu/sparc/rtems/score/cpu.h b/cpukit/score/cpu/sparc/rtems/score/cpu.h
index ea90e36752..c87618db85 100644
--- a/cpukit/score/cpu/sparc/rtems/score/cpu.h
+++ b/cpukit/score/cpu/sparc/rtems/score/cpu.h
@@ -1304,6 +1304,8 @@ static inline uint32_t CPU_swap_u32(
 
 typedef uint32_t CPU_Counter_ticks;
 
+typedef CPU_Counter_ticks ( *SPARC_Counter_read )( void );
+
 typedef CPU_Counter_ticks (*SPARC_Counter_difference)(
   CPU_Counter_ticks second,
   CPU_Counter_ticks first
@@ -1311,46 +1313,57 @@ typedef CPU_Counter_ticks (*SPARC_Counter_difference)(
 
 /*
  * The SPARC processors supported by RTEMS have no built-in CPU counter
- * support.  We have to use some hardware counter module for this purpose.  The
- * BSP must provide a 32-bit register which contains the current CPU counter
- * value and a function for the difference calculation.  It can use for example
- * the GPTIMER instance used for the clock driver.
+ * support.  We have to use some hardware counter module for this purpose, for
+ * example the GPTIMER instance used by the clock driver.  The BSP must provide
+ * an implementation of the CPU counter read and difference functions.  This
+ * allows the use of dynamic hardware enumeration.
  */
 typedef struct {
-  volatile const CPU_Counter_ticks *counter_register;
-  SPARC_Counter_difference counter_difference;
+  SPARC_Counter_read                counter_read;
+  SPARC_Counter_difference          counter_difference;
+  volatile const CPU_Counter_ticks *counter_address;
 } SPARC_Counter;
 
 extern SPARC_Counter _SPARC_Counter;
 
+CPU_Counter_ticks _SPARC_Counter_read_address( void );
+
+CPU_Counter_ticks _SPARC_Counter_read_asr23( void );
+
+CPU_Counter_ticks _SPARC_Counter_difference_normal(
+  CPU_Counter_ticks second,
+  CPU_Counter_ticks first
+);
+
+CPU_Counter_ticks _SPARC_Counter_difference_clock_period(
+  CPU_Counter_ticks second,
+  CPU_Counter_ticks first
+);
+
 /*
  * Returns always a value of one regardless of the parameters.  This prevents
  * an infinite loop in rtems_counter_delay_ticks().  Its only a reasonably safe
  * default.
  */
-CPU_Counter_ticks _SPARC_Counter_difference_default(
+CPU_Counter_ticks _SPARC_Counter_difference_one(
   CPU_Counter_ticks second,
   CPU_Counter_ticks first
 );
 
-static inline bool _SPARC_Counter_is_default( void )
-{
-  return _SPARC_Counter.counter_difference
-    == _SPARC_Counter_difference_default;
-}
-
 static inline void _SPARC_Counter_initialize(
-  volatile const CPU_Counter_ticks *counter_register,
-  SPARC_Counter_difference counter_difference
+  SPARC_Counter_read                counter_read,
+  SPARC_Counter_difference          counter_difference,
+  volatile const CPU_Counter_ticks *counter_address
 )
 {
-  _SPARC_Counter.counter_register = counter_register;
+  _SPARC_Counter.counter_read = counter_read;
   _SPARC_Counter.counter_difference = counter_difference;
+  _SPARC_Counter.counter_address = counter_address;
 }
 
 static inline CPU_Counter_ticks _CPU_Counter_read( void )
 {
-  return *_SPARC_Counter.counter_register;
+  return ( *_SPARC_Counter.counter_read )();
 }
 
 static inline CPU_Counter_ticks _CPU_Counter_difference(
@@ -1358,7 +1371,7 @@ static inline CPU_Counter_ticks _CPU_Counter_difference(
   CPU_Counter_ticks first
 )
 {
-  return (*_SPARC_Counter.counter_difference)( second, first );
+  return ( *_SPARC_Counter.counter_difference )( second, first );
 }
 
 #endif /* ASM */