Example #1
0
void loop(){
    int gx, gy, gz, ax, ay, az;
    int count=0;
    while(1){
        digitalWrite(LEDR, LOW);
        digitalWrite(LEDG, HIGH);
        digitalWrite(LEDB, LOW);
        ax=gyro.getAccelX();
        ay=gyro.getAccelY();
        az=gyro.getAccelZ();
        gx=gyro.getAngleX();
        gy=gyro.getAngleY();
        gz=gyro.getAngleZ();
        printf("Angle : %d, %d, %d\n", gx, gy, gz);
        printf("Accel : %d, %d, %d\n", ax, ay, az);
        if(gx>20 || gy > 20 || gz > 20){
            count++;   
        }
        else{
            count = 0;
        }
        if(count>10){
            mosquitto_publish(mosq, NULL, TOPIC, strlen(MESSAGE), MESSAGE, 0, false);
            alarm();
            printf("************ALART************\n");
            count=0;
        }
    }
}