Servos der Raketen Platine Testen
Wie?
In der Rakete habe ich 6 Servos verbaut, wovon sich 2 auf der Haupt Platine befinden und die anderen 4 auf der „Servo_Erweiterung“ Platine. Um zu testeten, ob alle Servos mit der Platine funktionieren, habe ich ein Beispielprogramm („Sweep“ aus der „Servo.h“ Bibliothek) so umgeschrieben. dieses Programm lässt dann alle 6 Servos mit den richtigen Pins hin und her schwenken.
Hier ist das Programm:
/////////////////////////////////////// // // // Servos der Raketen_Platiene // // // /////////////////////////////////////// // Mehr zum Code unter www.Towinet.de #include <Servo.h> //Binde die "Servo.h" Bibliothek ein float pos = 0.0; //Erstellt einen Float namens "Pos" Servo servo_1_Hauptplatiene; //Pin für servo_1_Hauptplatiene Servo servo_2_Hauptplatiene; //Pin für servo_2_Hauptplatiene Servo servo_1_Servoplatiene; //Pin für servo_1_Servoplatiene Servo servo_2_Servoplatiene; //Pin für servo_2_Servoplatiene Servo servo_3_Servoplatiene; //Pin für servo_3_Servoplatiene Servo servo_4_Servoplatiene; //Pin für servo_4_Servoplatiene void setup() { servo_1_Hauptplatiene.attach(2); //Pin für servo_1_Hauptplatiene servo_2_Hauptplatiene.attach(3); //Pin für servo_2_Hauptplatiene servo_1_Servoplatiene.attach(4); //Pin für servo_1_Servoplatiene servo_2_Servoplatiene.attach(5); //Pin für servo_2_Servoplatiene servo_3_Servoplatiene.attach(6); //Pin für servo_3_Servoplatiene servo_4_Servoplatiene.attach(7); //Pin für servo_4_Servoplatiene } void loop() { for (pos = 0.0; pos <= 180.0; pos += 0.1) { //Gehe in Schleife bis "Pos" 180.0 erreicht hat und gehe jede wiederholung mit "Pos" um 0.1 höher servo_1_Hauptplatiene.write(pos); //Servo 1 der Hauptplatiene soll sich auf "Pos" Bewegen servo_2_Hauptplatiene.write(pos); //Servo 2 der Hauptplatiene soll sich auf "Pos" Bewegen servo_1_Servoplatiene.write(pos); //Servo 1 der Servoplatiene soll sich auf "Pos" Bewegen servo_2_Servoplatiene.write(pos); //Servo 2 der Servoplatiene soll sich auf "Pos" Bewegen servo_3_Servoplatiene.write(pos); //Servo 3 der Servoplatiene soll sich auf "Pos" Bewegen servo_4_Servoplatiene.write(pos); //Servo 4 der Servoplatiene soll sich auf "Pos" Bewegen delay(1); //Warte für 0,001 sec } for (pos = 180.0; pos >= 0.0; pos -= 0.1) {//Gehe in Schleife bis "Pos" 0 erreicht hat und gehe jede wiederholung mit "Pos" um 0.1 kleiner servo_1_Hauptplatiene.write(pos); //Servo 1 der Hauptplatiene soll sich auf "Pos" Bewegen servo_2_Hauptplatiene.write(pos); //Servo 2 der Hauptplatiene soll sich auf "Pos" Bewegen servo_1_Servoplatiene.write(pos); //Servo 1 der Servoplatiene soll sich auf "Pos" Bewegen servo_2_Servoplatiene.write(pos); //Servo 2 der Servoplatiene soll sich auf "Pos" Bewegen servo_3_Servoplatiene.write(pos); //Servo 3 der Servoplatiene soll sich auf "Pos" Bewegen servo_4_Servoplatiene.write(pos); //Servo 4 der Servoplatiene soll sich auf "Pos" Bewegen delay(1); //Warte für 0,001 sec } }