[rtems commit] sparc: Add support for interrupt profiling

[Sebastian Huber]

Module:    rtems
Branch:    master
Commit:    de5d6d048db50312e20931e2c8bfb14305b138a5
Changeset: http://git.rtems.org/rtems/commit/?id=de5d6d048db50312e20931e2c8bfb14305b138a5

Author:    Sebastian Huber <sebastian.huber at embedded-brains.de>
Date:      Wed Mar  5 12:07:42 2014 +0100

sparc: Add support for interrupt profiling

---

 c/src/lib/libbsp/sparc/shared/irq_asm.S |   25 +++++++++++++++++++++++--
 1 files changed, 23 insertions(+), 2 deletions(-)

diff --git a/c/src/lib/libbsp/sparc/shared/irq_asm.S b/c/src/lib/libbsp/sparc/shared/irq_asm.S
index a277252..39629a3 100644
--- a/c/src/lib/libbsp/sparc/shared/irq_asm.S
+++ b/c/src/lib/libbsp/sparc/shared/irq_asm.S
@@ -399,7 +399,14 @@ save_isf:
         subcc    %l7, 1, %l7             ! outermost interrupt handler?
         bnz      dont_switch_stacks      ! No, then do not switch stacks
 
-        nop
+#if defined( RTEMS_PROFILING )
+         sethi   %hi(SYM(_SPARC_Counter)), %o5
+        ld       [%o5 + %lo(SYM(_SPARC_Counter))], %l4
+        ld       [%l4], %o5
+#else
+         nop
+#endif
+
 	ld       [%l5 + PER_CPU_INTERRUPT_STACK_HIGH], %sp
 
 dont_switch_stacks:
@@ -453,7 +460,21 @@ dont_fix_pil2:
                                         !   WAS LOADED WHEN ISF WAS SAVED!!!
         mov      %l3, %o0               ! o0 = 1st arg = vector number
         call     %g4, 0
-        nop                             ! delay slot
+#if defined( RTEMS_PROFILING )
+         mov     %o5, %l3               ! save interrupt entry instant
+        cmp      %l7, 0
+        bne      profiling_not_outer_most_exit
+         nop
+        call     SYM(sparc_disable_interrupts), 0
+         nop
+        ld       [%l4], %o2             ! o2 = 3rd arg = interrupt exit instant
+        mov      %l3, %o1               ! o1 = 2nd arg = interrupt entry instant
+        call     SYM(_Profiling_Outer_most_interrupt_entry_and_exit), 0
+         mov     %l5, %o0               ! o0 = 1st arg = per-CPU control
+profiling_not_outer_most_exit:
+#else
+         nop                            ! delay slot
+#endif
 
         /*
          *  Redisable traps so we can finish up the interrupt processing.