Autonomous Vehicle Simulation: PID Lane Keeping & Reactive Avoidance

Sterowanie PID: podstawa sterowania zwrotnego

Utrzymywanie samochodu na środku pasa ruchu to klasyczny problem sterowania zwrotnym: mierzy się błąd (jak bardzo samochód jest przesunięty z środka), a następnie stale korygowane jest kierownica, aby skierować ten błąd w kierunku zera. Sterownik PID – proporcjonalny, całkowy, pochodna – oblicza korektę kierownicą jako ważoną sumę trzech członów, każdy z nich reaguje na inny aspekt sygnału błędu:

błąd = przesunięcie_w_środek_pasa kierunek = Kp * błąd // P: reakcja na bieżący błąd + Ki * całka(błąd dt) // I: eliminacja stałego odchylenia + Kd * d(błąd)/dt // D: tłumienie oscylacji, reakcja na trend live demo · Sterowanie PID utrzymującym pasy z reaktywną unikanie przeszkód● LIVE Sam człon P sam w sobie działałby, gdyby samochód nie miał masy i nieskończonej responsywności, ale prawdziwa kierownica ma moment bezwładności i opóźnienie: czysty sterownik PID działający sam z siebie skłania się do albo zbyt słabej reakcji (przesuwanie się na boki podczas skręcania) lub oscylacji, jeśli jest mocno napędowany. Człon D przewiduje, w którą stronę zmierza błąd i hamuje korektę przed jej przekroczeniem, co sprawia, że dobrze dostrojona pętla PID wydaje się płynna zamiast nerwowa. Człon I ma mniejsze znaczenie dla utrzymywania pasa ruchu (rzadko występuje stałe odchylenie do zniwelowania) ale jest niezbędny w ogólnym zestawie narzędzi PID do problemów takich jak kontrola prędkości na zboczu, gdzie sterownik P sam w sobie ustala trwały błąd prędkości.

error = lane_center_offset

steer = Kp * error                          // P: react to current error
       + Ki * integral(error dt)            // I: cancel steady-state bias
       + Kd * d(error)/dt                   // D: damp oscillation, react to trend

Raycasting dla wykrywania pasa ruchu

Aby obliczyć początkowy błąd środka pasa ruchu, samochód emituje wiązkę promieni skierowanych na zewnątrz od siebie i mierzy, gdzie każda z nich przecina krawędź drogi lub oznakowanie pasa ruchu – ta sama technika wykorzystywana jest w symulacjach widzenia na głębokos oraz czujników w niezliczonych grach 2D. Zazwyczaj wystarczy krótka wiązka promieni skierowana prosto do przodu i para wiązek skośnych po lewej i prawej stronie; porównanie odległości od krawędzi pasa ruchu z lewej i prawej strony daje przesunięcie boczne bezpośrednio, a porównanie kąta najbliższego segmentu krawędzi do kierunku jazdy samochodu daje wyraz D dla błędu kierunkowego.

Czas do kolizji: kiedy hamować lub zmieniać pas ruchu

Sam utrzymywanie się w pasie ruchu nie zapobiega uderzeniu pojazdu w swoim pasie, dlatego działasz równolegle oddzielna warstwa reaktywna, obserwująca promieniowanie z przodu pod kątem przeszkód i obliczająca czas do kolizji (TTC) zamiast odległości bezwzględnej:

TTC = odległość_do_przeszkody / prędkość_zamknięcia Jeśli TTC, to odpowiednia wartość, a nie odległość bezwzględna, ponieważ uwzględnia względną prędkość: samochód 40 metrów przed, ale zamykający się szybko jest znacznie bardziej pilny niż nieruchoma przeszkoda oddalona o 15 metrów, którą pojazd ledwo podąża; hamowanie lub decyzje o zmianie pasa ruchu wywołane wyłącznie odległością albo zbyt wcześnie hamowałyby w przypadku wolno zamykającego się przerwy, albo zbyt późno w przypadku szybkiego. Zaawansowane systemy wspomagania kierowcy (ostrzeganie przed kolizją czołową, automatyczne hamowanie awaryjne) wykorzystują TTC jako główny trigger dokładnie z tego powodu.

TTC = distance_to_obstacle / closing_speed

if TTC < braking_threshold:   apply brakes proportional to 1/TTC
if TTC < lane_change_threshold and a gap exists:   steer to change lane

Dlaczego dwie warstwy zamiast jednej

Utrzymujemy utrzymywanie pasa ruchu i unikanie kolizji jako oddzielne sterowniki, zamiast łączyć je w jedną, ponieważ działają na różnych skalach czasowych i mają różne tryby awarii: PID utrzymywania pasa ruchu to gładka, ciągła, o niskim priorytecie korekcja, podczas gdy raycast wykrywający niebezpieczną kolizję musi natychmiast i zdecydowanie ją przerwać. Warstwowa architektura – spokojny, bazowy sterownik z warstwą reaktywną zdolną do zakłócenia go w sytuacji zagrożenia – jest tą samą architekturą używaną w rzeczywistych systemach autonomicznej jazdy, gdzie warstwa planowania ustala gładką, zamierzoną trajektorię, a znacznie szybsza warstwa reaktywnej bezpieczeństwa jest dopuszczalna do naruszenia tego planu natychmiast, gdy czas do kolizji spada poniżej twardego progu.

Często zadawane pytania

Wypróbuj na żywo

Wszystko powyżej działa bezpośrednio w Twojej przeglądarce — otwórz Self-Driving Car i zmieniaj parametry podczas działania. Nic nie jest instalowane ani przesyłane na serwer, cały model działa w jednej karcie.