From 9ecd51ab1028e8033057df3117aac27f6f2cd406 Mon Sep 17 00:00:00 2001
From: Paul Selkirk <paul@psgd.org>
Date: Thu, 4 May 2017 15:23:10 -0400
Subject: Copy profiling code from MCUOnEclipse.

---
 libraries/libprof/profil.c | 94 ++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 94 insertions(+)
 create mode 100644 libraries/libprof/profil.c

(limited to 'libraries/libprof/profil.c')

diff --git a/libraries/libprof/profil.c b/libraries/libprof/profil.c
new file mode 100644
index 0000000..24ede21
--- /dev/null
+++ b/libraries/libprof/profil.c
@@ -0,0 +1,94 @@
+/* profil.c -- win32 profil.c equivalent
+
+   Copyright 1998, 1999, 2000, 2001, 2002 Red Hat, Inc.
+
+   This file is part of Cygwin.
+
+   This software is a copyrighted work licensed under the terms of the
+   Cygwin license.  Please consult the file "CYGWIN_LICENSE" for
+   details. */
+
+/*
+ * This file is taken from Cygwin distribution, adopted to be used for bare embeeded targets.
+ */
+#include <stdio.h>
+#include <sys/types.h>
+#include <errno.h>
+#include <math.h>
+#include "profil.h"
+#include <string.h>
+#include <stdint.h>
+
+/* global profinfo for profil() call */
+static struct profinfo prof = {
+  PROFILE_NOT_INIT, 0, 0, 0, 0
+};
+
+/* sample the current program counter */
+void SysTick_Handler(void) {
+  void OSA_SysTick_Handler(void);
+  static size_t pc, idx;
+
+  OSA_SysTick_Handler(); /* call normal Kinetis SDK SysTick handler */
+  if (prof.state==PROFILE_ON) {
+    pc = ((uint32_t*)(__builtin_frame_address(0)))[14]; /* get SP and use it to get the return address from stack */
+    if (pc >= prof.lowpc && pc < prof.highpc) {
+      idx = PROFIDX (pc, prof.lowpc, prof.scale);
+      prof.counter[idx]++;
+    }
+  }
+}
+
+/* Stop profiling to the profiling buffer pointed to by p. */
+static int profile_off (struct profinfo *p) {
+  p->state = PROFILE_OFF;
+  return 0;
+}
+
+/* Create a timer thread and pass it a pointer P to the profiling buffer. */
+static int profile_on (struct profinfo *p) {
+  p->state = PROFILE_ON;
+  return 0; /* ok */
+}
+
+/*
+ * start or stop profiling
+ *
+ * profiling goes into the SAMPLES buffer of size SIZE (which is treated
+ * as an array of u_shorts of size size/2)
+ *
+ * each bin represents a range of pc addresses from OFFSET.  The number
+ * of pc addresses in a bin depends on SCALE.  (A scale of 65536 maps
+ * each bin to two addresses, A scale of 32768 maps each bin to 4 addresses,
+ * a scale of 1 maps each bin to 128k address).  Scale may be 1 - 65536,
+ * or zero to turn off profiling
+ */
+int profile_ctl (struct profinfo *p, char *samples, size_t size, size_t offset, u_int scale) {
+  size_t maxbin;
+
+  if (scale > 65536) {
+    errno = EINVAL;
+    return -1;
+  }
+  profile_off(p);
+  if (scale) {
+    memset(samples, 0, size);
+    memset(p, 0, sizeof *p);
+    maxbin = size >> 1;
+    prof.counter = (u_short*)samples;
+    prof.lowpc = offset;
+    prof.highpc = PROFADDR(maxbin, offset, scale);
+    prof.scale = scale;
+    return profile_on(p);
+  }
+  return 0;
+}
+
+/* Equivalent to unix profil()
+   Every SLEEPTIME interval, the user's program counter (PC) is examined:
+   offset is subtracted and the result is multiplied by scale.
+   The word pointed to by this address is incremented. */
+int profil (char *samples, size_t size, size_t offset, u_int scale) {
+  return profile_ctl (&prof, samples, size, offset, scale);
+}
+
-- 
cgit v1.2.3