|
|
@@ -0,0 +1,102 @@ |
|
|
|
#include <stdio.h> |
|
|
|
#include <stdlib.h> |
|
|
|
#include <stdint.h> |
|
|
|
#include <wiringPi.h> |
|
|
|
#include <wiringPiI2C.h> |
|
|
|
#include <errno.h> |
|
|
|
|
|
|
|
#define MPU3050_PWR (0x6b) |
|
|
|
#define MPU3050_I2C (0x69) |
|
|
|
#define MPU3050_REG (0x21) |
|
|
|
#define LED 0 |
|
|
|
#define BUTTON 5 |
|
|
|
#define DEBOUNCE_MS 1000 |
|
|
|
|
|
|
|
volatile int trigger; |
|
|
|
volatile uint8_t photoTaken; |
|
|
|
volatile unsigned int prevTime = 0; |
|
|
|
volatile uint8_t btnClicked = 0; |
|
|
|
|
|
|
|
void myInterrupt(void) |
|
|
|
{ |
|
|
|
unsigned int currentTime = millis(); |
|
|
|
unsigned int deltaTime = currentTime - prevTime; |
|
|
|
|
|
|
|
printf("%d\n", deltaTime); |
|
|
|
if (deltaTime > DEBOUNCE_MS) |
|
|
|
{ |
|
|
|
btnClicked = 1; |
|
|
|
prevTime = currentTime; |
|
|
|
printf("test\n"); |
|
|
|
if (trigger == 0) |
|
|
|
{ |
|
|
|
photoTaken = 0; |
|
|
|
trigger = 1; |
|
|
|
digitalWrite(LED, LOW); |
|
|
|
printf("T R I G G E R R E D\n"); |
|
|
|
} |
|
|
|
else |
|
|
|
{ |
|
|
|
photoTaken = 0; |
|
|
|
trigger = 0; |
|
|
|
digitalWrite(LED, HIGH); |
|
|
|
delay(100); |
|
|
|
digitalWrite(LED, LOW); |
|
|
|
delay(100); |
|
|
|
digitalWrite(LED, HIGH); |
|
|
|
delay(100); |
|
|
|
digitalWrite(LED, LOW); |
|
|
|
printf("T R I G G E R R E D A G A I N\n"); |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
int main() |
|
|
|
{ |
|
|
|
photoTaken = 0; |
|
|
|
trigger = 0; |
|
|
|
|
|
|
|
wiringPiSetup(); |
|
|
|
pinMode(BUTTON, INPUT); |
|
|
|
pinMode(LED, OUTPUT); |
|
|
|
|
|
|
|
int isrSetup = wiringPiISR(BUTTON, INT_EDGE_FALLING, &myInterrupt); |
|
|
|
int i2cSetup = wiringPiI2CSetup(MPU3050_I2C); |
|
|
|
|
|
|
|
if (i2cSetup < 0||isrSetup < 0) |
|
|
|
return 0; |
|
|
|
|
|
|
|
wiringPiI2CWriteReg8(i2cSetup, MPU3050_PWR, 0x01); |
|
|
|
int gyroInput; |
|
|
|
int count = 0; |
|
|
|
while(1) |
|
|
|
{ |
|
|
|
gyroInput = wiringPiI2CReadReg8(i2cSetup, MPU3050_REG); |
|
|
|
|
|
|
|
if(gyroInput == 0) |
|
|
|
{ |
|
|
|
count++; |
|
|
|
if (count > 10 && trigger == 0 && photoTaken == 0) |
|
|
|
{ |
|
|
|
digitalWrite(LED, HIGH); |
|
|
|
delay(2000); |
|
|
|
|
|
|
|
if (!btnClicked) |
|
|
|
{ |
|
|
|
system("raspistill -v -o photo.jpg && ./sendMail.sh"); |
|
|
|
photoTaken = 1; |
|
|
|
} |
|
|
|
|
|
|
|
btnClicked = 0; |
|
|
|
} |
|
|
|
} |
|
|
|
else |
|
|
|
{ |
|
|
|
count = 0; |
|
|
|
digitalWrite(LED, LOW); |
|
|
|
} |
|
|
|
|
|
|
|
delay(100); |
|
|
|
} |
|
|
|
return 0; |
|
|
|
} |