Untitled

 avatar
unknown
python
5 months ago
1.1 kB
3
Indexable
import serial
import time

# Konfiguracja portu szeregowego
SERIAL_PORT = '/dev/ttyACM0'  # Sprawdź port Arduino za pomocą `ls /dev/tty*`
BAUD_RATE = 115200  # Zmieniona prędkość transmisji

# Inicjalizacja połączenia szeregowego
arduino = serial.Serial(SERIAL_PORT, BAUD_RATE, timeout=1)
time.sleep(2)  # Czekaj na inicjalizację Arduino

def send_motor_commands(speed1, speed2):
    """
    Wyślij komendy do Arduino przez port szeregowy.
    - speed1, speed2: -255 do 255 (prędkości silników, znak określa kierunek)
    """
    try:
        # Tworzenie wiadomości do wysłania
        message = f"{speed1},{speed2}\n"
        arduino.write(message.encode())  # Wysyłanie danych do Arduino
        print(f"Wysłano dane: {message.strip()}")
    except Exception as e:
        print(f"Błąd komunikacji: {e}")

if __name__ == "__main__":
    while True:
        # Przykładowe dane
        send_motor_commands(128, -128)  # Motor 1 forward, Motor 2 backward
        time.sleep(1)

        send_motor_commands(-200, 50)  # Motor 1 backward, Motor 2 forward
        time.sleep(1)
Editor is loading...
Leave a Comment