Vai al contenuto
ELECTRONICS ENGINEERINGelectronics-engineering.com
Automotive

ACC 6: dalla richiesta di accelerazione alla coppia, motore, freni e tre zone

Forze sul veicolo con pendenza e vento, massa equivalente dimostrata, modello inverso e PI con anti-windup, tre zone motore, veleggiamento e freni, stima di pendenza e massa, tenuta in salita.

https://www.electronics-engineering.com/acc-controllo-coppia-motore-freni-tre-zone-pendenza-massa

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

Il pianificatore chiede un’accelerazione, a_{req}. L’auto però non ha un comando di accelerazione: ha un motore (o un motore elettrico) che dà coppia positiva e una piccola coppia frenante quando si rilascia il pedale, e dei freni che danno solo coppia frenante. Il controllo longitudinale trasforma a_{req} in due richieste di coppia alle ruote, T_{pt} al gruppo motopropulsore e T_{br} all’ESC, tenendo conto della pendenza, del vento, del carico, dei ritardi degli attuatori. È il punto in cui la fisica del veicolo entra davvero nel software, ed è la parte dove un ACC si sente: un passaggio brusco tra motore e freni, una frenata che arriva in ritardo, un’auto che arretra in salita.

Le forze sul veicolo

Forze longitudinali su un'auto in salita
L’auto su una salita di angolo \theta con vento v_w. Lungo la strada agiscono la forza motrice alle ruote F_x, la resistenza aerodinamica F_a, la resistenza al rotolamento F_r e la componente del peso m g \sin\theta; le reazioni normali N_f, N_r bilanciano m g \cos\theta.

La seconda legge di Newton lungo la strada (vedi le leggi di Newton e il piano inclinato) dà

    \[ m_{eq}\, a = F_x - F_a - F_r - m g \sin\theta, \]

con

  • F_x = (T_{pt} - T_{br})/r: la coppia totale alle ruote divisa per il raggio della ruota;
  • F_a = \tfrac12\rho\, C_d A\,(v - v_w)\,|v - v_w|: conta la velocità rispetto all’aria; v_w \mathchar"313E  0 è vento in coda, v_w \mathchar"313C  0 vento contrario;
  • F_r = c_r\, m g \cos\theta: rotolamento, con c_r \approx 0.012;
  • m g\sin\theta: la pendenza. Una salita del 5% significa \tan\theta = 0.05.

Per la nostra auto (1600 kg, C_d A = 0.7 m²) a 100 km/h: F_a = 324 N, F_r = 188 N, e una salita del 5% aggiunge 783 N, più delle altre due insieme. Un vento contrario di 12 m/s porta l’aerodinamica da 324 a 665 N. Un carico di 350 kg aggiunge il 22% a tutto ciò che dipende dalla massa. Nessuna di queste grandezze è nota con precisione al software: le gestiremo con stime e con la retroazione.

La massa equivalente

Trasmissione con inerzie e rapporti
Motore con inerzia J_e, cambio con rapporto i_g e rendimento \eta_g, differenziale i_0, ruote di inerzia J_w e raggio r.

Accelerare l’auto vuol dire accelerare anche tutto quello che gira. La massa equivalente si ricava dall’energia cinetica: con la velocità angolare delle ruote \omega_w = v/r e del motore \omega_e = i_g i_0\,v/r,

    \[ \tfrac12 m_{eq} v^2 = \tfrac12 m v^2 + \tfrac12 J_w \omega_w^2 + \tfrac12 J_e \omega_e^2 \;\Rightarrow\; m_{eq} = m + \frac{J_w}{r^2} + \frac{J_e (i_g i_0)^2}{r^2}. \]

In marcia alta m_{eq} supera m di qualche per cento (4% nel nostro modello), in prima marcia anche del 30% (la dinamica rotazionale spiega perché: il motore gira molto più veloce delle ruote e il termine cresce con il quadrato del rapporto).

La parte in anticipo: il modello inverso

Se conoscessimo tutto, la coppia necessaria si ricaverebbe invertendo l’equazione del moto:

    \[ T_{ff} = r\left(\hat m_{eq}\, a_{req} + \hat F_a(v) + \hat F_r + \hat m g \sin\hat\theta\right). \]

È la parte in anticipo (feedforward): da sola fa quasi tutto il lavoro, con le stime \hat m e \hat\theta che vedremo tra poco. Quello che non sa (il vento, gli errori del modello, l’efficacia variabile dei freni) lo corregge una retroazione proporzionale-integrale sull’errore di accelerazione, con l’accelerazione ricavata dalle velocità delle ruote:

    \[ T = T_{ff} + r\,\hat m_{eq}\left(k_p\,e + k_i\!\int e\,dt\right),\qquad e = a_{req} - \hat a. \]

L’azione integrale ha bisogno di un buon anti-windup (vedi il regolatore PID): qui non si integra quando l’attuatore della zona attiva è al limite, quando un cambio di zona è in corso o appena avvenuto, e nella zona intermedia. Senza la seconda regola, durante il tempo di attesa prima di passare ai freni l’integrale si caricava e poi faceva frenare l’auto a −3.9 m/s² invece dei −3.0 richiesti: lo abbiamo trovato nella simulazione e corretto.

Le tre zone

Il punto più delicato è la divisione tra motore e freni. La frontiera naturale è l’accelerazione di veleggiamento a_c: quella che l’auto ha con il pedale rilasciato e senza freni,

    \[ a_c(v, \theta, m) = \frac{T_{coast}/r - F_a(v) - F_r - m g\sin\theta}{m_{eq}}, \]

dove T_{coast} (−180 Nm alle ruote nel nostro modello) è il freno motore. Sopra a_c basta il motore; sotto servono i freni.

Le tre zone in funzione della velocità
Le zone nel piano velocità e accelerazione richiesta: D (motore, verde) sopra a_c, B (freni, rosso) sotto, C (veleggiamento, arancione) nella fascia intorno ad a_c. La curva a_c dipende molto dalla pendenza: a 100 km/h −0.64 m/s² in piano, −1.11 in salita del 5%, −0.16 in discesa del 5%. La curva verde in alto è il limite della potenza.

Il caso difficile è proprio la fascia intermedia, perché lì si sommano quattro problemi:

  1. piccole coppie frenanti sono imprecise: le prime decine di Nm di pressione vincono solo le molle dei pistoncini (nel modello 25 Nm non frenano), le pastiglie lontane dal disco hanno bisogno di 0.1 s per toccarlo, e una frenata leggera è rumorosa e consuma le pastiglie;
  2. i due attuatori hanno tempi diversi: il motore risponde con un tempo morto e una costante di tempo di 0.25 s, i freni in 0.12 s;
  3. la richiesta ha rumore: oscilla di qualche centesimo di m/s² con le misure dei sensori; con una frontiera netta passa avanti e indietro tra motore e freni;
  4. la frontiera si muove: dipende da velocità, pendenza e massa stimate.

Le soluzioni, nel codice:

  • una fascia di accettazione: nella zona C il motore è rilasciato e i freni non lavorano; l’errore residuo (al massimo la larghezza della fascia, 0.08 m/s²) si accetta e l’integrale si ferma, così non si carica;
  • tempo minimo in una zona (0.3 s) prima di cambiarla, tranne per una frenata vera (più di 0.5 m/s² sotto a_c), che entra subito;
  • coppia frenante minima di 40 Nm quando i freni sono attivi: o si frena in modo efficace o non si frena;
  • passaggio di consegne senza gradini: entrando nei freni, il motore non va a zero di colpo; i freni danno esattamente la differenza tra la coppia stimata del motore (un modello del suo ritardo) e quella totale, così la somma resta costante mentre il motore cala;
  • riempimento (prefill): se nella zona C la richiesta scende in fretta verso i freni, 15 Nm avvicinano le pastiglie al disco senza frenare.
Macchina a stati delle tre zone
Le transizioni tra le zone D, C e B: le soglie a_c \pm b, il tempo minimo \tau_d, l’ingresso immediato nei freni per una richiesta urgente. In ogni zona è indicato come si dividono le coppie.
Passaggio attraverso la zona intermedia
La richiesta scende lentamente da +0.4 a −1.2 m/s² e risale, con il rumore di una richiesta vera. Divisione ingenua (grigio, frontiera netta sulla coppia): 10 cambi tra motore e freni. Tre zone (blu): 4 cambi, il minimo per una rampa che scende e risale, i freni si attivano una sola volta, errore massimo 0.13 m/s² in entrambi i casi.

Con un’auto elettrica la zona C si allarga molto: la frenata rigenerativa del motore arriva a −1.5 m/s² e oltre, e la divisione diventa tra rigenerazione (che recupera energia) e freni a disco (per le frenate forti o a batteria carica). La struttura è la stessa, con il motore che lavora anche con coppie negative.

Stimare pendenza e massa

Il modello inverso ha bisogno di \hat\theta e \hat m. Si ricavano da segnali che ogni auto ha già.

Pendenza. L’accelerometro longitudinale (nell’unità inerziale dell’ESC) non misura l’accelerazione dell’auto ma la forza specifica: in salita la gravità lo “tira” all’indietro come un’accelerazione in avanti, e misura a_{imu} = a + g\sin\theta. Le ruote invece misurano solo a (derivando la velocità). Quindi

    \[ \sin\hat\theta = \frac{a_{imu} - \hat a_{wheel}}{g}, \]

filtrata con una costante di tempo di 1 s. Un errore di 0.03 m/s² dell’accelerometro (il suo offset) diventa un errore di pendenza dello 0.3%: piccolo, e la retroazione lo corregge. A veicolo fermo la formula dà la pendenza esatta: serve per tenere l’auto in salita.

Massa. In marcia, senza freni, l’equazione del moto dice

    \[ \underbrace{\hat T_{pt}/r - F_a - m_{nom} k_{rot}\,\hat a}_{y} = m\,\underbrace{(a_{imu} + g\,c_r)}_{\varphi}, \]

lineare nella massa: è una regressione, e la si risolve con i minimi quadrati in forma ricorsiva (RLS), aggiornando la stima a ogni campione:

    \[ k = \frac{P\varphi}{\lambda + \varphi^2 P},\qquad \hat m \leftarrow \hat m + k\,(y - \varphi\hat m),\qquad P \leftarrow \frac{P - k\varphi P}{\lambda}. \]

Il fattore di oblio \lambda = 0.998 dà una memoria di circa 10 s. La stima si aggiorna solo quando l’equazione è affidabile: niente freni (la loro coppia è poco nota), velocità oltre 18 km/h, accelerazione di almeno 0.3 m/s² (altrimenti \varphi è piccolo e la stima prende il rumore).

Stima di massa e pendenza
Auto con 350 kg di carico (massa vera 1950 kg, nominale 1600) e una salita del 6% tra 30 e 45 s. La massa stimata arriva a 1890 kg dopo le prime accelerazioni e a 1906 kg alla fine (errore del 2%); la pendenza stimata 6.32% contro 5.99% veri (l’offset dell’accelerometro).

Il controllore al lavoro

Controllore longitudinale come schema a blocchi
Il controllore come schema a blocchi: parte in anticipo (FF) con massa e pendenza stimate, PI con anti-windup sull’errore tra a_{req} e l’accelerazione stimata, somma in T_{tot}, divisione nelle zone in base ad a_c, modello del motore che dà la coppia stimata \hat T_{pt} per il passaggio ai freni; lo stimatore (EST) ricava \hat a, \hat\theta, \hat m da velocità e accelerometro.

Il banco di prova più duro: 90 km/h, e tutto quello che il controllore non sa. Un carico di 350 kg, una salita del 6% da 4 a 20 s, 12 m/s di vento contrario da 14 s, freni del 20% meno efficaci (pastiglie fredde o usurate), offset dell’accelerometro; alla fine una frenata richiesta di 2 m/s².

Prestazioni con disturbi non noti
Solo modello inverso con parametri nominali (arancione): l’auto perde velocità fino a 51 km/h. Con le stime di massa e pendenza (viola): 85 km/h. Con anche il PI (verde): 89.8 km/h, e in frenata −1.98 m/s² di media contro −2 richiesti, nonostante i freni più deboli. In basso le coppie di motore e freni nella versione completa.
Inseguimento di un veicolo che frena
L’obiettivo frena a −3 m/s² da 90 a 50 km/h. Al centro la richiesta del pianificatore (viola) e l’accelerazione vera (blu); in basso la coppia del motore scende fino al freno motore e i freni prendono il resto senza gradini.

Ferma, in salita

Quando la macchina a stati è in STANDSTILL o WAIT (stop & go, lezione 5) il controllore riceve il comando di tenuta:

  • tenuta: freni a 1.3\,|r\,\hat m g\sin\hat\theta| + 400 Nm, almeno 800 Nm, e l’integrale azzerato. A veicolo fermo la pendenza stimata è esatta;
  • ripartenza senza arretrare: sotto 0.5 m/s in salita i freni tengono la parte del peso che il motore non dà ancora, T_{br} = 1.15\,r\,\hat m g\sin\hat\theta + 100 - \hat T_{pt}, e si aprono man mano che la coppia del motore cresce. Nello stop & go della lezione 5, su una salita del 4%, l’auto non arretra di un millimetro.
/* 2. zone around the coast acceleration, band + dwell time; urgent braking enters at once */
a_c = CoastAcceleration(p, v, c->sin_th, m);
want = a_req > a_c + c->b_hi ? Z_DRIVE : (a_req < a_c - c->b_lo ? Z_BRAKE : Z_COAST);
c->t_zone += ACC_DT;
urgent = want == Z_BRAKE && a_req < a_c - 0.5f;
if (want != c->zone && (c->t_zone >= c->t_dwell || urgent)) { c->zone = want; c->t_zone = 0.0f; }
sat = t_tot > t_hi || t_tot < t_lo || (c->zone == Z_DRIVE && t_tot < p->t_coast && e < 0.0f);
settling = want != c->zone || c->t_zone < c->t_dwell;
if (c->zone != Z_COAST && !sat && !settling) c->i_term += c->ki * e * ACC_DT;      /* anti-windup */
t_tot = clampf(t_tot, t_lo, t_hi);
/* 3. split: the brakes complement the ESTIMATED powertrain torque */
*t_pt = c->zone == Z_DRIVE ? t_tot : p->t_coast;
*t_br = c->zone == Z_BRAKE ? maxf(c->t_brake_min, c->t_pt_est - t_tot) : 0.0f;

Abbiamo tutti i pezzi. Nell’ultima lezione li mettiamo insieme e li proviamo su un catalogo di scenari con criteri misurabili, in Python e in C.

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