Diff: northStarFuncs.cpp

Revision:

3:123b546e4a5c

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/northStarFuncs.cpp	Tue Jun 30 16:06:47 2015 +0000
@@ -0,0 +1,73 @@
+
+#include <stdint.h>
+#include <stdlib.h>
+#include "northStarFuncs.h"
+#include <math.h>
+
+#define UINT8_MAX        255 // not in stdint.h for some reason
+
+// red   = abs(accel.x) scaled to 1G
+// green = abs(accel.y) scaled to 1G
+// blue  = abs(accel.z) scaled to 1G
+uint8_t conditionAccels(float reading) 
+{
+  uint8_t colorValue;
+  
+  // abs(reading)
+  if (reading < 0.0) {reading = -reading;}
+  
+  // scale from mg to 0 to 255
+  reading = reading / 4; 
+  
+  // limit to max
+  if (reading > UINT8_MAX ) { 
+    colorValue = UINT8_MAX ; 
+  } else {
+    colorValue = reading;
+  }
+  return colorValue;
+}
+
+uint8_t conditionMags(float heading, float offset, float range) 
+{
+  float h = heading + offset;
+  float colorValFloat;
+  uint8_t colorVal;
+  
+  if (h < -180.0) { h = h + 360.0; }
+  if (h > 180.0) { h = h - 360.0; }
+  // now h is pointing in the direction of interest
+  
+  colorValFloat = 255.0 - abs(h)*255.0/range;
+  if (colorValFloat < 0.0) { colorValFloat = 0.0; }
+  colorVal = colorValFloat; 
+  return colorVal;
+}
+ 
+// arbitrary conversion: squares to reduces vibe (<1 rad/s)
+// so as to highlight real movement
+uint8_t conditionGyros(float reading) 
+{
+  uint8_t colorValue;
+  float colorValueFloat;
+  
+  colorValueFloat = (reading*reading)/1500.0;
+  if (colorValueFloat > 255) {
+     colorValue = 255;
+  } else {
+     colorValue = colorValueFloat;
+  }
+
+  return colorValue;
+}
+
+eModes changeMode(eModes current)
+{
+  switch (current) {
+    case(OFF):   return ACCEL;
+    case(ACCEL): return GYRO;
+    case(GYRO):  return MAG;
+    case(MAG):   return OFF;
+  }
+  return OFF;
+}