Thank you for your assistance, you sir are a gentleman and a scholar. I tweaked it slightly, testing the relay with an LED as I managed to fry my servo. I also missed a connection in my fritzing diagram. Currently the relay/LED turn on at the same time as the servo. I will test further when the cheaper servo arrives. How do you post the code so it is in its own window?
// IronMan Helmet: eye blink sequence_v1.0
// created by:
// Movie Props, Costumes and Scale Models | the RPF thread:
//
http://www.therpf.com/f24/iron-man-m...ml#post2647126
//import servo lib
#include <Servo.h>
//servo object names
Servo myservo; // create servo object to control a servo
Servo myservo1;
const int buttonPin = 2; // the pin that the pushbutton is attached to
int buttonState = 0; // current state of the button
int lastButtonState = 0; // previous state of the button
int pos = 0; // variable to store the servo positions
int pos1 = 180;
// led control pins (need to be PWM enabled pins for fading)
const int leftEye = 6; // the number of the left eye/pcb LEDs
const int rightEye = 3; // the number of the right eye/pcb LEDs
// relay control pins
const int myservoLock1 = 7;
const int myservoLock2 = 8;
unsigned long delaytime = 1;
unsigned long blinkspeed = 100;
unsigned long currentPWM = 0;
boolean isOpen = true;
#define S_IDLE 1
#define S_LEDON 2
#define S_WAITON 3
#define S_LEDOFF 4
#define S_WAITOFF 5
#define S_INITON 6
#define S_INITWAIT 7
#define S_BLINKON 8
#define S_SERVOUP 9
#define S_SERVODOWN 0
//FSM init vars
static int state = S_IDLE; // initial state is 1, the "idle" state.
static unsigned long lastTime; // To store the "current" time in for delays.
void setup() {
// Set up serial port
Serial.begin(9600);
//start it off
//state = S_BLINKON;
Serial.print("INTIT STATE: ");
Serial.println(state);
myservo.attach(9); // attaches the servo on pin 9 to the servo object
myservo1.attach(10); // attaches the servo on pin 10 to the servo object
pinMode(buttonPin, INPUT); // initialize the button pin as a input
digitalWrite(buttonPin, HIGH); //use interal pull up resistors
pinMode(myservoLock1, OUTPUT); // Set up relays as outputs
pinMode(myservoLock2, OUTPUT);
}
void loop() {
switch (state)
{
case S_IDLE:
// We don't need to do anything here, waiting for a forced state change...like button press.
//check mian button state
buttonState = digitalRead(buttonPin);
// compare buttonState to previous state
if (buttonState != lastButtonState) {
//if button pressed/down
if (buttonState == LOW) {
//ie: pressed
if (isOpen == true) {
Serial.print("CLOSING FACE PLATE: ");
Serial.println(isOpen, DEC);
// Close relays, deactivate the lock
digitalWrite(myservoLock1, HIGH);
digitalWrite(myservoLock2, HIGH);
// State change
state = S_SERVODOWN;
}
else {
Serial.print("OPENING FACE PLATE: ");
Serial.println(isOpen, DEC);
// State change
//state = S_SERVOUP;
state = S_LEDOFF;
}
isOpen = !isOpen;
}
else {
//went from ON/HIGH to LOW/OFF..ie: released
//Serial.print("RELEASE: ");
//Serial.println(isOpen, DEC);
}
}
// save the current state for next loop
lastButtonState = buttonState;
break;
case S_BLINKON:
Serial.println("init blink.........");
//do blink routine here
analogWrite(leftEye, 155);
analogWrite(rightEye, 155);
delay(blinkspeed);
analogWrite(leftEye, 0);
analogWrite(rightEye, 0);
delay(10);
/*
analogWrite(leftEye, 155);
analogWrite(rightEye, 155);
delay(blinkspeed);
analogWrite(leftEye, 0);
analogWrite(rightEye, 0);
delay(10);
*/
currentPWM = 0;
state = S_LEDON;
break;
case S_LEDON:
Serial.println("increase........");
lastTime = millis(); // Remember the current time
analogWrite(leftEye, currentPWM);
analogWrite(rightEye, currentPWM);
state = S_WAITON; // Move to the next state
break;
case S_WAITON:
// If one second has passed, then move on to the next state.
if (millis() > lastTime + delaytime)
{
if (currentPWM < 255) {
currentPWM += 5;
state = S_LEDON;
}
else {
Serial.println("@ 255 done........");
state = S_IDLE;
//state = S_LEDOFF; //no auto turn off.. set to idle state
}
}
break;
case S_LEDOFF:
Serial.println("........decrease");
lastTime = millis(); // Remember the current time
analogWrite(leftEye, currentPWM);
analogWrite(rightEye, currentPWM);
state = S_WAITOFF;
break;
case S_WAITOFF:
// If one second has passed, then move on to the next state.
if (millis() > lastTime + delaytime)
{
if (currentPWM > 0) {
currentPWM -= 5;
state = S_LEDOFF;
}
else {
Serial.println("@ 0 done........");
// OPen relays, activate lock
digitalWrite(myservoLock1, HIGH);
digitalWrite(myservoLock2, HIGH);
state = S_SERVOUP; //leds off..raise faceplate
}
}
break;
case S_SERVOUP:
myservo.write(100);
myservo1.write(100);
state = S_IDLE;
Serial.println("servo up.........");
// Open relays, activate lock
delay(20);
digitalWrite(myservoLock1, LOW);
digitalWrite(myservoLock2, LOW);
break;
case S_SERVODOWN:
myservo.write(0);
myservo1.write(0);
delay(20); //wait to trigger the led flicker.. will remove delay() use in next revision
state = S_BLINKON;
Serial.println("servo down.........");
// Open relays, activate lock
delay(20);
digitalWrite(myservoLock1, LOW);
digitalWrite(myservoLock2, LOW);
break;
default:
state = S_IDLE;
break;
}
}
![20150309_141612[1].jpg](https://therpf-f28a.kxcdn.com/forums/data/attachments/194/194181-0dd810234285784d5a22476c7d5a3d3e.jpg "20150309_141612[1].jpg")
![20150309_141606[1].jpg](https://therpf-f28a.kxcdn.com/forums/data/attachments/194/194182-1f411da38ba4f7db749250e2dae0776f.jpg "20150309_141606[1].jpg")
![20150309_141618[1].jpg](https://therpf-f28a.kxcdn.com/forums/data/attachments/194/194183-4ed9dcade9d6ef7f0d05a5485c7f3df9.jpg "20150309_141618[1].jpg")
![20150309_141624[1].jpg](https://therpf-f28a.kxcdn.com/forums/data/attachments/194/194184-aa00fd986a41db865011c048fbe28e91.jpg "20150309_141624[1].jpg")
![20150309_141630[1].jpg](https://therpf-f28a.kxcdn.com/forums/data/attachments/194/194185-d4ea3741f6d8999001ec939fdab45c54.jpg "20150309_141630[1].jpg")
