Merge pull request #878 from adafruit/TheKitty-patch-105

Files for the guide Monster M4sk Is Watching You

Author: TheKitty

Monster_M4sk_Watching_You/M4_Eyes/DMAbuddy.h

@@ -0,0 +1,16 @@
+// Very infrequently the jobStatus member in Adafruit_ZeroDMA gets out of
+// sync and the screen DMA updates lock up. This is a hacky workaround.
+// jobStatus is a protected member of Adafruit_ZeroDMA, we can't reset it
+// directly in the sketch, but a subclass can. So we have this minimal
+// subclass with a DMA-channel-toggle-off-on-and-jobStatus-reset function.
+
+class DMAbuddy : public Adafruit_ZeroDMA {
+ public:
+  // Call this function when a DMA stall is detected:
+  void fix(void) {
+    // We literally just switch the channel off and on again to fix it...
+    DMAC->Channel[channel].CHCTRLA.bit.ENABLE = 0; // Disable channel
+    DMAC->Channel[channel].CHCTRLA.bit.ENABLE = 1; // Enable channel
+    jobStatus = DMA_STATUS_OK; // Back in business!
+  }
+};

Monster_M4sk_Watching_You/M4_Eyes/HeatSensor.cpp

@@ -0,0 +1,110 @@
+/* Read the IR sensor and try to figure out where the heat is located. 
+*/
+
+#include "HeatSensor.h"
+
+#include <Wire.h>
+#include <Adafruit_AMG88xx.h>
+
+Adafruit_AMG88xx amg;
+
+float pixels[AMG88xx_PIXEL_ARRAY_SIZE];
+
+void HeatSensor::setup()
+{
+    x = 0;
+    y = 0;
+    magnitude = 0;
+
+    bool status;
+    
+    // default settings
+    status = amg.begin();
+    if (!status) {
+        Serial.println("Could not find a valid AMG88xx sensor, check wiring!");
+        while (1);
+    }
+
+    yield();
+    delay(100); // let sensor boot up
+}
+
+// Find the approximate X and Y values of the peak temperature in the pixel array,
+// along with the magnitude of the brightest spot.
+void HeatSensor::find_focus()
+{
+    amg.readPixels(pixels);
+    yield();
+
+    x = 0, y = 0, magnitude = 0;
+    float minVal = 100, maxVal = 0;
+    int i = 0;
+    for (float yPos = 3.5; yPos > -4; yPos -= 1.0) {
+        for (float xPos = 3.5; xPos > -4; xPos -= 1.0) {
+            float p = pixels[i];
+            x += xPos * p;
+            y += yPos * p;
+            minVal = min(minVal, p);
+            maxVal = max(maxVal, p);
+            i++;
+        }
+    }
+    x = - x / AMG88xx_PIXEL_ARRAY_SIZE / 5.0;
+    y = y / AMG88xx_PIXEL_ARRAY_SIZE / 5.0;
+    x = max(-1.0, min(1.0, x));
+    y = max(-1.0, min(1.0, y));
+    magnitude = max(0, min(50, maxVal - 20));
+
+    // Report.
+#define SERIAL_OUT  3
+#if SERIAL_OUT == 1
+    // Print raw values
+    Serial.print("[");
+    for(int i=1; i<=AMG88xx_PIXEL_ARRAY_SIZE; i++){
+      Serial.print(pixels[i-1]);
+      Serial.print(", ");
+      if( i%8 == 0 ) Serial.println();
+    }
+    Serial.println("]");
+    Serial.println();
+#endif
+#if SERIAL_OUT == 2
+    // Print character-graphic array
+    const char charPixels[] = " .-*o0#";
+    Serial.println("========");
+    for (int i = 1; i <= AMG88xx_PIXEL_ARRAY_SIZE; i++) {
+      int val = min(5, round(max(0, pixels[i-1] - 20) / 2));
+      Serial.print(charPixels[val]);
+      if (i % 8 == 0) 
+        Serial.println();
+    }
+    Serial.println();
+#endif
+#if SERIAL_OUT == 3 || SERIAL_OUT == 2
+    // Print coordinates and brightness
+    Serial.print(x);
+    Serial.print(' ');
+    Serial.print(y);
+    Serial.print(' ');
+    Serial.println(magnitude);
+#endif
+}
+
+/*
+void loop() {
+    // Read all the pixels
+
+    // Find the focal point.
+    float x, y, magnitude;
+    find_focus(x, y, magnitude);
+
+    // Set diagnostic LEDs.
+    analogWrite(CENTER_LED, round(max(0, magnitude / 30) * 255));
+    analogWrite(RIGHT_LED, round(min(1.0, max(0.0, -x / 3)) * 255));
+    analogWrite(LEFT_LED, round(min(1.0, max(0.0, x / 3)) * 255));
+    analogWrite(UP_LED, round(min(1.0, max(0.0, y / 3)) * 255));
+    analogWrite(DOWN_LED, round(min(1.0, max(0.0, -y / 3)) * 255));
+
+    delay(200);
+}
+*/

Monster_M4sk_Watching_You/M4_Eyes/HeatSensor.h

@@ -0,0 +1,24 @@
+/* Read the IR sensor and try to figure out where the heat is located. 
+
+    Orientation: Looking into the sensor, the window is on the bottom of the silver package,
+    and the Adafruit star is at the upper left.
+    X goes from about -1.0 on the left, facing out of the sensor, to +1.0 on the right.
+    Y goes roughly from -1.0 (less?) on the bottom to +1.0 on the top.
+    The sensor is oriented with its text upside down for the moment.
+    Magnitude is currently the maximum temperature of any pixel, in degrees C.
+*/
+
+class HeatSensor {
+public:
+    // The current focus position, each from -1.0 .. +1.0.
+    float x, y;
+
+    // The current magnitude estimate, in degrees C.
+    float magnitude;
+
+    // Must be called once.
+    void setup();
+
+    // Reads the sensor and updates x, y, and magnitude.
+    void find_focus();
+};