Funkční kód pro Arduino Nano

Implementace řídicí logiky stříleče míčků se Soft-Startem

Po zapojení elektroniky je nutné správně naprogramovat mikrokontroléry. Níže je finální kód, který řídí plynulý rozběh motorů, časovaný pohyb serva i detekci míčku z IR senzoru.

#include <Servo.h>

// --- Nastavení pinů ---
const int IR_PIN = 9;        // IR senzor u páčky (D9)
const int MOTOR_PWM = 5;     // H-můstek BTS7960B pin RPWM (D5)
const int SERVO_PIN = 8;     // Servo MG945 (D8)

// --- Polohy serva a výkon ---
const int SERVO_REST_POS = 0;   // Klidová poloha: Rameno A drží míček
const int SERVO_DROP_POS = 90;  // Pracovní poloha: Míček padá, Rameno B blokuje vstup
const int MOTOR_SPEED = 255;    // Plný výkon motorů (100 % PWM)

// --- Časování (v milisekundách) ---
const int DROP_HOLD_TIME = 1000; // 1 s: Servo drží dole (90°), míček padá, Rameno B blokuje
const int MOTOR_FLY_TIME = 6500; // 6,5 s: Plný výkon motorů během letu míčku

Servo feederServo;

void setup() {
  Serial.begin(9600);

  pinMode(IR_PIN, INPUT_PULLUP);
  pinMode(MOTOR_PWM, OUTPUT);

  feederServo.attach(SERVO_PIN);
  feederServo.write(SERVO_REST_POS); // Servo startuje v poloze 0 deg

  analogWrite(MOTOR_PWM, 0);         // Motory na začátku stojí

  Serial.println("====================================");
  Serial.println(" SYSTEM PRIPRAVEN - Cekam na micek ");
  Serial.println("====================================");
}

void loop() {
  // 1. Míček dopadne na Rameno A a aktivuje IR senzor (LOW)
  if (digitalRead(IR_PIN) == LOW) {
    Serial.println("-> Micek detekovan na packe!");

    // 2. PLYNULÝ START MOTORŮ (Soft-Start)
    Serial.println("1. Motory plynule nabiha na full (Soft-Start)...");
    for (int speed = 0; speed <= MOTOR_SPEED; speed += 15) {
      analogWrite(MOTOR_PWM, speed);
      delay(30); // Plynulý náběh 0 -> 255 trvá cca 0,5 sekundy
    }
    analogWrite(MOTOR_PWM, MOTOR_SPEED); // Pojistka plného výkonu

    // 3. Krátké ustálení motorů před otáčením serva
    delay(500);

    // 4. Otočení na 90°: Míček padá do trubky, Rameno B zadrží další míček
    Serial.println("2. Otacim servo na 90 deg (micek padat, Rameno B blokuje)...");
    feederServo.write(SERVO_DROP_POS);

    // 5. Čekání 1 sekundu v poloze 90°
    delay(DROP_HOLD_TIME);

    // 6. Návrat serva zpět na 0° (Rameno A připraveno pro další míček)
    Serial.println("3. Vracim servo zpet na 0 deg...");
    feederServo.write(SERVO_REST_POS);

    // 7. Motory točí na plný výkon
    Serial.println("4. Micek leti trubkou (plny vykont)...");
    delay(MOTOR_FLY_TIME);

    // 8. Pozvolné, šetrné zpomalení motorů (Soft-Stop)
    Serial.println("5. Plynule zpomaluji motory (Soft-Stop)...");
    for (int speed = MOTOR_SPEED; speed >= 0; speed -= 5) {
      analogWrite(MOTOR_PWM, speed);
      delay(30); // Plynulé zastavení trvá cca 1,5 sekundy
    }

    analogWrite(MOTOR_PWM, 0); // Pojistka úplného vypnutí
    Serial.println("6. Motory plne zastaveny.");

    Serial.println("\n--- Cekam na dalsi micek ---");
  }
}

Celkový princip fungování

Program monitoruje přítomnost míčku v podavači a následně spouští sekvenci plynulého výstřelu:

  1. Detekce míčku: IR senzor na páčce zachytí míček a pošle signál LOW do Arduina.
  2. Soft-Start motorů: Motory 775 plynule nábíhají z 0 na 100 % PWM (cca 0,5 s), což zamezuje extrémním proudovým rázům v napájecím zdroji.
  3. Podání míčku: Po krátkém ustálení otáček (0,5 s) se servo otočí na 90°, čímž pustí míček do trubky a druhou částí dvouramenného držáku (Rameno B) zablokuje další míčky.
  4. Návrat serva: Servo vyčká 1 sekundu v pracovní poloze a poté se vrátí zpět na 0° (Rameno A je připraveno zachytit další míček).
  5. Průlet a výstřel: Motory běží na plný výkon ještě 6,5 sekundy, aby bezpečně udělovaly kinetickou energii prolétávajícímu míčku.
  6. Soft-Stop motorů: Výkon motorů plynule klesá ze 100 % na 0 % (cca 1,5 s), což šetří mechatronické díly a chrání elektroniku před indukovanými špičkami.

Vysvětlení použitých funkcí a příkazů

Soft-Start / Soft-Stop (for)

Plynulé rampování hodnoty PWM v cyklech for odstraňuje tvrdý proudový náraz při startu motorů 775 a brání poklesům napětí zdroje.

analogWrite(MOTOR_PWM, val)

Posílá PWM signál na pin D5 pro H-můstek BTS7960B. Hodnota 255 reprezentuje plné napětí 12 V pro maximální otáčky.

feederServo.write(angle)

Nastavuje úhel serva MG945. Poloha 0° zamezuje vypadnutí míčku, poloha 90° ho pustí a současně zablokuje další v řadě.

digitalRead(IR_PIN)

Monitoruje pin D9. Využívá interní pull-up rezistor a po sepnutí optické závory/páčky míčkem načte hodnotu LOW.