---
title: 'Funkční kód pro Arduino Nano'
url: 'https://grav.server.strojlab.cz/277464/hlavni-projekt/funkcni-kod-pro-arduino-nano'
markdown: 'https://grav.server.strojlab.cz/277464/hlavni-projekt/funkcni-kod-pro-arduino-nano.md'
date: '2026-11-07'
description: '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. …'
---

# 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.

  ```
<span style="color: #f472b6 !important;">#include</span> <span style="color: #38bdf8 !important;"><Servo.h></span>

<span style="color: #64748b !important;">// --- Nastavení pinů ---</span>
<span style="color: #f472b6 !important;">const int</span> <span style="color: #e2e8f0 !important;">IR_PIN</span> = <span style="color: #facc15 !important;">9</span>;        <span style="color: #64748b !important;">// IR senzor u páčky (D9)</span>
<span style="color: #f472b6 !important;">const int</span> <span style="color: #e2e8f0 !important;">MOTOR_PWM</span> = <span style="color: #facc15 !important;">5</span>;     <span style="color: #64748b !important;">// H-můstek BTS7960B pin RPWM (D5)</span>
<span style="color: #f472b6 !important;">const int</span> <span style="color: #e2e8f0 !important;">SERVO_PIN</span> = <span style="color: #facc15 !important;">8</span>;     <span style="color: #64748b !important;">// Servo MG945 (D8)</span>

<span style="color: #64748b !important;">// --- Polohy serva a výkon ---</span>
<span style="color: #f472b6 !important;">const int</span> <span style="color: #e2e8f0 !important;">SERVO_REST_POS</span> = <span style="color: #facc15 !important;">0</span>;   <span style="color: #64748b !important;">// Klidová poloha: Rameno A drží míček</span>
<span style="color: #f472b6 !important;">const int</span> <span style="color: #e2e8f0 !important;">SERVO_DROP_POS</span> = <span style="color: #facc15 !important;">90</span>;  <span style="color: #64748b !important;">// Pracovní poloha: Míček padá, Rameno B blokuje vstup</span>
<span style="color: #f472b6 !important;">const int</span> <span style="color: #e2e8f0 !important;">MOTOR_SPEED</span> = <span style="color: #facc15 !important;">255</span>;    <span style="color: #64748b !important;">// Plný výkon motorů (100 % PWM)</span>

<span style="color: #64748b !important;">// --- Časování (v milisekundách) ---</span>
<span style="color: #f472b6 !important;">const int</span> <span style="color: #e2e8f0 !important;">DROP_HOLD_TIME</span> = <span style="color: #facc15 !important;">1000</span>; <span style="color: #64748b !important;">// 1 s: Servo drží dole (90°), míček padá, Rameno B blokuje</span>
<span style="color: #f472b6 !important;">const int</span> <span style="color: #e2e8f0 !important;">MOTOR_FLY_TIME</span> = <span style="color: #facc15 !important;">6500</span>; <span style="color: #64748b !important;">// 6,5 s: Plný výkon motorů během letu míčku</span>

<span style="color: #38bdf8 !important;">Servo</span> <span style="color: #e2e8f0 !important;">feederServo</span>;

<span style="color: #f472b6 !important;">void</span> <span style="color: #60a5fa !important;">setup</span>() {
  <span style="color: #38bdf8 !important;">Serial</span>.<span style="color: #60a5fa !important;">begin</span>(<span style="color: #facc15 !important;">9600</span>);

  <span style="color: #60a5fa !important;">pinMode</span>(<span style="color: #e2e8f0 !important;">IR_PIN</span>, <span style="color: #38bdf8 !important;">INPUT_PULLUP</span>);
  <span style="color: #60a5fa !important;">pinMode</span>(<span style="color: #e2e8f0 !important;">MOTOR_PWM</span>, <span style="color: #38bdf8 !important;">OUTPUT</span>);

  <span style="color: #e2e8f0 !important;">feederServo</span>.<span style="color: #60a5fa !important;">attach</span>(<span style="color: #e2e8f0 !important;">SERVO_PIN</span>);
  <span style="color: #e2e8f0 !important;">feederServo</span>.<span style="color: #60a5fa !important;">write</span>(<span style="color: #e2e8f0 !important;">SERVO_REST_POS</span>); <span style="color: #64748b !important;">// Servo startuje v poloze 0 deg</span>

  <span style="color: #60a5fa !important;">analogWrite</span>(<span style="color: #e2e8f0 !important;">MOTOR_PWM</span>, <span style="color: #facc15 !important;">0</span>);         <span style="color: #64748b !important;">// Motory na začátku stojí</span>

  <span style="color: #38bdf8 !important;">Serial</span>.<span style="color: #60a5fa !important;">println</span>(<span style="color: #4ade80 !important;">"===================================="</span>);
  <span style="color: #38bdf8 !important;">Serial</span>.<span style="color: #60a5fa !important;">println</span>(<span style="color: #4ade80 !important;">" SYSTEM PRIPRAVEN - Cekam na micek "</span>);
  <span style="color: #38bdf8 !important;">Serial</span>.<span style="color: #60a5fa !important;">println</span>(<span style="color: #4ade80 !important;">"===================================="</span>);
}

<span style="color: #f472b6 !important;">void</span> <span style="color: #60a5fa !important;">loop</span>() {
  <span style="color: #64748b !important;">// 1. Míček dopadne na Rameno A a aktivuje IR senzor (LOW)</span>
  <span style="color: #f472b6 !important;">if</span> (<span style="color: #60a5fa !important;">digitalRead</span>(<span style="color: #e2e8f0 !important;">IR_PIN</span>) == <span style="color: #38bdf8 !important;">LOW</span>) {
    <span style="color: #38bdf8 !important;">Serial</span>.<span style="color: #60a5fa !important;">println</span>(<span style="color: #4ade80 !important;">"-> Micek detekovan na packe!"</span>);

    <span style="color: #64748b !important;">// 2. PLYNULÝ START MOTORŮ (Soft-Start)</span>
    <span style="color: #38bdf8 !important;">Serial</span>.<span style="color: #60a5fa !important;">println</span>(<span style="color: #4ade80 !important;">"1. Motory plynule nabiha na full (Soft-Start)..."</span>);
    <span style="color: #f472b6 !important;">for</span> (<span style="color: #f472b6 !important;">int</span> <span style="color: #e2e8f0 !important;">speed</span> = <span style="color: #facc15 !important;">0</span>; <span style="color: #e2e8f0 !important;">speed</span> <= <span style="color: #e2e8f0 !important;">MOTOR_SPEED</span>; <span style="color: #e2e8f0 !important;">speed</span> += <span style="color: #facc15 !important;">15</span>) {
      <span style="color: #60a5fa !important;">analogWrite</span>(<span style="color: #e2e8f0 !important;">MOTOR_PWM</span>, <span style="color: #e2e8f0 !important;">speed</span>);
      <span style="color: #60a5fa !important;">delay</span>(<span style="color: #facc15 !important;">30</span>); <span style="color: #64748b !important;">// Plynulý náběh 0 -> 255 trvá cca 0,5 sekundy</span>
    }
    <span style="color: #60a5fa !important;">analogWrite</span>(<span style="color: #e2e8f0 !important;">MOTOR_PWM</span>, <span style="color: #e2e8f0 !important;">MOTOR_SPEED</span>); <span style="color: #64748b !important;">// Pojistka plného výkonu</span>

    <span style="color: #64748b !important;">// 3. Krátké ustálení motorů před otáčením serva</span>
    <span style="color: #60a5fa !important;">delay</span>(<span style="color: #facc15 !important;">500</span>);

    <span style="color: #64748b !important;">// 4. Otočení na 90°: Míček padá do trubky, Rameno B zadrží další míček</span>
    <span style="color: #38bdf8 !important;">Serial</span>.<span style="color: #60a5fa !important;">println</span>(<span style="color: #4ade80 !important;">"2. Otacim servo na 90 deg (micek padat, Rameno B blokuje)..."</span>);
    <span style="color: #e2e8f0 !important;">feederServo</span>.<span style="color: #60a5fa !important;">write</span>(<span style="color: #e2e8f0 !important;">SERVO_DROP_POS</span>);

    <span style="color: #64748b !important;">// 5. Čekání 1 sekundu v poloze 90°</span>
    <span style="color: #60a5fa !important;">delay</span>(<span style="color: #e2e8f0 !important;">DROP_HOLD_TIME</span>);

    <span style="color: #64748b !important;">// 6. Návrat serva zpět na 0° (Rameno A připraveno pro další míček)</span>
    <span style="color: #38bdf8 !important;">Serial</span>.<span style="color: #60a5fa !important;">println</span>(<span style="color: #4ade80 !important;">"3. Vracim servo zpet na 0 deg..."</span>);
    <span style="color: #e2e8f0 !important;">feederServo</span>.<span style="color: #60a5fa !important;">write</span>(<span style="color: #e2e8f0 !important;">SERVO_REST_POS</span>);

    <span style="color: #64748b !important;">// 7. Motory točí na plný výkon</span>
    <span style="color: #38bdf8 !important;">Serial</span>.<span style="color: #60a5fa !important;">println</span>(<span style="color: #4ade80 !important;">"4. Micek leti trubkou (plny vykont)..."</span>);
    <span style="color: #60a5fa !important;">delay</span>(<span style="color: #e2e8f0 !important;">MOTOR_FLY_TIME</span>);

    <span style="color: #64748b !important;">// 8. Pozvolné, šetrné zpomalení motorů (Soft-Stop)</span>
    <span style="color: #38bdf8 !important;">Serial</span>.<span style="color: #60a5fa !important;">println</span>(<span style="color: #4ade80 !important;">"5. Plynule zpomaluji motory (Soft-Stop)..."</span>);
    <span style="color: #f472b6 !important;">for</span> (<span style="color: #f472b6 !important;">int</span> <span style="color: #e2e8f0 !important;">speed</span> = <span style="color: #e2e8f0 !important;">MOTOR_SPEED</span>; <span style="color: #e2e8f0 !important;">speed</span> >= <span style="color: #facc15 !important;">0</span>; <span style="color: #e2e8f0 !important;">speed</span> -= <span style="color: #facc15 !important;">5</span>) {
      <span style="color: #60a5fa !important;">analogWrite</span>(<span style="color: #e2e8f0 !important;">MOTOR_PWM</span>, <span style="color: #e2e8f0 !important;">speed</span>);
      <span style="color: #60a5fa !important;">delay</span>(<span style="color: #facc15 !important;">30</span>); <span style="color: #64748b !important;">// Plynulé zastavení trvá cca 1,5 sekundy</span>
    }

    <span style="color: #60a5fa !important;">analogWrite</span>(<span style="color: #e2e8f0 !important;">MOTOR_PWM</span>, <span style="color: #facc15 !important;">0</span>); <span style="color: #64748b !important;">// Pojistka úplného vypnutí</span>
    <span style="color: #38bdf8 !important;">Serial</span>.<span style="color: #60a5fa !important;">println</span>(<span style="color: #4ade80 !important;">"6. Motory plne zastaveny."</span>);

    <span style="color: #38bdf8 !important;">Serial</span>.<span style="color: #60a5fa !important;">println</span>(<span style="color: #4ade80 !important;">"\n--- Cekam na dalsi micek ---"</span>);
  }
}
```

## 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`.

  [← Zpět na hlavní projekt](../hlavni-projekt)

---

## Navigation

- Parent: [Hlavní projekt](https://grav.server.strojlab.cz/277464/hlavni-projekt.md)
- Previous: [3D tisk trychtýře, páčky a koleček](https://grav.server.strojlab.cz/277464/hlavni-projekt/3d-tisk-trychtyre-packy-a-kolecek.md)
- Next: [Kompletní produkt a ukázka funkčnosti](https://grav.server.strojlab.cz/277464/hlavni-projekt/kompletni-produkt-a-ukazka-funkcnosti.md)
