Sequence no longer ends with an erroneous frame
Moved the sequence start and stop logic into the button_end function. This will allow the sequence to stop without firing a final frame after the sequence is done. Also added variables to define the speed of the motors a little more easily.
This commit is contained in:
parent
59a696f6aa
commit
ed075bbfa9
|
@ -10,6 +10,8 @@ GND-----\ | \-----PIN
|
||||||
----------------------------------------------------
|
----------------------------------------------------
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
const int FAST_PWM = 255;
|
||||||
|
const int SLOW_PWM = SLOW_PWM;
|
||||||
|
|
||||||
/* ------------------------------------------------
|
/* ------------------------------------------------
|
||||||
* pins
|
* pins
|
||||||
|
@ -33,8 +35,8 @@ volatile int button_state[4] = {1, 1, 1, 1};
|
||||||
volatile long button_time[4] = {0, 0, 0, 0};
|
volatile long button_time[4] = {0, 0, 0, 0};
|
||||||
volatile long buttontime = 0;
|
volatile long buttontime = 0;
|
||||||
|
|
||||||
volatile int fwd_speed = 255;
|
volatile int fwd_speed = FAST_PWM;
|
||||||
volatile int bwd_speed = 255;
|
volatile int bwd_speed = FAST_PWM;
|
||||||
|
|
||||||
volatile boolean sequence = false;
|
volatile boolean sequence = false;
|
||||||
volatile boolean running = false;
|
volatile boolean running = false;
|
||||||
|
@ -59,17 +61,16 @@ void setup () {
|
||||||
}
|
}
|
||||||
|
|
||||||
void loop () {
|
void loop () {
|
||||||
|
timer = millis();
|
||||||
Btn(0);
|
Btn(0);
|
||||||
Btn(1);
|
Btn(1);
|
||||||
Btn(2);
|
Btn(2);
|
||||||
Btn(3);
|
Btn(3);
|
||||||
if (running) {
|
|
||||||
timer = millis();
|
|
||||||
if (sequence && delaying) {
|
if (sequence && delaying) {
|
||||||
Watch_delay();
|
Watch_delay();
|
||||||
} else {
|
|
||||||
Read_micro();
|
|
||||||
}
|
}
|
||||||
|
if (running) {
|
||||||
|
Read_micro();
|
||||||
} else {
|
} else {
|
||||||
delay(LOOP_DELAY);
|
delay(LOOP_DELAY);
|
||||||
}
|
}
|
||||||
|
@ -96,7 +97,7 @@ void Frame () {
|
||||||
}
|
}
|
||||||
|
|
||||||
boolean Read_delay () {
|
boolean Read_delay () {
|
||||||
if (fwd_speed == 255) {
|
if (fwd_speed == FAST_PWM) {
|
||||||
if (timer - frame_start >= 300) {
|
if (timer - frame_start >= 300) {
|
||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
|
@ -169,7 +170,7 @@ void Btn (int index) {
|
||||||
if (val != button_state[index]) {
|
if (val != button_state[index]) {
|
||||||
if (val == LOW) { // pressed
|
if (val == LOW) { // pressed
|
||||||
button_time[index] = millis();
|
button_time[index] = millis();
|
||||||
button_start(index);
|
//button_start(index);
|
||||||
} else if (val == HIGH) { // not pressed
|
} else if (val == HIGH) { // not pressed
|
||||||
buttontime = millis() - button_time[index];
|
buttontime = millis() - button_time[index];
|
||||||
button_end(index, buttontime);
|
button_end(index, buttontime);
|
||||||
|
@ -178,26 +179,29 @@ void Btn (int index) {
|
||||||
button_state[index] = val;
|
button_state[index] = val;
|
||||||
}
|
}
|
||||||
|
|
||||||
void button_start (int index) {
|
/*
|
||||||
|
* dormant for now
|
||||||
|
* void button_start (int index) {
|
||||||
if (index == 0) {
|
if (index == 0) {
|
||||||
if (sequence) {
|
|
||||||
sequence = false;
|
|
||||||
Output(2, 250);
|
|
||||||
}
|
}
|
||||||
}
|
}*/
|
||||||
}
|
|
||||||
|
|
||||||
void button_end (int index, long buttontime) {
|
void button_end (int index, long buttontime) {
|
||||||
if (index == 0) {
|
if (index == 0) {
|
||||||
if (buttontime > 1000) {
|
if (buttontime > 1000) {
|
||||||
if (!sequence) {
|
if (!sequence) {
|
||||||
sequence = true;
|
sequence = true;
|
||||||
Output(2, 250);
|
Output(2, 75);
|
||||||
}
|
|
||||||
Frame();
|
Frame();
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
if (sequence) {
|
||||||
|
sequence = false;
|
||||||
|
//Output(2, 75);
|
||||||
} else {
|
} else {
|
||||||
Frame();
|
Frame();
|
||||||
}
|
}
|
||||||
|
}
|
||||||
} else if (index == 1) { //set direction
|
} else if (index == 1) { //set direction
|
||||||
if (buttontime < 1000) {
|
if (buttontime < 1000) {
|
||||||
cam_dir = true;
|
cam_dir = true;
|
||||||
|
@ -208,12 +212,12 @@ void button_end (int index, long buttontime) {
|
||||||
}
|
}
|
||||||
} else if (index == 2) { // set speed
|
} else if (index == 2) { // set speed
|
||||||
if (buttontime <= 1000) {
|
if (buttontime <= 1000) {
|
||||||
fwd_speed = 255;
|
fwd_speed = FAST_PWM;
|
||||||
bwd_speed = 255;
|
bwd_speed = FAST_PWM;
|
||||||
Output(1, 500);
|
Output(1, 500);
|
||||||
} else if (buttontime > 1000) {
|
} else if (buttontime > 1000) {
|
||||||
fwd_speed = 127;
|
fwd_speed = SLOW_PWM;
|
||||||
bwd_speed = 127;
|
bwd_speed = SLOW_PWM;
|
||||||
Output(2, 250);
|
Output(2, 250);
|
||||||
}
|
}
|
||||||
} else if (index == 3) { //set delay
|
} else if (index == 3) { //set delay
|
||||||
|
|
Loading…
Reference in New Issue