Code cleanup

This commit is contained in:
Matt 2016-03-18 18:05:56 -04:00
parent f5facf735e
commit 58ab992ab9
1 changed files with 14 additions and 24 deletions

View File

@ -1,6 +1,6 @@
//Intval for pro trinket arduinos //Intval for pro trinket arduinos
//Using 12vdc motors in place of a stepper //Using 12vdc motors in place of a stepper
//HBridge for motor control //L289N HBridge for motor control
//Microswitch for control //Microswitch for control
/* /*
@ -18,22 +18,8 @@ GND-----\ | \-----PIN
const int PIN_INDICATOR = 13; const int PIN_INDICATOR = 13;
const int PIN_MOTOR_FORWARD = 9; const int PIN_MOTOR_FORWARD = 9;
const int PIN_MOTOR_BACKWARD = 10; const int PIN_MOTOR_BACKWARD = 10;
//const int PIN_MICRO = 12;
const int PIN_MICRO = 19; //laser cut version const int PIN_MICRO = 19; //laser cut version
const int BUTTON[4] = {3, 6, 5, 4}; //trigger, direction, speed, delay const int BUTTON[4] = {3, 6, 5, 4}; //trigger, direction, speed, delay
/*
//Trinket
const int PIN_INDICATOR = 13;
const int PIN_MOTOR_FORWARD = 9;
const int PIN_MOTOR_BACKWARD = 10;
const int PIN_MICRO = 12;
const int BUTTON[4] = {3, 6, 5, 4}; //trigger, direction, speed, delay
*/
volatile int button_state[4] = {1, 1, 1, 1};
volatile long button_time[4] = {0, 0, 0, 0};
volatile long buttontime = 0;
/* ------------------------------------------------ /* ------------------------------------------------
* loop * loop
@ -43,8 +29,12 @@ const int LOOP_DELAY = 10;
/* ------------------------------------------------ /* ------------------------------------------------
* state * state
* ------------------------------------------------*/ * ------------------------------------------------*/
volatile int FWD_SPEED = 255; volatile int button_state[4] = {1, 1, 1, 1};
volatile int BWD_SPEED = 255; volatile long button_time[4] = {0, 0, 0, 0};
volatile long buttontime = 0;
volatile int fwd_speed = 255;
volatile int bwd_speed = 255;
volatile boolean sequence = false; volatile boolean sequence = false;
volatile boolean running = false; volatile boolean running = false;
@ -89,14 +79,14 @@ void Frame (boolean dir) {
Time_start(); Time_start();
cam_dir = dir; cam_dir = dir;
if (cam_dir) { if (cam_dir) {
analogWrite(PIN_MOTOR_FORWARD, FWD_SPEED); analogWrite(PIN_MOTOR_FORWARD, fwd_speed);
analogWrite(PIN_MOTOR_BACKWARD, 0); analogWrite(PIN_MOTOR_BACKWARD, 0);
} else { } else {
analogWrite(PIN_MOTOR_BACKWARD, BWD_SPEED); analogWrite(PIN_MOTOR_BACKWARD, bwd_speed);
analogWrite(PIN_MOTOR_FORWARD, 0); analogWrite(PIN_MOTOR_FORWARD, 0);
} }
running = true; running = true;
if (FWD_SPEED == 255) { if (fwd_speed == 255) {
delay(300); delay(300);
} else { } else {
delay(600); delay(600);
@ -206,12 +196,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 = 255;
BWD_SPEED = 255; bwd_speed = 255;
Output(1, 500); Output(1, 500);
} else if (buttontime > 1000) { } else if (buttontime > 1000) {
FWD_SPEED = 127; fwd_speed = 127;
BWD_SPEED = 127; bwd_speed = 127;
Output(2, 250); Output(2, 250);
} }
} else if (index == 3) { //set delay } else if (index == 3) { //set delay