METHOD FOR CONTROLLING A WHEELED VEHICLE IN LOW-GRIP CONDITIONS

Abstract

A method of controlling a vehicle having wheels provided with tires resting on a surface, the method using a model of the physical behavior of each tire as a function of a sideslip angle (β.sub.ij) for each tire relative to the surface. The model is obtained by implementing an adaptive algorithm that selectively applies an affABREGEine model (Z1), a DUGOFF model (Z2), or a constant model (Z3).

Claims

1. A method of controlling a vehicle having wheels provided with tires resting on a surface, the method using a model of the physical behavior of each tire as a function of a sideslip angle for each tire relative to the surface, the method being characterized in that the model is obtained by defining a theoretical curve for variation of the lateral force exerted by a tire on the surface as a function of its sideslip angle by identifying in the curve a first zone of linear variation, a second zone of linear-to-nonlinear transition, and a third zone of nonlinear variation; and, for each tire, executing the steps of: acting in real time to define a group of successive lateral force values, each corresponding to a sideslip angle and determining whether said values are varying in accordance with the first zone, the second zone, or the third zone; applying an affine model when the values are varying in accordance with the first zone; applying a DUGOFF model when the values are varying in accordance with the second zone; and applying a constant model when the values are varying in accordance with the third zone.

2. The method according to claim 1, wherein the affine model has the form:
F*.sub.yij=a.sub.1β.sub.ij+b.sub.1 where F*.sub.yij is the value of the lateral force of each tire, a.sub.1 is the slope of the curve in the zone and b.sub.1 is the intercept.

3. The method according to claim 1, wherein the DUGOFF model has the form:
F*.sub.yij=F.sub.y.sub.ij dug where: F*.sub.yij is the lateral force of each tire; $F_{y_{\mathrm{ij}\mathrm{dug}}}=\{\begin{array}{cc}{C}_{{\beta }_{\mathrm{ij}}}\tan \left({\beta }_{\mathrm{ij}}\right)& \mathrm{if}\lambda \ge 1\\ C_{{\beta }_{\mathrm{ij}}}\tan \left({\beta }_{\mathrm{ij}}\right)\left(2-\lambda \right)\lambda & \mathrm{if}\lambda <1\end{array};$ $\lambda =\frac{{\mu }_{y_{\mathrm{ij}}\max }{F}_{z_{\mathrm{ij}}}}{2C_{{\beta }_{\mathrm{ij}}}.Math.\tan \left({\beta }_{\mathrm{ij}}\right).Math.};$ C.sub.βij is the cornering stiffness coefficient of each tire; μ.sub.ymaxij is the maximum lateral friction coefficient of each tire; and β.sub.ij is the sideslip angle of each tire.

4. The method according to claim 1, wherein the constant model has the form:
F*.sub.yij=b.sub.2 where F*.sub.yij is the lateral force of each tire and b.sub.2 is the maximum lateral force in the third zone.

5. The method according to claim 1, wherein application of each of the models consists in finding the cornering stiffness coefficient and the maximum lateral friction coefficient for each tire that minimizes the difference between the lateral force values obtained for each tire with each model and the values of the group of values.

6. The method according to claim 5, wherein application of the affine model implements the least squares method.

7. The method according to claim 5, wherein application of the DUGOFF model includes implementing a Levenberg Marquardt optimization algorithm.

8. The method according to claim 1, wherein the group of lateral force values is modified by adding a value if: the difference between the most recent sideslip angle of the group and the current sideslip angle β(k+1) is greater than a first angle threshold (∈.sub.1); and/or no value has been added or a length of time longer than a first time threshold (τ.sub.1).

9. The method according to claim 1, wherein the group of lateral force values is modified by subtracting a value if: the difference between the first sideslip angle of the group values and the last sideslip angle β(k) of the group of values is greater than a second angle threshold (∈.sub.2), then the first value is deleted; a value has been in the window for a length of time longer than a second time threshold, then the first value is deleted; and/or the group has a number of values that is greater than a predetermined threshold number, then at least one value is deleted and preferably every other value is deleted.

10. The method according to claim 1, wherein the model for application is determined by calculating the slope of the curve and by applying the values of the group of the affine model, with the transition from one zone to another being determined as a function of the values of the slope and of the ordinate.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0014] Reference is made to the accompanying drawings, in which:

[0015] FIG. 1 shows the operation of the algorithm of the invention, and it includes a depiction of how the lateral force varies as a function of the sideslip angle;

[0016] FIG. 2 is a diagrammatic plan view of a wheeled vehicle;

[0017] FIG. 3 shows a simplified vehicle moving relative to the ground, its front wheels being grouped together as a single front wheel and its rear wheels being grouped together as a single rear wheel; and

[0018] FIG. 4 shows the data needed for estimating the cornering stiffness coefficient and the maximum lateral friction coefficient in an implementation of the invention.

DETAILED DESCRIPTION OF THE INVENTION

[0019] The invention is described below in application to a vehicle having four steerable wheels.

[0020] With reference to the figures, the vehicle, given overall reference 1, comprises a body 2 standing on the ground via four steerable wheels, namely: a left front wheel fl, a right front wheel fr, a left rear wheel rl, and a right rear wheel rr. In conventional manner, each wheel comprises a rim surrounded by a tire, and the wheels are steerable relative to the body 2 by motor means 3 connected to an electronic control unit 4 that is also connected to motor means 5 for driving the wheels in rotation and to a braking system 6 for braking rotation of the wheels.

[0021] The control unit 4 is also connected to sensors including an inertial measurement unit 7 comprising, in conventional manner, accelerometers and gyros for determining the attitude of the vehicle 1 and the speeds and accelerations to which it is being subjected. The control unit 4 thus receives in particular the speed of the vehicle 1 along its longitudinal axis (x), the speed of the vehicle 1 along its lateral axis (y), and the yaw velocity of the vehicle 1. Other sensors can be envisaged for the application under consideration, and in particular a sensor measuring the speed of rotation of each wheel, a sensor measuring the orientation (or steering angle) of each wheel, a pressure sensor for each tire, a temperature sensor for each tire. . . . Such sensors and how they are used are known and they are not described in greater detail herein.

[0022] The control unit 4 is a computer unit executing a program including instructions for performing the method of the invention. The control method of invention applies at least one control relationship based on an estimate for the cornering stiffness coefficient cβ.sub.ij and for the maximum lateral friction coefficient p.sub.ymaxij of each of the wheels fl, fr, rl, rr relative to the ground. By using this control relationship, the control unit 4 can control the motor means 3, the motor means 5, and the braking device 6 in order to keep the vehicle 1 on a desired path.

[0023] The estimates for the cornering stiffness coefficient C.sub.βij and for the maximum lateral friction coefficient μ.sub.ymaxij of each wheel are obtained by performing an adaptive algorithm that, for each wheel, executes the steps of: [0024] defining a theoretical curve (FIG. 1) for variation of a lateral force exerted by a tire on the surface as a function of the sideslip angle β by identifying therein a first zone Z1 in which variation is linear, a second zone Z2 of linear-to-nonlinear transition, and a third zone Z3 in which variation is nonlinear; [0025] acting in real time to define a group of successive lateral force values {circumflex over (F)}.sub.ypij each corresponding to a sideslip angle β and determining whether said values are varying in accordance with the first zone Z1, the second zone Z2, or the third zone Z3; [0026] applying an affine estimation model when the lateral force values lie in the first zone Z1; [0027] applying a DUGOFF model when the lateral force values lie in the second zone Z2; and [0028] applying a constant model when the lateral force values lie in the third zone Z3.

[0029] The theoretical curve is shown in FIG. 1 to illustrate the operation of the adaptive algorithm of the invention. It can be subdivided into three sections A, B, and C corresponding respectively to linear conditions, to transient conditions, and to nonlinear conditions. The figure also shows the first zone Z1, the second zone Z2, and the third zone Z3, which do not coincide exactly with the three sections.

[0030] There follows a more detailed description of how the successive lateral force values {circumflex over (F)}.sub.ypij are determined. These values are used as inputs to the models (and they are therefore referred to as “input values”) and they are written {circumflex over (F)}.sub.ypij. These input values are determined in real time so as to have available at all times a group of values concerning the period immediately preceding the instant in question.

[0031] As input values, it would be possible to use measurements of the lateral force on each tire: nevertheless, it would then be necessary to have recourse to complicated measurement methods requiring large quantities of calculations in order to make the measurements usable. That is why it is preferred to estimate the input values in the manner explained below.

[0032] Estimating the lateral force input values requires the sideslip angles and the normal forces to be estimated for each of the wheels.

[0033] The sideslip angles for each of the wheels are estimated from the following formulas:

[00001]${\beta }_{\mathrm{fl}}={\delta }_{\mathrm{fl}}-\arctan \left(\frac{V_y+l_f\stackrel{.}{\psi }}{V_x-\frac{e_f}{2}\stackrel{.}{\psi }}\right)$${\beta }_{\mathrm{fr}}={\delta }_{\mathrm{fr}}-\arctan \left(\frac{V_y+l_f\stackrel{.}{\psi }}{V_x+\frac{e_f}{2}\stackrel{.}{\psi }}\right)$${\beta }_{\mathrm{rl}}={\delta }_{\mathrm{rl}}-\arctan \left(\frac{V_y-l_r\stackrel{.}{\psi }}{V_x-\frac{e_r}{2}\stackrel{.}{\psi }}\right)$${\beta }_{\mathrm{rr}}={\delta }_{\mathrm{rr}}-\arctan \left(\frac{V_y-l_r\stackrel{.}{\psi }}{V_x+\frac{e_r}{2}\stackrel{.}{\psi }}\right)$

[0034] In which: [0035] l.sub.f is the distance between the center of gravity of the vehicle and the front axis; [0036] I.sub.f is the distance between the center of gravity of the vehicle and the rear axis; [0037] e.sub.f is the front track width; [0038] e.sub.r is the rear track width; [0039] V.sub.x is the longitudinal speed of the center of gravity; [0040] V.sub.y is the lateral speed of the center of gravity; [0041] {dot over (ψ)} is the angular velocity in yaw; and [0042] δ.sub.fl, δ.sub.fr, δ.sub.rl, δ.sub.rr are the steering angles of the wheels.

[0043] The various speeds and accelerations are supplied by the inertial unit 7 or they are calculated from the measurements supplied by said inertial unit 7. The steering angles of the wheels are determined by the control relationship from the actions of the driver or they are supplied by dedicated sensors. The other parameters are constant characteristics of the vehicle 1. The normal forces for each wheel—with weight transfers during stages of acceleration, braking, and tilting of the vehicle being taken into account—are determined as follows:

[00002]$F_{{𝓏}_{\mathrm{fi}}}=m\frac{l_r}{2l}g-m\frac{h{a}_x}{2l}-m\frac{h{a}_y{l}_r}{e_{f}l}$$F_{{𝓏}_{\mathrm{fr}}}=m\frac{l_f}{2l}g-m\frac{h{a}_x}{2l}+m\frac{h{a}_y{l}_r}{e_{f}l}$$F_{{𝓏}_{\mathrm{rl}}}=m\frac{l_f}{2l}g+m\frac{h{a}_x}{2l}-m\frac{h{a}_y{l}_f}{e_{f}l}$$F_{{𝓏}_{\mathrm{rr}}}=m\frac{l_f}{2l}g+m\frac{h{a}_x}{2l}+m\frac{h{a}_y{l}_f}{e_{f}l}$

[0044] In which: m is the mass of the vehicle, g is the acceleration due to gravity, h is the height of the center of gravity, a.sub.x is a longitudinal acceleration of the center of gravity, and a.sub.y is a lateral acceleration of the center of gravity. The first parameter is a constant characteristic of the vehicle or it may be measured by a sensor, and the acceleration due to gravity depends on the geographical zone and it can be measured.

[0045] It is possible to estimate the longitudinal force F.sub.xpii for each tire:

[00003]$F_{{\mathrm{xp}}_{\mathrm{ij}}}=\frac{T_{{\omega }_{\mathrm{ij}}}-I_r{\stackrel{.}{\omega }}_{\mathrm{ij}}}{r_{\mathrm{ij}}}$

[0046] Where: [0047] T.sub.ω.sub.ij is the torque of the wheel under consideration; [0048] I.sub.r is the moment of inertia of the wheel under consideration (and is identical for all of the wheels in the present example); [0049] {dot over (ω)}.sub.ij is the angular velocity of the wheel under consideration; and [0050] r.sub.ij is the effective radius of the tire on the wheel under consideration.

[0051] In this example, input values for the lateral force are estimated without having recourse to a model, since a model is already in use for determining the cornering stiffness coefficient C.sub.βij and the maximum lateral friction coefficient μ.sub.umaxij. For example, it is possible to use the method described by J. Yang et al., «Estimate

[0052] Lateral Tire Force Based on Yaw Moment without Using Tire Model», ISRN Mechanical Engineering Volume 2014, Hindawi Publishing Corporation.

[0053] The yaw moment M.sub.G at the center of gravity G and the yaw moments M.sub.Gij at the centers of gravity G.sub.ij of each of the wheels are calculated initially:

M.sub.G=I.sub.z{umlaut over (ψ)}=T.sub.x.sub.0+T.sub.y.sub.0

M.sub.G.sub.ij=M.sub.G+m({right arrow over (a.sub.G)}Λ{right arrow over (GG.sub.ij)}). {right arrow over (z.sub.G)}=T.sub.x.sub.ij+T.sub.y.sub.ij

[0054] In this pair of equations: [0055] {right arrow over (a.sub.G)} is the acceleration vector at G; [0056] {right arrow over (z.sub.G)} is the vertical axis attached to the vehicle; [0057] T.sub.x includes the terms that depend on the longitudinal forces (as described in the above-mentioned article); and [0058] T.sub.x includes the terms that depend on the lateral forces (as described in the above-mentioned article).

[0059] The subscripts i designate a front wheel (i=f) or a rear wheel (i=r) while the subscripts j designate a left wheel (j=l) or a right wheel (j=r).

[0060] By putting the pair of equations in the form of a matrix, the following is obtained:

[00004]$\widehat{F_Y}=H^{-1}{T}_Y$$\mathrm{With}:$$\{\begin{array}{c}\begin{array}{c}\begin{array}{c}{T}_Y={\left(T_{y_0}\frac{\left(T_{y_{\mathrm{rl}}}-T_{y_{\mathrm{fl}}}\right)+\left(T_{y_{\mathrm{rr}}}-T_{y_{\mathrm{fr}}}\right)}{2}\right)}^T\\ \widehat{F_Y}=(\begin{array}{cc}{\hat{F}}_{\mathrm{ypf}}& {{\hat{F}}_{\mathrm{ypr}})}^T\end{array}\end{array}\\ T_{y_{\mathrm{.circle-solid.}}}=M_{\mathrm{.circle-solid.}}-T_{x_{\mathrm{.circle-solid.}}}\end{array}\\ H=\left(\begin{array}{cc}{l}_f\cos \left({\delta }_f\right)& -l_r\cos \left({\delta }_r\right)\\ \left(l_f+l_r\cos \left({\delta }_f\right)\right)& \left(l_f+l_r\cos \left({\delta }_r\right)\right)\end{array}\right)\end{array}$

[0061] F.sub.ypf corresponds to the total lateral force for the front axle and F.sub.ypr corresponds to the total lateral force for the rear axle. The symbol .circle-solid., as in M.sub..circle-solid., T.sub.y.circle-solid., and T.sub.x.circle-solid., serves to simplify the expression in order to avoid repeating equations: and in this example it can be replaced by G or by G.sub.ij depending on whether it is the center of gravity of the vehicle 1 that is concerned or the center of gravity of each of the wheels. The input values of the lateral forces for each wheel are calculated by distributing the vertical force as follows:

[00005]${\hat{F}}_{\mathrm{ypfl}}=\frac{F_{𝓏\mathrm{fl}}}{F_{𝓏\mathrm{fl}}+F_{𝓏\mathrm{fr}}}{\hat{F}}_{\mathrm{ypf}}$${\hat{F}}_{\mathrm{ypfr}}=\frac{F_{𝓏\mathrm{fr}}}{F_{𝓏\mathrm{fl}}+F_{𝓏\mathrm{fr}}}{\hat{F}}_{\mathrm{ypf}}$${\hat{F}}_{\mathrm{yprl}}=\frac{F_{𝓏\mathrm{rl}}}{F_{𝓏\mathrm{rl}}+F_{𝓏\mathrm{rr}}}{\hat{F}}_{\mathrm{ypr}}$${\hat{F}}_{\mathrm{yprr}}=\frac{F_{𝓏\mathrm{rr}}}{F_{𝓏\mathrm{rl}}+F_{𝓏\mathrm{rr}}}{\hat{F}}_{\mathrm{ypr}}$

[0062] For model selection purposes, the input values are inserted into the algorithm in the form of a sliding window. The sliding window is in fact a group containing the data {{dot over (F)}.sub.y.sub.ij(k), β.sub.ij(k), t(k)} with 1≤k≤N, where N is the empirically determined maximum dimension of the window, and t is time. The window is used to accumulate values over time so as to avoid estimation aberrations, but is also necessary to limit the number of values that are accumulated in order to limit calculation time and load. Use of the window is based on thresholds ∈.sub.1, ∈.sub.2, τ.sub.1, and τ.sub.2 in such a manner that: [0063] a value is added to the window if: [0064] the difference between the most recent sideslip angle β(k) of the window and the current sideslip angle β(k+1) is greater than a first angle threshold Å.sub.1; and/or [0065] no value has been added for a time longer than a first time threshold τ.sub.1; and [0066] the window is refreshed if: [0067] the difference between the first sideslip angle β(1) of the window and the last sideslip angle β(N) of the window is greater than a second angle threshold ∈.sub.2, then the first value is deleted; and/or [0068] a value has been in the window for a length of time longer than a second time threshold τ.sub.2, then the first value is deleted; and/or [0069] the window contains a number of data items equal to a predetermined number threshold, then values are deleted, preferably in this example every other value.

[0070] Which model to apply is determined by calculating the slope of the curve by applying the values of the group to the affine model, with the transition from one zone to another being determined as a function of the values of the slope and of the intercept. Specifically, the value of the slope is representative of a straight line in the first zone Z1, decreases down to 0 in the second zone Z2, and is small and negative in the third zone Z3.

[0071] Application of the models seeks to select the cornering stiffness coefficient C.sub.βij and the maximum lateral friction coefficient μ.sub.ymaxij so as to minimize the error between the estimates F*.sub.yij of the lateral force value and the input values {dot over (F)}.sub.ypij.

[0072] The affine model is written in the following form:

F*.sub.yij32 a.sub.1β.sub.ij+b.sub.1

[0073] It can be understood that a.sub.1 represents the slope of the curve in the zone Z1 while b.sub.1 represents the intercept (i.e. the value of the lateral force for a sideslip angle of zero).

[0074] Application of the affine model advantageously includes least squares solving using:

[00006]$\underset{n=1}{\overset{k}{.Math.}}{\left({\hat{F}}_{{\mathrm{yp}}_{\mathrm{ij}}}\left(n\right)-F_{{\mathrm{yij}}_{\mathrm{aff}}}\left(n\right)\right)}^2$$\mathrm{With}:F_{{\mathrm{yij}}_{\mathrm{aff}}}=a_1{\beta }_{\mathrm{ij}}+b_1$

[0075] Application of the affine model serves only to determine the cornering stiffness coefficient C.sub.βij, which can thus be updated.

[0076] The DUGOFF defines the longitudinal force F.sub.x and the lateral force F.sub.y as follows:

[00007]$F_x=C_{\sigma }\frac{{\sigma }_x}{1+{\sigma }_x}f\left(\lambda \right)$$F_y=C_{\beta }\frac{\tan \left(\beta \right)}{1+{\sigma }_x}f\left(\lambda \right)$

[0077] The parameter f(λ) is given by:

[00008]$f\left(\lambda \right)=\{\begin{array}{cc}\left(2-\lambda \right)\lambda & \mathrm{if}\lambda <1\\ 1& \mathrm{if}\lambda \ge 1\end{array}$$\lambda =\frac{{\mu }_{\max }{F}_z\left(1+{\sigma }_x\right)}{2\sqrt{{\left(C_{\sigma }{\sigma }_x\right)}^2+{\left(C_{\beta }\tan \left(\beta \right)\right)}^2}}$

[0078] In these formulas: [0079] σ.sub.x is the longitudinal slip ratio; [0080] C.sub.σ is the longitudinal stiffness; [0081] C.sub.β is the cornering stiffness coefficient;

[0082] F.sub.z is the normal force; and [0083] μ.sub.max is the maximum ground-tire friction coefficient.

[0084] By ignoring longitudinal slip, the simplified DUGOFF model is obtained, which is preferably used in this example:

[00009]$F_{y_{\mathrm{ij}}\mathrm{dug}}=\{\begin{array}{c}{C}_{{\beta }_{\mathrm{ij}}}\tan \left({\beta }_{\mathrm{ij}}\right)\mathrm{if}\lambda \ge 1\\ C_{{\beta }_{\mathrm{ij}}}\tan \left({\beta }_{\mathrm{ij}}\right)\left(2-\lambda \right)\lambda \mathrm{if}\lambda <1\end{array}$$\mathrm{With}$$\lambda =\frac{{\mu }_{y_{\mathrm{ij}}\max }{F}_{z_{\mathrm{ij}}}}{2C_{{\beta }_{\mathrm{ij}}}.Math.\tan \left({\beta }_{\mathrm{ij}}\right).Math.}$

[0085] The subscripts i specify a front wheel (i=f) or a rear wheel (i=r) while the subscripts j specify a left wheel (j=1) or a right wheel (j=r).

[0086] Application of the DUGOFF model includes performing a Levenberg Marquardt optimization algorithm. Let:

[00010]$\underset{n=1}{\overset{k}{.Math.}}{\left({\hat{F}}_{{\mathrm{yp}}_{\mathrm{ij}}}\left(n\right)-F_{{\mathrm{yij}}_{\mathrm{dug}}}\left(n\right)\right)}^2$

[0087] Thus, the cornering stiffness coefficient C.sub.⊖ij and the maximum lateral friction coefficient μ.sub.ymaxij of each tire relative to the ground are both used for modelling the characteristics of the interaction between the tire and the ground, and can therefore be updated by applying the model.

[0088] This gives rise finally to:

F*.sub.yij=b.sub.2

[0089] Applying the constant model consists in giving a predetermined value to the estimate of the lateral force when the value of the lateral force that is to be estimated lies in the third zone Z3, and is written as follows:

F*.sub.yij=b.sub.2

[0090] In this equation, b.sub.2=F.sub.y.sub.cst, which corresponds to the maximum lateral force value in the zone Z3, i.e.:

F.sub.y.sub.cst=max({circumflex over (F)}.sub.yp.sub.ij(k))

[0091] Only the value of the maximum lateral friction coefficient μ.sub.ymaxij for each tire relative to the ground is determined and updated with this model.

[0092] It is advantageous to calculate the sideslip angle β.sub.th that constitutes the threshold from which the affine model is no longer valid. In theory, in the first zone, the affine model and the DUGOFF model (with λ≥1) ought to coincide. Thus, the ratio p is substantially equal to 1, such that:

[00011]$p=\frac{F_{\mathrm{lin}}}{F_{\mathrm{ydugNL}}}$

[0093] F.sub.lin corresponds to the lateral force obtained by a linear model such that:

F.sub.lin=C.sub.β.sub.ijβ.sub.ij.

[0094] F.sub.ycugNL corresponds to the lateral force obtained by the DUGOFF model for λ<1.

[0095] It is considered that the threshold β.sub.th is reached when p is greater than or equal 1.05 (determined empirically). The following is then obtained:

[00012]$p=\frac{C_{{\beta }_{\mathrm{ij}}}{\beta }_{\mathrm{ij}}}{\left(2-\lambda \right)\lambda C_{{\beta }_{\mathrm{ij}}}\tan \left({\beta }_{\mathrm{ij}}\right)}\approx \frac{1}{\left(2-\lambda \right)\lambda }$

[0096] This equation is solved as follows:

[00013]${\beta }_{{\mathrm{th}}_{\mathrm{ij}}}=\frac{4p{\mu }_{y_{\mathrm{ij}}\max }{F}_{z_{\mathrm{ij}}}{C}_{{\beta }_{\mathrm{ij}}}\pm \sqrt{\Delta }}{8C_{{\beta }_{\mathrm{ij}}}^2}$$\mathrm{With}$$\Delta =16{\mu }_{y_{\mathrm{ij}}\max }^2{F}_{z_{\mathrm{ij}}}^2{C}_{{\beta }_{\mathrm{ij}}}^2\left(p^2-p\right),\Delta \ge 0$

[0097] The smaller value is then selected as the threshold, namely:

[00014]${\beta }_{{\mathrm{th}}_{\mathrm{ij}}}=\frac{4p{\mu }_{y_{\mathrm{ij}}\max }{F}_{z_{\mathrm{ij}}}{C}_{{\beta }_{\mathrm{ij}}}-\sqrt{\Delta }}{8C_{{\beta }_{\mathrm{ij}}}^2}$

[0098] In this example, the estimated values of the lateral force are used in a control relationship u for assistance in driving the vehicle. The control relationship u=(T.sub.ω, δ.sub.f, δ.sub.r).sup.T, implemented by the electronic control unit 4 enables said electronic control unit 4 to control the motor means 3, the motor means 4, and/or the braking device 6 in such a manner as to adjust the torque of the wheels and their steering angles in order to keep the vehicle 1 on the desired path.

[0099] In practice, the control relationship seeks to reduce the difference between the real position of the vehicle 1, which is associated with a reference frame [c], relative to a position of a reference vehicle ideally placed along the path, which is associated with a reference frame [d]. The vehicle 1 and the reference vehicle and the respective positions (X,Y,ψ).sup.T and (X.sub.d, Y.sub.d, ψ.sub.d).sup.T in the same inertial reference frame [i]. R.sub.ψd is the transformation matrix between the reference frames [d] and [i], and R.sub.ψd is the transformation matrix between the reference frames [c] and [i], such that:

[00015]$R_{{\psi }_{•}}\stackrel{△}{=}\left(\begin{array}{ccc}\cos \left({\psi }_{•}\right)& -\sin \left({\psi }_{•}\right)& 0\\ \sin \left({\psi }_{•}\right)& \cos \left({\psi }_{•}\right)& 0\\ 0& 0& 1\end{array}\right)$

[0100] The longitudinal, lateral, and yaw error in following the path is written e=(e.sub.X, e.sub.Y, e.sub.ψ).sup.T in the reference frame [i] and x.sub.1 in the reference frame [c] such that:

[00016]$\begin{array}{cc}{e}_1{R}_{-\psi }e& \left(1\right)\end{array}$$\mathrm{and}$$e_X{X}_d-X,$$e_Y{Y}_d-Y,$$e_{\psi }{\psi }_d-\psi .$

[0101] By using the notation x(V.sub.x, V.sub.y, ψ).sup.T and x.sub.d(V.sub.x.sub.d, V.sub.y.sub.d, {dot over (ψ)}.sub.d).sup.T for the longitudinal, lateral, and yaw velocities respectively of the real vehicle and of the reference vehicle, and by differentiating the error in following the path, the following is obtained:

ė=R.sub.ψdx.sub.d−R.sub.ψx   (2)

[0102] By projecting equation (2) into the reference frame [c), the following is obtained:

e.sub.2R.sub.−ψė=R.sub.e.sub.ψx.sub.d−x   (3)

[0103] Differentiating e.sub.1 and e.sub.2 gives respectively

[00017]$\begin{array}{cc}{.Math.}_1:{\stackrel{.}{e}}_1=-\stackrel{.}{\psi }\wedge e_1+e_2& \left(4\right)\end{array}$$\begin{array}{cc}{.Math.}_2:{\stackrel{.}{e}}_2=R_{e_{\psi }}\left({\stackrel{.}{e}}_{\psi }\wedge x_d+{\stackrel{.}{x}}_d\right)-\stackrel{.}{x}& \left(5\right)\end{array}$$\mathrm{With}:$$\Lambda \stackrel{△}{=}\left(\begin{array}{ccc}0& -1& 0\\ 1& 0& 0\\ 0& 0& 0\end{array}\right)$

[0104] It is then necessary to establish a model of the dynamic behavior of the vehicle 1. In order to simplify, the four wheeled vehicle 1 is reduced to a vehicle having two wheels, namely a front wheel f and a rear wheel r (see FIG. 3), and the center of gravity is assumed to be relatively low so as to make it possible to ignore rolling and pitching movements. These simplifications are considered not to harm the modelling of the dynamic behavior of the vehicle by means of the following equations:

[00018]$\begin{array}{cc}\{\begin{array}{c}m\left({\stackrel{.}{V}}_x-V_y\stackrel{.}{\psi }\right)=F_{\mathrm{xf}}+F_{\mathrm{xr}},\\ m\left({\stackrel{.}{V}}_y+V_x\stackrel{.}{\psi }\right)=F_{\mathrm{yf}}+F_{\mathrm{yr}},\\ I_z\stackrel{.Math.}{\psi }=l_f{F}_{\mathrm{yf}}-l_r{F}_{\mathrm{yr}}.\end{array}& \left(6\right)\end{array}$

[0105] With: [0106] F.sub.xf the longitudinal force of the front wheel; [0107] F.sub.xr the longitudinal force of the rear wheel; [0108] F.sub.yf the lateral force of the front wheel; [0109] F.sub.yr the lateral force of the front wheel; and [0110] Iz the moment of inertia in yaw about the vertical axis, with the other parameters described above.

[0111] The forces and the moments in the above equations are expressed as follows in the reference frame [c]:

[00019]$\begin{array}{cc}\{\begin{array}{ccc}{F}_{\mathrm{xf}}=F_{{\mathrm{xp}}_f}& \cos \left({\delta }_F\right)-F_{{\mathrm{yp}}_f}& \sin \left({\delta }_F\right),\\ F_{\mathrm{yf}}=F_{{\mathrm{yp}}_f}& \cos \left({\delta }_F\right)+F_{{\mathrm{xp}}_f}& \sin \left({\delta }_F\right),\\ F_{\mathrm{xr}}=F_{{\mathrm{xp}}_r}& \cos \left({\delta }_R\right)-F_{{\mathrm{yp}}_r}& \sin \left({\delta }_R\right),\\ F_{\mathrm{yr}}=F_{{\mathrm{yp}}_r}& \cos \left({\delta }_R\right)+F_{{\mathrm{xp}}_r}& \sin \left({\delta }_R\right).\end{array}& \left(7\right)\end{array}$

[0112] In the reference frames of the tires, the longitudinal forces are defined as follows:

[00020]$\begin{array}{cc}\{\begin{array}{c}{F}_{{\mathrm{xp}}_f}=\frac{{\mathrm{pT}}_{\omega }-I_r{\stackrel{.}{\omega }}_f}{r},\\ F_{{\mathrm{xp}}_r}=\frac{\left(1-p\right)T_{\omega }-I_r{\stackrel{.}{\omega }}_r}{r},\end{array}& \left(8\right)\end{array}$

[0113] The coefficient p is a coefficient for the distribution of the total torque Tω, which lies in the range 0 (for the torque passing solely via the rear wheels) to 1 (for the torque passing solely via the front wheels) and in this example it is set at 0.5.

[0114] By using a linear model for modelling the lateral forces F.sub.ypf and F.sub.ypr of the front and rear tires for sideslip angles β.sub.f, β.sub.r, the following is obtained:

[00021]$\begin{array}{cc}\{\begin{array}{c}{F}_{{\mathrm{yp}}_f}\simeq F_{{\mathrm{yp}}_f}^{\mathrm{lin}}\stackrel{△}{=}{C}_{{\beta }_f}{\beta }_f=C_{{\beta }_f}\left({\delta }_f-\frac{V_y+l_f\stackrel{.}{\psi }}{V_x}\right)\\ F_{{\mathrm{yp}}_r}\simeq F_{{\mathrm{yp}}_r}^{\mathrm{lin}}\stackrel{△}{=}{C}_{{\beta }_r}{\beta }_r=C_{{\beta }_r}\left({\delta }_r-\frac{V_y-l_r\stackrel{.}{\psi }}{V_x}\right)\end{array}& \left(9\right)\end{array}$

[0115] By assuming that the steering angles δ.sub.r, δ.sub.f are relatively small and by injecting the equations (7), (8), (9) into the equations (6), the following is obtained:

{dot over (x)}=f(x)+g(x)u+h(u)   (10)

[0116] In which:

[00022]$\begin{array}{cc}f\left(x\right)=\left(\begin{array}{c}\begin{array}{c}{V}_y\stackrel{.}{\psi }-\frac{I_r}{mr}\left({\stackrel{.}{\omega }}_f+{\stackrel{.}{\omega }}_r\right)\\ -V_x\stackrel{.}{\psi }-\frac{C_{{\beta }_f}\left(V_y+l_f\stackrel{.}{\psi }\right)+C_{{\beta }_r}\left(V_y-l_r\stackrel{.}{\psi }\right)}{m{V}_x}\end{array}\\ \frac{-l_f{C}_{{\beta }_f}\left(V_y+l_f\stackrel{.}{\psi }\right)+l_r{C}_{{\beta }_r}\left(V_y-l_r\stackrel{.}{\psi }\right)}{I_{𝓏}{V}_x})\end{array}\right)& \left(11\right)\end{array}$$u=\left(\begin{array}{c}\begin{array}{c}{T}_{\omega }\\ {\delta }_F\end{array}\\ {\delta }_R\end{array}\right),h=\left(\begin{array}{c}\begin{array}{c}-\frac{C_{{\beta }_f}{\delta }_f^2+C_{{\beta }_r}{\delta }_r^2}{m}\\ \frac{p{\delta }_F{T}_{\omega }+\left(1-p\right){\delta }_R{T}_{\omega }}{mr}\end{array}\\ \frac{l_{f}p{T}_{\omega }{\delta }_F-l_r\left(1-p\right)T_{\omega }{\delta }_R}{r{I}_{𝓏}}\end{array}\right)$$g\left(x\right)=\left(\begin{array}{ccc}\frac{1}{mr}& \frac{C_{{\beta }_f}\left(V_y+l_f\stackrel{.}{\psi }\right)}{m{V}_x}& \frac{C_{{\beta }_r}\left(V_y+l_r\stackrel{.}{\psi }\right)}{m{V}_x}\\ 0& \frac{r{C}_{{\beta }_f}-I_r{\stackrel{.}{\omega }}_f}{rm}& \frac{r{C}_{{\beta }_r}-I_r{\stackrel{.}{\omega }}_r}{rm}\\ 0& \frac{l_f\left(r{C}_{{\beta }_f}-I_r{\stackrel{.}{\omega }}_f\right)}{I_{𝓏}r}& \frac{-l_r\left(r{C}_{{\beta }_r}-I_r{\stackrel{.}{\omega }}_r\right)}{I_{𝓏}r}\end{array}\right)$

[0117] In order to reduce the complexity of the model (10), non-linear terms and the command are ignored so as to obtain:

{dot over (x)}=f(x)+g(x)u   (12)

[0118] Nevertheless, since the object is to control an off-road vehicle, a purely linear model cannot suffice. It is therefore necessary to modify the linear model in order to adapt it to non-linear behavior of the tires:

[0119] specifically, it is known that as sideslip angles increase, the linear model gives a lateral force F.sub.y.sub.p.sup.lin=C.sub.ββ that is greater than the real front or rear lateral force F.sub.y.sub.p, which in this example is in fact the lateral force as estimated from the DUGOFF model. A force {tilde over (F)} is thus introduced in order to ensure that the assumptions about the linear model being valid remain true, and the following is written:

F.sub.y.sub.p=F.sub.y.sub.p.sup.lin+{tilde over (F)}  (13)

[0120] Since measured values are not available for the real lateral force, recourse is had to estimate, and in this example the following estimate is chosen F.sub.y.sub.p=F*.sub.yij.

[0121] For small steering angles, this gives:

[00023]$\begin{array}{cc}\{\begin{array}{c}{F}_x=F_{\mathrm{xp}}-F_{\mathrm{yp}}\delta =F_{\mathrm{xp}}-\left(F_{y_p}^{\mathrm{lin}}+\tilde{F}\right)\delta \\ F_y=F_{\mathrm{yp}}+F_{\mathrm{xp}}\delta =F_{y_p}^{\mathrm{lin}}+\tilde{F}+F_{\mathrm{xp}}\delta \end{array}& \left(14\right)\end{array}$

[0122] As a result, the set of equations (6) gives:

{dot over (x)}=f(x)+g.sub.1(x)u+Δ.sub.++Δ.sub.−  (15)

[0123] With:

[00024]$\begin{array}{cc}{g}_1\left(x\right)=g\left(x\right)+{\Delta }_g& \left(16\right)\end{array}$${\Delta }_g\stackrel{△}{=}\left(\begin{array}{ccc}0& -{\tilde{F}}_f& -{\tilde{F}}_r\\ 0& 0& 0\\ 0& 0& 0\end{array}\right)$${\Delta }_{+}^T\stackrel{△}{=}\left(\begin{array}{cc}\begin{array}{cc}0& \frac{{\tilde{F}}_f+{\tilde{F}}_r}{m}\end{array}& 0\end{array}\right)$${\Delta }_{-}^T\stackrel{△}{=}\left(\begin{array}{cc}\begin{array}{cc}0& 0\end{array}& \frac{l_f{\tilde{F}}_f-l_r{\tilde{F}}_r}{I_z}\end{array}\right)$

[0124] A solution for solving the problem of a vehicle with four steerable wheels following a path involves using the expression for the dynamic error vector.

[0125] The control relationship is constructed by a recursive technique known as “backstepping” and that is based on equations (4) and (5). The control relationship serves to stabilize the error in asymptotic manner.

[0126] In order to implement the backstepping technique, the variable e.sub.2 in equation (4) is considered to be a control input for regulating e.sub.1 on zero. To do this, let:

z.sub.1e.sub.1

Σ.sub.1: ż.sub.1=−{dot over (ψ)}Λz.sub.1+e.sub.2   (17)

[0127] In a first step of the backstepping technique, a first candidate Lyapunov function is selected, namely V.sub.1(z.sub.1)½z.sub.1.sup.Tz.sub.1, with its derivative being made negative by selecting e.sub.2={dot over (ψ)}Λz.sub.1−K.sub.1z.sub.1 with K.sub.1 being a positively defined diagonal matrix. This leads to {dot over (V)}.sub.1(z.sub.1)=−z.sub.1.sup.TK.sub.1z.sub.1. Since e.sub.2 is not the true external control input, the following residue is obtained

z.sub.2e.sub.2−e.sub.2d

with e.sub.2d{dot over (ψ)}Λz.sub.1−K.sub.1z.sub.1   (18)

[0128] This residue is introduced into equation (17) , enabling Σ.sub.1 to be stabilized. Equation (17) then becomes:

ż.sub.1={dot over (ψ)}Λz.sub.1+z.sub.2+e.sub.2d=z.sub.2−K.sub.1z.sub.1

[0129] While the Lyapunov derivative becomes:

{dot over (V)}.sub.1(z.sub.1)=−z.sub.1.sup.TK.sub.1z.sub.1+½(z.sub.2.sup.Tz.sub.1+z.sub.1.sup.Tz.sub.2)

[0130] In a second step of the backstepping technique, a candidate Lyapunov function is selected for the dynamic behavior of Z.sub.2, namely:

V.sub.2=V.sub.1°½z.sub.2.sup.Tz.sub.2.

[0131] The derivative of this function is:

[00025]$\begin{array}{cc}{\dot{V}}_2=-z_1^T{K}_1{z}_1+\frac{1}{2}\left(z_2^T\left(z_1+{\stackrel{.}{z}}_2\right)+{\left(z_1+{\stackrel{.}{z}}_2\right)}^T{z}_2\right)& \left(19\right)\end{array}$

[0132] This derivative is made negative by selecting

ż.sub.2=ė.sub.2−ė.sub.2d=−z.sub.2−K.sub.2z.sub.2   (20)

in which K.sub.2 is positive.

[0133] The derivative is {dot over (V)}.sub.2=−z.sub.1.sup.TK.sub.1z.sub.1−z.sub.2.sup.TK.sub.2z.sub.2, which is less than or equal to 0.

[0134] The final command input is the vector u, which appears in the term k in equations (12) and (5).

[0135] By making equations (20) and (5) equal, the following control relationship is obtained for regulating e.sub.1:

[00026]$\begin{array}{cc}\{\begin{array}{c}\begin{array}{c}\begin{array}{cc}u& =g^{-1}\left(-f+R_{e_{\psi }}\left({\stackrel{.}{e}}_{\psi }\wedge x_d+{\stackrel{.}{x}}_d\right)-U\right),\end{array}\\ U\stackrel{△}{=}{\stackrel{.}{e}}_2={\dot{e}}_{2d}-e_1-K_2\left(e_2-e_{2d}\right),\end{array}\\ e_2=\stackrel{.}{\psi }\wedge z_1-K_1{z}_1\end{array}.& \left(21\right)\end{array}$

[0136] It can be seen that the control relationship holds if g is invertible. This gives:

[00027]$\begin{array}{cc}\det \left(g\right)=-\left(\frac{l_r\left({\mathrm{rC}}_{{\beta }_f}-I_r{\dot{\omega }}_f\right)\left({\mathrm{rC}}_{{\beta }_r}-I_r{\stackrel{.}{\omega }}_r\right)}{m^2{r}^3{I}_z}+\frac{l_f\left(r{C}_{{\beta }_r}-I_r{\stackrel{.}{\omega }}_r\right)\left(r{C}_{{\beta }_f}-I_r{\stackrel{.}{\omega }}_f\right)}{m^2{r}^3{I}_z}\right)& \left(22\right)\end{array}$

[0137] In which

[00028]$\frac{r{C}_{\beta }}{I_r}$

is 10.sup.4 and is greater than the acceleration of the rotation of the wheel, so rC.sub.β−I.sub.r{dot over (ω)}≠0.

[0138] The dynamic behavior of the system in a closed loop is as follows:

[00029]$\left(\begin{array}{c}{\stackrel{.}{𝓏}}_1\\ {\stackrel{.}{𝓏}}_2\end{array}\right)=\left(\begin{array}{cc}-K_1& 0\\ 0& -K_2\end{array}\right)\left(\begin{array}{c}{𝓏}_1\\ {𝓏}_2\end{array}\right)+\left(\begin{array}{cc}0& 1\\ -1& 0\end{array}\right)\left(\begin{array}{c}{𝓏}_1\\ {𝓏}_2\end{array}\right)$

[0139] The control relationship u as formulated in this way takes account only of the linear behavior of the tires.

[0140] In order to adapt the control relationship u to the non-linear behavior of the tires, two corrective terms Δ.sub.+ and Δ.sub.− are added to the other terms of said relationship.

[0141] The forces {tilde over (F)}.sub.f and {tilde over (F)}.sub.r of equation (16) depend on the steering angles δ.sub.f and δ.sub.r, which are the command inputs, and the delaying values of {circumflex over (Δ)}.sub.+ and {circumflex over (Δ)}.sub.− that are the estimates of Δ.sub.+ and Δ.sub.− are written Δ.sub.+and Δ.sub.−. The following is then obtained:

[00030]$\begin{array}{cc}\{\begin{array}{c}{\stackrel{\_}{\Delta }}_{+}\left(s\right)\stackrel{△}{=}{e}^{-\tau s}{F}_{LP}\left(s\right){\widehat{\Delta }}_{+}\left(s\right)\\ {\stackrel{\_}{\Delta }}_{-}\left(s\right)\stackrel{△}{=}{e}^{-\tau s}{F}_{\mathrm{LP}}\left(s\right){\hat{\Delta }}_{-}\left(s\right)\\ F_{LP}\left(s\right)\stackrel{△}{=}\frac{1}{1+\frac{1}{2\pi f_0}}\end{array}& \left(23\right)\end{array}$

[0142] In which s is the Laplace operator, τ is the delay, F.sub.LP(s) is a lowpass filter and f.sub.0 is the cut-off frequency of the filter.

[0143] It is thus possible to add to the control relationship u (21) the delaying values Δ.sub.+ and Δ.sub.− of the estimates of Δ.sub.+ and Δ.sub.− so that the relationship u takes the following form:

[00031]$\{\begin{array}{c}\begin{array}{c}\begin{array}{cc}u& =g^{-1}\left(-f+R_{e_{\psi }}\left({\stackrel{.}{e}}_{\psi }\wedge x_d+{\stackrel{.}{x}}_d\right)-U-{\stackrel{\_}{\Delta }}_{+}-{\stackrel{\_}{\Delta }}_{-}\right),\end{array}\\ U={\dot{e}}_{2d}-e_1-K_2\left(e_2-e_{2d}\right),\end{array}\\ e_{2d}=\stackrel{.}{\psi }\wedge e_1-K_1{e}_1\end{array}.$

[0144] Thus, the control relationship then has a first portion that is based on a linear model for the behavior of the tires and a corrective second portion that is subtracted from the first portion in order to take account of the non-linear effects in the behavior of the tires. It can be understood that by adapting a control relationship based on a linear model by adding corrective terms that are based on a non-linear model, preparation of the control relationship is simplified. This is applicable to any control relationship based on a linear model.

[0145] The terms {tilde over (F)}.sub.f and {tilde over (F)}.sub.r in the expression for {circumflex over (Δ)}.sub.+ and {circumflex over (Δ)}.sub.− are calculated by the above-described method. An estimate is thus obtained for the maximum lateral friction coefficient {circumflex over (μ)}.sub.y.sub.max and for the cornering stiffness coefficient Ĉ.sub.β for the front and rear tires.

[0146] As summarized in FIG. 4, estimation is based on the measurements taken by the inertial unit 7, such as the angular velocity in yaw {dot over (ψ)}, the longitudinal and lateral speeds V.sub.x and V.sub.y, and the longitudinal and lateral accelerations a.sub.x and a.sub.y. Use is also made of the torque T.sub.ω and of the steering angles δ.sub.f and δ.sub.r, which are supplied by the control relationship itself, and also of the angular acceleration of the wheel {dot over (ω)}. The algorithm takes account of the linear and non-linear portions of the characteristics of the tires by using the adaptive algorithm having three zones. Once the estimates for the maximum lateral friction coefficient {circumflex over (μ)}.sub.y.sub.max and for the cornering stiffness coefficient Ĉ.sub.β for the front and rear wheels have been obtained, these estimates are used in the DUGOFF model in order to obtain estimates for the lateral force {circumflex over (F)}.sub.yp such that:

[00032]$\begin{array}{cc}{\hat{F}}_{\mathrm{yp}}\{\begin{array}{cc}{\hat{C}}_{\beta }\tan \left(\beta \right)& \mathrm{if}\lambda \ge 1\\ {\hat{C}}_{\beta }\tan \left(\beta \right)\left(2-\lambda \right)\lambda & \mathrm{if}\lambda <1\end{array}& \left(25\right)\end{array}$$\mathrm{With}:$$\lambda =\frac{{\hat{\mu }}_{y_{\max }}{F}_z}{2{\hat{C}}_{\beta }.Math.\tan \left(\beta \right).Math.}$

[0147] Thus, this gives:

[00033]$\begin{array}{cc}\stackrel{\widehat{~}}{F}{\hat{F}}_{\mathrm{yp}}-{\hat{F}}_{\mathrm{yp}}^{\mathrm{lin}}& \left(26\right)\end{array}$$\mathrm{With}{\hat{F}}_{\mathrm{yp}}^{\mathrm{lin}}={\hat{C}}_{\beta }\beta \mathrm{and}{\hat{\Delta }}_{+}^T=\left(\begin{array}{cc}\begin{array}{cc}0& \frac{{\stackrel{\widehat{~}}{F}}_f+{\stackrel{\widehat{~}}{F}}_r}{m}\end{array}& 0\end{array}\right),$${\hat{\Delta }}_{-}^T\stackrel{△}{=}\left(\begin{array}{cc}\begin{array}{cc}0& 0\end{array}& \frac{l_f{\stackrel{\widehat{~}}{F}}_f-l_r{\stackrel{\widehat{~}}{F}}_r}{I_z}\end{array}\right)$

[0148] Naturally, the invention is not limited to the implementation described, but covers any variant coming within the field of the invention as defined by the claims.

[0149] In particular, the modelling may be used as the basis for a vehicle control relationship, e.g. for controlling the steering of one or more wheels, and/or for controlling the motor means of one or more wheels, and/or for controlling the brakes of one or more wheels, but it may alternatively be used for the purposes of triggering warnings representative of the running conditions of the vehicle.

[0150] It is not essential to group the wheels together on a per axle basis.

[0151] Some other technique could be used for the control relationship.

[0152] It is also possible to calculate the threshold sideslip angle between the linear zone and the non-linear zone as follows:

[00034]${\beta }_{{\mathrm{th}}_{\mathrm{ij}}}^{\star }=\frac{{\mu }_{y_{\max }}{F}_{{𝓏}_{\mathrm{ij}}}}{C_{{\beta }_{\mathrm{ij}}}}$

However, this threshold is greater than the threshold as calculated above.

[0153] The vehicle could be different from that described, for example, it could have a different number of wheels.