openrcforums

Code: Select all

int channel;
int gear;

void setup() {
  pinMode(5, INPUT);
  Serial.begin(9600);
  Serial.println("Channel reader starting");
  channel = pulseIn(5, HIGH, 20000);
  if (channel > 1600) {
      // gear switch already on when we got power,
      // we will ignore first toggle state
      gear = 2;
  }
  else {
      // gear switch is off
      gear = 0;
  }  
}

void loop() {
  channel = pulseIn(5, HIGH, 20000);
  if (channel > 1600 && gear == 0) {
    Serial.println("Gear switch went on");
    gear = 1;
    Serial.print("sending 250ms pulse to camera pin 6...");
    // send video control line to 0V
    delay(250);
    // return video control line to 3.3V
    Serial.println("done!");
    Serial.println("Camera should now be recording.");
  }
  if (channel < 1600 && gear == 1) {
    Serial.println("Gear switch went off");
    gear = 0;
    Serial.print("sending 250ms pulse to camera pin 6...");
    // send video control line to 0V
    delay(250);
    // return video control line to 3.3V
    Serial.println("done!");
    Serial.println("Camera should no longer be recording.");
  }    
  if (channel < 1600 && gear == 2) {
    Serial.println("Gear switch went off, ignoring first switch from invalid state.");
    gear = 0;
  }
}

Code: Select all

#define vidIntPin 2 
#define picIntPin 3
#define vidPin 5 // yellow
#define picPin 4 // white


volatile unsigned long vidIntStart = 0; // Set in the interrupt
volatile boolean vidReady = false; // Set in the interrupt and read in the loop
volatile int vidPwmLength = 0;

volatile unsigned long picIntStart = 0; // Set in the interrupt
volatile boolean picReady = false; // Set in the interrupt and read in the loop
volatile int picPwmLength = 0;

boolean takingVideo = false;
boolean takingPhoto = false;

void setup()
{
  attachInterrupt(vidIntPin-2, readVideoPin, CHANGE);
  attachInterrupt(picIntPin-2, readPicPin, CHANGE);

  pinMode(vidPin, INPUT); // Set pins to safe values
  pinMode(picPin, INPUT);

//  Serial.begin(9600);
//  Serial.println("RC camera capture");
}

void loop()
{
//  if (picReady) {
//    Serial.print("picPwmLength ");
//    Serial.println(picPwmLength);
//  } 

//  if (vidReady) {
//    Serial.print("vidPwmLength ");
//    Serial.println(vidPwmLength);
//  } 

  if (picReady && picPwmLength > 1500 && !takingPhoto) {
//    Serial.println("Triggered photo");
    takingPhoto = true;
    takePic();  
  } 
  else if (picReady && picPwmLength < 1001) {
    takingPhoto = false;
  }

  if (vidReady && vidPwmLength > 1500 && takingVideo == false) {
//    Serial.println("Triggered video on");
    takingVideo = true;
    takeVid();
  } 
  else if (vidReady && vidPwmLength < 1001 && takingVideo) {
//    Serial.println("Turn off video");
    takeVid();
    takingVideo = false;
  } 

  picReady = false;
  vidReady = false;
}

void readVideoPin()
{
  if (digitalRead(vidIntPin) == HIGH) { 
    vidIntStart = micros();
  } 
  else {
    if (vidIntStart && !vidReady)
    {
      vidPwmLength = (int)(micros() - vidIntStart);
      vidIntStart = 0;
      vidReady = true;
    }
  }
}

void readPicPin()
{
  if (digitalRead(picIntPin) == HIGH) { 
    picIntStart = micros();
  } 
  else {
    if (picIntStart && !picReady)
    {
      picPwmLength = (int)(micros() - picIntStart);
      picIntStart = 0;
      picReady = true;
    }
  }
}

void takeVid() {
//  Serial.println("Turning on/off video");
  pinMode(vidPin, OUTPUT);
  digitalWrite(vidPin, LOW);
  delay(250);
  pinMode(vidPin, INPUT);
}

void takePic() {
//  Serial.println("Taking photo");
  pinMode(picPin, OUTPUT);
  digitalWrite(picPin, LOW);
  delay(250);
  pinMode(picPin, INPUT);
}