Hexbug spin friemeltje sensoren / mijn eerste Instructable (2 / 3 stap)

Stap 2: CODE

int pbLeft = 0; var voor recht
int pbRight = 0; var voor links

VOID Setup {}
pinMode (bumpLeft, INPUT);
pinMode (bumpRight, INPUT);
pinMode (ledPin, OUTPUT);
pinMode (servoFw, OUTPUT);
pinMode (servoTrn, OUTPUT);
}

void loop {}
vooruit(); Start vooruit
Test-schakelaar
pbLeft = digitalRead(bumpLeft);
pbRight = digitalRead(bumpRight);

LED-indicator weergeven
showLED();

Als links hit
Als (pbLeft == HIGH) {}
reverse();
delay(500);
turnRight();
delay(1500);
}

Als rechts hit
Als (pbRight == HIGH) {}
reverse();
delay(500);
turnLeft();
delay(1500);
}
}

Beweging routines
ongeldig vooruit() {}
digitalWrite (servoFw, hoge);
digitalWrite (servoTrn, laag);
}

VOID reverse() {}
digitalWrite (servoFw, laag);
digitalWrite (servoTrn, hoge);
}

ongeldig turnRight() {}
digitalWrite (servoFw, laag);
digitalWrite (servoTrn, hoge);
}

ongeldig turnLeft() {}
digitalWrite (servoFw, laag);
digitalWrite (servoTrn, hoge);
}

ongeldig showLED() {}
Toon geleid als bumper raakt
Als (pbRight == HIGH || pbLeft == HIGH) {}
Zet led op
digitalWrite (ledPin, hoge);
}
else {}
LED uitschakelen
digitalWrite (ledPin, laag);
}
}