Proiectul implementeaza un pendul invers ce balanseaza un obiect pe verticala în sus folosind un algoritm de control - PID. Sunt mai multe variante de pendul invers, unele mai ușor de implementat (folosirea unei roți cu greutǎți - însuși greutatea, obiectul balansat face balansarea), sau ce am ales sǎ realizez eu, balansarea unui obiect independent de modulul de balansare folosind un motor la baza acestuia.

Ideea de la care am pornit a fost în sine echilibrarea unui pendul, vǎzând pe internet tot felul de self-balancing robots și aplicarea unui algoritm de control.

Proiectul poate fi folosit în sine pentru explicarea mai ușoara a PID-ului altor studenți, având un feedback live asupra ce fac cele 3 elemente din PID asupra unui sistem controlat, putând din interfața web sǎ aplici noi valori la un singur click.

User-ul va putea trimite valori pentru PID live cǎtre main controller (ESP32) folosind un web server. ESP-ul va aplica algoritmul de control asupra unui Motor folosind valorile pentru PID primite din aplicația web.

Pentru ușurarea sistemului avem urmatoarele surse de input:

• Poziția si viteza motorului care face balansarea pendulului.
• Pozitia pendulului la momentul actual folosind un incremental rotary encoder.

Folosind aceste lucruri putem ajunge la poziția de control a pendulului.

Listă de piese:

• ESP32 DevKit V1 - ESP32-WROOM-32 240Mhz
• Incremental Rotary Encoder - folosit pentru calcularea unghiului
• Motor DC 12V, 280RPM
• Sursa de tensiune in comutatie Meanwell 12V 75W
• Buck-Converter LM2596HS-ADJ
• INFINEON IFX9201SG 6A H-bridge motor driver
• Pendul realizat din fibra de sticla
• Diverse bracket-uri si componente printate 3D
• Componente electronice de baza (condensatoare, rezistente, etc.)

Schema electrica motor driver:

Schema electrica full: schematic_invertedpendulum.pdf

Modelul 3D al PCB-ului:

Modelele 3D ale proiectului:

Stare actuala pendul: (Nu a venit inca PCB-ul)

Platform.io:

Platform.io este un mediu de dezvoltare built on top of VS Code, mult mai rapid si mai versatil decat simplul Arduino IDE, ce ofera posibilitatea programarii multor environment-uri, printre care si cel de la Esspressif32. Compilarea si upload-ul catre placi este mult mai smooth, putand face si software debug prin serial.

Librarii si surse:

Pentru librarii am folosit Arduino.h si RotaryEncoder.h, care vine cu niste functii mai rapide de a calcula unghiul din cele 1200 de pulsuri folosind un interrupt handler mai eficient.

Algoritmi si structuri: Pe partea de algoritmi, proiectul se bazeaza pe un algoritm de control, mai exact PID, ce se foloseste de unghiul la momentul T al pendulului ca input.

k_p = 1
k_i = 0
k_d = 0
 
# Loop forever
interval = 1 #1ms
error_prev = 0
integral = 0
setpoint = 180
while True:
 
    # Get angle from encoder(feedback)
    val = encoder->get_angle()
 
    # Calculate the PID terms
    error = setpoint – val
    integral = integral + (error * interval)
    derivative = (error – error_prev) / interval
    output = (k_p * error) + (k_i * integral) + (k_d * derivative)
 
    # Save value for next iteration
    error_prev = error

Export to PDF