intval 2.2 concept
This commit is contained in:
parent
f45a1adf86
commit
922904a500
|
|
@ -0,0 +1,405 @@
|
|||
boolean debug_state = false;
|
||||
|
||||
//Can be controlled via serial
|
||||
//Buttons are optional
|
||||
//Exposure controls assumes use of a 120RPM motor
|
||||
//Uses TB6612FNG
|
||||
//Target board is an Adafruit Metro Mini,
|
||||
//also using an Uno as a dev board
|
||||
|
||||
/*
|
||||
----------------------------------------------------
|
||||
Microswitch (use INPUT_PULLUP!!)
|
||||
GND-----\ | \-----PIN
|
||||
----------------------------------------------------
|
||||
*/
|
||||
|
||||
const int MOTOR_RPM = 120;
|
||||
const int BOLEX_C = round((133 / (1.66 * 360)) * 1000); //bolex exposure constant
|
||||
const int FAST_PWM = 255;
|
||||
const int SLOW_PWM = 127;
|
||||
|
||||
/* ------------------------------------------------
|
||||
* pins
|
||||
* ------------------------------------------------*/
|
||||
//Adafruit Metro Mini
|
||||
const int PIN_INDICATOR = 13;
|
||||
const int PIN_MICRO = 7; //new in 2.2
|
||||
const int BUTTON[4] = {3, 6, 5, 4}; //trigger, direction, speed, delay
|
||||
|
||||
//TB6612FNG
|
||||
const int STBY = 11; //standby
|
||||
//Motor A
|
||||
const int PWMA = 10; //Speed control
|
||||
const int AIN1 = 9; //Direction
|
||||
const int AIN2 = 8; //Direction
|
||||
|
||||
/* ------------------------------------------------
|
||||
* loop
|
||||
* ------------------------------------------------*/
|
||||
const int LOOP_DELAY = 10;
|
||||
|
||||
/* ------------------------------------------------
|
||||
* state
|
||||
* ------------------------------------------------*/
|
||||
volatile int button_state[4] = {1, 1, 1, 1};
|
||||
volatile long button_time[4] = {0, 0, 0, 0};
|
||||
volatile long buttontime = 0;
|
||||
|
||||
volatile boolean sequence = false;
|
||||
volatile boolean running = false;
|
||||
volatile boolean cam_dir = true;
|
||||
volatile boolean delaying = false;
|
||||
volatile boolean timed = false;
|
||||
|
||||
volatile int counter = 0;
|
||||
|
||||
volatile int micro_position = 0;
|
||||
volatile boolean micro_primed = false;
|
||||
|
||||
unsigned long timer = 0;
|
||||
unsigned long frame_start = 0;
|
||||
unsigned long delay_start = 0;
|
||||
|
||||
String timed_str = "600";
|
||||
unsigned long timed_val = 600;
|
||||
unsigned long timed_open = 300; //ms after start_frame to pause
|
||||
volatile boolean timed_paused = false;
|
||||
unsigned long timed_delay = 0;
|
||||
unsigned long timed_last = 0;
|
||||
unsigned long timed_avg = 600;
|
||||
|
||||
volatile int fwd_speed = FAST_PWM;
|
||||
volatile int bwd_speed = FAST_PWM;
|
||||
|
||||
volatile long seq_delay = 42;
|
||||
|
||||
/* ------------------------------------------------
|
||||
* serial
|
||||
* ------------------------------------------------*/
|
||||
|
||||
const char cmd_camera = 'c'; //Trigger the camera to advance or rewind 1 frame
|
||||
const char cmd_cam_forward = 'e'; //Set camera direction to FORWARDS
|
||||
const char cmd_cam_backward = 'f'; //Set camera direction to BACKWARDS
|
||||
const char cmd_timed = 'n'; //Set camera exposure time: follow command immediately with number of millisecions, ie: 1000
|
||||
const char cmd_debug = 'd'; //Turn on debug messages, will break mcopy firmware
|
||||
const char cmd_connect = 'i'; //Confirm firmware on Arduino
|
||||
const char cmd_mcopy_identifier = 'm'; //Incoming identification char for mcopy use only
|
||||
const char cmd_cam_identifier = 'k'; //Response char for identifying device as camera
|
||||
|
||||
volatile char cmd_char = 'z'; //Default null command
|
||||
|
||||
const int serialDelay = 5;
|
||||
|
||||
void setup() {
|
||||
Serial_init();
|
||||
Pins_init();
|
||||
Buttons_init();
|
||||
}
|
||||
|
||||
void loop() {
|
||||
if (Serial.available()) {
|
||||
/* read the most recent byte */
|
||||
cmd_char = (char)Serial.read();
|
||||
}
|
||||
if (cmd_char != 'z') {
|
||||
cmd(cmd_char);
|
||||
cmd_char = 'z';
|
||||
}
|
||||
timer = millis();
|
||||
Btn(0);
|
||||
Btn(1);
|
||||
Btn(2);
|
||||
Btn(3);
|
||||
if (sequence && delaying) {
|
||||
Watch_delay();
|
||||
}
|
||||
|
||||
if (running) {
|
||||
if (timed) {
|
||||
Read_timed();
|
||||
} else {
|
||||
Read_micro();
|
||||
}
|
||||
}
|
||||
if (!running && !sequence && !delaying){
|
||||
delay(LOOP_DELAY);
|
||||
}
|
||||
}
|
||||
|
||||
void cmd (char val) {
|
||||
if (val == cmd_debug) {
|
||||
debug();
|
||||
} else if (val == cmd_connect) {
|
||||
connect();
|
||||
} else if (val == cmd_mcopy_identifier) {
|
||||
identify();
|
||||
} else if (val == cmd_camera) {
|
||||
Frame();
|
||||
} else if (val == cmd_cam_forward) {
|
||||
cam_direction(true); //explicit
|
||||
} else if (val == cmd_cam_backward) {
|
||||
cam_direction(false);
|
||||
} else if (val == cmd_timed) {
|
||||
timedString();
|
||||
}
|
||||
}
|
||||
|
||||
void debug () {
|
||||
debug_state = true;
|
||||
Serial.println(cmd_debug);
|
||||
log("debugging enabled");
|
||||
}
|
||||
|
||||
void connect () {
|
||||
Serial.println(cmd_connect);
|
||||
log("connect()");
|
||||
}
|
||||
|
||||
void identify () {
|
||||
Serial.println(cmd_cam_identifier);
|
||||
log("identify()");
|
||||
}
|
||||
|
||||
//sending "0" will reset to default exposure time
|
||||
void timedString () {
|
||||
while (Serial.available() == 0) {
|
||||
//Wait for timed string
|
||||
}
|
||||
timed_str = Serial.readString();
|
||||
timed_val = timed_str.toInt();
|
||||
if (timed_val < 600) {
|
||||
timed_val = 600;
|
||||
timed_str = "600";
|
||||
timed = false;
|
||||
} else {
|
||||
timed_delay = timed_val - BOLEX_C;
|
||||
timed = true;
|
||||
}
|
||||
Serial.println(cmd_timed);
|
||||
log("Set exposure time to: ");
|
||||
log(timed_str);
|
||||
}
|
||||
|
||||
void Serial_init () {
|
||||
Serial.begin(57600);
|
||||
Serial.flush();
|
||||
Serial.setTimeout(serialDelay);
|
||||
}
|
||||
|
||||
void Pins_init () {
|
||||
pinMode(STBY, OUTPUT);
|
||||
pinMode(PWMA, OUTPUT);
|
||||
pinMode(AIN1, OUTPUT);
|
||||
pinMode(AIN2, OUTPUT);
|
||||
|
||||
pinMode(PIN_MICRO, INPUT_PULLUP);
|
||||
pinMode(PIN_INDICATOR, OUTPUT);
|
||||
}
|
||||
|
||||
void Buttons_init () {
|
||||
for (int i = 0; i < 4; i++) {
|
||||
pinMode(BUTTON[i], INPUT_PULLUP);
|
||||
}
|
||||
}
|
||||
|
||||
void Btn (int index) {
|
||||
int val = digitalRead(BUTTON[index]);
|
||||
if (val != button_state[index]) {
|
||||
if (val == LOW) { // pressed
|
||||
button_time[index] = millis();
|
||||
//button_start(index);
|
||||
} else if (val == HIGH) { // not pressed
|
||||
buttontime = millis() - button_time[index];
|
||||
button_end(index, buttontime);
|
||||
}
|
||||
}
|
||||
button_state[index] = val;
|
||||
}
|
||||
|
||||
/*
|
||||
* dormant for now
|
||||
* void button_start (int index) {
|
||||
if (index == 0) {
|
||||
}
|
||||
}*/
|
||||
|
||||
void button_end (int index, long buttontime) {
|
||||
if (index == 0) {
|
||||
if (buttontime > 1000) {
|
||||
if (!sequence) {
|
||||
sequence = true;
|
||||
Output(2, 75);
|
||||
Frame();
|
||||
}
|
||||
} else {
|
||||
if (sequence) {
|
||||
sequence = false;
|
||||
//Output(2, 75);
|
||||
} else {
|
||||
Frame();
|
||||
}
|
||||
}
|
||||
} else if (index == 1) { //set direction
|
||||
if (buttontime < 1000) {
|
||||
cam_dir = true;
|
||||
Output(1, 500);
|
||||
} else if (buttontime > 1000) {
|
||||
cam_dir = false;
|
||||
Output(2, 250);
|
||||
}
|
||||
} else if (index == 2) { // set speed
|
||||
if (buttontime >= 1000) {
|
||||
timed_delay = buttontime - BOLEX_C;
|
||||
timed = true;
|
||||
Output(2, 250);
|
||||
} else if (buttontime < 1000) {
|
||||
timed_delay = 0;
|
||||
timed = false;
|
||||
Output(1, 500);
|
||||
}
|
||||
} else if (index == 3) { //set delay
|
||||
if (buttontime < 42) {
|
||||
seq_delay = 42;
|
||||
Output(1, 500);
|
||||
} else {
|
||||
seq_delay = buttontime;
|
||||
Output(2, 250);
|
||||
}
|
||||
}
|
||||
buttontime = 0;
|
||||
}
|
||||
|
||||
void Indicator (boolean state) {
|
||||
if (state) {
|
||||
digitalWrite(PIN_INDICATOR, HIGH);
|
||||
} else {
|
||||
digitalWrite(PIN_INDICATOR, LOW);
|
||||
}
|
||||
}
|
||||
|
||||
void Output (int number, int len) {
|
||||
for (int i = 0; i < number; i++) {
|
||||
Indicator(true);
|
||||
delay(len);
|
||||
Indicator(false);
|
||||
delay(42);
|
||||
}
|
||||
}
|
||||
|
||||
void Frame () {
|
||||
frame_start = millis();
|
||||
if (cam_dir) {
|
||||
digitalWrite(AIN1, HIGH);
|
||||
digitalWrite(AIN2, LOW);
|
||||
analogWrite(PWMA, fwd_speed);
|
||||
} else {
|
||||
digitalWrite(AIN1, LOW);
|
||||
digitalWrite(AIN2, HIGH);
|
||||
analogWrite(PWMA, bwd_speed);
|
||||
}
|
||||
digitalWrite(STBY, HIGH); //disable standby
|
||||
running = true;
|
||||
micro_primed = false;
|
||||
}
|
||||
|
||||
boolean Read_delay () {
|
||||
if (fwd_speed == FAST_PWM) {
|
||||
if (timer - frame_start >= 300) {
|
||||
return true;
|
||||
}
|
||||
} else {
|
||||
if (timer - frame_start >= 600) {
|
||||
return true;
|
||||
}
|
||||
}
|
||||
return false;
|
||||
}
|
||||
|
||||
void Watch_delay () {
|
||||
if (timer - delay_start >= seq_delay) {
|
||||
delaying = false;
|
||||
Frame();
|
||||
}
|
||||
}
|
||||
|
||||
void Read_timed () {
|
||||
if (!timed_paused) {
|
||||
if (timer - frame_start > timed_open
|
||||
&& timer - frame_start < timed_open + timed_delay) {
|
||||
Pause_timed();
|
||||
} else if (timer - frame_start > timed_open + timed_delay) {
|
||||
micro_position = digitalRead(PIN_MICRO);
|
||||
if (micro_position == HIGH) {
|
||||
Stop();
|
||||
}
|
||||
delay(2);//smooths out signal
|
||||
}
|
||||
}
|
||||
if (timed_paused && timer - frame_start > timed_open + timed_delay) {
|
||||
Start_timed();
|
||||
}
|
||||
}
|
||||
|
||||
void Pause_timed () {
|
||||
timed_paused = true;
|
||||
digitalWrite(STBY, LOW); //enable standby
|
||||
}
|
||||
|
||||
void Start_timed () {
|
||||
timed_paused = false;
|
||||
digitalWrite(STBY, HIGH); //disable standby
|
||||
}
|
||||
|
||||
void Read_micro () {
|
||||
if (Read_delay()) {
|
||||
micro_position = digitalRead(PIN_MICRO);
|
||||
if (micro_position == LOW
|
||||
&& micro_primed == false) {
|
||||
micro_primed = true;
|
||||
} else if (micro_position == HIGH
|
||||
&& micro_primed == true) {
|
||||
Stop();
|
||||
}
|
||||
delay(2);//smooths out signal
|
||||
}
|
||||
}
|
||||
|
||||
void Stop () {
|
||||
delay(10);
|
||||
digitalWrite(STBY, LOW); //enable standby
|
||||
|
||||
running = false;
|
||||
micro_primed = false;
|
||||
|
||||
if (cam_dir) {
|
||||
counter += 1;
|
||||
} else {
|
||||
counter -= 1;
|
||||
}
|
||||
|
||||
timed_last = timer - frame_start;
|
||||
timed_avg = (timed_avg + timed_last) / 2;
|
||||
|
||||
Serial.println(cmd_camera);
|
||||
log("Frame completed");
|
||||
log(String(timed_last));
|
||||
}
|
||||
|
||||
void cam_direction (boolean state) {
|
||||
cam_dir = state;
|
||||
if (state) {
|
||||
timed_open = 300;
|
||||
Serial.println(cmd_cam_forward);
|
||||
log("cam_direction -> true");
|
||||
} else {
|
||||
timed_open = 400;
|
||||
Serial.println(cmd_cam_backward);
|
||||
log("cam_direction -> false");
|
||||
}
|
||||
}
|
||||
void log (String msg) {
|
||||
if (debug_state) {
|
||||
Serial.println(msg);
|
||||
}
|
||||
}
|
||||
Loading…
Reference in New Issue