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:
- Detekce míčku: IR senzor na páčce zachytí míček a pošle signál
LOWdo Arduina. - 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.
- 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.
- 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).
- 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.
- 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.