import serial
import socket

print(f"Penser à killer le service MavP2P")

# Configuration
SERIAL_PORT = '/dev/ttyAMA0' # Port série du Pi (GPIO 14/15)
BAUD_RATE = 115200
UDP_PORT = 5005

# Setup Serial & UDP
ser = serial.Serial(SERIAL_PORT, BAUD_RATE, timeout=0.1)
sock = socket.socket(socket.AF_INET, socket.SOCK_DGRAM)
sock.bind(("0.0.0.0", UDP_PORT))
sock.setblocking(False)

remote_addr = None

print(f"Pont RPi démarré sur {SERIAL_PORT}")

try:
    while True:
        # UDP -> Port Série
        try:
            data, addr = sock.recvfrom(1024)
            remote_addr = addr # Mémorise l'IP du PC pour répondre
            ser.write(data)
        except BlockingIOError:
            pass

        # Port Série -> UDP
        if ser.in_waiting > 0:
            data = ser.read(ser.in_waiting)
            if remote_addr:
                sock.sendto(data, remote_addr)
except KeyboardInterrupt:
    ser.close()
    print("Arrêt du pont.")