![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
StateChart for behavior of FlippityFlappity in presentation. Behavior here is predictable and deterministic.
Dependencies: MMA8451Q Multi_WS2811_Demo TSI mbed
Diff: main.cpp
- Revision:
- 0:8f759cbfc3c9
diff -r 000000000000 -r 8f759cbfc3c9 main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Mon Apr 06 20:29:33 2015 +0000 @@ -0,0 +1,107 @@ +#include "mbed.h" +#include "string" +#include "list" +#include "WS2811.h" +#include "Colors.h" +#include "TSISensor.h" +#include "MMA8451Q.h" +#include "mpr121.h" +#include "statechart.h" + +#define MMA8451_I2C_ADDRESS (0x1d<<1) + +/*-----------------------------------------------------------------------*/ + +// Neopixel Setup +unsigned const nLEDs = MAX_LEDS_PER_STRIP; // Defined in WS2811.h +unsigned const DATA_OUT_PIN1 = 2; // PTD2 +unsigned const DATA_OUT_PIN2 = 3; // PTD3 + +// Maestro Setup +Serial maestro(USBTX,USBRX); + +// Timer Setup +Timer timeRunning; + +// MPR121 Setup +InterruptIn interrupt(D9); +I2C i2c(D14, D15); +Mpr121 mpr121(&i2c, Mpr121::ADD_VSS); // constructor(i2c object, i2c address of the mpr121) +int touch_val = 0; +int prox_val = 0; + +// Accelerometer Setup +MMA8451Q acc(PTE25, PTE24, MMA8451_I2C_ADDRESS); + +// Battery Read Setup +AnalogIn battery(A1); + +/*-----------------------------------------------------------------------*/ + +void setToProxMode( bool prox ) { + + if( prox ) { // Proximity Mode Setup + + mpr121.setProximityMode(true); + unsigned char mode = mpr121.read(ELE_CFG); // Get the current mode + mpr121.write(ELE_CFG,0x00); // Put the MPR into setup mode + mpr121.write(EPROXTTH, 0x00); // Write the new threshold + mpr121.write(EPROXRTH, 0x00); + mpr121.write(ELE_CFG, mode); //Restore the operating mode + + } else { // Touch Mode Setup + + mpr121.setProximityMode(false); + unsigned char badTouch[12] = { 0x04, 0x04, 0x04, // Tail-side Body + 0x04, 0x04, 0x04, // Tail-side End + 0x07, 0x07, 0x07, // Head-side Body + 0x05, 0x05, 0x05,}; // Head-side End + + unsigned char sweetRelease[12] = { 0x03, 0x03, 0x03, // Tail-side Body + 0x03, 0x03, 0x03, // Tail-side End + 0x02, 0x02, 0x02, // Head-side Body + 0x02, 0x02, 0x02}; // Head-side End + for( int i = 0; i < 12; i++ ) { + mpr121.setElectrodeThreshold(i,badTouch[i],sweetRelease[i]); // Reset Touch Sensitivity + } + } +} + +// Primary Interrupt Function for MPR121 +void fallInterrupt() { + touch_val = mpr121.read(0x00); + touch_val += mpr121.read(0x01) << 8; +} + +/*-----------------------------------------------------------------------*/ + +int main() { + + WS2811 lightStrip1(nLEDs, DATA_OUT_PIN1); + WS2811 lightStrip2(nLEDs, DATA_OUT_PIN2); + lightStrip1.begin(); + lightStrip2.begin(); + + Statechart statechart; + + // Set to Touch Mode + setToProxMode(false); + + // Start MPR121 Interrupts + interrupt.fall(&fallInterrupt); + interrupt.mode(PullUp); + + // Main Loop: Show Neopixels + timeRunning.start(); + float currTime; + float xyz[3]; + + while(true) { + currTime = timeRunning.read_ms(); + acc.getAccAllAxis(xyz); + + statechart.fishStatechart(currTime, touch_val, prox_val, xyz, maestro, lightStrip1, lightStrip2, battery); + } +} + + \ No newline at end of file