Sketchfabのslimercorpによるフィッティング/チョーク

#include <Ultrasonic.h> #include <plcStandardLib_1.h> //============================================================= //      R_TRIG R_TRIG1; R_TRIG R_TRIG2; R_TRIG R_TRIG3; R_TRIG R_TRIG4; F_TRIG F_TRIG1; bool TrashFull; //    bool igotit; //   ,     bool check_pls; //      bool PumpUp; //        bool NoFlow; //      bool Pressed; //     bool beep_pause_superlong; //     bool beep_pause_superlong_end; //       bool beep_pause_long; //    bool beep_pause_long_end; //     bool beep_pause_short; //    bool beep_pause_short_end; //    bool beep_on; //      bool beep_duration_end; //   bool beep_granted; //    bool Pressed_now; //    bool UnPressed_now; //    bool time_end; //   bool reset; //     int mode; //  int error; //  int n_pressed; //    2  int k_beep; //     float us_level_raw; //    ,     float us_level_filt; ////    ,       float level; //   float level0; //       long t0; //         long time_to_destroy; //           2  //============================================================= //============================================================= //  Ultrasonic ultrasonic(4, 3); // 3 - Echo, 4 - Trig const int LevelTrashPin = 2; //      const int RelayPin = 5; //    const int BeepPin = 6; //   const int ButtonPin = 7; //  //============================================================= //============================================================= //  //    TON TON1(50); //   50,  //      TON TON2(50); //   50,   TOF TOF1(50); //   50,  TON TON3(10000); //   10 ,       TON TON4(1500); //   1.5,    TON TON5(1500); //   1.5,     TON TON6(10000); //   10 ,     TON TON7(60000); //   1 ,     TON TON8(1000); //   1 ,   DEBUG INFO TON TON9(500); //   0.5 ,     //============================================================= //============================================================= // ,   const int f_mode=500; //        const int f_error=100; //     const int t_nc=5000; //          (time_no_control) const int dLevel_cp=3; //         (cp - control period) const int button_cp=3000; //      const float w_level=0.3; //   const float us_level_filt_fault=0.1; //          const float HeightTank = 20; //    const float HighLevel = 15; //    const float LowLevel = 3; //    const bool debug_on=true; //    Serial //============================================================= void setup() { Serial.begin(9600); //     :  COM    . pinMode(LevelTrashPin, INPUT_PULLUP); pinMode(RelayPin, OUTPUT); pinMode(BeepPin, OUTPUT); pinMode(ButtonPin,INPUT_PULLUP); igotit=false; check_pls=false; NoFlow=false; beep_pause_long=false; beep_pause_short=false; beep_on=false; beep_pause_superlong=false; beep_pause_long=false; beep_pause_short=false; beep_on=false; k_beep=0; t0=millis(); mode=1; tone(BeepPin,f_mode,1000); //   ,   } void loop() { //============================================================= //   // -  ,  -  ,  -  . //   ,          TrashFull=TON1.Run((digitalRead(LevelTrashPin))); //      //  ,   ,      //   -     //   -     //    ,       -  // -    ,      , //      ()  //     ()  if (TOF1.Run((digitalRead(ButtonPin)))==false) {Pressed=true;} if (TON2.Run((digitalRead(ButtonPin)))==true) {Pressed=false;} //     if (TON9.Run(!TON9.Q)) {us_level_raw=ultrasonic.distanceRead();}; us_level_filt=(1-w_level)*us_level_filt+w_level*us_level_raw; //     0  HeightTank  ; level=constrain((HeightTank-us_level_filt), 0, HeightTank) ; //============================================================= //============================================================= //    //NoFlow,igotit,check_pls //          dLevel_cp   . //   ,       ,      time_end=TON3.Run(PumpUp && !reset); if ((R_TRIG1.Run(PumpUp)==true) | (reset==true)) {level0=level;} //     if ((time_end==true) && (level-level0<dLevel_cp)) {NoFlow=true;} else {NoFlow=false;} //      if ((time_end==true) && (NoFlow==false)) {reset=true;} else {reset=false;} //       //         .        Pressed_now=R_TRIG2.Run(Pressed); //    UnPressed_now=F_TRIG1.Run(Pressed); //    if ((mode==2) | (mode==3)) { time_to_destroy=(button_cp-(millis()-t0)); // button_cp   0     if ((Pressed_now==true) && (n_pressed==0) && (time_to_destroy<0)) {t0=millis();} //          if ((UnPressed_now==true) && (time_to_destroy>=0)) {n_pressed=n_pressed+1;} //     if (time_to_destroy<0) {n_pressed=0;} } //   - "i got it"/ .         //     ,    .     : //  1   3  if ((mode==2) && (n_pressed==1)) {igotit=true; n_pressed==0;} //   - "check_pls"/ .         //                //  .     : //  2   3  if ((mode==3) && (n_pressed==2)) {check_pls=true; n_pressed==0;} //============================================================= //============================================================= //   //         ,          1 if ((mode==1) && (TrashFull==true) && (millis()>t_nc)) {mode=2; error=1;} //         ,          2 if ((mode==1) && (us_level_filt<us_level_filt_fault) && (millis()>t_nc)) {mode=2; error=2;} //       ,          3 if ((mode==1) && (NoFlow==true) && (millis()>t_nc)) {mode=2; error=3;} //        -         if ((mode==2) && (igotit==true)) {mode=3; error=0; igotit=false;} //                       if ((mode==3) && (check_pls==true)) {mode=1; check_pls=false;} //============================================================= //============================================================= //       // : 1 -  , ; 2 - ,  ; 3 -  ,    ; if (mode==1) { //  if (level<=LowLevel) {PumpUp=true;} //   -   if (level>HighLevel) {PumpUp=false;} //   -   } if ((mode==2) | (mode==3)) {PumpUp=false;} //       //============================================================= //============================================================= //      (Digital Output) //      if (PumpUp==true) {digitalWrite(RelayPin, LOW);} else {digitalWrite(RelayPin, HIGH);} //      delay,          //    1-   ,   ,   if (R_TRIG3.Run(mode==1)==true) {tone(BeepPin,f_mode,1000); beep_on=false; beep_pause_short=false; beep_pause_long=false; beep_pause_superlong=false; k_beep=0;} beep_duration_end=TON4.Run(beep_on); //   beep_pause_short_end=TON5.Run(beep_pause_short); //    beep_pause_long_end=TON6.Run(beep_pause_long); //    beep_pause_superlong_end=TON7.Run(beep_pause_superlong); //     //   2-,      if (mode==2) { // : beep_granted=!beep_pause_long && !beep_pause_short && (k_beep<error); //     if (beep_granted==true) {tone(BeepPin, f_error); beep_on=true;} //   ,  ,   ,    -      if (beep_duration_end==true) { noTone(BeepPin); k_beep=k_beep+1; //-   beep_on=false; //   if (error>k_beep) {beep_pause_short=true; beep_pause_long=false;} else {beep_pause_long=true; beep_pause_short=false;} } //   ,   if (beep_pause_short_end==true) {beep_pause_short=false;} //   ,   if (beep_pause_long_end==true) {beep_pause_long=false; k_beep=0;} } //    ,       if (R_TRIG4.Run(mode==3)==true) {tone(BeepPin,f_mode,1000); beep_on=false; beep_pause_short=false; beep_pause_long=false; beep_pause_superlong=true;} //     ,      if (mode==3) { beep_granted=!beep_pause_superlong; //          1  if (beep_granted==true) {tone(BeepPin, f_error); beep_on=true;} //   ,    if (beep_duration_end==true) { noTone(BeepPin); beep_on=false; //   beep_pause_superlong=true; } //   ,   if (beep_pause_superlong_end==true) {beep_pause_superlong=false;} } //============================================================= //============================================================= // Debug,     if ((debug_on==true) && (TON8.Run(!TON8.Q))) { //    Serial.write(27); Serial.print("[2J"); // clear screen Serial.write(27); Serial.print("[H"); // cursor to home //        Serial.println("=================Debug info of ArduOsch================="); Serial.println("=================DicreteInputs=========================="); Serial.print("LevelTrashPin="); Serial.print((digitalRead(LevelTrashPin))); Serial.print("| ButtonPin="); Serial.print(digitalRead(ButtonPin)); Serial.print("| US_raw="); Serial.print(us_level_raw); Serial.print("| US_filtered="); Serial.println(us_level_filt); Serial.println("=================DicreteInputs after processing========="); Serial.print("TrashFull="); Serial.print(TrashFull); Serial.print("| ButtonPressed="); Serial.print(Pressed); Serial.print("| Level="); Serial.println(level); Serial.println("=================NoFlow condition======================="); Serial.print("PumpUp="); Serial.print(PumpUp); Serial.print(" Time_end="); Serial.print(time_end); Serial.print(" Reset="); Serial.print(reset); Serial.print("| Level0==="); Serial.print(level0); Serial.print("| TON3_EST="); Serial.print(TON3.PT-TON3.ET); Serial.print("| NoFlow="); Serial.println(NoFlow); Serial.println("=================How mush was man clicked on button?===="); Serial.print("TimeToDestroy="); Serial.print(time_to_destroy); Serial.print("| t0="); Serial.print(t0); Serial.print("| n_pressed="); Serial.println(n_pressed); Serial.println("=================What is the system state?=============="); Serial.print("Mode="); Serial.print(mode); Serial.print("| error="); Serial.println(error); Serial.println("=================Beep code=============="); Serial.print("beep_granted="); Serial.print(beep_granted); Serial.print("| beep_pause_superlong="); Serial.print(beep_pause_superlong); Serial.print("| beep_pause_long="); Serial.print(beep_pause_long); Serial.print("| beep_pause_short="); Serial.println(beep_pause_short); Serial.print("k_beep="); Serial.print(k_beep); Serial.print("| beep_on="); Serial.println(beep_on); } //============================================================= }