API tools faq
paste
Advertisement
Guest User

machine program

a guest
Dec 17th, 2019
222
0
Never
Add comment
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 25.45 KB | None | 0 0
raw download clone embed print report
  1. //u/Mayl00
  2. #include <AccelStepper.h>
  3. #include <SoftwareSerial.h>
  4. AccelStepper stepper1(AccelStepper::DRIVER, 3, 4);
  5. AccelStepper stepper2(AccelStepper::DRIVER, 5, 6);
  6. #include <LCD.h>
  7. #include <Wire.h>
  8. #include <LiquidCrystal_I2C.h>
  9. LiquidCrystal_I2C lcd(0x27, 2, 1, 0, 4, 5, 6, 7);
  10.  
  11. int Sound = 7;
  12. int Listen = 8;
  13. int knop = 2;
  14. ////////////////////////Variables////////////////////////////////////
  15. int commando; //app commando
  16. int nummer; //random nummer
  17. long initialhoming = -1;
  18.  
  19. float distance;
  20. float duration;
  21. ////////////////////////Posities////////////////////////////////////
  22. int Home = 0;
  23. int posCola = 57;
  24. int posFanta = 817;
  25. int posBacardi = 1550;
  26. int posRaz = 2250;
  27. int posJD = 3050;
  28. int posVodka = 3780;
  29. int dispensen = 1200;
  30.  
  31. void setup() {
  32.   Serial.begin(9600);
  33.   Serial2.begin(9600);
  34.   lcd.begin(20, 4);
  35.   lcd.clear();
  36.   lcd.setBacklightPin(3, POSITIVE);
  37.   lcd.setBacklight(HIGH);
  38.  
  39.   pinMode(knop, INPUT_PULLUP);
  40.   pinMode(Sound, OUTPUT);
  41.   pinMode(Listen, INPUT);
  42.   delay(5);
  43.   ////////////////////////////Base configure/////////////////////////////////////
  44.   lcd.clear();
  45.   lcd.setCursor(0, 0);
  46.   lcd.print("Configureren..");
  47.   Serial.println("Going to configure base");
  48.  
  49.   stepper1.setCurrentPosition(0);
  50.   stepper1.setMaxSpeed(300);
  51.   stepper1.setAcceleration(800);
  52.   while (digitalRead(knop)) {
  53.     stepper1.moveTo(initialhoming);
  54.     stepper1.run();
  55.     initialhoming--;
  56.     delay(5);
  57.   }
  58.   stepper1.setCurrentPosition(0);
  59.   stepper1.setMaxSpeed(100);
  60.   stepper1.setAcceleration(0);
  61.   initialhoming = 1;
  62.  
  63.   while (!digitalRead(knop)) {
  64.     stepper1.moveTo(initialhoming);
  65.     stepper1.run();
  66.     initialhoming++;
  67.     delay(5);
  68.   }
  69.   stepper1.setCurrentPosition(0);
  70.   stepper1.setMaxSpeed(800);
  71.   stepper1.setAcceleration(700);
  72.  
  73.   stepper2.setCurrentPosition(0);
  74.   stepper2.setMaxSpeed(1000);
  75.   stepper2.setAcceleration(750);
  76.   ////////////////////////////////////Done///////////////////////////////////////
  77.   Serial.println("Base is configured!");
  78.   while (Serial2.available())
  79.     Serial2.read();
  80.  
  81.   lcd.clear();
  82.   lcd.setCursor(0, 0);
  83.   lcd.print("Maak uw keuze");
  84. }
  85.  
  86. void loop() {
  87.  
  88.   ///////////////////////////////////////////////////////////////////////////////////////////
  89.   if (Serial2.available() > 0) {
  90.     commando = Serial2.read();
  91.     Serial.println("Commando binnengekregen");
  92.  
  93.     switch (commando) {
  94.  
  95.       case 'A':///////////////////////////////Standaard drankjes///////////////////////////////////
  96.         Serial.println("reading Cola");
  97.         lcd.clear();
  98.         lcd.setCursor(0, 0);
  99.         lcd.print("Keuze:");
  100.         lcd.setCursor(0, 1);
  101.         lcd.print("Cola");
  102.         lcd.setCursor(0, 2);
  103.         lcd.print("Goede keuze!");
  104.         GlasNeerzetten();
  105.         Cola();
  106.         GlasWeghalen();
  107.         break;
  108.  
  109.       case 'B':
  110.         Serial.println("reading Fanta");
  111.         lcd.clear();
  112.         lcd.setCursor(0, 0);
  113.         lcd.print("Keuze:");
  114.         lcd.setCursor(0, 1);
  115.         lcd.print("Fanta");
  116.         lcd.setCursor(0, 2);
  117.         lcd.print("Mooie keuze!");
  118.         GlasNeerzetten();
  119.         Fanta();
  120.         GlasWeghalen();
  121.         break;
  122.  
  123.       case 'C'://////////////////////////////////BACARDI REEKS/////////////////////////////////////
  124.         Serial.println("reading Baco");
  125.         lcd.clear();
  126.         lcd.setCursor(0, 0);
  127.         lcd.print("Keuze:");
  128.         lcd.setCursor(0, 1);
  129.         lcd.print("Baco");
  130.         lcd.setCursor(0, 2);
  131.         lcd.print("Ga ik maken voor je");
  132.         GlasNeerzetten();
  133.         Baco();
  134.         GlasWeghalen();
  135.         break;
  136.  
  137.       case 'D':
  138.         Serial.println("reading BacoX");
  139.         lcd.clear();
  140.         lcd.setCursor(0, 0);
  141.         lcd.print("Keuze:");
  142.         lcd.setCursor(0, 1);
  143.         lcd.print("Baco extra sterk");
  144.         lcd.setCursor(0, 2);
  145.         lcd.print("Zuiplap");
  146.         GlasNeerzetten();
  147.         BacoX();
  148.         GlasWeghalen();
  149.         break;
  150.  
  151.       case 'E':
  152.         Serial.println("reading Bafa");
  153.         lcd.clear();
  154.         lcd.setCursor(0, 0);
  155.         lcd.print("Keuze:");
  156.         lcd.setCursor(0, 1);
  157.         lcd.print("Bacardi Fanta");
  158.         lcd.setCursor(0, 2);
  159.         lcd.print("Komt voor mekaar!");
  160.         GlasNeerzetten();
  161.         Bafa();
  162.         GlasWeghalen();
  163.         break;
  164.  
  165.       case 'F':
  166.         Serial.println("reading BafaX");
  167.         lcd.clear();
  168.         lcd.setCursor(0, 0);
  169.         lcd.print("Keuze:");
  170.         lcd.setCursor(0, 1);
  171.         lcd.print("Bafa extra sterk");
  172.         lcd.setCursor(0, 2);
  173.         lcd.print("Zuipschuit");
  174.         GlasNeerzetten();
  175.         BafaX();
  176.         GlasWeghalen();
  177.         break;
  178.  
  179.       case 'G'://////////////////////////////////BACARDI RAZ REEKS/////////////////////////////////////
  180.         Serial.println("reading RazCo");
  181.         lcd.clear();
  182.         lcd.setCursor(0, 0);
  183.         lcd.print("Keuze:");
  184.         lcd.setCursor(0, 1);
  185.         lcd.print("Raz cola");
  186.         lcd.setCursor(0, 2);
  187.         lcd.print("Ga ik maken voor je");
  188.         GlasNeerzetten();
  189.         RazCo();
  190.         GlasWeghalen();
  191.         break;
  192.  
  193.       case 'H':
  194.         Serial.println("reading RazCoX");
  195.         lcd.clear();
  196.         lcd.setCursor(0, 0);
  197.         lcd.print("Keuze:");
  198.         lcd.setCursor(0, 1);
  199.         lcd.print("Raz cola extra sterk");
  200.         lcd.setCursor(0, 2);
  201.         lcd.print("Komt voor mekaar");
  202.         GlasNeerzetten();
  203.         RazCoX();
  204.         GlasWeghalen();
  205.         break;
  206.  
  207.       case 'I':
  208.         Serial.println("reading RazFa");
  209.         lcd.clear();
  210.         lcd.setCursor(0, 0);
  211.         lcd.print("Keuze:");
  212.         lcd.setCursor(0, 1);
  213.         lcd.print("Raz Fanta");
  214.         lcd.setCursor(0, 2);
  215.         lcd.print("Lekkere keuze!");
  216.         GlasNeerzetten();
  217.         RazFa();
  218.         GlasWeghalen();
  219.         break;
  220.  
  221.       case 'J':
  222.         Serial.println("reading RazFaX");
  223.         lcd.clear();
  224.         lcd.setCursor(0, 0);
  225.         lcd.print("Keuze:");
  226.         lcd.setCursor(0, 1);
  227.         lcd.print("Raz Fanta extra sterk");
  228.         lcd.setCursor(0, 2);
  229.         lcd.print("Ga ik maken voor je");
  230.         GlasNeerzetten();
  231.         RazFaX();
  232.         GlasWeghalen();
  233.         break;
  234.  
  235.       case 'K'://////////////////////////////////JACK DANIELS REEKS/////////////////////////////////////
  236.         Serial.println("reading JD");
  237.         lcd.clear();
  238.         lcd.setCursor(0, 0);
  239.         lcd.print("Keuze:");
  240.         lcd.setCursor(0, 1);
  241.         lcd.print("Enkele Jack Daniels");
  242.         lcd.setCursor(0, 2);
  243.         lcd.print("Ik ga aan de slag");
  244.         GlasNeerzetten();
  245.         JD();
  246.         GlasWeghalen();
  247.         break;
  248.  
  249.       case 'L':
  250.         Serial.println("reading JDX");
  251.         lcd.clear();
  252.         lcd.setCursor(0, 0);
  253.         lcd.print("Keuze:");
  254.         lcd.setCursor(0, 1);
  255.         lcd.print("Dubbele Jack Daniels");
  256.         lcd.setCursor(0, 2);
  257.         lcd.print("Beter dan een enkel!");
  258.         GlasNeerzetten();
  259.         JDX();
  260.         GlasWeghalen();
  261.         break;
  262.  
  263.       case 'M':
  264.         Serial.println("reading JackCola");
  265.         lcd.clear();
  266.         lcd.setCursor(0, 0);
  267.         lcd.print("Keuze:");
  268.         lcd.setCursor(0, 1);
  269.         lcd.print("JackCola");
  270.         lcd.setCursor(0, 2);
  271.         lcd.print("Komt voor mekaar!");
  272.         GlasNeerzetten();
  273.         JackCola();
  274.         GlasWeghalen();
  275.         break;
  276.  
  277.       case 'N':
  278.         Serial.println("JackColaX");
  279.         lcd.clear();
  280.         lcd.setCursor(0, 0);
  281.         lcd.print("Keuze:");
  282.         lcd.setCursor(0, 1);
  283.         lcd.print("JackCola extra sterk");
  284.         lcd.setCursor(0, 2);
  285.         lcd.print("Niet teveel h??");
  286.         GlasNeerzetten();
  287.         JackColaX();
  288.         GlasWeghalen();
  289.         break;
  290.  
  291.       case 'O'://////////////////////////////////VODKA REEKS/////////////////////////////////////
  292.         Serial.println("reading VodCo");
  293.         lcd.clear();
  294.         lcd.setCursor(0, 0);
  295.         lcd.print("Keuze:");
  296.         lcd.setCursor(0, 1);
  297.         lcd.print("VodkaCola");
  298.         lcd.setCursor(0, 2);
  299.         lcd.print("Komt voor mekaar!");
  300.         GlasNeerzetten();
  301.         VodCo();
  302.         GlasWeghalen();
  303.         break;
  304.  
  305.       case 'P':
  306.         Serial.println("reading VodCoX");
  307.         lcd.clear();
  308.         lcd.setCursor(0, 0);
  309.         lcd.print("Keuze:");
  310.         lcd.setCursor(0, 1);
  311.         lcd.print("VodCo extra sterk");
  312.         lcd.setCursor(0, 2);
  313.         lcd.print("Oke, ga ik doen!");
  314.         GlasNeerzetten();
  315.         VodCoX();
  316.         GlasWeghalen();
  317.         break;
  318.  
  319.       case 'Q':
  320.         Serial.println("reading VodFa");
  321.         lcd.clear();
  322.         lcd.setCursor(0, 0);
  323.         lcd.print("Keuze:");
  324.         lcd.setCursor(0, 1);
  325.         lcd.print("VodkaFanta");
  326.         lcd.setCursor(0, 2);
  327.         lcd.print("Ga ik maken voor je!");
  328.         GlasNeerzetten();
  329.         VodFa();
  330.         GlasWeghalen();
  331.         break;
  332.  
  333.       case 'R':
  334.         Serial.println("reading VodFaX");
  335.         lcd.clear();
  336.         lcd.setCursor(0, 0);
  337.         lcd.print("Keuze:");
  338.         lcd.setCursor(0, 1);
  339.         lcd.print("VodFa extra sterk");
  340.         lcd.setCursor(0, 2);
  341.         lcd.print("Komt voor mekaar!");
  342.         GlasNeerzetten();
  343.         VodFaX();
  344.         GlasWeghalen();
  345.         break;
  346.     }
  347.   }
  348. }
  349.  
  350.  
  351. void Cola() {////////////////////////////////STANDAARD REEKS////////////////////////////////////
  352.   Serial.println("Doing Cola");
  353.   lcd.setCursor(0, 2);
  354.   lcd.print("Aan het werk..      ");
  355.   stepper1.runToNewPosition(posCola);
  356.   Serial.println("Platform staat onder Cola, dispensen..");
  357.   stepper2.runToNewPosition(dispensen);
  358.   delay(2700);
  359.   stepper2.runToNewPosition(Home);
  360.   delay(2000);
  361.   Frisdrank();
  362.   Serial.println("Dispensen voltooid.");
  363.   stepper1.runToNewPosition(Home);
  364.   Serial.println("Cola taak voltooid!");
  365.   while (Serial2.available())
  366.     Serial2.read();
  367. }
  368.  
  369. void Fanta() {
  370.   Serial.println("Doing Fanta");
  371.   lcd.setCursor(0, 2);
  372.   lcd.print("Aan het werk..      ");
  373.   stepper1.runToNewPosition(posFanta);
  374.   Serial.println("Platform staat onder Fanta, dispensen..");
  375.   stepper2.runToNewPosition(dispensen);
  376.   delay(2700);
  377.   stepper2.runToNewPosition(Home);
  378.   delay(2000);
  379.   Frisdrank();
  380.   Serial.println("Dispensen voltooid.");
  381.   stepper1.runToNewPosition(Home);
  382.   Serial.println("Fanta taak voltooid!");
  383.   while (Serial2.available())
  384.     Serial2.read();
  385. }
  386.  
  387. void Baco() {//////////////////////////////////BACARDI REEKS/////////////////////////////////////
  388.   Serial.println("Doing Baco");
  389.   lcd.setCursor(0, 2);
  390.   lcd.print("Aan het werk..      ");
  391.   stepper1.runToNewPosition(posBacardi);
  392.   Serial.println("Platform staat onder Bacardi, dispensen..");
  393.   stepper2.runToNewPosition(dispensen);
  394.   delay(1000);
  395.   stepper2.runToNewPosition(Home);
  396.   Serial.println("Dispensen voltooid. op naar de volgende!");
  397.   stepper1.runToNewPosition(posCola);
  398.   Serial.println("Platform staat onder Cola, dispensen..");
  399.   Frisdrank();
  400.   Serial.println("Dispensen voltooid.");
  401.   stepper1.runToNewPosition(Home);
  402.   Serial.println("Baco taak voltooid!");
  403.   while (Serial2.available())
  404.     Serial2.read();
  405. }
  406.  
  407.  
  408. void BacoX() {
  409.   Serial.println("Doing Dubbele baco");
  410.   lcd.setCursor(0, 2);
  411.   lcd.print("Aan het werk..      ");
  412.   stepper1.runToNewPosition(posBacardi);
  413.   Serial.println("Platform staat onder Bacardi, dispensen..");
  414.   stepper2.runToNewPosition(dispensen);
  415.   delay(1000);
  416.   stepper2.runToNewPosition(Home);
  417.   Serial.println("Dat is 1..");
  418.   delay(500);
  419.   stepper2.runToNewPosition(dispensen);
  420.   delay(1000);
  421.   stepper2.runToNewPosition(Home);
  422.   Serial.println("Dispensen voltooid. op naar de volgende!");
  423.   stepper1.runToNewPosition(posCola);
  424.   Serial.println("Platform staat onder Cola, dispensen..");
  425.   Frisdrank();
  426.   Serial.println("Dispensen voltooid.");
  427.   stepper1.runToNewPosition(Home);
  428.   Serial.println("Baco taak voltooid!");
  429.   while (Serial2.available())
  430.     Serial2.read();
  431. }
  432.  
  433. void Bafa() {
  434.   Serial.println("Doing Bacardi Fanta");
  435.   lcd.setCursor(0, 2);
  436.   lcd.print("Aan het werk..      ");
  437.   stepper1.runToNewPosition(posBacardi);
  438.   Serial.println("Platform staat onder Bacardi, dispensen..");
  439.   stepper2.runToNewPosition(dispensen);
  440.   delay(1000);
  441.   stepper2.runToNewPosition(Home);
  442.   Serial.println("Dispensen voltooid. op naar de volgende!");
  443.   stepper1.runToNewPosition(posFanta);
  444.   Serial.println("Platform staat onder Fanta, dispensen..");
  445.   Frisdrank();
  446.   Serial.println("Dispensen voltooid.");
  447.   stepper1.runToNewPosition(Home);
  448.   Serial.println("Bafa taak voltooid!");
  449.   while (Serial2.available())
  450.     Serial2.read();
  451. }
  452.  
  453. void BafaX() {
  454.   Serial.println("Doing Dubbele Bafa");
  455.   lcd.setCursor(0, 2);
  456.   lcd.print("Aan het werk..      ");
  457.   stepper1.runToNewPosition(posBacardi);
  458.   Serial.println("Platform staat onder Bacardi, dispensen..");
  459.   stepper2.runToNewPosition(dispensen);
  460.   delay(1000);
  461.   stepper2.runToNewPosition(Home);
  462.   Serial.println("Dat is 1..");
  463.   delay(500);
  464.   stepper2.runToNewPosition(dispensen);
  465.   delay(1000);
  466.   stepper2.runToNewPosition(Home);
  467.   Serial.println("Dispensen voltooid. op naar de volgende!");
  468.   stepper1.runToNewPosition(posFanta);
  469.   Serial.println("Platform staat onder Fanta, dispensen..");
  470.   Frisdrank();
  471.   Serial.println("Dispensen voltooid.");
  472.   stepper1.runToNewPosition(Home);
  473.   Serial.println("Dubbele Bafa taak voltooid!");
  474.   while (Serial2.available())
  475.     Serial2.read();
  476. }
  477.  
  478. void RazCo() {//////////////////////////////////BACARDI RAZ REEKS/////////////////////////////////////
  479.   Serial.println("Doing Raz cola");
  480.   lcd.setCursor(0, 2);
  481.   lcd.print("Aan het werk..      ");
  482.   stepper1.runToNewPosition(posRaz);
  483.   Serial.println("Platform staat onder Raz, dispensen..");
  484.   stepper2.runToNewPosition(dispensen);
  485.   delay(1000);
  486.   stepper2.runToNewPosition(Home);
  487.   Serial.println("Dispensen voltooid. op naar de volgende!");
  488.   stepper1.runToNewPosition(posCola);
  489.   Serial.println("Platform staat onder Cola, dispensen..");
  490.   Frisdrank();
  491.   Serial.println("Dispensen voltooid.");
  492.   stepper1.runToNewPosition(Home);
  493.   Serial.println("Raz cola taak voltooid!");
  494.   while (Serial2.available())
  495.     Serial2.read();
  496. }
  497.  
  498. void RazCoX() {
  499.   Serial.println("Doing dubbele Raz cola");
  500.   lcd.setCursor(0, 2);
  501.   lcd.print("Aan het werk..        ");
  502.   stepper1.runToNewPosition(posRaz);
  503.   Serial.println("Platform staat onder Raz, dispensen..");
  504.   stepper2.runToNewPosition(dispensen);
  505.   delay(1000);
  506.   stepper2.runToNewPosition(Home);
  507.   Serial.println("Dat is 1..");
  508.   delay(500);
  509.   stepper2.runToNewPosition(dispensen);
  510.   delay(1000);
  511.   stepper2.runToNewPosition(Home);
  512.   Serial.println("Dispensen voltooid. op naar de volgende!");
  513.   stepper1.runToNewPosition(posCola);
  514.   Serial.println("Platform staat onder Cola, dispensen..");
  515.   Frisdrank();
  516.   Serial.println("Dispensen voltooid.");
  517.   stepper1.runToNewPosition(Home);
  518.   Serial.println("Dubbele Raz Cola taak voltooid!");
  519.   while (Serial2.available())
  520.     Serial2.read();
  521. }
  522.  
  523. void RazFa() {
  524.   Serial.println("Doing Raz Fanta");
  525.   lcd.setCursor(0, 2);
  526.   lcd.print("Aan het werk..      ");
  527.   stepper1.runToNewPosition(posRaz);
  528.   Serial.println("Platform staat onder Raz, dispensen..");
  529.   stepper2.runToNewPosition(dispensen);
  530.   delay(1000);
  531.   stepper2.runToNewPosition(Home);
  532.   Serial.println("Dispensen voltooid. op naar de volgende!");
  533.   stepper1.runToNewPosition(posFanta);
  534.   Serial.println("Platform staat onder Fanta, dispensen..");
  535.   Frisdrank();
  536.   Serial.println("Dispensen voltooid.");
  537.   stepper1.runToNewPosition(Home);
  538.   Serial.println("Bafa taak voltooid!");
  539.   while (Serial2.available())
  540.     Serial2.read();
  541. }
  542.  
  543. void RazFaX() {
  544.   Serial.println("Doing dubbele Raz Fanta");
  545.   lcd.setCursor(0, 2);
  546.   lcd.print("Aan het werk..      ");
  547.   stepper1.runToNewPosition(posRaz);
  548.   Serial.println("Platform staat onder Raz, dispensen..");
  549.   stepper2.runToNewPosition(dispensen);
  550.   delay(1000);
  551.   stepper2.runToNewPosition(Home);
  552.   Serial.println("Dat is 1..");
  553.   delay(500);
  554.   stepper2.runToNewPosition(dispensen);
  555.   delay(1000);
  556.   stepper2.runToNewPosition(Home);
  557.   Serial.println("Dispensen voltooid. op naar de volgende!");
  558.   stepper1.runToNewPosition(posFanta);
  559.   Serial.println("Platform staat onder Fanta, dispensen..");
  560.   Frisdrank();
  561.   Serial.println("Dispensen voltooid.");
  562.   stepper1.runToNewPosition(Home);
  563.   Serial.println("Dubbele Bafa taak voltooid!");
  564.   while (Serial2.available())
  565.     Serial2.read();
  566. }
  567.  
  568. void JD() {//////////////////////////////////JACK DANIELS REEKS/////////////////////////////////////
  569.   Serial.println("Doing JackDaniels");
  570.   lcd.setCursor(0, 2);
  571.   lcd.print("Aan het werk..      ");
  572.   stepper1.runToNewPosition(posJD);
  573.   Serial.println("Platform staat onder Jack Daniels, dispensen..");
  574.   stepper2.runToNewPosition(dispensen);
  575.   delay(1000);
  576.   stepper2.runToNewPosition(Home);
  577.   Serial.println("Dispensen voltooid.");
  578.   stepper1.runToNewPosition(Home);
  579.   Serial.println("Jack Daniels taak voltooid!");
  580.   while (Serial2.available())
  581.     Serial2.read();
  582. }
  583.  
  584. void JDX() {
  585.   Serial.println("Doing Dubbele Jack Daniels");
  586.   lcd.setCursor(0, 2);
  587.   lcd.print("Aan het werk..      ");
  588.   stepper1.runToNewPosition(posJD);
  589.   Serial.println("Platform staat onder Jack Daniels, dispensen..");
  590.   stepper2.runToNewPosition(dispensen);
  591.   delay(1000);
  592.   stepper2.runToNewPosition(Home);
  593.   Serial.println("Dat is 1..");
  594.   delay(500);
  595.   stepper2.runToNewPosition(dispensen);
  596.   delay(1000);
  597.   stepper2.runToNewPosition(Home);
  598.   Serial.println("Dispensen voltooid.");
  599.   stepper1.runToNewPosition(Home);
  600.   Serial.println("Dubbele Jack Daniels taak voltooid!");
  601.   while (Serial2.available())
  602.     Serial2.read();
  603. }
  604.  
  605. void JackCola() {
  606.   Serial.println("Doing Jack Cola");
  607.   lcd.setCursor(0, 2);
  608.   lcd.print("Aan het werk..      ");
  609.   stepper1.runToNewPosition(posJD);
  610.   Serial.println("Platform staat onder Jack Daniels, dispensen..");
  611.   stepper2.runToNewPosition(dispensen);
  612.   delay(1000);
  613.   stepper2.runToNewPosition(Home);
  614.   Serial.println("Dispensen voltooid. op naar de volgende!");
  615.   stepper1.runToNewPosition(posCola);
  616.   Serial.println("Platform staat onder Cola, dispensen..");
  617.   Frisdrank();
  618.   Serial.println("Dispensen voltooid.");
  619.   stepper1.runToNewPosition(Home);
  620.   Serial.println("Jack Cola taak voltooid!");
  621.   while (Serial2.available())
  622.     Serial2.read();
  623. }
  624.  
  625. void JackColaX() {
  626.   Serial.println("Doing dubbele Jack Cola");
  627.   lcd.setCursor(0, 2);
  628.   lcd.print("Aan het werk..      ");
  629.   stepper1.runToNewPosition(posJD);
  630.   Serial.println("Platform staat onder Jack Daniels, dispensen..");
  631.   stepper2.runToNewPosition(dispensen);
  632.   delay(1000);
  633.   stepper2.runToNewPosition(Home);
  634.   Serial.println("Dat is 1..");
  635.   delay(500);
  636.   stepper2.runToNewPosition(dispensen);
  637.   delay(1000);
  638.   stepper2.runToNewPosition(Home);
  639.   Serial.println("Dispensen voltooid. op naar de volgende!");
  640.   stepper1.runToNewPosition(posCola);
  641.   Serial1.println("Platform staat onder Cola, dispensen..");
  642.   Frisdrank();
  643.   Serial1.println("Dispensen voltooid.");
  644.   stepper1.runToNewPosition(Home);
  645.   Serial1.println("Dubbele JackCola taak voltooid!");
  646.   while (Serial2.available())
  647.     Serial2.read();
  648. }
  649.  
  650. void VodCo() {//////////////////////////////////VODKA REEKS/////////////////////////////////////
  651.   Serial.println("Doing Vodka Cola");
  652.   lcd.setCursor(0, 2);
  653.   lcd.print("Aan het werk..      ");
  654.   stepper1.runToNewPosition(posVodka);
  655.   Serial.println("Platform staat onder Vodka, dispensen..");
  656.   stepper2.runToNewPosition(dispensen);
  657.   delay(1000);
  658.   stepper2.runToNewPosition(Home);
  659.   Serial.println("Dispensen voltooid. op naar de volgende!");
  660.   stepper1.runToNewPosition(posCola);
  661.   Serial.println("Platform staat onder Cola, dispensen..");
  662.   Frisdrank();
  663.   Serial.println("Dispensen voltooid.");
  664.   stepper1.runToNewPosition(Home);
  665.   Serial.println("Vodka Cola taak voltooid!");
  666.   while (Serial2.available())
  667.     Serial2.read();
  668. }
  669.  
  670. void VodCoX() {
  671.   Serial.println("Doing dubbele Vodka Cola");
  672.   lcd.setCursor(0, 2);
  673.   lcd.print("Aan het werk..      ");
  674.   stepper1.runToNewPosition(posVodka);
  675.   Serial.println("Platform staat onder Vodka, dispensen..");
  676.   stepper2.runToNewPosition(dispensen);
  677.   delay(1000);
  678.   stepper2.runToNewPosition(Home);
  679.   Serial.println("Dat is 1..");
  680.   delay(500);
  681.   stepper2.runToNewPosition(dispensen);
  682.   delay(1000);
  683.   stepper2.runToNewPosition(Home);
  684.   Serial.println("Dispensen voltooid. op naar de volgende!");
  685.   stepper1.runToNewPosition(posCola);
  686.   Serial.println("Platform staat onder Cola, dispensen..");
  687.   Frisdrank();
  688.   Serial.println("Dispensen voltooid.");
  689.   stepper1.runToNewPosition(Home);
  690.   Serial.println("Dubbele Vodka Cola taak voltooid!");
  691.   while (Serial2.available())
  692.     Serial2.read();
  693. }
  694.  
  695. void VodFa() {
  696.   Serial.println("Doing Vodka Fanta");
  697.   lcd.setCursor(0, 2);
  698.   lcd.print("Aan het werk..      ");
  699.   stepper1.runToNewPosition(posVodka);
  700.   Serial.println("Platform staat onder Vodka, dispensen..");
  701.   stepper2.runToNewPosition(dispensen);
  702.   delay(1000);
  703.   stepper2.runToNewPosition(Home);
  704.   Serial.println("Dispensen voltooid. op naar de volgende!");
  705.   stepper1.runToNewPosition(posFanta);
  706.   Serial.println("Platform staat onder Fanta, dispensen..");
  707.   Frisdrank();
  708.   Serial.println("Dispensen voltooid.");
  709.   stepper1.runToNewPosition(Home);
  710.   Serial.println("Vodka Fanta taak voltooid!");
  711.   while (Serial2.available())
  712.     Serial2.read();
  713. }
  714.  
  715. void VodFaX() {
  716.   Serial.println("Doing dubbele Vodka Fanta");
  717.   lcd.setCursor(0, 2);
  718.   lcd.print("Aan het werk..      ");
  719.   stepper1.runToNewPosition(posVodka);
  720.   Serial.println("Platform staat onder Vodka, dispensen..");
  721.   stepper2.runToNewPosition(dispensen);
  722.   delay(1000);
  723.   stepper2.runToNewPosition(Home);
  724.   Serial.println("Dat is 1..");
  725.   delay(500);
  726.   stepper2.runToNewPosition(dispensen);
  727.   delay(1000);
  728.   stepper2.runToNewPosition(Home);
  729.   Serial.println("Dispensen voltooid. op naar de volgende!");
  730.   stepper1.runToNewPosition(posFanta);
  731.   Serial.println("Platform staat onder Fanta, dispensen..");
  732.   Frisdrank();
  733.   Serial.println("Dispensen voltooid.");
  734.   stepper1.runToNewPosition(Home);
  735.   Serial.println("Dubbele Vodka Fanta taak voltooid!");
  736.   while (Serial2.available())
  737.     Serial2.read();
  738. }
  739.  
  740. void Frisdrank() { //5x frisdrank dispensen
  741.   stepper2.runToNewPosition(dispensen);
  742.   delay(2700);//1
  743.   lcd.setCursor(0, 3);
  744.   lcd.print("Nog heel even hoor!");
  745.   stepper2.runToNewPosition(Home);
  746.   delay(2000);//1
  747.   stepper2.runToNewPosition(dispensen);
  748.   delay(2700);
  749.   lcd.setCursor(0, 3);
  750.   lcd.print("3..                 ");
  751.   stepper2.runToNewPosition(Home);
  752.   delay(2000);//2
  753.   stepper2.runToNewPosition(dispensen);
  754.   delay(2700);
  755.   lcd.setCursor(0, 3);
  756.   lcd.print("2..                 ");
  757.   stepper2.runToNewPosition(Home);
  758.   delay(2000);//3
  759.   stepper2.runToNewPosition(dispensen);
  760.   delay(2700);
  761.   lcd.setCursor(0, 3);
  762.   lcd.print("1..                 ");
  763.   stepper2.runToNewPosition(Home);
  764.   delay(2000);//4
  765.   stepper2.runToNewPosition(dispensen);
  766.   delay(2700);
  767.   lcd.setCursor(0, 3);
  768.   lcd.print("0!                  ");
  769.   stepper2.runToNewPosition(Home);
  770.   //5
  771. }
  772.  
  773. void GlasNeerzetten() {
  774.   lcd.setCursor(0, 3);
  775.   lcd.print("Plaats uw glas      ");
  776. terug2:
  777.   delay(100);
  778.   digitalWrite(Sound, HIGH);
  779.   delay(10);
  780.   digitalWrite(Sound, LOW);
  781.   duration = pulseIn(Listen, HIGH);
  782.   distance = (duration / 2) / 29.1;
  783.   while (distance > 10) {
  784.     delay(100);
  785.     digitalWrite(Sound, HIGH);
  786.     delay(10);
  787.     digitalWrite(Sound, LOW);
  788.     duration = pulseIn(Listen, HIGH);
  789.     distance = (duration / 2) / 29.1;
  790.     Serial.println("Glas checken");
  791.   }
  792.   delay(100);
  793.   digitalWrite(Sound, HIGH);
  794.   delay(10);
  795.   digitalWrite(Sound, LOW);
  796.   duration = pulseIn(Listen, HIGH);
  797.   distance = (duration / 2) / 29.1;
  798.   if (distance > 10) {
  799.     goto terug2;
  800.   }
  801.   lcd.setCursor(0, 3);
  802.   lcd.print("Dankjewel!          ");
  803.   Serial.println("Nieuw glas is neergezet");
  804.   delay(1500);
  805.   lcd.setCursor(0, 3);
  806.   lcd.print("                    ");
  807. }
  808.  
  809. void GlasWeghalen() {
  810.   lcd.clear();
  811.   lcd.setCursor(0, 0);
  812.   lcd.print("Voltooid!");
  813.   RandomCase();
  814.   lcd.setCursor(0, 3);
  815.   lcd.print("Neem het glas AUB");
  816. terug1:
  817.   delay(100);
  818.   digitalWrite(Sound, HIGH);
  819.   delay(10);
  820.   digitalWrite(Sound, LOW);
  821.   duration = pulseIn(Listen, HIGH);
  822.   distance = (duration / 2) / 29.1;
  823.   while (distance < 10) {
  824.     delay(100);
  825.     digitalWrite(Sound, HIGH);
  826.     delay(10);
  827.     digitalWrite(Sound, LOW);
  828.     duration = pulseIn(Listen, HIGH);
  829.     distance = (duration / 2) / 29.1;
  830.     Serial.println("Glas checken");
  831.   }
  832.   delay(100);
  833.   digitalWrite(Sound, HIGH);
  834.   delay(10);
  835.   digitalWrite(Sound, LOW);
  836.   duration = pulseIn(Listen, HIGH);
  837.   distance = (duration / 2) / 29.1;
  838.   if (distance < 10) {
  839.     goto terug1;
  840.   }
  841.   Serial.println("Glas is weggehaald");
  842.   delay(500);
  843.  
  844.   lcd.clear();
  845.   lcd.setCursor(0, 0);
  846.   lcd.print("Maak uw keuze");
  847. }
  848.  
  849. void RandomCase() {
  850.   nummer = random(10);
  851.   Serial.println("random case geselecteerd");
  852.   lcd.setCursor(0, 1);
  853.   switch (nummer) {
  854.  
  855.     case 0:
  856.       lcd.print("Proost pik!");
  857.       break;
  858.  
  859.     case 1:
  860.       lcd.print("Salute!");
  861.       break;
  862.  
  863.     case 2:
  864.       lcd.print("Smakelijk drinken!");
  865.       break;
  866.  
  867.     case 3:
  868.       lcd.print("Proost!");
  869.       break;
  870.  
  871.     case 4:
  872.       lcd.print("Zuipse!");
  873.       break;
  874.  
  875.     case 5:
  876.       lcd.print("Zometeen nog een!");
  877.       break;
  878.  
  879.     case 6:
  880.       lcd.print("Skal!");
  881.       break;
  882.  
  883.     case 7:
  884.       lcd.print("Cheers!");
  885.       break;
  886.  
  887.     case 8:
  888.       lcd.print("Geniet ervan!");
  889.       break;
  890.  
  891.     case 9:
  892.       lcd.print("Bottoms up!");
  893.       break;
  894.  
  895.   }
  896. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement
Public Pastes
Advertisement
We use cookies for various purposes including analytics. By continuing to use Pastebin, you agree to our use of cookies as described in the Cookies Policy.  OK, I Understand
Not a member of Pastebin yet?
Sign Up, it unlocks many cool features!