Vai al contenuto
ELECTRONICS ENGINEERINGelectronics-engineering.com
Automotive

ACC 5: pianificazione, inseguimento, avvicinamento elastico, preboost e stop & go

Time gap corto, medio, lungo e molto lungo, stabilità e stabilità della colonna dimostrate, avvicinamento cinematico con elasticità, preboost di sorpasso, legge di arresto dello stop & go, MPC.

https://www.electronics-engineering.com/acc-pianificazione-time-gap-stabilita-colonna-avvicinamento-preboost-stop-and-go

Nessun voto ancora: sii il primo a votare questa pagina.

Abbiamo l’obiettivo: la sua distanza d, la sua velocità v_t, la sua accelerazione a_t. Il pianificatore decide, ogni 20 ms, quale accelerazione chiedere all’auto. Non basta un regolatore: inseguire a regime, avvicinarsi a un veicolo molto più lento, preparare un sorpasso e fermarsi in coda sono problemi diversi, con soluzioni diverse. La struttura che usiamo è quella di molti sistemi di serie, a regole: ogni modo propone un’accelerazione, vince la più prudente, poi limiti e strappo.

Pianificatore a regole come schema a blocchi
Il pianificatore: quattro proposte (velocità impostata, inseguimento con il termine di preboost, avvicinamento cinematico, variazione del time gap per il sorpasso) entrano in un blocco di minimo; poi saturazione ai limiti della norma e limitatore di strappo. L’uscita è la richiesta a_{req} al controllo di coppia.

La politica a tempo di distanziamento costante

La distanza desiderata è d_{des} = d_0 + h\,v: cresce con la nostra velocità. Gli errori che il pianificatore usa sono

    \[ e_d = d - d_{des}, \qquad \Delta v = v_t - v. \]

Perché proprio così e non una distanza fissa? Con una distanza fissa una colonna di auto con ACC amplifica i disturbi lungo la colonna a meno di comunicare tra veicoli; con il tempo di distanziamento si può evitare, come dimostriamo tra poco. Il guidatore sceglie h tra quattro valori.

Le quattro impostazioni del tempo di distanziamento
A sinistra, la distanza desiderata in funzione della velocità per corto (1.0 s), medio (1.4 s), lungo (1.8 s) e molto lungo (2.2 s), con il minimo della norma (0.8 s, punteggiato). A 130 km/h vanno da 40 a 83 m. A destra, inseguendo un’auto a 100 km/h, il guidatore passa da lungo a molto lungo (5 s) e poi, con due pressioni, a corto (25 s): h (viola) cambia di 0.25 s al secondo e la distanza lo segue senza strappi.

Il cambio di h è volutamente lento: un salto da 2.2 a 1.0 s significherebbe un errore di distanza di 33 m in un istante, e il regolatore accelererebbe di colpo.

Inseguimento a regime

Il modo di base è un regolatore proporzionale-derivativo sull’errore di distanza, con l’accelerazione dell’obiettivo in anticipo:

    \[ a_f = k_d\, e_d + k_v\, \Delta v + k_a\, a_t, \qquad k_d = 0.15\ \mathrm{s^{-2}},\ k_v = 0.6\ \mathrm{s^{-1}},\ k_a = 0.3. \]

Stabilità. Supponiamo per ora che l’auto realizzi subito l’accelerazione chiesta (\dot v = a_f) e che l’obiettivo vada a velocità costante. Allora \dot e_d = \Delta v - h\,\dot v e \dot{\Delta v} = -\dot v, cioè

    \[ \frac{d}{dt}\begin{bmatrix}e_d\\ \Delta v\end{bmatrix} = \begin{bmatrix}-h k_d & 1 - h k_v\\ -k_d & -k_v\end{bmatrix}\begin{bmatrix}e_d\\ \Delta v\end{bmatrix}. \]

La traccia è -(k_v + h k_d), il determinante h k_d k_v + k_d(1 - h k_v) = k_d: il polinomio caratteristico è

    \[ s^2 + (k_v + h k_d)\,s + k_d = 0, \]

stabile per ogni k_d \mathchar"313E  0, k_v + h k_d \mathchar"313E  0 (il criterio di Routh per il secondo ordine). Con h = 1.8 s: pulsazione naturale \sqrt{0.15} = 0.39 rad/s e smorzamento (0.6 + 0.27)/(2\cdot 0.39) = 1.12, cioè nessuna sovraelongazione (la risposta del secondo ordine). Un inseguimento lento e tranquillo è quello che si vuole: nessuno vuole un’auto che reagisce a ogni piccola variazione di chi la precede.

Inseguimento di un veicolo che cambia velocità
Inseguimento di un’auto che oscilla tra 85 e 95 km/h con periodo di 12 s: la nostra velocità (blu) segue con un leggero ritardo e un’ampiezza minore; la distanza resta vicina a quella desiderata.

La stabilità della colonna

Una sola auto stabile non basta. In una colonna di auto con ACC ognuna segue la precedente: se ciascuna amplifica un po’ le variazioni di velocità, l’ultima subisce un disturbo enorme (è l’onda che nasce dal nulla negli ingorghi). Con le trasformate di Laplace (vedi le funzioni di trasferimento), per l’auto i che segue l’auto i-1:

    \[ s V_i = k_d\left(\frac{V_{i-1} - V_i}{s} - h V_i\right) + k_v (V_{i-1} - V_i) \;\Rightarrow\; G(s) = \frac{V_i}{V_{i-1}} = \frac{k_v s + k_d}{s^2 + (k_v + k_d h)s + k_d}. \]

La colonna non amplifica i disturbi se |G(j\omega)| \le 1 a ogni frequenza. Con s = j\omega:

    \[ k_d^2 + k_v^2\omega^2 \le (k_d - \omega^2)^2 + (k_v + k_d h)^2\omega^2 \iff \omega^2 + k_d^2 h^2 + 2 k_v k_d h - 2 k_d \ge 0. \]

Il caso peggiore è \omega \to 0; dividendo per k_d si ottiene la condizione

    \[ \boxed{\,k_d h^2 + 2 k_v h \ge 2\,}. \]

Con k_d = 0.15, k_v = 0.6: per h = 1.5 vale 2.14 e va bene; per h = 1.0 vale 1.35 e la colonna amplifica. Per questo i guadagni non possono essere fissi: nel codice k_v cresce quando il time gap si accorcia, k_v = \max(0.6,\ (2 - k_d h^2)/(2h) + 0.05), cioè 0.98 per h = 1.0 s.

Modulo della funzione di trasferimento della colonna
|G(j\omega)| in decibel per diversi time gap con i guadagni fissi (linee continue): per 0.8 e 1.0 s supera 0 dB, la colonna amplifica. Le linee tratteggiate sono gli stessi time gap con k_v adattato: restano sotto 0 dB.
Una colonna di otto auto
Otto auto in colonna; la prima frena a −2 m/s² per 2 s e poi riaccelera. Con h = 0.6 s e guadagni fissi (sinistra) l’onda cresce: la prima scende a 75.6 km/h, l’ultima a 68.9. Con h = 1.5 s (destra) si smorza: l’ultima scende solo a 79.7 km/h. Gli attuatori hanno un ritardo di 0.2 s, che peggiora la condizione: è una delle ragioni del minimo di 0.8 s della norma.

L’avvicinamento a un veicolo più lento

Arriviamo a 130 km/h e davanti, a 200 m, c’è un’auto a 80 km/h. Il regolatore di inseguimento, lasciato fare, aspetta che l’errore di distanza diventi piccolo e poi frena forte: con \Delta v = -14 m/s il termine k_v\Delta v vale -8.3 m/s², limitato a -3.5. Un guidatore esperto fa diversamente: smette di accelerare, poi frena dolcemente e in modo costante.

La decelerazione cinematica. Nel moto relativo, con l’obiettivo a velocità costante, una decelerazione costante a annulla la differenza di velocità \Delta v dopo uno spazio relativo D dato da \Delta v^2 = 2|a|D. Se vogliamo che \Delta v si annulli esattamente quando la distanza arriva a d_{end}, serve

    \[ a_{kin} = -\frac{\Delta v^2}{2\,(d - d_{end})} + a_t. \]

Ricalcolata a ogni ciclo, questa legge corregge da sola gli errori: se l’auto frena meno del previsto, lo spazio rimasto diminuisce e la richiesta aumenta.

L’elasticità. Non è necessario arrivare esattamente a d_{des} con \Delta v = 0. Se accettiamo di scendere temporaneamente sotto la distanza desiderata di un margine \delta e di recuperarlo dopo con calma, lo spazio disponibile per frenare cresce e la frenata si addolcisce: con d_{end} = d_{des} - \delta,

    \[ |a_{kin}| = \frac{\Delta v^2}{2\,(d - d_{des} + \delta)} \mathchar"313C  \frac{\Delta v^2}{2\,(d - d_{des})}. \]

Nel codice \delta = \min(0.25\,h\,v,\ 12\ \mathrm{m}): un quarto della distanza desiderata, mai più di 12 m.

Fasi dell'avvicinamento
Le fasi nel piano distanza e velocità di avvicinamento: (1) si smette di accelerare e si veleggia; (2) frenata costante sulla parabola \Delta v^2 = 2|a|(d - d_{end}), che finisce a d_{des} - \delta invece che a d_{des} (tratteggiata); (3) breve sotto-distanza elastica; (4) recupero dolce fino a d_{des}.

Tre dettagli rendono la manovra robusta:

  • modo con isteresi: l’avvicinamento comincia con una velocità di avvicinamento vera (oltre 1 m/s) e finisce quando questa è quasi nulla o il margine elastico è finito; senza isteresi, con \Delta v vicino a zero il modo si accende e si spegne;
  • fase dolce: finché a_{kin} è più debole di quanto si ottiene rilasciando il pedale (-0.35 m/s²), si lascia lavorare il regolatore di inseguimento, ma senza frenare più del necessario (\max(a_f, a_{kin})) e senza avvicinarsi più in fretta di \sqrt{2\cdot 0.35\,(d - d_{end})};
  • recupero elastico: dopo l’avvicinamento la distanza mancante si recupera con un guadagno ridotto (k_d = 0.08) e una decelerazione di al massimo -0.3 m/s²: la distanza si riapre perché rallentiamo appena, non perché freniamo.
Avvicinamento: regolatore, cinematica, cinematica con elasticità
Da 130 a 80 km/h partendo da 180 m. Il solo regolatore di inseguimento (grigio) aspetta 5 s e poi frena fino a −1.9 m/s². La legge cinematica (blu) frena subito e in modo costante, al massimo −0.94 m/s². Con l’elasticità (verde) la frenata è ancora più dolce, −0.80 m/s²; la distanza scende a 29 m contro i 37 desiderati e poi si recupera lentamente.

Il preboost di sorpasso

Seguiamo un camion a 80 km/h con la velocità impostata a 130. Il guidatore mette la freccia a sinistra per sorpassare. Un ACC semplice continua a tenere i 37 m di distanza finché il camion non è uscito dal corridoio, e solo allora accelera: il sorpasso comincia lento, e chi arriva da dietro nella corsia di sorpasso deve frenare.

Il preboost anticipa il sorpasso: con la freccia verso la corsia di sorpasso, un obiettivo più lento della velocità impostata e la corsia accanto libera (lo dicono i radar d’angolo e la fusione), il pianificatore

  • riduce il time gap verso h_{pb} = 0.9 s, sempre con la variazione lenta di 0.25 s al secondo;
  • aggiunge un’accelerazione a_{pb} = 0.6 m/s² al termine di inseguimento;
  • smette dopo 4 s se il cambio di corsia non avviene, o appena la freccia si spegne, e la distanza torna dolcemente al valore normale.
Il preboost di sorpasso
Con la freccia a sinistra il time gap scende verso h_{pb} e l’auto comincia ad accelerare prima che il camion esca dal corridoio; dopo il cambio di corsia l’obiettivo è libero e l’accelerazione sale verso a_{max}.
Sorpasso con e senza preboost
Freccia a 5 s, cambio di corsia a 8 s (zona viola). Con il preboost (viola) al cambio di corsia siamo già a 86 km/h invece di 80 e arriviamo a 120 km/h 1.1 s prima; la distanza dal camion scende al minimo a 34.6 m (0.9 s di distanziamento a quella velocità), mai sotto.

Stop & go

Nel traffico in coda l’obiettivo frena fino a fermarsi. Il regolatore di inseguimento, con l’accelerazione dell’obiettivo in anticipo, ne copierebbe la frenata e ci fermerebbe dove ci troviamo, magari a 15 m. Serve invece fermarsi a d_0 dal punto in cui l’altro si fermerà.

La legge di arresto. Se l’obiettivo frena con a_t \mathchar"313C  0, si fermerà dopo lo spazio v_t^2 / (2|a_t|), cioè alla distanza x_{stop} = d + v_t^2/(2|a_t|) da noi. Per fermarci a d_0 dietro quel punto con decelerazione costante:

    \[ a_{stop} = -\frac{v^2}{2\,(x_{stop} - d_0)}. \]

Se l’obiettivo è già fermo, x_{stop} = d. La legge sostituisce inseguimento e avvicinamento quando l’obiettivo si fermerà entro 4 s e noi andiamo sotto i 54 km/h. A bassa velocità valgono i limiti più ampi della ISO 22179, interpolati come visto nella lezione 1: fino a −5 m/s² e +4 m/s² sotto i 18 km/h. Quando siamo fermi a meno di d_0 + 2 m dall’obiettivo fermo, il pianificatore chiede l’arresto e la macchina a stati passa in STANDSTILL: i freni tengono l’auto (lezione 6).

Stop and go in salita
Stop & go su una salita del 4% con tutta la catena longitudinale. L’auto davanti si ferma due volte. Prima sosta: ci fermiamo a 3.93 m e ripartiamo da soli circa 0.6 s dopo che l’altra è ripartita. Seconda sosta: dopo 3 s la macchina a stati passa in WAIT; la ripartenza avviene quando il guidatore preme RES (33 s). Nessun arretramento in salita: i freni (rosso) cedono solo mentre la coppia del motore (verde) cresce.

Arbitraggio, limiti e strappo

Le proposte dei modi (velocità impostata a_{cc} = 0.4\,(v_{set} - v), inseguimento, avvicinamento, arresto) entrano nel blocco di minimo: vince la più prudente. Poi:

  • saturazione ai limiti della norma, che dipendono dalla velocità (da -3.5/+2 m/s² sopra 72 km/h a -5/+4 sotto 18 km/h);
  • limite di strappo: la richiesta cambia al massimo di 2.5 m/s³ (comfort); in frenata decisa (sotto -2 m/s²) fino a 5 m/s³ a bassa velocità.
self.mode = min(cands, key=cands.get)                  # the most cautious proposal wins
a_lo, a_hi, j_lo = iso_limits(v, p)                    # ISO 15622 / 22179, speed dependent
a_goal = float(np.clip(cands[self.mode], a_lo, a_hi))
if self.stop_request:
    a_goal, self.mode = min(a_goal, -0.5), "stop"
jerk = j_lo if a_goal < -2.0 else p.jerk_max
self.a_out += float(np.clip(a_goal - self.a_out, -jerk * dt, p.jerk_max * dt))

L’alternativa: il controllo predittivo

Un approccio diverso è il controllo predittivo (MPC), che abbiamo visto nella lezione sul controllo ottimo e predittivo. Con lo stato (e_d, \Delta v, a) e il modello del moto relativo, a ogni ciclo si risolve un problema quadratico su un orizzonte di qualche secondo: minimizzare una somma pesata di errore di distanza, differenza di velocità, accelerazione e strappo, con vincoli espliciti (limiti della norma, distanza minima, velocità impostata). L’avvicinamento dolce, l’elasticità e la frenata anticipata nascono da soli dal costo e dai vincoli.

A regole (questa lezione)Predittivo (MPC)
comportamentoprogettato modo per modonasce da costo e vincoli
vincolicon saturazioni e casi particolariespliciti, rispettati per costruzione
calcolomicrosecondiun problema quadratico ogni 20 ms
taratura e certificazioneogni parametro ha un significato fisicopesi meno intuitivi, solver da qualificare

Molti sistemi di serie restano a regole proprio per l’ultima riga; l’MPC è sempre più usato dove la centralina ha potenza di calcolo e servono previsioni lunghe (curve, limiti di velocità, cambi di corsia).

La richiesta a_{req} è pronta. Ma l’auto non ha un comando di accelerazione: ha un motore e dei freni. Nella prossima lezione la trasformiamo in coppia alle ruote, con tutta la fisica del veicolo.

Iscriviti
Notificami
guest
0 commenti
Vecchi
Più recenti Le più votate
0
Esprimete la vostra opinione commentando.x