Beruflich Dokumente
Kultur Dokumente
enum moveDirection {
forward,
backward
};
enum turnDirection {
clockwise,
counterClockwise
};
void setup()
{
pinMode(PIR1,INPUT);
pinMode(PIR2,INPUT);
pinMode(pinAIN2, OUTPUT);
pinMode(pinAIN1, OUTPUT);
pinMode(pinPWMA, OUTPUT);
pinMode(pinBIN1, OUTPUT);
pinMode(pinBIN2, OUTPUT);
pinMode(pinPWMB, OUTPUT);
}
void loop()
{
int v1=digitalRead (PIR1);
int v2=digitalRead (PIR2);
if (v1==HIGH & v2==HIGH)
{
move(backward, 180);
delay(waitTime);
turn(clockwise, 180);
delay(waitTime);
}
else
{
enableMotors();
move(forward, 180);
delay(waitTime);
}
turn(counterClockwise, 180);
delay(waitTime);
}
else
{
enableMotors();
move(forward, 180);
delay(waitTime);
}
//enableMotors();
//move(forward, 180);
//delay(waitTime);
//move(backward, 180);
//delay(waitTime);
//turn(clockwise, 180);
//delay(waitTime);
//turn(counterClockwise, 180);
//delay(waitTime);
//fullStop();
//delay(waitTime);
}
void fullStop()
{
disableMotors();
stopMotor(pinMotorA);
stopMotor(pinMotorB);
}
analogWrite(pinMotor[0], speed);
}
analogWrite(pinMotor[0], speed);
}
analogWrite(pinMotor[0], 0);
}
void enableMotors()
{
digitalWrite(pinSTBY, HIGH);
}
void disableMotors()
{
digitalWrite(pinSTBY, LOW);
}