Skip to content

πŸ† БорСвнования, баланс+

Choose a tag to compare

@Mukller Mukller released this 11 Jun 17:49

ВСрсия для сорСвнований с ΡƒΠ»ΡƒΡ‡ΡˆΠ΅Π½Π½ΠΎΠΉ балансировкой ΠΈ слСТСниСм ΠΏΠΎ Π»ΠΈΠ½ΠΈΠΈ

НовоС в v3.2.0

  • πŸ€– Π‘Ρ‚Π°Π±ΠΈΠ»ΡŒΠ½Π°Ρ балансировка Π½Π° мСстС (STATE_IDLE, 5 сСк)
  • ➑️ ΠŸΡ€ΡΠΌΠΎΠ΅ Π΄Π²ΠΈΠΆΠ΅Π½ΠΈΠ΅ Π²ΠΏΠ΅Ρ€Π΅Π΄ (STATE_STRAIGHT, 2 сСк)
  • πŸ“ БлСдящСС ΠΏΠΎ Π»ΠΈΠ½ΠΈΠΈ Π΄Π²ΠΈΠΆΠ΅Π½ΠΈΠ΅ (STATE_LINE_FOLLOW)
  • πŸ”§ АвтоматичСскоС ΠΎΠ±Π½Π°Ρ€ΡƒΠΆΠ΅Π½ΠΈΠ΅ Π½Π΅Ρ€Π°Π±ΠΎΡ‚Π°ΡŽΡ‰ΠΈΡ… Π΄Π°Ρ‚Ρ‡ΠΈΠΊΠΎΠ²
  • πŸ“Š Π Π°ΡΡˆΠΈΡ€Π΅Π½Π½Π°Ρ диагностика Π² Serial (ΠΊΠ°ΠΆΠ΄Ρ‹Π΅ 100мс)

ΠšΠ»ΡŽΡ‡Π΅Π²Ρ‹Π΅ особСнности

βœ… БистСма автоматичСски Ρ€Π°Π±ΠΎΡ‚Π°Π΅Ρ‚ Π΄Π°ΠΆΠ΅ Ссли Ρ†Π΅Π½Ρ‚Ρ€Π°Π»ΡŒΠ½Ρ‹Π΅ Π΄Π°Ρ‚Ρ‡ΠΈΠΊΠΈ Π»ΠΈΠ½ΠΈΠΈ Π½Π΅ ΠΎΡ‚Π²Π΅Ρ‡Π°ΡŽΡ‚
βœ… Π˜ΡΠΏΠΎΠ»ΡŒΠ·ΡƒΠ΅Ρ‚ ΠΊΡ€Π°ΠΉΠ½ΠΈΠ΅ Π΄Π°Ρ‚Ρ‡ΠΈΠΊΠΈ (GPIO 34, 32) для слСТСния ΠΏΠΎ Π»ΠΈΠ½ΠΈΠΈ
βœ… PID ΠΊΠΎΠ½Ρ‚Ρ€ΠΎΠ»ΡŒ балансировки синхронизирован с Ρ€ΡƒΠ»Π΅Π½ΠΈΠ΅ΠΌ
βœ… ВстроСнная Π·Π°Ρ‰ΠΈΡ‚Π°: ΠΌΠΎΡ‚ΠΎΡ€Ρ‹ стопят ΠΏΡ€ΠΈ ΡƒΠ³Π»Π΅ >70Β°
βœ… ВСст ΠΌΠΎΡ‚ΠΎΡ€ΠΎΠ² ΠΏΡ€ΠΈ Π²ΠΊΠ»ΡŽΡ‡Π΅Π½ΠΈΠΈ (1 сСк)

Как ΠΈΡΠΏΠΎΠ»ΡŒΠ·ΠΎΠ²Π°Ρ‚ΡŒ

  1. Π—Π°Π³Ρ€ΡƒΠ·ΠΈΡ‚ΡŒ esp32_robot_main.ino Π½Π° ESP32
  2. ΠžΡ‚ΠΊΡ€Ρ‹Ρ‚ΡŒ Serial Monitor (115200 baud)
  3. Π”ΠΎΠΆΠ΄Π°Ρ‚ΡŒΡΡ ΠΊΠ°Π»ΠΈΠ±Ρ€ΠΎΠ²ΠΊΠΈ гироскопа (3 ΠΏΠΎΠΏΡ‹Ρ‚ΠΊΠΈ)
  4. ΠŸΠΎΠ΄Π½ΡΡ‚ΡŒ Ρ€ΠΎΠ±ΠΎΡ‚Π° Π²Π΅Ρ€Ρ‚ΠΈΠΊΠ°Π»ΡŒΠ½ΠΎ ΠΈ Π΄Π΅Ρ€ΠΆΠ°Ρ‚ΡŒ Π½Π΅ΠΏΠΎΠ΄Π²ΠΈΠΆΠ½ΠΎ
  5. ПослС 5 сСк балансировки Ρ€ΠΎΠ±ΠΎΡ‚ ΠΏΠ΅Ρ€Π΅ΠΉΠ΄Π΅Ρ‚ Π² Ρ€Π΅ΠΆΠΈΠΌ двиТСния

Для слСТСния ΠΏΠΎ Π»ΠΈΠ½ΠΈΠΈ

  • Π—Π°ΠΏΡƒΡΡ‚ΠΈΡ‚ΡŒ test_line_calibrate.ino для ΠΏΡ€ΠΎΠ²Π΅Ρ€ΠΊΠΈ Π΄Π°Ρ‚Ρ‡ΠΈΠΊΠΎΠ²
  • ВрСбуСтся чёрная линия Π½Π° Π±Π΅Π»ΠΎΠΌ Ρ„ΠΎΠ½Π΅ (контрастная)
  • Π§ΠΈΡ‚Π°ΠΉ LINE_FOLLOWING_GUIDE.md для ΠΏΠΎΠ»Π½ΠΎΠΉ инструкции

Hardware

  • ESP32 (Arduino Core v3.x)
  • MPU6050/6500/9250 (гироскоп + аксСлСромСтр)
  • VL53L0X (Π»Π°Π·Π΅Ρ€Π½Ρ‹ΠΉ Π΄Π°Π»ΡŒΠ½ΠΎΠΌΠ΅Ρ€)
  • TMC2209 (Π΄Ρ€Π°ΠΉΠ²Π΅Ρ€ ΠΌΠΎΡ‚ΠΎΡ€ΠΎΠ²)
  • 5 Π΄Π°Ρ‚Ρ‡ΠΈΠΊΠΎΠ² Π»ΠΈΠ½ΠΈΠΈ (GPIO 34, 35, 36, 39, 32)

Π€Π°ΠΉΠ»Ρ‹ Π² Ρ€Π΅Π»ΠΈΠ·Π΅

  • esp32_robot_main.ino β€” основной скСтч (PID + state machine)
  • test_line_calibrate.ino β€” ΠΊΠ°Π»ΠΈΠ±Ρ€ΠΎΠ²ΠΊΠ° Π΄Π°Ρ‚Ρ‡ΠΈΠΊΠΎΠ²
  • LINE_FOLLOWING_GUIDE.md β€” полная докумСнтация
  • ВсС ΠΌΠΎΠ΄ΡƒΠ»ΠΈ (.cpp/.h) Π²ΠΊΠ»ΡŽΡ‡Π΅Π½Ρ‹ Π² ΠΏΠ°ΠΏΠΊΠ΅ скСтча