Bolly and my kids (1 / 2 steg)
Steg 1: Kopplingsschema och kod
KOD:
CONST int RightMotor = 12;
CONST int LeftMotor = 11;
CONST int RightSensor = 1;
CONST int LeftSensor = 2;
int SensorLeft;
int SensorRight;
int SensorDifference;
void setup() {
pinMode (LeftMotor, OUTPUT);
pinMode (RightMotor, OUTPUT);
pinMode (LeftSensor, indata);
pinMode (RightSensor, indata);
digitalWrite (A1, hög);
digitalWrite (A2, hög);
Serial.BEGIN(9600);
Serial.println ("\nBeginning ljus söker beteende");
}
void loop() {
SensorLeft = 1023 - analogRead(LeftSensor);
Delay(1);
SensorRight = 1023 - analogRead(RightSensor);
Delay(1);
SensorDifference = abs (SensorLeft - SensorRight);
om (SensorLeft > 500 & & SensorRight > 500) {
om (SensorLeft > SensorRight & & SensorDifference > 75) {
digitalWrite (RightMotor, hög);
digitalWrite (LeftMotor, låg);
}
om (SensorLeft < SensorRight & & SensorDifference > 75) {
digitalWrite (RightMotor, låg);
digitalWrite (LeftMotor, hög);
}
om (SensorDifference < 75) {
digitalWrite (RightMotor, hög);
digitalWrite (LeftMotor, hög);
}
}
om (SensorLeft < 500 & & SensorRight < 500) {
om (SensorLeft > SensorRight & & SensorDifference > 75) {
digitalWrite (RightMotor, låg);
digitalWrite (LeftMotor, låg);
}
}
}