Stap 18:
#include < Servo.h >
Servo lift;
Servo roteren;
int val = 0;
int begin = 10;
int volgende = 7;
int dummy = 0;
Const int pwmA = 3;
Const int brakeA = 9;
Const int dirA = 12;
VOID Setup
{
Lift.attach (2), //lift op pin2
Rotate.attach (5), //rotate op pin 5
pinMode (start, INPUT); //pin 10 als input
pinMode (volgende, uitgang); //pin 7-uitgang
digitalWrite (volgende, hoge);
Lift.write (80); //upright
Rotate.write (135); //face track
vertraging (2000);
}
void loop
{
Val=digitalRead(start);
if(Val==low)
{dummy = 1;
Lift.write(85);
delay(100);
Lift.write(90);
delay(100);
Lift.write(95);
delay(100);
Lift.write(100);
delay(100);
Lift.write(105);
delay(100);
Lift.write(110);
delay(100);
Lift.write(115);
delay(100);
Lift.write(120);
delay(100);
Lift.write(125);
delay(100);
Lift.write(130);
delay(100);
Lift.write(135);
delay(100);
Lift.write(140);
delay(100);
Lift.write(145);
delay(100);
Lift.write(150);
delay(100);
Lift.write(155);
delay(100);
Lift.write(160);
delay(100);
Lift.write(165);
delay(100);
Lift.write(170);
delay(100);
pinMode(dirA,OUTPUT);
pinMode(brakeA,OUTPUT);
digitalWrite (dirA, laag); //forward
digitalWrite (brakeA, laag); //release rem
analogWrite (pwmA, 255); //motor op max
delay(20000);
Lift.write(145);
delay(100);
Lift.write(135);
delay(100);
Lift.write (125); //lift iets
delay(800);
Rotate.write(130);
delay(100);
Rotate.write(125);
delay(100);
Rotate.write(120);
delay(100);
Rotate.write(115);
delay(100);
Rotate.write(110);
delay(100);
Rotate.write(105);
delay(100);
Rotate.write(100);
delay(100);
Rotate.write(95);
delay(100);
Rotate.write(90);
delay(100);
Rotate.write(85);
delay(100);
Rotate.write(80);
delay(100);
Rotate.write(75);
delay(100);
Rotate.write(70);
delay(100);
Rotate.write(65);
delay(100);
Rotate.write(60);
delay(100);
Rotate.write(55);
delay(100);
Rotate.write(50);
delay(100);
Lift.write(140);
delay(100);
Lift.write(145);
delay(100);
Lift.write (150); //at katapult
delay(1000);
analogWrite(pwmA,0);
digitalWrite(brakeA,LOW);
delay(3000);
Lift.write(80);
vertraging (1000); //upright
Rotate.write(75);
delay(200);
Rotate.write(100);
delay(200);
Rotate.write(110);
delay(200);
Rotate.write(120);
delay(200);
Rotate.write(130);
delay(100);
Rotate.write(135);
delay(100);
Dummy = 0;
digitalWrite(next,LOW);
delay(1000);
digitalWrite(next,HIGH);
}}