Froggy värld 5 kaffe griparen (18 / 21 steg)
Steg 18:
#include < Servo.h >
Servo hiss.
Servo rotera;
int val = 0;
int start = 10;
int nästa = 7.
int dummy = 0;
CONST int pwmA = 3;
CONST int brakeA = 9;
CONST int dirA = 12.
void setup()
{
Lift.attach (2), //lift på pin2
rotate.attach (5), //rotate på stift 5
pinMode (start, indata); //pin 10 som indata
pinMode (därefter matas); //pin 7 utgång
digitalWrite (nästa, hög).
Lift.write (80), //upright
rotate.write (135); //face spår
fördröjning (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, låg), //forward
digitalWrite (brakeA, låg), //release broms
analogWrite (pwmA, 255); //motor på max
Delay(20000);
Lift.write(145);
Delay(100);
Lift.write(135);
Delay(100);
Lift.write (125), //lift något
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);
fördröjning (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);
}}