Skip to main content
Arduino

Return to Revisions

1 of 3
zuni
zuni
  • 13
  • 2

How to add another condition in the loop?

I am using mpu6050 for counting the twitch movemnt.The alogrithm is counting the peak\twitch whenever it goes obove the threshold value. Now , i want to add that the algorithm count twitch only when it goes above threshold value and all the twitch within 90s are counted a one twitch movement. Kindly help me with. Also try to integrate this in my code.

Here is the code.

#include "I2Cdev.h" #include "MPU6050.h"

#if I2CDEV_IMPLEMENTATION == I2CDEV_ARDUINO_WIRE #include "Wire.h" #endif

MPU6050 accelgyro;

int16_t ax, ay, az; float threshhold=5000.0; float conmove=4; const int sampletime=90000;

float xval[100]={0}; float yval[100]={0}; float zval[100]={0}; float xavg; float yavg; float zavg;

int twitch,flag=0; MPU6050 mpu6050;

int16_t tr; // raw temperature data register value char buffer[7]; // temporary string buffer; used with dtostrf() function #define OUTPUT_READABLE_ACCELGYRO

#define LED_PIN 13 bool blinkState = false;

void setup() {

// join I2C bus (I2Cdev library doesn't do this automatically)
#if I2CDEV_IMPLEMENTATION == I2CDEV_ARDUINO_WIRE
    Wire.begin();
#elif I2CDEV_IMPLEMENTATION == I2CDEV_BUILTIN_FASTWIRE
    Fastwire::setup(400, true);
#endif

Serial.begin(115200);

// initialize device
Serial.println("Initializing I2C devices...");
accelgyro.initialize();
mpu6050.initialize();  // initialize MPU6050 sensor module

// verify connection
Serial.println("Testing device connections...");
Serial.println(accelgyro.testConnection() ? "MPU6050 connection successful" : "MPU6050 connection failed");

pinMode(LED_PIN, OUTPUT);
calibrate();
delay(5000);

} void loop() {

accelgyro.getAcceleration(&ax, &ay, &az);
tr = mpu6050.getTemperature();

#ifdef OUTPUT_READABLE_ACCELGYRO
+
    // display tab-separated accel/gyro x/y/z values
    Serial.print("a/g:\t");
    Serial.print(ax); Serial.print("\t");
    Serial.print(ay); Serial.print("\t");
    Serial.print(az);
   
   
    
#endif

#ifdef OUTPUT_BINARY_ACCELGYRO
    Serial.write((uint8_t)(ax >> 8)); Serial.write((uint8_t)(ax & 0xFF));
    Serial.write((uint8_t)(ay >> 8)); Serial.write((uint8_t)(ay & 0xFF));
    Serial.write((uint8_t)(az >> 8)); Serial.write((uint8_t)(az & 0xFF));
    

#endif

// blink LED to indicate activity
blinkState = !blinkState;
digitalWrite(LED_PIN, blinkState);
 int acc=0;

float totvect[100]={0}; float totave[100]={0}; float xaccl[100]={0}; float yaccl[100]={0}; float zaccl[100]={0};

for (int i=0;i<100;i++) { xaccl[i]=float(ax); delay(1); yaccl[i]=float(ay); delay(1);

zaccl[i]=float(az); delay(1);

totvect[i] = sqrt(((xaccl[i]-xavg)* (xaccl[i]-xavg))+ ((yaccl[i] - yavg)(yaccl[i] - yavg)) + ((zval[i] - zavg)(zval[i] - zavg))); totave[i] = (totvect[i] + totvect[i-1]) / 2 ; //acc=acc+totave[i]; Serial.println(totave[i]); Serial.print("T = "); Serial.print(dtostrf(tr/340.0+36.53, 5, 1, buffer)); Serial.println(" °C");

// delay(200);

//cal twitch if (totave[i]>threshhold && flag==0) { twitch=twitch+1; flag=1;

} else if (totave[i] > threshhold && flag==1 ) { //do nothing } if (totave[i] <threshhold && flag==1 ) {flag=0;}

Serial.println('\n'); Serial.print("twitch="); Serial.println(twitch);

}

//float tim=acc/100; //Serial.println(tim); delay(1000); // stepcal(totave); }

void calibrate()

{ digitalWrite(13,HIGH); accelgyro.getAcceleration(&ax, &ay, &az);

float sum=0; float sum1=0; float sum2=0; for (int i=0;i<100;i++) { xval[i]=float(ax);

sum=xval[i]+sum; } delay(100); xavg=sum/100.0;

Serial.println(xavg);

for (int j=0;j<100;j++) { yval[j]=float(ay);

sum1=yval[j]+sum1; } yavg=sum1/100.0;

Serial.println(yavg); delay(100); for (int i=0;i<100;i++) { zval[i]=float(az);

sum2=zval[i]+sum2; } zavg=sum2/100.0; delay(100); Serial.println(zavg);

digitalWrite(13,LOW);

}

zuni
  • 13
  • 2