SYSTEM AND METHOD IN DATA-DRIVEN VEHICLE DYNAMIC MODELING FOR PATH-PLANNING AND CONTROL

Abstract

Operation and motion control, by a vehicle's ADAS or AD features, is improved in ways suitable to EVs having higher driving and handling performance. The vehicle dynamic model for high rates of lateral acceleration (e.g., sharp cornering or taking curves having a small radius of curvature as faster speeds) is improved by one or more of optimizing time cornering stiffness with a sigmoid function and/or altering front/rear steering angle to account for roll steer and compliance steer, based on vehicle testing. Indicators for lane departure warning or collision warning, evasive steering, or emergency braking are therefore reliably extended to allow higher performance maneuvers.

Claims

1. An apparatus, comprising: a transceiver configured to receive signals from a controller area network (CAN) bus coupled to at least one device configured to capture motion information for at least one motion by an ego vehicle; and an operation and motion controller configured to: process the motion information relating to at least the one motion by the ego vehicle to determine lateral acceleration for the ego vehicle using a dynamic vehicle model, the vehicle dynamic model including one or more of cornering stiffness, front steering angle, and rear steering angle adapted as a function of lateral acceleration, and activate a steering control with a braking or acceleration control based on the determined lateral acceleration.

2. The apparatus according to claim 1, wherein the cornering stiffness is adapted by a sigmoid function of lateral acceleration of the ego vehicle.

3. The apparatus according to claim 2, wherein the cornering stiffness is determined from: ${\begin{matrix} \dot{β} \\ \dot{r} \end{matrix}} = [\begin{matrix} \frac{- 2}{m V_{x}} (C_{f} + C_{r}) & - 1 + \frac{2 (- l_{f} C_{f} + l_{r} C_{r})}{m V_{x}^{2}} \\ \frac{2}{I_{z}} (- l_{f} C_{f} + l_{r} C_{r}) & \frac{- 2}{I_{z} V_{x}} (l_{f}^{2} C_{f} + l_{r}^{2} C_{r}) \end{matrix}] {\begin{matrix} β \\ r \end{matrix}} + [\begin{matrix} 2 \frac{C_{f}}{m V_{x}} & 2 \frac{C_{r}}{m V_{x}} \\ 2 \frac{l_{f} C_{f}}{I_{z}} & - 2 \frac{l_{r} C_{r}}{I_{z}} \end{matrix}] [\begin{matrix} 1 & k_{f} \\ 0 & k_{r} \end{matrix}] {\begin{matrix} δ_{f} \\ A_{y} \end{matrix}},$ where A.sub.y is the lateral acceleration of the ego vehicle, C.sub.f and C.sub.r are front and rear cornering stiffness, respectively, β is side-slip angle of the ego vehicle and {dot over (β)} is the derivative of β with respect to time, r is velocity of the ego vehicle in a yaw direction and {dot over (r)} is the derivative of r with respect to time, V.sub.x is the longitudinal component of the ego vehicle's velocity V, l.sub.f and l.sub.r are front and rear wheelbase length for the ego vehicle, m and l.sub.z are translational and rotational mass inertia for the ego vehicle, respectively, and k.sub.f and k.sub.r are optimization parameters determined by testing of the vehicle.

4. The apparatus according to claim 1, wherein the front steering angle and the rear steering angle each include a term accounting for roll steering and compliance steering.

5. The apparatus according to claim 4, wherein the front steering angle δ.sub.f is given by
δ.sub.f =δ.sub.f,kinematic +k.sub.fa.sub.y, where δ.sub.f,kinematic corresponds to kinematic steering of front wheels of the ego vehicle, a.sub.y is the lateral acceleration of the ego vehicle, and k.sub.f is an optimization parameter determined by testing of a design for the ego vehicle.

6. The apparatus according to claim 5, wherein k.sub.fa.sub.y accounts for roll steering and compliance steering of front wheels of the ego vehicle.

7. The apparatus according to claim 4, wherein the rear steering angle δ.sub.r is given by
δ.sub.r=k.sub.ra.sub.y, where a.sub.y is the lateral acceleration of the ego vehicle, and k.sub.r is an optimization parameter determined by testing of a design for the ego vehicle.

8. The apparatus according to claim 7, wherein k.sub.ra.sub.y accounts for roll steering and compliance steering of rear wheels of the ego vehicle.

9. The ego vehicle comprising the apparatus according to claim 1, the ego vehicle further comprising: a motor configured to drive at least one of front or rear wheels of the ego vehicle; a chassis supporting axles on which the wheels are mounted, the wheels coupled to a steering mechanism configured to control at least one of the front steering angle or the rear steering angle based on activation of the steering control; and a brake actuator configured to actuate brakes for one or more of the wheels based on activation of the braking or acceleration control.

10. The ego vehicle according to claim 9, wherein the ego vehicle is an electric vehicle and the motor is an electric motor.

11. A method, comprising: receiving a signals from a controller area network (CAN) bus coupled to at least one device configured to capture motion information for at least one motion by an ego vehicle; processing the motion information relating to the at least the one motion by the ego vehicle to determine lateral acceleration for the ego vehicle using a dynamic vehicle model, the vehicle dynamic model including one or more of cornering stiffness, front steering angle, and rear steering angle adapted as a function of lateral acceleration; and activating a steering control with a braking or acceleration control based on the determined lateral acceleration.

12. The method according to claim 11, wherein the cornering stiffness is adapted by a sigmoid function of lateral acceleration of the ego vehicle.

13. The method according to claim 12, wherein the cornering stiffness is determined from: ${\begin{matrix} \dot{β} \\ \dot{r} \end{matrix}} = [\begin{matrix} \frac{- 2}{m V_{x}} (C_{f} + C_{r}) & - 1 + \frac{2 (- l_{f} C_{f} + l_{r} C_{r})}{m V_{x}^{2}} \\ \frac{2}{I_{z}} (- l_{f} C_{f} + l_{r} C_{r}) & \frac{- 2}{I_{z} V_{x}} (l_{f}^{2} C_{f} + l_{r}^{2} C_{r}) \end{matrix}] {\begin{matrix} β \\ r \end{matrix}} + [\begin{matrix} 2 \frac{C_{f}}{m V_{x}} & 2 \frac{C_{r}}{m V_{x}} \\ 2 \frac{l_{f} C_{f}}{I_{z}} & - 2 \frac{l_{r} C_{r}}{I_{z}} \end{matrix}] [\begin{matrix} 1 & k_{f} \\ 0 & k_{r} \end{matrix}] {\begin{matrix} δ_{f} \\ A_{y} \end{matrix}},$ where A.sub.y is the lateral acceleration of the ego vehicle, C.sub.f and C.sub.r are front and rear cornering stiffness, respectively, β is side-slip angle of the ego vehicle and {dot over (β)} is the derivative of β with respect to time, r is velocity of the ego vehicle in a yaw direction and {dot over (r)} is the derivative of r with respect to time, V.sub.x is the longitudinal component of the ego vehicle's velocity V, l.sub.f and l.sub.r are front and rear wheelbase length for the ego vehicle, m and l.sub.z are translational and rotational mass inertia for the ego vehicle, respectively, and k.sub.f and k.sub.r are optimization parameters determined by testing of the vehicle.

14. The method according to claim 11, wherein the front steering angle and the rear steering angle each include a term accounting for roll steering and compliance steering.

15. The method according to claim 14, wherein the front steering angle δ.sub.f is given by
δ.sub.f=δ.sub.f,kinematic+k.sub.fa.sub.y, where δ.sub.f,kinematic corresponds to kinematic steering of front wheels of the ego vehicle, a.sub.y is the lateral acceleration of the ego vehicle, and k.sub.f is an optimization parameter determined by testing of a design for the ego vehicle.

16. The method according to claim 15, wherein k.sub.fa.sub.y accounts for roll steering and compliance steering of front wheels of the ego vehicle.

17. The method according to claim 14, wherein the rear steering angle δ.sub.r is given by
δ.sub.r=k.sub.ra.sub.y, where a.sub.y is the lateral acceleration of the ego vehicle, and k.sub.r is an optimization parameter determined by testing of a design for the ego vehicle.

18. The method according to claim 17, wherein k.sub.ra.sub.y accounts for roll steering and compliance steering of rear wheels of the ego vehicle.

19. The method according to claim 11, further comprising: driving at least one of front or rear wheels of the ego vehicle with a motor; supporting axles on which the wheels are mounted on a chassis, the wheels coupled to a steering mechanism configured to control at least one of the front steering angle or the rear steering angle based on activation of the steering control; and actuating brakes for one or more of the wheels based on activation of the braking or acceleration control.

20. The method according to claim 19, wherein the ego vehicle is an electric vehicle and the motor is an electric motor.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0009] For a more complete understanding of this disclosure and its advantages, reference is now made to the following description taken in conjunction with the accompanying drawings, in which like reference numerals represent like parts:

[0010] FIG. 1 is a perspective view of a vehicle within which operation or motion control based on an enhanced vehicle dynamic model is implemented in accordance with embodiments of the present disclosure;

[0011] FIGS. 2 and 2A depict a vehicle control system for a vehicle within which operation or motion control based on an enhanced vehicle dynamic model is implemented in accordance with embodiments of the present disclosure;

[0012] FIG. 3 illustrates a functional diagram of a system within a vehicle for performing operation or motion control based on an enhanced vehicle dynamic model in accordance with embodiments of the present disclosure;

[0013] FIGS. 4A and 4B illustrate parameters used in both the basic and enhanced bicycle models of vehicle dynamics;

[0014] FIG. 5 depicts an example of normalized cornering stiffness as a function of lateral acceleration;

[0015] FIG. 6 illustrates a high level flow diagram for a process of operation or motion control based on an enhanced vehicle dynamic model in accordance with embodiments of the present disclosure;

[0016] FIG. 7A depicts an exemplary relationship between lateral tire force and vertical load, FIG. 7B depicts an example of linear and nonlinear regimes between lateral tire force and tire sideslip angle, and FIG. 7C depicts an example of the effect of combined slip within the friction circle of a tire;

[0017] FIGS. 8A and 8B depict examples of relationships between lateral tire force and cornering stiffness, respectively, on tire slip angle;

[0018] FIG. 9 illustrates a model for determining the effect of lateral and longitudinal load transfer on vertical tire force; and

[0019] FIG. 10 illustrates estimation of longitudinal tire force from vertical tire force and other parameters.

DETAILED DESCRIPTION

[0020] FIGS. 1 through 10, described below, and the various embodiments used to describe the principles of this disclosure are by way of illustration only and should not be construed in any way to limit the scope of this disclosure. Those skilled in the art will understand that the principles of this disclosure may be implemented in any type of suitably arranged device or system.

[0021] The purpose of vehicle dynamic model is to develop algorithms for path planning and control in ADAS and AD features, where the algorithms are designed based on a vehicle dynamic model. There are two main requirements of a vehicle dynamic model: high fidelity, and simplicity. The vehicle model should match the real vehicle (high fidelity) and be simple enough for design and implementation of a path planner and controller. These two requirements of high fidelity and simplicity are in tension with each other, so meeting both requirements is challenging.

[0022] The widely used bicycle model is simple and useful for designing controller, but has fidelity limited to maneuvers where lateral acceleration is up to around 5 meters per square second (m/s.sup.2) due to assumptions of the constant cornering stiffness. The basic linear bicycle model is therefore limited in designing a controller that covers all the driving ranges, including high maneuvers involving, for example, lateral acceleration ranging from 5 to 10 [m/s2].

Manual Tuning

[0023] Manual tuning of the bicycle model applies weights on the cornering stiffnesses (C.sub.f, C.sub.r) based on lateral acceleration (a.sub.y). For example, the weights applied are 1 on C.sub.f and C.sub.r when |a.sub.y |≤5 [m/s.sup.2], whereas the applied weights are less than 1 when |a.sub.y |>5 [m/s.sup.2], so that the linear bicycle model with varying C.sub.f and C.sub.r better matches the real vehicle at the main signals of yaw rate, lateral acceleration, and side-slip angle.

[0024] The assumptions of the bicycle dynamic model are that: velocity V is slowly changing (i.e., {dot over (V)}=0) and β is small (i.e., cos(β)≈0, sin(β)≈β, such that V.sub.x=V cos(β)≈V, V.sub.y =V sin(β)≈Vβ and {dot over (V)}.sub.y ={dot over (β)}. The kinematics of the bicycle model are:

[00002] $\begin{matrix} \dot{R} = {ub}_{x} + {vb}_{y} \\ \overset{.Math.}{R} = \dot{u} b_{x} + u {\dot{b}}_{x} + \dot{v} b_{y} + v {\dot{b}}_{y} \\ = (\dot{u} - rv) b_{x} + (\dot{v} + ru) b_{y} \end{matrix}$

where b.sub.x, b.sub.y is unit vector of body frame. The dynamics of the bicycle model are:

mÿ=ΣF.sub.ym({dot over (v)}+ru)=mV(β+r)=ΣF.sub.y=F.sub.FL+F.sub.FR

I.sub.z{umlaut over (ψ)}=ΣM.sub.zI.sub.z{dot over (r)}=ΣM.sub.z=l.sub.f(F.sub.FL+F.sub.FR)−l.sub.r(F.sub.RL=F.sub.RR)

With the assumption that: F.sub.FL =F.sub.FR =C.sub.f,α.sub.f, and F.sub.RL =F.sub.RR =C.sub.rα.sub.r:

[00003] $\dot{β} = - r + 2 \frac{C_{f}}{m V_{x}} (δ_{f} - β - \frac{l_{f} r}{V_{x}}) + 2 \frac{C_{r}}{m V_{x}} (δ_{r} - β + \frac{l_{r} r}{V_{x}})$ $\dot{r} = 2 \frac{l_{f} C_{f}}{I_{z}} (δ_{f} - β - \frac{l_{f} r}{V_{x}}) - 2 \frac{l_{r} C_{r}}{I_{z}} (δ_{r} - β + \frac{l_{r} r}{V_{x}})$

where V: vehicle speed, x, y, z: longitudinal/lateral/yaw direction of vehicle, β: side-slip angle of vehicle, u, v, r: the velocity of velocity of longitudinal/lateral/yaw direction, m, I.sub.z: translational/rotational mass inertia, l.sub.f, l.sub.r: front/rear wheel-base length, F.sub.y, M.sub.z: force and moment applied to vehicle, F.sub.ij: tire forces at ij location of front left (FL) to rear right (RR), C.sub.f, C.sub.r: tire cornering stiffness at front/rear, and δ.sub.f, δ.sub.r: front/rear road wheel angle.

[0025] In the state-space representation:

{dot over (Σ)}=A Σ+Bu

where Σ=[β, r].sup.T, u=,[δ.sub.f,δ.sub.r].sub.T, A=A(C.sub.f,C.sub.r,V.sub.x,m, I.sub.z, l.sub.f, l.sub.r), and B =B.sub.f, (C.sub.f, C.sub.r, V.sub.x,m, I.sub.z, l.sub.f). In a full form:

[00004] ${\begin{matrix} \dot{β} \\ \dot{r} \end{matrix}} = [\begin{matrix} \frac{- 2}{m V_{x}} (C_{f} + C_{r}) & - 1 + \frac{2 (- l_{f} C_{f} + l_{r} C_{r})}{m V_{x}^{2}} \\ \frac{2}{I_{z}} (- l_{f} C_{f} + l_{r} C_{r}) & \frac{- 2}{I_{z} V_{x}} (l_{f}^{2} C_{f} + l_{r}^{2} C_{r}) \end{matrix}] {\begin{matrix} β \\ r \end{matrix}} + [\begin{matrix} 2 \frac{C_{f}}{m V_{x}} & 2 \frac{C_{r}}{m V_{x}} \\ 2 \frac{l_{f} C_{f}}{I_{z}} & - 2 \frac{l_{r} C_{r}}{I_{z}} \end{matrix}] {\begin{matrix} δ_{f} \\ δ_{r} \end{matrix}} .$

[0026] Multi-degree-of-freedom analytic modeling

[0027] Multi-degree-of-freedom analytic modeling modifies the bicycle model with estimation of tire cornering stiffness, vertical tire force, and longitudinal tire force.

[0028] A. Tire Cornering Stiffness Estimation

[0029] Tire cornering stiffness estimation considers effects on lateral tire force (F.sub.y). The relationship between lateral tire force and vertical load is shown in FIG. 7A. Notice that the relationship is nonlinear, so that the effective lateral tire force is reduced (C.fwdarw.D) by the lateral load transfer ((ΔF.sub.z). FIG. 7B depicts linear and nonlinear regimes between lateral tire force and tire sideslip angle. FIG. 7C depicts the effect of combined slip within the friction circle of a tire:

F.sub.x.sup.2+F.sub.y.sup.2≤μ.sup.2F.sub.z.sup.2.

[0030] Tire cornering stiffness estimation also considers the effect of vertical and longitudinal tire forces, such as Pacejka's empirical tire model, which includes:

[0031] Lateral tire force (F.sub.y) as function of longitudinal tire force;

[0032] Cornering stiffness (C.sub.ij for ij=FL, FR, RL, RR) on combined slip conditions; and

[0033] The estimation of longitudinal and vertical tire forces (F.sub.x, F.sub.z) involves:

[00005] $φ_{x} = \frac{\sqrt{μ^{2} F_{z}^{2} - F_{x}^{2}}}{μ F_{z}}$ $C_{α} (μ, F_{z}, F_{x}) = φ_{x} .Math. {C_{α} (μ, F_{z}, F_{x} = 0) - \frac{1}{2} μ F_{z}} + \frac{1}{2} (μ F_{z} - F_{x})$

where C.sub.α(μ, F.sub.z, F.sub.x=0): cornering stiffness of pure slip without longitudinal slip according to F.sub.z variation. Examples of relationships between lateral tire force and cornering stiffness, respectively, on tire slip angle are depicted in FIGS. 8A and 8B.

[0034] F.sub.z Estimation

[0035] Tire vertical forces F.sub.z are affected by lateral and longitudinal load transfer, which come from the longitudinal and lateral acceleration (a.sub.x, a.sub.y, respectively, in [m/s.sup.2]). F.sub.z estimation based on the model depicts in FIG. 9 employs:

F.sub.z_FL=F.sub.SW,F−W.sub.LTLT,F−W.sub.LGLT

F.sub.z_FR=F.sub.SW,F+W.sub.LTLT,F−W.sub.LGLT

F.sub.z_RL=F.sub.SW,R−W.sub.LTLT,R−W.sub.LGLT

F.sub.z_RR=F.sub.SW,R+W.sub.LTLT,R−W.sub.LGLT

The longitudinal load transfer W.sub.LGLT is:

[00006] $W_{LGLT} = \frac{m_{s}}{2} \frac{h_{s}}{L} a_{x} .$

The lateral load transfers W.sub.LTLT,F and W.sub.LTLT,R are:

[00007] $W_{LTLT, F} = \frac{a_{y} m_{s}}{t_{f}} [\frac{K_{ϕ f} h_{s}}{K_{ϕ f} + K_{ϕ r} - m_{s} ℊ h_{s}} + \frac{l_{r}}{L} h_{f}]$ $W_{LTLT, R} = \frac{a_{y} m_{s}}{t_{r}} [\frac{K_{ϕ r} h_{s}}{K_{ϕ f} + K_{ϕ r} - m_{s} ℊ h_{s}} + \frac{l_{f}}{L} h_{r}]$

The static weights F.sub.SW,F,F.sub.SW,R are:

[00008] $F_{SW, F} = (m_{s} \frac{l_{r}}{L} + m_{uf}) \frac{ℊ}{2}$ $F_{SW, R} = (m_{s} \frac{l_{f}}{L} + m_{ur}) \frac{ℊ}{2}$

where g: gravity [m/s2], m.sub.s: sprung mass, m.sub.uf,m.sub.ur: front/rear un-sprung mass, l.sub.f,l.sub.r: front/rear wheelbase (L=l.sub.f+l.sub.r), t.sub.f,l.sub.r: front/rear track width, h.sub.s: roll center height from ground, h.sub.f, h.sub.r: heights of front/rear roll center from the ground.

[0036] F.sub.x Estimation

[0037] Longitudinal tire forces F.sub.x are affected by driving/brake/rolling resistance torque, parameters of gear ratio, and effective rolling radius of tire. In a front wheel drive example, the estimation of longitudinal tire force is illustrated in FIG. 10.

[0038] FIG. 1 is a perspective view of a vehicle 100 within which operation or motion control based on an enhanced vehicle dynamic model is implemented in accordance with embodiments of the present disclosure. The embodiment of the vehicle 100 illustrated in FIG. 1 is for illustration and explanation only. FIG. 1 does not limit the scope of this disclosure to any particular implementation of a vehicle.

[0039] The vehicle 100 of FIG. 1 includes a chassis (not visible in FIG. 1) supporting a cabin 101 for carrying passengers. In some embodiments, the vehicle 100 is an EV in which the chassis is in the form of a “skateboard” vehicle platform supporting one or more energy storage elements (e.g., batteries) that provide input electrical power used by various components of the EV, such as one or more electric motors of the vehicle 100 and a control system of the electric vehicle described in further detail below. In other embodiments, the vehicle 100 is a combustion engine vehicle.

[0040] Passengers may enter and exit the cabin 101 through at least one door 102 forming part of the cabin 101. A transparent windshield 103 and other transparent panels mounted within and forming part of the cabin 101 allow at least one passenger (referred to as the “operator,” even when the vehicle 100 is operating in an AD mode) to see outside the cabin 101. Rear view mirrors 104 mounted to sides of the cabin 101 enable the operator to see objects to the sides and rear of the cabin 101 and may include warning indicators (e.g., selectively illuminated warning lights) for ADAS features such as blind spot warning (indicating that another vehicle is in the operator's blind spot) and/or lane departure warning.

[0041] Wheels 105 mounted on axles that are supported by the chassis and driven by the motor(s) (all not visible in FIG. 1) allow the vehicle 100 to move smoothly. The wheels 105 are mounted on the axles in a manner permitting rotation relative to a longitudinal centerline of the vehicle 100 for steering and are also connected to steering controls (not visible). Conventional automobile features such as headlamps, taillights, turn signal indicators, windshield wipers, and bumpers are also depicted. The vehicle 100 may further include cargo storage within or connected to the cabin 101 and mounted on the chassis, with the cargo storage area(s) optionally partitioned by dividers from the passenger area(s) of the cabin 101.

[0042] In the present disclosure, the vehicle 100 includes a vision system including at least a front camera 106, side cameras 107 (mounted on the bottoms of the rear view mirrors 104 in the example depicted), and a rear camera. The cameras 106, 107 provide images to the vehicle control system for use as part of ADAS and AD features as described below, and the images may optionally be displayed to the operator. In addition, the vehicle 100 includes a radar transceiver 120 (shown in phantom in FIG. 1, as not visible from the exterior of vehicle 100).

[0043] Although FIG. 1 illustrates one example of a vehicle 100, those skilled in the art will recognize that the full structure and operation of a suitable vehicle are not depicted in the drawings or described here. Instead, for simplicity and clarity, only the structure and operation necessary for an understanding the present disclosure is depicted and described. Various changes may be made to the example of FIG. 1, and the enhanced vehicle dynamic model described in this disclosure may be used with any other suitable vehicle.

[0044] FIGS. 2 and 2A depict a vehicle control system 200 for a vehicle within which operation or motion control based on an enhanced vehicle dynamic model is implemented in accordance with embodiments of the present disclosure. The embodiment of the vehicle control system 200 illustrated in FIGS. 2 and 2A is for illustration and explanation only. FIGS. 2 and 2A do not limit the scope of this disclosure to any particular implementation of a vehicle control system.

[0045] FIG. 2 depicts a modern vehicle control system 200 utilizing various electronic control units (ECUs) interconnected on a controller area network (CAN) via the so-called CAN bus. The standard for the CAN bus was released around 1993 by the International Organization for Standardization (ISO) as ISO 11898. The current version of that standard is ISO 11898-1:2015, and the CAN busses described herein may comply with that standard in some embodiments. Each ECU typically includes a printed circuit board (PCB) with a processor or microcontroller integrated circuit coupled to various input sensors, switches, relays, and other output devices. The CAN design permits the ECUs to communicate with each other without the need for a centralized host. Instead, communication takes place on a peer-to-peer basis. The CAN design therefore permits data from sensors and other ECUs to circulate around the vehicle ECUs, with each ECU transmitting sensor and programming information on the CAN bus while simultaneously listening to the CAN bus to pull out data needed to complete tasks being performed by that ECU. There is no central hub or routing system, just a continuous flow of information available to all the ECUs.

[0046] By way of example, power doors on a vehicle may be operated by an ECU called the body control module (not shown in FIG. 2). Sensors constantly report whether the doors are open or closed. When the driver pushes a button to close a door, the signal from that switch is broadcast across the CAN bus. When the body control module ECU detects that signal, however, the body control module ECU does not simply close the door. Instead, the body control module ECU first checks the data stream to make sure the vehicle is in park and not moving and, if all is well, gives a command to a power circuit that energizes the motors used to close the door. The body control module ECU may go even further, such as by monitoring the voltage consumed by the motors. If the body control module ECU detects a voltage spike, which happens when a door is hindered by an errant handbag or a wayward body part, the ECU immediately reverses the direction of the door to prevent potential injury. If the door closes properly, the latch electrically locks the door shut, which is an event that may be detected by the body control module ECU.

[0047] Notably, vehicle control systems are migrating to higher-speed networks with an Ethernet-like bus for which each ECU is assigned an Internet protocol (IP) address. Among other things, this may allow both centralized vehicle ECUs and remote computers to pass around huge amounts of information and participate in the Internet of Things (IoT).

[0048] In the example shown in FIG. 2, the vehicle control system 200 includes a CAN bus 201 embodied or controlled by a gateway ECU 202, which facilitates messages on and among CANs, transmitted and detected by ECUs. FIG. 2 illustrates a powertrain CAN 203 to which a transmission ECU 204 is connected and a chassis CAN 205 to which a braking ECU 206 and a steering (e.g., steering angle) ECU 207 are connected. The braking ECU 206 is connected to brake actuator(s) (not shown) for emergency and normal braking, while the steering ECU 207 is connected to a steering drive motor for evasive and normal steering. The vehicle control system 200 in FIG. 2 also includes a user interface (UI) CAN 208 to which a “dashboard” ECU 209 and a touchscreen ECU 210 are connected. The ECUs 209 and 201 may be integrated with the respective dashboard controls and touchscreen. The UI CAN 208 and the associated dashboard ECU 209 and touchscreen 210 allow the operator to set operating parameters such as following distance for ACC, enable or disable ADAS indicators such as blind spot detection or collision warning, and the like. The dashboard ECU 209 may be connected to sensors and indicators other than those on the dashboard, such as the rear view mirror blind spot indicators described above. The ADAS indicators may include illuminated indicators on any combination of the dashboard and the rear view mirrors and/or in a heads-up display projected onto the windshield 103; audio warnings sounded on the vehicle's audio system speakers; and/or haptic indicators such as a vibrator within the vehicle operator's seat.

[0049] For the present disclosure, the vehicle control system 200 includes an image processing module (IPM) CAN 211 to which the front camera ECU 216, side camera ECU 217, and rear camera ECU 218 are connected. The front camera ECU 216 receives image data from the front camera 106 on the vehicle 100, while the side camera ECU 217 receives image data from each of the side cameras 107 and the rear camera ECU 218 receives image data from the rear camera. In some embodiments, a separate ECU may be used for each camera, such that two side camera ECUs may be employed. The IPM CAN 211 and the front camera ECU 216, side camera ECU 217, and rear camera ECU 218 process image data for use in vision-based ADAS features, such as providing a rear back-up camera display and/or stitching together the images to create a “bird's eye” view of the vehicle's surroundings.

[0050] For the present disclosure, the vehicle control system 200 also includes a radar CAN 220 to which a radar ECU 221 and a radar transceiver are connected. The radar CAN 220, radar ECU 221, and radar transceiver are used to detect objects around the vehicle 100 and to measure the relative distance to and velocity of those objects.

[0051] FIG. 2A illustrates a high level block diagram for the architecture 250 of each CAN depicted in FIG. 2. Each CAN shown in FIG. 2, including the IPM CAN 211, includes a functional ECU 251 for the specific function performed by the respective CAN (e.g., image processing in the case of IPM CAN 211). The functional ECU 251 is coupled to a CAN controller 252 that controls the interactions of the respective CAN with the other CANs within the vehicle 100 through the gateway ECU 202. A CAN transceiver 253 receives messages from and transmit messages to other CANs under the control of the CAN controller 252.

[0052] Although FIGS. 2 and 2A illustrate one example of a vehicle control system 200, those skilled in the art will recognize that the full structure and operation of a suitable vehicle control system is not depicted in the drawings or described here. Instead, for simplicity and clarity, only the structure and operation necessary for an understanding the present disclosure is depicted and described. Various changes may be made to the example of FIGS. 2 and 2A, and the operation control based on an enhanced vehicle dynamic model described in this disclosure may be used with any other suitable vehicle control system.

[0053] To support various ADAS and AD functions such as lane departure warning, collision detection/warning, steering assistance or evasive steering, and emergency braking, the IPM CAN 211 for the vehicle 100 detects an occupied traffic lane within which the vehicle 100 is traveling, predicts the path of the vehicle 100 within that lane, and/or detects other vehicles in adjacent lanes or cutting-in to the occupied lane for collision detection. Such functionality often uses a dynamic model for the vehicle 100, to predict vehicle behavior. As noted above, the bicycle model has fidelity for lateral acceleration up to around 5 [m/s.sup.2]. Refinements described above may improve fidelity, but at the expense of simplicity. In the present disclosure, an enhanced vehicle dynamic model for controlling operation—activating indicator(s), a steering control, or a braking control—is described that improves fidelity, with acceptable increase in complexity.

[0054] FIG. 3 illustrates a functional diagram of a system 300 within a vehicle for performing operation or motion control based on an enhanced vehicle dynamic model in accordance with embodiments of the present disclosure. The embodiment of the system 300 illustrated in FIG. 3 is for illustration and explanation only. FIG. 3 does not limit the scope of this disclosure to any particular implementation. In some embodiments, the system 300 in FIG. 3 may be implemented by, or in connection with, the chassis CAN 205 and braking ECU 206 and steering ECU 207 in FIG. 2, including the functional (CAN) ECU 251, CAN processor/controller 252, and CAN transceiver 253 depicted in FIG. 2A for the chassis CAN 205. Lane detection for the system 300 in FIG. 3 may be implemented using, or by connection to, the front camera 106 and the side cameras 107 in FIG. 1 and the IPM CAN 211, front camera ECU 216, side camera ECU(s) 217, and rear camera ECU 218 in FIG. 2, including the functional (CAN) ECU 251, CAN processor/controller 252, and CAN transceiver 253 depicted in FIG. 2A for the IPM CAN 211. Target vehicle detection for the system 300 in FIG. 3 may be implemented using, or by connection to, the radar CAN 220 and radar ECU 221 depicted in FIG. 2, and the radar transceiver, including the functional (CAN) ECU 251, CAN processor/controller 252, and CAN transceiver 253 depicted in FIG. 2A for the radar CAN 220. Specific functions depicted in FIG. 3 may be distributed among those components.

[0055] To support ADAS and AD features, the system 300 includes the functions of camera perception 301, target vehicle behavior prediction 302, decision and motion planning 303, and motion control 304. Camera perception 301 detects a target vehicle that may cut-in to the lane ahead, while target vehicle behavior prediction 302 determines a likelihood that the target vehicle will cut-in to the lane ahead based on the target vehicle's distance and relative velocity and acceleration. Decision and motion planning 303 and motion control 304 respectively determine and, if necessary, implement reactive responses to cut-in by the target vehicle, such as collision warning, evasive steering, and/or emergency braking.

[0056] Motion control 304 implements at least motion-based lateral control 305. Motion-based lateral control 305 in the example of FIG. 3 is based on lateral dynamics validation, with extraction of cornering stiffness C.sub.f, C.sub.r and control design based on those extracted parameters. Motion-based lateral control 305 may be based in part on vehicle dynamics test 306, which can include testing based on ISO standards, logging of inputs/outputs, and use of flow-through data.

[0057] The enhanced vehicle dynamic model of the present disclosure is an enhanced bicycle model. FIGS. 4A and 4B illustrate parameters used in both the basic and enhanced bicycle models of vehicle dynamics, in particular during steering (lateral acceleration): 0 is the instantaneous rolling center of the turn; R is the radius from the vehicle center of gravity; A and B are the pivot points of the front and rear wheels, respectively, and l.sub.f and l.sub.r are the front/rear wheelbase length, respectively; β is the angle of the vehicle's velocity vector V relative to the x-axis, the longitudinal direction of the vehicle; δ.sub.f is the steering angle of the front wheels relative to the x-axis. FIG. 4A illustrates the bicycle model parameters for front-wheel steering only. FIG. 4B illustrates the parameters for a vehicle with Ackerman steering (front- and rear-wheel steering), and thus also includes δ.sub.r, the steering angle of the rear wheels relative to the longitudinal x-axis.

[0058] For satisfying the requirements of high fidelity and simplicity, the vehicle model of the present disclosure is based on the widely used bicycle model, enhanced by modifying three main parts: varying cornering stiffness, and front/rear steer wheel angle estimation.

[0059] The varying cornering stiffness (where C.sub.f, C.sub.r are tire cornering stiffness at the front/rear wheels, respectively) for the enhanced bicycle model of the present disclosure results from the simple variation of a sigmoid function, which does not require estimation of the longitudinal and vertical tire forces, but just three parameters to be optimized by test data. The front/rear road wheel angle (δ.sub.f,δ.sub.r, respectively) have extra terms to be tuned or optimized according to the lateral acceleration from test data, which covers the effect of not only kinematics but also compliance and roll steer.

[0060] Accordingly, the enhanced bicycle model of the present disclosure:

[0061] keeps the same degree-of-freedom as the basic bicycle model;

[0062] includes no external dynamics; and

[0063] modifies cornering stiffnesses and the road wheel angle(s) with the variation of sigmoid function and corresponding parameters: a, b, c, k.sub.f, k.sub.r on C.sub.f, C.sub.r, δ.sub.f, δ.sub.r.

[0064] A comparison of the conventional bicycle model and enhance bicycle model of the present disclosure follows:

TABLE-US-00001 Conventional Enhanced Modifications bicycle model bicycle model Cornering stiffness C.sub.FL = C.sub.FR = C.sub.F = const. Optimization with a C.sub.FL, C.sub.FR, C.sub.RL, C.sub.RR C.sub.RL = C.sub.RR = C.sub.R = const. variation form of sigmoid function: Front wheel angle δ.sub.f: δ.sub.f = δ.sub.f,kinematic only δ.sub.f = δ.sub.f,kinematic + k.sub.fa.sub.y, Kinematic steer: where k.sub.fa.sub.y covers both δ.sub.f,kinematic δ.sub.f,roll and δ.sub.f,compliance Roll steer: δ.sub.f,roll Compliance steer: δ.sub.f,compliance Rear wheel angle δ.sub.r: δ.sub.r = 0 only δ.sub.r = k.sub.ra.sub.y, where k.sub.ra.sub.y No kinematic steer: covers both δ.sub.r,roll and δ.sub.f,kinematic = 0 δ.sub.r,compliance Roll steer: δ.sub.r,roll Compliance steer: δ.sub.r,compliance

[0065] From the basic bicycle model:

[00009] ${\begin{matrix} \dot{β} \\ \dot{r} \end{matrix}} = [\begin{matrix} \frac{- 2}{m V_{x}} (C_{f} + C_{r}) & - 1 + \frac{2 (- l_{f} C_{f} + l_{r} C_{r})}{m V_{x}^{2}} \\ \frac{2}{I_{z}} (- l_{f} C_{f} + l_{r} C_{r}) & \frac{- 2}{I_{z} V_{x}} (l_{f}^{2} C_{f} + l_{r}^{2} C_{r}) \end{matrix}] {\begin{matrix} β \\ r \end{matrix}} + [\begin{matrix} 2 \frac{C_{f}}{m V_{x}} & 2 \frac{C_{r}}{m V_{x}} \\ 2 \frac{l_{f} C_{f}}{I_{z}} & - 2 \frac{l_{r} C_{r}}{I_{z}} \end{matrix}] {\begin{matrix} δ_{f} \\ δ_{r} \end{matrix}}$

where {dot over (β)} is the derivative of β with respect to time and {dot over (r)} is the derivative of r; V.sub.x is the longitudinal component of the vehicle's velocity V; and m, I.sub.z are translational/rotational mass inertia for the vehicle.

[0066] In the enhanced bicycle model of the present disclosure, the front and rear road wheel angles include an add-on effect from lateral acceleration A.sub.y:

[00010] ${\begin{matrix} δ_{f} \\ δ_{r} \end{matrix}} = {\begin{matrix} δ_{f} + k_{f} A_{y} \\ k_{r} A_{y} \end{matrix}} = [\begin{matrix} 1 & k_{f} \\ 0 & k_{r} \end{matrix}] {\begin{matrix} δ_{f} \\ A_{y} \end{matrix}},$

such that the resulting enhanced bicycle dynamic model follows:

[00011] ${\begin{matrix} \dot{β} \\ \dot{r} \end{matrix}} = [\begin{matrix} \frac{- 2}{m V_{x}} (C_{f} + C_{r}) & - 1 + \frac{2 (- l_{f} C_{f} + l_{r} C_{r})}{m V_{x}^{2}} \\ \frac{2}{I_{z}} (- l_{f} C_{f} + l_{r} C_{r}) & \frac{- 2}{I_{z} V_{x}} (l_{f}^{2} C_{f} + l_{r}^{2} C_{r}) \end{matrix}] {\begin{matrix} β \\ r \end{matrix}} + [\begin{matrix} 2 \frac{C_{f}}{m V_{x}} & 2 \frac{C_{r}}{m V_{x}} \\ 2 \frac{l_{f} C_{f}}{I_{z}} & - 2 \frac{l_{r} C_{r}}{I_{z}} \end{matrix}] [\begin{matrix} 1 & k_{f} \\ 0 & k_{r} \end{matrix}] {\begin{matrix} δ_{f} \\ A_{y} \end{matrix}} .$

[0067] The front and rear cornering stiffness can be expressed as the product of nominal stiffness and a variation of the sigmoid function:

[00012] $\begin{matrix} Cornering stiffness = nominal stiffness .Math. variation of sigmoid \\ = C_{0} [\frac{c}{1 + e^{b (x - a)}} + 1 - c] \\ C_{f} = C_{f 0} [\frac{c}{1 + e^{b (x - a)}} + 1 - c] \\ C_{r} = C_{r 0} [\frac{c}{1 + e^{b (x - a)}} + 1 - c] \end{matrix}$

where x is lateral acceleration in [m/s.sup.2]; C.sub.f0 and C.sub.r0 are known nominal cornering stiffness (in Newton-meters per radian [Nm/rad]) at the front and rear wheels; and a, b, c, k.sub.f, and k.sub.r are parameters to be determined by optimization with the following constraints:

7≤a≤8

0«b≈2

0«c<1

|k.sub.f|,|k.sub.r«1

a is the parameter of translation in the x-axis, which indicates the range of the linear cornering stiffness. b is the parameter of compression or expansion of the stiffness shape in the x-axis. c is the parameter of compression or expansion of the stiffness shape in the y-axis. k.sub.f and k.sub.r are parameters that account for the effects of roll and compliance steer. An example of normalized cornering stiffness as a function of lateral acceleration is depicted in FIG. 5.

[0068] Optimization

[0069] An optimization-based procedure is used to identify the unknown parameters at the proposed vehicle dynamic model. To find the optimal parameters, a cost function is minimized:

[00013] $J (a, b, c, k_{f}, k_{r}) = {.Math.}_{k = 1}^{N} ({(ω_{k} - ω (a, b, c, k_{f}, k_{r}))}^{2} + {(β_{k} - β (a, b, c, k_{f}, k_{r}))}^{2})$

where ω.sub.k and β.sub.k are the kth sample of the yaw rate and side-slip angle, respectively; and ωand β are calculated from the enhanced linear dynamic bicycle model. This optimization can be also carried on the set of yaw rate and lateral acceleration (A.sub.y):

[00014] $J (a, b, c, k_{f}, k_{r}) = {.Math.}_{k = 1}^{N} ({(ω_{k} - ω (a, b, c, k_{f}, k_{r}))}^{2} + {(A_{y_{k}} - A_{y} (a, b, c, k_{f}, k_{r}))}^{2}) .$

[0070] FIG. 6 illustrates a high level flow diagram for a process of operation or motion control based on an enhanced vehicle dynamic model in accordance with embodiments of the present disclosure. The embodiment of the process 600 illustrated in FIG. 6 is for illustration and explanation only. FIG. 6 does not limit the scope of this disclosure to any particular implementation. In some embodiments, the process 600 in FIG. 6 may be implemented using, or by connection to, either or both of the front/side cameras 106, 107 and/or the radar transceiver 120 in FIG. 1, and either or both of the IPM CAN 211, front camera ECU 216, side camera ECU(s) 217, and rear camera ECU 218 and/or the radar CAN 220 and radar ECU 221 in FIG. 2, including the functional (CAN) ECU 251, CAN processor/controller 252, and CAN transceiver 253 for IPM CAN 211 or radar CAN 220 depicted in FIG. 2A. The process 600 may be implemented using the functions depicted in FIG. 3.

[0071] The example process 600 illustrated in FIG. 6 includes capturing at least one image frame for traffic lane(s) in front and/or to the sides of the vehicle using at least one camera, and/or detecting surrounding (“target”) vehicles using either or both of the at least one camera or the radar transceiver mounted on the vehicle (step 601). This may involve capturing images using a front camera and one or both side cameras and “stitching” those images together to form a panoramic field of view encompassing up to 180°. This may also involve detecting lane boundaries for the occupied lane and/or detecting other vehicles, including motion of the subject (“ego”) vehicle relative to the occupied lane and/or the other vehicles.

[0072] Based on the vehicle, lane and target vehicle information, lateral acceleration of the vehicle for specific ADAS/AD features is determined using the enhanced vehicle dynamic model described herein (step 602). A check is then made (step 603) of whether some operation or motion control is indicated by the determined lateral acceleration. If not, another iteration of the process is started. If so, an indicator and/or a vehicle control is activated (step 604), and another iteration of the process is started. Activating an indicator may involve activating a lane departure warning indicator or a collision warning indicator. Activating a vehicle control may involve activating a steering control and generating and/or receiving a steering angle control signal for at least one of the front steering angle or the rear steering angle based on activation of the steering control, and/or activating a braking control and generating or receiving a braking control signal for actuating brakes on one or more of the wheels based on activation of the braking control.

[0073] The enhanced vehicle dynamic model of the present disclosure is a far simpler form of improving the fidelity of the bicycle model to high performance maneuvers, derived from the intuition of underlying multi dynamics by suggesting that the cornering stiffness function (versus lateral acceleration) shape be varied by a sigmoid function, and the effect of roll/compliance steer at both front and rear steer angle be accounted for by adding a lateral acceleration term. Optimization with vehicle test data provides the optimal set of parameters without spending much time on tuning parameters and with acceptable increase in complexity.

[0074] It may be advantageous to set forth definitions of certain words and phrases used throughout this patent document. The terms “include” and “comprise,” as well as derivatives thereof, mean inclusion without limitation. The term “or” is inclusive, meaning and/or. The phrase “associated with,” as well as derivatives thereof, may mean to include, be included within, interconnect with, contain, be contained within, connect to or with, couple to or with, be communicable with, cooperate with, interleave, juxtapose, be proximate to, be bound to or with, have, have a property of, have a relationship to or with, or the like. The phrase “at least one of,” when used with a list of items, means that different combinations of one or more of the listed items may be used, and only one item in the list may be needed. For example, “at least one of: A, B, and C” includes any of the following combinations: A, B, C, A and B, A and C, B and C, and A and B and C.

[0075] The description in this patent document should not be read as implying that any particular element, step, or function is an essential or critical element that must be included in the claim scope. Also, none of the claims is intended to invoke 35 U.S.C. § 112(f) with respect to any of the appended claims or claim elements unless the exact words “means for” or “step for” are explicitly used in the particular claim, followed by a participle phrase identifying a function. Use of terms such as (but not limited to) “mechanism,” “module,” “device,” “unit,” “component,” “element,” “member,” “apparatus,” “machine,” “system,” “processor,” “processing device,” or “controller” within a claim is understood and intended to refer to structures known to those skilled in the relevant art, as further modified or enhanced by the features of the claims themselves, and is not intended to invoke 35 U.S.C. § 112(f).

[0076] While this disclosure has described certain embodiments and generally associated methods, alterations and permutations of these embodiments and methods will be apparent to those skilled in the art. Accordingly, the above description of example embodiments does not define or constrain this disclosure. Other changes, substitutions, and alterations are also possible without departing from the spirit and scope of this disclosure, as defined by the following claims.

SYSTEM AND METHOD IN DATA-DRIVEN VEHICLE DYNAMIC MODELING FOR PATH-PLANNING AND CONTROL

Inventors

Cpc classification

Classification Explorer

B60L2260/32

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

H04L2012/40215

ELECTRICITY

Classification Explorer

B60L3/0015

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

B60L2240/622

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

B60L15/2036

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

H04L2012/40273

ELECTRICITY

Classification Explorer

B60L2240/18

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

B60L2240/24

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

B60Y2200/91

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

H04L12/12

ELECTRICITY

Classification Explorer

B60L3/108

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

B60L2240/22

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

H04L12/40

ELECTRICITY

Classification Explorer

B60L2240/46

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

B60R16/0232

PERFORMING OPERATIONS; TRANSPORTING

International classification

Classification Explorer

B60L15/20

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

B60L3/10

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

B60R16/023

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

H04L12/40

ELECTRICITY

Abstract

Claims

Description