Patent Application
20220126851
The subject disclosure relates to autonomous or semi-autonomous vehicles and, in particular, to systems and methods for adjusting a path trajectory tracked by an autonomous or semi-autonomous vehicle.
An autonomous or semi-autonomous vehicle can include a driver-assisted driving mode of automation in which the vehicle operates on its own with occasional steering inputs from the driver. The autonomous steering feature operates a path tracking program to follow a target path along a road without any input from the driver. To assume control over the vehicle, the driver can apply a torque to the steering wheel to override and temporarily disengage the path tracking program. However, the driver does not have the ability to adjust the location of the target path without assuming control of the vehicle. The path tracking program therefore resists any steering input or torque applied by the driver to maintain its tracking of the current target path. Accordingly, it is desirable to provide a system and method for allowing the driver to adjust a target path without assuming control of the vehicle and without resistance from the vehicle.
In one exemplary embodiment, a method of operating an autonomous vehicle is disclosed. A driver-applied steering torque is received at the autonomous vehicle while the autonomous vehicle is following an initial target path via a path tracking program. A driver is allowed to adjust a path of the autonomous vehicle from the initial target path to a final target path determined through the driver-applied steering torque.
In addition to one or more of the features described herein, the driver-applied steering torque is greater than an activation threshold and less than an override threshold for disengaging the path tracking program. The method further includes maintaining via the path tracking program, the path of the autonomous vehicle at the final target path when the driver-applied steering torque is removed. The driver experiences a variable resistance for manual steering while adjusting the path of the autonomous vehicle with the path tracking program engaged. The method further includes generating a dynamic path that lags a lateral position of the autonomous vehicle based on the driver-applied steering torque and vehicle dynamics. The method further includes tracking the autonomous vehicle to the dynamic path to provide an artificial damping resistance to a lateral motion of the autonomous vehicle. The method further includes adjusting the artificial damping resistance of the autonomous vehicle to accommodate for hardware differences and driver habits.
In another exemplary embodiment, a system for operating an autonomous vehicle is disclosed. The system includes a processor configured to receive a driver-applied steering torque while the autonomous vehicle is following an initial target path via a path tracking program, and allow a driver to adjust a path of the autonomous vehicle from the initial target path to a final target path determined through the driver-applied steering torque.
In addition to one or more of the features described herein, the driver-applied steering torque is greater than an activation threshold and less than an override threshold for disengaging the path tracking program. The processor is further configured to maintain the path of the autonomous vehicle at the final target path when the driver-applied steering torque is removed. The processor is further configured to allow the driver to experience a variable resistance for manual steering while the driver adjusts the path of the autonomous vehicle with the path tracking program engaged. The processor is further configured to generate a dynamic path that lags a lateral position of the autonomous vehicle based on the driver-applied steering torque and vehicle dynamics. The processor is further configured to track the autonomous vehicle to the dynamic path to provide an artificial damping resistance to a lateral motion of the autonomous vehicle. The processor is further configured to adjust the artificial damping resistance of the autonomous vehicle to accommodate for hardware differences and driver habits.
In yet another exemplary embodiment, an autonomous vehicle is disclosed. The autonomous vehicle includes a processor configured to receive a driver-applied steering torque while the autonomous vehicle is following an initial target path via a path tracking program, and allow a driver to adjust a path of the autonomous vehicle from the initial target path to a final target path determined through the driver-applied steering torque.
In addition to one or more of the features described herein, the driver-applied steering torque is greater than an activation threshold and a less than an override threshold for disengaging the path tracking program. The processor is further configured to maintain the path of the autonomous vehicle at the final target path when the driver-applied steering torque is removed. The processor is further configured to allow the driver to experience a variable resistance for manual steering while the driver adjusts the path of the autonomous vehicle with the path tracking program engaged. The processor is further configured to generate a dynamic path that lags a lateral position of the autonomous vehicle based on the driver-applied steering torque and vehicle dynamics. The processor is further configured to track the autonomous vehicle to the dynamic path to provide an artificial damping resistance to a lateral motion of the autonomous vehicle.
The above features and advantages, and other features and advantages of the disclosure are readily apparent from the following detailed description when taken in connection with the accompanying drawings.
Other features, advantages and details appear, by way of example only, in the following detailed description, the detailed description referring to the drawings in which:
The following description is merely exemplary in nature and is not intended to limit the present disclosure, its application or uses. It should be understood that throughout the drawings, corresponding reference numerals indicate like or corresponding parts and features.
In accordance with an exemplary embodiment,
The autonomous vehicle 10 generally includes at least a navigation system 20, a propulsion system 22, a transmission system 24, a steering system 26, a brake system 28, a sensor system 30, an actuator system 32, and a controller 34. The navigation system 20 determines a road-level route plan for automated driving of the autonomous vehicle 10. The propulsion system 22 provides power for creating a motive force for the autonomous vehicle 10 and can, in various embodiments, include an internal combustion engine, an electric machine such as a traction motor, and/or a fuel cell propulsion system. The transmission system 24 is configured to transmit power from the propulsion system 22 to two or more wheels 16 of the autonomous vehicle 10 according to selectable speed ratios. The steering system 26 influences a position of the two or more wheels 16. The brake system 28 is configured to provide braking torque to the two or more wheels 16.
The sensor system 30 includes a radar system 40 that senses objects in an exterior environment of the autonomous vehicle 10 and provides various parameters of the objects useful in locating the position and relative velocities of various remote vehicles in the environment of the autonomous vehicle. Such parameters can be provided to the controller 34. In operation, the transmitter 42 of the radar system 40 sends out a radio frequency (RF) reference signal 48 that is reflected back at the autonomous vehicle 10 by one or more objects 50 in the field of view of the radar system 40 as one or more reflected echo signals 52, which are received at receiver 44. The one or more reflected echo signals 52 can be used to determine various parameters of the one or more objects 50, such as a range of the object, Doppler frequency or relative radial velocity of the object, and azimuth, etc. The sensor system 30 includes additional sensors, such as digital cameras, for identifying road features, etc.
The controller 34 builds a trajectory for the autonomous vehicle 10 based on the output of sensor system 30. The controller 34 can provide the trajectory to the actuator system 32 to control the propulsion system 22, transmission system 24, steering system 26, and/or brake system 28 in order to navigate the autonomous vehicle 10 with respect to the one or more objects 50. The controller 34 includes a processor 36 and a computer readable storage device or computer-readable storage medium 38. The computer readable storage medium includes programs or instructions 39 that, when executed by the processor 36, operate the autonomous vehicle based on sensor system outputs. The computer-readable storage medium 38 may further include programs or instructions 39 that when executed by the processor 36, to perform the various methods disclosed herein.
The controller 34 can operate a path tracking program that tracks a lateral position of the autonomous vehicle 10 with respect to a lane center of a road and controls the lateral position to move the autonomous vehicle 10 along a selected target path of the road. The path tracking program tracks any lateral deviation of the autonomous vehicle 10 from the target path and makes a correction when the deviation exceeds a realignment threshold to maintain the lateral position of the target path.
In various embodiments, a method is disclosed herein allowing a driver to intervene in the path tracking program in order to change a target path or lateral position of the autonomous vehicle 10 with respect to a desired path. The path tracking program receives a driver-applied steering torque at the steering wheel 27. When the driver-applied steering torque is greater than an activation threshold and less than an override torque, the path tracking program accommodates the driver by dynamically offsetting the target path. The driver thereby repositions the vehicle using the steering wheel 27, similar to normal hands-on driving. When the driver-applied steering torque is removed, the path tracking program tracks to the target path to which the vehicle has been repositioned.
Using the methods disclosed herein, the path tracking program allows the driver to select the lateral position via the driver-applied steering torque. The driver is able to reposition the vehicle laterally between times t1 and t2 with an artificial damping resistance provided from the path tracking program. After time t2, the path tracking program disclosed herein allows the vehicle 10 to travel along a second vehicle path 212 to remain at the lateral position of time t2. The path tracking program is engaged and in control throughout the maneuver.
Table 1 below shows various ranges of driver-applied steering torque, τd, and their effects on the autonomous vehicle.
The path tracking program tracks a driver-applied steering torque |τd| against threshold values τactivation and τoverride. When the driver-applied steering torque is less that the activation threshold τactivation, then the path tracking program maintains a current offset of the target path and resists the driver-applied steering torque to maintain its trajectory. When the driver-applied steering torque is greater than the activation threshold and less than the override threshold τoverride, then the path tracking program dynamically offsets the target path along the direction of the driver-applied steering torque, allowing the driver to reposition or move the vehicle laterally along the roadway. The driver is thereby able to adjust the path of the vehicle through manual steering at the steering wheel, with the driver experiencing a variable resistance imparted by the artificial damping from the controller torque. When the driver-applied steering torque is greater than the override threshold, then a signal is sent to the path tracking program to allow the driver to assume control of the vehicle and the path tracking program is disengaged.
y
c
=c
0
+c
1
x+c
2
x
2+ . . . Eq. (1)
where yc is a lateral coordinate of the lane center 208 within the road, x is a longitudinal coordinate along the road, c0 is an offset of the lane center, c1 is a heading of the lane center, and c2 is a second polynomial coefficient of the lane center. A target path offset 310 between the target path 304 and the lane center 208 is calculated as shown in Eq. (2):
y
target
=y
c
−y
target Eq. (2)
The curvature of the lane center 208 is related to the second polynomial coefficient c2, as shown in Eq. (3):
κc≈−2c2 Eq. (3)
The relative heading angle ψ is given by Eq. (4):
ψ≈−c1 Eq. (4)
The path tracking program maintains the autonomous vehicle 10 along the initial target path 302 by enforcing a stiffness condition and a positive damping condition to resist lateral deviations. The stiffness condition, which provides neutral stability for lane offset with respect to driver-applied steering torque, is given in Eq. (5):
where τd is a driver-applied steering torque on the autonomous vehicle 10. Eq. (5) indicates that the location of the lane center in the vehicle-centered coordinate system 308 does not change as the driver applies a torque on the vehicle. The amount of driver torque required to maintain the offset position is zero when the stiffness condition is enforced. The positive damping condition is given in Eq. (6):
The positive damping condition can be adjusted prior to vehicle operations to accommodate different driving conditions, vehicle programs, hardware differences and driver habits.
The path tracking program predicts a future path by tracking various parameters over a discrete timeline that is segmented into a series of time steps separated by a constant step interval Δts. If the driver-applied steering torque is present (i.e., |τd|≥τoverride) and below override threshold, and the vehicle is translating in the same direction as the steering torque (i.e., sgn(τd)==sgn(ψ), then a lane adjusting program can be activated to select a new target path.
The preview path relative to the lane center at current time step is used to generate a path that leads the current position of the vehicle, as shown in Eq. (7):
Δypreview
where Δypreview
Δytarget
where Kdamping is a damping resistance to a lane change. The target path as constructed lags the current position of the vehicle and thus positively resists or provides artificial damping against the driver-applied steering torque as the target path follows the preview path. The target path offset is bounded by minimum and maximum offsets, shown in Eq. (9):
Δymin≤|Δytarget
and the target offset is confined to be less than the preview offset, as shown in Eq. (10):
|Δytarget
The damping resistance prevents the vehicle from overshooting the preview path. Once the driver-applied steering torque is removed, the target path is set to the preview path as shown in Eq. (11)
Δytarget
Graph 510 shows the target path and preview path for the vehicle in response to the driver applied steering torque. Time is shown along the abscissa in seconds and lateral offset is shown in meters along the ordinate axis. The preview path 514 is shown to be set along the lane center, with little or no offset. While the offset of the target path 512 is shown to increase at time=20 seconds due to the introduction of the driver-applied steering torque at that time, the preview path 514 remains unchanged. Thus, the offset of the target path 512 is due only to the presence of the driver-applied steering torque and will return to tracking the preview path 514 once the driver-applied steering torque is removed.
Graph 610 shows the target path and preview path for the vehicle in response to the driver applied steering torque. Time is shown along the abscissa in seconds and lateral offset is shown in meters along the ordinate axis. The vehicle offset 614 is shown being adjusted from an initial target path before time t=20 seconds to a final target path after time t=23. A curve 612 representing the preview path 306 moves slightly ahead of the vehicle offset while the driver-applied steering torque is present to move the vehicle to the final target path. The vehicle tracks the final target path without any driver-applied steering torque after time t=23.
While the above disclosure has been described with reference to exemplary embodiments, it will be understood by those skilled in the art that various changes may be made and equivalents may be substituted for elements thereof without departing from its scope. In addition, many modifications may be made to adapt a particular situation or material to the teachings of the disclosure without departing from the essential scope thereof. Therefore, it is intended that the present disclosure not be limited to the particular embodiments disclosed, but will include all embodiments falling within the scope thereof.
