1 files changed, 51 insertions, 0 deletions
diff --git a/lib/pivot_points.c b/lib/pivot_points.c
new file mode 100644
index 0000000..b86c44a
--- /dev/null
+++ b/lib/pivot_points.c
@@ -0,0 +1,51 @@
+// Pivot Points
+//
+// pivot_points
+//
+// Pivot Points
+//
+// 
+//
+// Inputs:    5
+// Outputs:   5
+// Constants: 0
+
+
+#include "ts.h"
+
+
+ts_parameter_t const ts_pivot_points_p = { .n_inputs = 4, .n_outputs = 5, .n_constants = 0, .params_size = 0 };
+
+uint_t ts_pivot_points_offset( ts_constant_t const *c )
+{
+	( void )c;
+	return ( 1 );
+}
+
+int ts_pivot_points(
+	fp_t * const *y, uint_t y_n,
+	fp_t const * const *x, uint_t x_n,
+	uint_t n, ts_constant_t const *c
+)
+{
+	TS_PROLOGUE( ts_pivot_points_p );
+	(void)c;
+    if (n > 0) { y[0][0] = 0; y[1][0] = 0; y[2][0] = 0; y[3][0] = 0; y[4][0] = 0; }
+    for( uint_t i = 1; i < n; ++i )
+    {
+        fp_t prev_h = ts_h( x, i - 1 );
+        fp_t prev_l = ts_l( x, i - 1 );
+        fp_t prev_c = ts_c( x, i - 1 );
+
+        fp_t p = ( prev_h + prev_l + prev_c ) / 3.0;
+        fp_t range = prev_h - prev_l;
+
+        y[0][i] = p;
+        y[1][i] = 2.0 * p - prev_l;
+        y[2][i] = 2.0 * p - prev_h;
+        y[3][i] = p + range;
+        y[4][i] = p - range;
+    }
+	return 0;
+}
+