CEB Press Test - Selection Switching

/* Open Source Ecology CEB Press v19.01 with Arduino Uno or Mega as controller of choice.
 CC-BY-SA, GPLv3, and OSE License for Distributive Economics
 Use Mega to keep consistency with OSE D3D 3D Printer to minimize GVCS part count.
 Switches FET's HIGH/LOW to control two hydraulic solenoids,
 measures piston motion time relative to pressure sensor trigger,
 and repeats cycle while auto calibrating timing from previous cycles and startup positions.

 Extension time is measured. Orientation of machine is such that cylinder retracts to the right.
 See sequence at http://bit.ly/2Hnuk6F

 Faults should be self-resolving based on pressing sequence: pressure trigger reverses direction
 at fault point and no block results. There is one likely place for faults to occur: soil load into chamber.

 Uses HiLetgo Relay Shield 5V 4 Channel for Arduino:

 https://www.amazon.com/HiLetgo-Relay-Shield-Channel-Arduino/dp/B07F7Y55Z7/ref=sr_1_2?ie=UTF8&qid=1547696929&sr=8-2&keywords=hiletgo+relay+shield

 Note pins must be trimmed flat under Relay 1 connector and must be insulated to prevent shorts.

 Relay 1 is controlled by digital pin 7
 Relay 2 is controlled by digital pin 6
 Relay 3 is controlled by digital pin 5
 Relay 4 is controlled by digital pin 4

 A high written to a pin turns the relay ON
 A low written to a pin turns the relay OFF

 Contributions by:
 Abe Anderson
 http://opensourceecology.org/wiki/AbeAnd_Log
 Marcin Jakubowski
 http://opensourceecology.org/wiki/Marcin_Log

 Unfamiliar with code structures? See https://www.arduino.cc/en/Reference/HomePage
 */

//defines to make it easier for non-coders to make adjustments for troubleshooting and custom changes

#define SOLENOID_UP 7         //Extension. See pin mapping above.
#define SOLENOID_DOWN 6       //swap these pin numbers for wire inversion
#define SOLENOID_LEFT 5       //Extension.
#define SOLENOID_RIGHT 4      //swap these pin numbers for wire inversion

#define PRESSURE_SENSOR 13    //Needs pins adjacent to get 8-pin dupont housing for both selector and sensor
#define SELECTOR_QUARTER 12     //Second 8-pin Dupont housing for the solenoids
                              //Reset is the shutdown/initialization procedure. All procedures are selected by
#define SELECTOR_HALF 11      //the WHILE function. QUARTER to FULL refers to brick thickness.
#define SELECTOR_THREEQUARTER 10   //Secondary cylinder timing is measured only.
#define SELECTOR_FULL 9       //Primary cylinder thickness setting is based on secondary cylinder motion.

#define PRESSURE_SENSOR_DEBOUNCE 20     //milliseconds to delay for pressure sensor debounce
#define DELAY 500                       // 1/2 sec extra to compress brick via main Cyl (default 500ms)
                                        //custom function declarations
bool checkPressure();                     //function to read pressure sensor
bool resetSelected();                   //
//bool quarterSelected();               //
bool halfSelected();                    //
bool threequarterSelected();            //
bool fullSelected();                    //
                                        //Global variables
unsigned long drawerExtTime = 0;        //Time measurement for calibrating motion.
unsigned long previousMillis = 0;       //time measurement for expansion

void setup() {

  //initialize pin I/O Inputs and turn everything off to avoid startup glitches

  pinMode(PRESSURE_SENSOR, INPUT_PULLUP);
  pinMode(SELECTOR_HALF, INPUT_PULLUP);
  pinMode(SELECTOR_THREEQUARTER, INPUT_PULLUP);
  pinMode(SELECTOR_FULL, INPUT_PULLUP);
  pinMode(SOLENOID_RIGHT, OUTPUT);
  digitalWrite(SOLENOID_RIGHT, LOW);
  pinMode(SOLENOID_LEFT, OUTPUT);
  digitalWrite(SOLENOID_LEFT, LOW);
  pinMode(SOLENOID_DOWN, OUTPUT);
  digitalWrite(SOLENOID_DOWN, LOW);
  pinMode(SOLENOID_UP, OUTPUT);
  digitalWrite(SOLENOID_UP, LOW);

}

void loop() {
                                             //Step 0 Reset/Initialize - Brick pressing sequence - http://bit.ly/2Hnuk6F



while (fullSelected() == true) {          // happens when 8 is selected

    digitalWrite(SOLENOID_UP, HIGH);
    delay(1000);
    digitalWrite(SOLENOID_UP, LOW);
    delay(1000);
    digitalWrite(SOLENOID_DOWN, HIGH);
    delay(1000);
    digitalWrite(SOLENOID_DOWN, LOW);
    delay(1000);
    digitalWrite(SOLENOID_LEFT, HIGH);
    delay(1000);
    digitalWrite(SOLENOID_LEFT, LOW);
    delay(1000);
    digitalWrite(SOLENOID_RIGHT, HIGH);
    delay(1000);
    digitalWrite(SOLENOID_RIGHT, LOW);
    delay(1000);

     if (checkPressure() == false) {
      digitalWrite(SOLENOID_UP, HIGH);
      delay(2000);
      }
}


  while (threequarterSelected() == true) {               //happens when 9 is selected

    digitalWrite(SOLENOID_UP, HIGH);
    delay(500);
    digitalWrite(SOLENOID_UP, LOW);
    delay(500);
    digitalWrite(SOLENOID_DOWN, HIGH);
    delay(500);
    digitalWrite(SOLENOID_DOWN, LOW);
    delay(500);
    digitalWrite(SOLENOID_LEFT, HIGH);
    delay(500);
    digitalWrite(SOLENOID_LEFT, LOW);
    delay(500);
    digitalWrite(SOLENOID_RIGHT, HIGH);
    delay(500);
    digitalWrite(SOLENOID_RIGHT, LOW);
    delay(500);


  }

   if ( threequarterSelected() == false && fullSelected == false ) {           //happens when nothing is selected

    digitalWrite(SOLENOID_UP, HIGH);
    delay(500);
    digitalWrite(SOLENOID_UP, LOW);
    delay(500);
  }


}                                                //end of loop
                                                 //custom function definitions
                                                 //reads pressure sensor state HIGH is false and LOW is true
bool checkPressure() {
  if (digitalRead(PRESSURE_SENSOR) == HIGH) {
    delay(PRESSURE_SENSOR_DEBOUNCE);
    if (digitalRead(PRESSURE_SENSOR) == HIGH) {
      return true;
    }
    else {
      return false;
    }
  }
  else {
    return false;
  }}

  //reads selector  - HIGH is false, LOW is true- SELECTOR_RESET, SELECTOR_QUARTER, SELECTOR_HALF, SELECTOR_3QUARTERS, SELECTOR_FULL,
  bool resetSelected() {
    if (threequarterSelected() == false && halfSelected() == false && fullSelected() == false) {
      return true;
    }
    else {
      return false;
    }}

  bool halfSelected() {
  if (digitalRead(SELECTOR_HALF) == HIGH) {
    delay(PRESSURE_SENSOR_DEBOUNCE);
    if (digitalRead(SELECTOR_HALF) == HIGH) {
      return false;
    }
    else {
      return true;
    }
  }
  else {
    return true;
  }}

  bool threequarterSelected() {
  if (digitalRead(SELECTOR_THREEQUARTER) == HIGH) {
    delay(PRESSURE_SENSOR_DEBOUNCE);
    if (digitalRead(SELECTOR_THREEQUARTER) == HIGH) {
      return false;
    }
    else {
      return true;
    }
  }
  else {
    return true;
  }}

    bool fullSelected() {
  if (digitalRead(SELECTOR_FULL) == HIGH) {
    delay(PRESSURE_SENSOR_DEBOUNCE);
    if (digitalRead(SELECTOR_FULL) == HIGH) {
      return false;
    }
    else {
      return true;
    }
  }
  else {
    return true;
  }}