1 files changed, 28 insertions, 0 deletions
diff --git a/libraries/libprof/profiler.S b/libraries/libprof/profiler.S
new file mode 100644
index 0000000..1aa5c97
--- /dev/null
+++ b/libraries/libprof/profiler.S
@@ -0,0 +1,28 @@
+/*
+ * profiler.S
+ *  Implements the gprof profiler arc counting function.
+ *  Created on: 06.08.2015
+ *      Author: Erich Styger
+ */
+
+    .syntax unified
+    .arch armv7-m
+
+.globl __gnu_mcount_nc
+.type __gnu_mcount_nc, %function
+
+__gnu_mcount_nc:
+#if 0 /* dummy version, doing nothing */
+  mov    ip, lr
+  pop    { lr }
+  bx     ip
+#else
+  push {r0, r1, r2, r3, lr}     /* save registers */
+  bic r1, lr, #1                /* R1 contains callee address, with thumb bit cleared */
+  ldr r0, [sp, #20]             /* R0 contains caller address */
+  bic r0, r0, #1                /* clear thumb bit */
+  bl _mcount_internal           /* jump to internal _mcount() implementation */
+  pop {r0, r1, r2, r3, ip, lr}  /* restore saved registers */
+  bx ip                         /* return to caller */
+#endif
+