Methods and systems for providing driver assistance in a vehicle
The system improves autonomous driving by determining vehicle trajectory and confidence value through lateral acceleration comparison, adjusting speed profiles based on road marking identification, addressing accuracy and safety issues in unclear conditions.
Patent Information
- Application Number
- DE102023128600
- Authority / Receiving Office
- DE · DE
- Patent Type
- Patents
- Current Assignee / Owner
- Priority Date
- 2023-08-04
- Filing Date
- 2023-10-18
- Publication Date
- 2024-12-05
- Estimated Expiration
- 2043-10-18
AI Technical Summary
Existing autonomous driving systems face challenges in maintaining accurate longitudinal speed control, particularly when road markings are not clearly identifiable, leading to reduced confidence in trajectory prediction and potential safety hazards.
A system that determines a vehicle's trajectory and confidence value based on predicted and actual lateral acceleration, adjusting longitudinal speed profiles accordingly using camera data to identify road markings, and employing machine learning techniques to enhance prediction accuracy.
Enhances the accuracy and safety of autonomous driving by dynamically adjusting speed profiles based on confidence levels, ensuring stable vehicle control even in conditions with unclear road markings.
Smart Images

Figure 00000000_0000_ABST
Abstract
Description
[0001] The technical field generally relates to systems, methods, and apparatus for providing longitudinal speed control by an autonomous or semi-autonomous driving system.
[0002] An autonomous vehicle is a vehicle capable of sensing its surroundings and navigating with little or no user input. An autonomous vehicle senses its surroundings using sensing devices such as radar, lidar, image sensors, and the like. The autonomous vehicle system also utilizes information from GPS (Global Positioning Systems) technology, navigation systems, vehicle-to-vehicle communications, vehicle-to-infrastructure technology, and / or drive-by-wire systems to navigate the vehicle.
[0003] Vehicle automation has been classified into numerical levels ranging from zero, meaning no automation with full human control, to five, meaning full automation without human control. Various automated driver assistance systems such as cruise control, adaptive cruise control, and parking assistance correspond to lower levels of automation, while true "driverless" vehicles correspond to higher levels of automation.
[0004] Some autonomous driving features enable adaptive cruise control, lane following, lane centering, etc., which control the speed and / or steering to follow a specific path or lane. In some cases, such as on winding roads, a driving function may be disabled due to the inability to detect the road ahead.
[0005] DE 10 2018 125 207 A1 describes a system comprising a processor and a memory, wherein the memory includes instructions to be executed by the processor to: control a vehicle based on determining a first and second lane marking, wherein lane markings are mathematical descriptions of roadway lane markings applied to a roadway to mark lanes, determining a missing first or second lane marking and controlling the vehicle for a certain period of time based on a remaining first or second lane marking.
[0006] DE 10 2007 036 417 A1 describes a method for operating a distance control system for vehicles, in which the distance between a vehicle and a target object located in front of the vehicle is controlled by accelerating or decelerating system interventions depending on the situation, taking predictive route data into account. To increase the operational reliability of the vehicle, an event zone is predictively determined for a route section ahead, whereby the event zone corresponds to a specific distance range before a topological event marking a potential hazard. If the target object is lost within the event zone, an event mode is activated in which the implementation of accelerating system interventions is suppressed.
[0007] Accordingly, it is an object of the invention to provide improved methods and systems for improved autonomous or semi-autonomous control of the vehicle. Furthermore, other desirable features and characteristics of the present description will become apparent from the following detailed description and the appended claims, taken in conjunction with the accompanying drawings and the foregoing technical field and background.
[0008] The object of the invention is achieved by methods and systems according to the invention for providing driving assistance in a vehicle.
[0009] The method according to the invention comprises determining, by means of a processor, a trajectory of the vehicle along a roadway; determining, by means of the processor, a confidence value based on a predicted lateral acceleration and an actual lateral acceleration at a point along the trajectory; determining, by means of the processor, longitudinal velocity data based on the confidence value; and generating, by means of the processor, control signals for vehicle actuators to control the vehicle based on the longitudinal velocity data. The method further comprises receiving, by means of the processor, sensor data from a sensor system of the vehicle, wherein the sensor data comprises camera data, and wherein the determination of the trajectory from the camera data is based on an identification of lane markings on a roadway in front of the vehicle.If the lane markings are not identified from the camera data, determining the confidence value involves decreasing the confidence value. The confidence value is compared against three ranges to determine an appropriate speed profile. If the confidence value is high or within a high range, the longitudinal speed is adjusted according to an optimal speed profile. If the confidence value is medium or within a medium range, the longitudinal speed is adjusted according to a speed profile that is partially constrained. If the confidence value is low or within a small range, the longitudinal speed is adjusted according to a speed profile that is constrained.
[0010] According to one embodiment, determining the confidence value is based on a difference between the predicted lateral acceleration and the actual lateral acceleration at the point along the trajectory. If the difference is above a threshold, the confidence value is increased. If the difference is below the threshold, the confidence value is decreased.
[0011] According to another embodiment, the method comprises determining the predicted lateral acceleration based on a radial point along the trajectory.
[0012] According to a further embodiment, the method comprises determining the actual lateral acceleration based on steering data.
[0013] According to a further embodiment, the point is a point in front of the vehicle along the trajectory.
[0014] According to a further embodiment, the point is an instantaneous point of the vehicle trajectory.
[0015] According to a further embodiment, the determination of the longitudinal speed data is based on a speed profile defined by a current speed, a target speed and a desired speed.
[0016] According to a further embodiment, determining the longitudinal velocity data is based on a comparison of the confidence value with a plurality of regions and selecting a velocity profile determined from a plurality of velocity profiles based on the comparison.
[0017] According to the invention, a system for a vehicle comprises a controller comprising non-transitory computer-readable media and configured, by means of a processor, to: determine a trajectory of the vehicle along a roadway; determine a confidence value based on a predicted lateral acceleration and an actual lateral acceleration at a point along the trajectory; determine longitudinal velocity data based on the confidence value; and generate control signals for vehicle actuators to control the vehicle based on the longitudinal velocity data. The controller is further configured, by means of the processor, to receive sensor data from a sensor system of the vehicle. The sensor data includes camera data, and determining the trajectory from the camera data is based on identifying lane markings on a roadway ahead of the vehicle.If the lane markings are not identified from the camera data, determining the confidence value involves decreasing the confidence value. If the confidence value is high or within a high range, the longitudinal speed is adjusted according to an optimal speed profile. If the confidence value is medium or within a medium range, the longitudinal speed is adjusted according to a speed profile that is partially constrained. If the confidence value is low or within a small range, the longitudinal speed is adjusted according to a speed profile that is constrained.
[0018] According to one embodiment, the controller is further configured to receive sensor data from a sensor system of the vehicle, wherein the sensor data includes camera data, and wherein the controller determines the trajectory based on an identification of lane markings on a roadway in front of the vehicle from the camera data.
[0019] According to another embodiment, if the lane markings are not identified by the camera data, the controller is configured to determine the confidence value by decreasing the confidence value.
[0020] According to a further embodiment, the controller is configured to determine the confidence value based on a difference between the predicted lateral acceleration and the actual lateral acceleration at the point along the trajectory, wherein the controller is configured to increase the confidence value when the difference is above a threshold, and wherein the controller is configured to decrease the confidence value when the difference is below the threshold.
[0021] According to another embodiment, the controller is further configured to determine the predicted lateral acceleration based on a radial point along the trajectory.
[0022] According to another embodiment, the controller is further configured to determine the actual lateral acceleration based on steering data.
[0023] According to a further embodiment, the point is a point in front of the vehicle along the trajectory.
[0024] According to a further embodiment, the point is an instantaneous point of the vehicle trajectory.
[0025] According to another embodiment, the controller is configured to determine the longitudinal speed data based on a plurality of speed profiles each defined by a current speed, a target speed, and a desired speed, determine the longitudinal speed data based on a comparison of the confidence value to a plurality of ranges, and select a speed profile from the plurality of speed profiles based on the comparison.
[0026] In one example, a vehicle comprises: a sensor system configured to sense the surroundings of the vehicle; an actuator system; and a controller for implementing a driver assistance system, the controller configured to: determine a trajectory of the vehicle along a roadway; determine a confidence value based on a predicted lateral acceleration and an actual lateral acceleration at a point along the trajectory; determine longitudinal velocity data based on the confidence value; and generate control signals for the actuator system to control the vehicle based on the longitudinal velocity data.
[0027] The exemplary embodiments are described below in conjunction with the following drawings, wherein like numerals indicate like elements and wherein: Fig. 1 is a block diagram showing an autonomous vehicle with a cruise control system; Fig. Figure 2 is a functional block diagram showing the components of an autonomous driving system with the speed control system; Fig. Figure 3 is a data flow diagram illustrating the features of the vehicle's cruise control system; Fig. 4 is a representation of a roadway and trajectory and data determined by the speed control system; and Fig. Figure 5 is a process flow diagram showing an example speed control process.
[0028] The following detailed description is merely exemplary and is not intended to limit the application and uses. Furthermore, there is no intention to be bound by any expressed or implied theory presented in the preceding technical field, background, summary, or the following detailed description.As used herein, the term "module" refers to any hardware, software, firmware, electronic control component, processing logic, and / or processor device, individually or in any combination, including but not limited to: application specific integrated circuits (ASICs), a field programmable gate array (FPGA), an electronic circuit, a processor (common, dedicated, or group), and memory executing one or more software or firmware programs, a combinational logic circuit, and / or other suitable components that provide the described functionality.
[0029] Embodiments of the present description may be described herein in terms of functional and / or logical block components and various processing steps. Such block components may be implemented by any number of hardware, software, and / or firmware components configured to perform the specified functions. For example, an embodiment of the present description may utilize various integrated circuit components, such as memory elements, digital signal processing elements, logic elements, lookup tables, or the like, capable of performing a variety of functions under the control of one or more microprocessors or other controllers.Furthermore, those skilled in the art will recognize that embodiments of the present description may be used in connection with any number of systems and that the systems described herein are merely exemplary embodiments of the present description.
[0030] For the sake of brevity, conventional techniques related to signal processing, data transmission, signaling, control, machine learning models, radar, lidar, image analysis, and other functional aspects of the systems (and the individual operating components of the systems) are not described in detail here. Furthermore, the connecting lines depicted in the various figures are intended to represent exemplary functional relationships and / or physical couplings between the various elements. It should be noted that many alternative or additional functional relationships or physical connections may be present in an embodiment of the present description.
[0031] Referring to Fig. 1, a cruise control system, generally designated 100, is connected to a vehicle 10 in accordance with various embodiments. In general, the cruise control system 100 controls the longitudinal speed of the vehicle using speed profile shaping based on a certain confidence value. The cruise control system 100 determines the confidence value, for example, by comparing driver actions (i.e., the current vehicle trajectory, based, for example, on wheel angle) with a formulated optimal trajectory. The cruise control system 100 uses the confidence value to shape the speed profile in many situations, including when road markings disappear.
[0032] As in Fig. 1, the vehicle 10 generally includes a chassis 12, a body 14, front wheels 16, and rear wheels 18. The body 14 is mounted on the chassis 12 and substantially encloses the components of the vehicle 10. The body 14 and the chassis 12 may together form a frame. The wheels 16-18 are each pivotally connected to the chassis 12 near a corner of the body 14.
[0033] In various embodiments, the vehicle 10 is an autonomous or semi-autonomous vehicle, and the cruise control system 100 is integrated into the autonomous or semi-autonomous vehicle 10 (hereinafter referred to as autonomous vehicle 10). The autonomous vehicle 10 is, for example, a vehicle that is automatically controlled in some way to transport passengers or goods from one location to another. The vehicle 10 is illustrated as a passenger car in the depicted embodiment, but it should be understood that any other vehicle, including motorcycles, trucks, sport utility vehicles (SUVs), recreational vehicles (RVs), watercraft, aircraft, etc., may also be used.In an exemplary embodiment, the autonomous vehicle 10 is configured to perform autonomous functions such as, but not limited to, manual lane centering, adaptive cruise control, super cruise, ultra cruise, etc.
[0034] As illustrated, the autonomous vehicle 10 generally includes a propulsion system 20, a transmission system 22, a steering system 24, a braking system 26, a sensor system 28, an actuator system 30, at least one data storage device 32, at least one controller 34, and a communication system 36. The propulsion system 20, in various embodiments, may include an internal combustion engine, an electric machine such as a traction motor, and / or a fuel cell propulsion system. The transmission system 22 is configured to transfer the power of the propulsion system 20 to the vehicle wheels 16-18 according to selectable speed ratios. According to various embodiments, the transmission system 22 may include a continuously variable automatic transmission, a continuously variable transmission, or other suitable transmission. The braking system 26 is configured to apply braking torque to the vehicle wheels 16-18.In various embodiments, the braking system 26 may include friction brakes, cable brakes, a regenerative braking system such as an electric motor, and / or other suitable braking systems. The steering system 24 influences a position of the vehicle wheels 16-18.
[0035] The sensor system 28 includes one or more sensing devices 40a-40n that sense observable conditions of the external environment and / or the internal environment of the autonomous vehicle 10. The sensing devices 40a-40n may include, but are not limited to, radars, lidars, global positioning systems, optical cameras, thermal cameras, ultrasonic sensors, and / or other sensors. The actuator system 30 includes one or more actuator devices 42a-42n that control one or more vehicle functions, such as, but not limited to, the propulsion system 20, the transmission system 22, the steering system 24, and the braking system 26. In various embodiments, the vehicle features may also include interior and / or exterior features of the vehicle, such as doors, a trunk, and cabin features such as air, music, lighting, etc. (unnumbered).
[0036] The communication system 36 is configured to wirelessly transmit information to and from other units 48, such as other vehicles (“V2V” communication), the infrastructure (“V2I” communication), remote systems, and / or personal devices (described in more detail with respect to Fig. 2). In an exemplary embodiment, the communication system 36 is a wireless communication system configured to communicate over a wireless local area network (WLAN) using IEEE 802.11 standards or using cellular data communication. However, additional or alternative communication methods, such as a dedicated short-range communication (DSRC) channel, are also contemplated within the scope of this description. DSRC channels refer to short- to medium-range, one-way or two-way wireless communication channels specifically designed for use in motor vehicles, as well as a set of protocols and standards.
[0037] The data storage device 32 stores data for use in automatically controlling the autonomous vehicle 10. In various embodiments, the data storage device 32 stores defined maps of the navigable environment. In various embodiments, the defined maps may be predefined by and obtained from a remote system. For example, the defined maps may be compiled by the remote system and transmitted to the autonomous vehicle 10 (wirelessly and / or wired) and stored in the data storage device 32. As can be appreciated, the data storage device 32 may be part of the controller 34, separate from the control unit 34, or part of the controller 34 and part of a separate system.
[0038] The controller 34 includes at least one processor 44 and a computer-readable storage device or medium 46. The processor 44 may be any custom or off-the-shelf processor, a central processing unit (CPU), a graphics processing unit (GPU), an auxiliary processor among multiple processors connected to the controller 34, a semiconductor-based microprocessor (in the form of a microchip or chipset), a macroprocessor, any combination thereof, or generally any device for executing instructions. The computer-readable storage devices or media 46 may include volatile and non-volatile memory, for example, read-only memory (ROM), random access memory (RAM), and keep-alive memory (KAM). KAM is persistent or non-volatile memory that can be used to store various operating variables while the processor 44 is powered off.The computer-readable storage device(s) 46 may be implemented using any number of known storage devices such as PROMs (programmable read-only memory), EPROMs (electrically PROM), EEPROMs (electrically erasable PROM), flash memory, or other electrical, magnetic, optical, or combination storage devices capable of storing data, some of which represent executable instructions used by the controller 34 in controlling the autonomous vehicle 10.
[0039] The instructions may comprise one or more separate programs, each containing an ordered list of executable instructions for implementing logical functions. The instructions, when executed by processor 44, receive and process signals from sensor system 28, perform logic, calculations, methods, and / or algorithms to automatically control the components of autonomous vehicle 10, and generate control signals for actuator system 30 to automatically control the components of autonomous vehicle 10 based on the logic, calculations, methods, and / or algorithms. Although in Fig. 1 only one controller 34 is shown, embodiments of the autonomous vehicle 10 may include any number of controllers 34 that communicate via any suitable communication medium or combination of communication media and that cooperate to process the sensor signals, perform logic, calculations, methods and / or algorithms, and generate control signals to automatically control features of the autonomous vehicle 10.
[0040] In various embodiments, as discussed in detail below, one or more instructions of controller 34 are included in cruise control system 100 and, when executed by processor 44, process sensor data and / or other data, predict an optimal trajectory, compare driver actions to the optimal trajectory, calculate a confidence value based on the comparison, and form a longitudinal response profile of vehicle 10 based on the confidence value.
[0041] With reference to Fig. 2 and with continued reference to Fig. 1 illustrates a data flow diagram of various embodiments of an autonomous driving system (ADS) 70 that may be embedded within the controller 34 and that may include portions of the cruise control system 100 according to various embodiments. That is, suitable software and / or hardware components of the controller 34 (e.g., processor 44 and computer-readable storage device 46) are used to provide an autonomous driving system 70 used in conjunction with the vehicle 10.
[0042] Inputs to the autonomous driving system 70 may be received from the sensor system 28, from other control modules (not shown) connected to the autonomous vehicle 10, from the communication system 36, and / or determined / modeled by other sub-modules (not shown) within the controller 34. In various embodiments, the instructions of the autonomous driving system 70 may be organized by function or system. As shown in Fig. 2, the autonomous driving system 70 may include, for example, a computer vision system 74, a positioning system 76, a guidance system 78, and a vehicle control system 80. As can be appreciated, in various embodiments, the instructions may be organized into any number of systems (e.g., combined, further subdivided, etc.), as the description is not limited to the present examples.
[0043] In various embodiments, the computer vision system 74 synthesizes and processes sensor data and predicts the presence, location, classification, and / or path of objects and features in the environment of the vehicle 10. In various embodiments, the computer vision system 74 may integrate information from multiple sensors, including, but not limited to, cameras, lidars, radars, and / or any number of other types of sensors.
[0044] The positioning system 76 processes sensor data along with other data to determine a position (e.g., a local position relative to a map, an exact position relative to the lane of a road, the vehicle's direction, the speed, etc.) of the vehicle 10 relative to its surroundings. The steering system 78 processes sensor data along with other data to determine a path for the vehicle 10 to follow. The vehicle control system 80 generates control signals for controlling the vehicle 10 according to the determined path. In particular, the vehicle control system 80 generates control signals (e.g., steering control signals, acceleration control signals, braking control signals) for the actuator system 30 to control the vehicle 10 to follow the desired trajectory determined by the steering system 78.
[0045] As already briefly mentioned, the cruise control system 100 is Fig. 1 in the autonomous driving system 70. For example, all or parts of the speed control system 100 may be included in one or more of the subsystems or as a separate system (as shown). As shown in Fig. 3 and with continued reference to Fig. 1 and Fig. 2, the speed control system 100 includes, for example, a trajectory determination module 350, a lateral acceleration determination module 352, a confidence value determination module 354, a longitudinal control module 356, and a speed profile data store 358.
[0046] In various embodiments, the speed profile data store 358 stores speed profiles that define an acceleration or deceleration pattern used for the longitudinal control of the vehicle 10. In various embodiments, any number of speed profiles may be defined. For example, they may be defined as a multi-dimensional lookup table based on a current speed, a target speed, and a desired speed or speed error. In various embodiments, the speed profiles provide as an output a torque value to drive the wheels at the desired speed. The torque values may be defined according to the configuration of the drive system, the transmission system, and / or the braking system 26 of the vehicle 10 and the resulting deceleration / acceleration rates.By way of example, the description will be discussed using at least three exemplary speed profiles with three different rates, a first profile referred to as the optimal acceleration / deceleration profile, a second profile referred to as the partially limited acceleration / deceleration profile, and a third profile referred to as the limited acceleration / deceleration profile.
[0047] In various embodiments, the trajectory determination module 350 receives sensor data 360 as input. The trajectory determination module 350 processes the sensor data 360 to determine an upcoming trajectory of the vehicle 10. In various embodiments, the trajectory determination module 350 determines the trajectory based on the type and location of the lane markings identified ahead of the vehicle 10. The sensor data 360 may include, for example, camera data from the camera sensor. In various embodiments, other sensor data may also be used to determine the lane markings.
[0048] The trajectory determination module 350 processes the camera data using one or more machine learning techniques to extract the type and position of left and / or right lane markings in front of the vehicle 10. In various embodiments, the machine learning techniques, along with the type and position, provide a confidence value, and the trajectory determination module 350 determines the trajectory from the type and position of the lane markings and the confidence value. The trajectory determination module 350 then identifies one or more radial points along the trajectory. As shown in Fig. 4, the trajectory determination module 350 determines, for example, radial points (r0, r1, r2, etc.) along a predicted trajectory 390 (e.g., by sweeping the trajectory 390) based on the relationship: r=|y(x¨la)|[1+(y(x˙la))2]3 / 2, where y(x) = c0 + c1x + c2 x 2 + c3 x3 and where la stands for the forecast.
[0049] The trajectory determination module 350 generates predictive point data 362 based on the determined points.
[0050] In some cases, the trajectory determination module 350 does not identify a lane marking, or the trajectory determination module 350 is unable to identify lane markings with a certain degree of certainty. The trajectory determination module 350 determines that a short distance has passed since the last lane markings were identified (e.g., less than a threshold). In such cases, the trajectory determination module 350 determines a current point along a current path of the vehicle 10 based on the last known lane marking or the projected virtual lane markings and generates current point data 363 based thereon.
[0051] In various embodiments, the lateral acceleration determination module 352 receives as input the look-ahead point data 362 or the current point data 363, as well as sensor data 364. The sensor data 364 may include steering data from a sensor connected to the steering system. Upon receiving the look-ahead point data 362, the lateral acceleration determination module 352 predicts a lateral acceleration at the look-ahead point identified by the look-ahead data 362.
[0052] For example, lateral acceleration can be predicted based on this relationship: ay=Vx(t)2r,
[0053] Where r represents the curvature at the point and V x (t) stands for the longitudinal velocity at time t.
[0054] In various embodiments, the speed can be calculated based on the relationship: Vx(t)=∫0tlaax(t)dt+C, where a x represents the longitudinal acceleration, and where C represents a compensation value determined from a currently applied speed profile. For example, the lateral acceleration determination module 352 determines whether lateral acceleration compensation is required based on the executed longitudinal speed profile. For example, if the current longitudinal speed profile requires longitudinal deceleration because another vehicle was detected in the lane, the predicted lateral acceleration is compensated to account for the expected deceleration of the vehicle 10. Of course, the compensation may also be based on other scenarios and profiles, as the description is not limited to the present example.
[0055] In various embodiments, the lateral acceleration determination module 352 predicts a lateral acceleration at the instantaneous point identified by the instantaneous point data 363 when the instantaneous point data 363 is received. As can be imagined, the predicted lateral acceleration may be similarly determined and compensated based on the longitudinal velocity profile, as described above.
[0056] In various embodiments, the lateral acceleration determination module 352 then determines the actual lateral acceleration resulting from the driver's steering of the vehicle 10 at the look-ahead or current point. The sensor data 364 may include, for example, steering data from the sensors connected to the steering system 24 of the vehicle 10. The lateral acceleration determination module 352 evaluates the steering data and generates the actual lateral acceleration data 370 therefrom.
[0057] In various embodiments, the confidence value determination module 354 receives as input the predicted lateral acceleration data 368 and the actual lateral acceleration data 370. The confidence value determination module 354 determines a confidence value and generates confidence value data 372 based thereon. For example, if the predicted lateral acceleration is based on a current point basis, the confidence value determination module 354 decreases the confidence value.
[0058] In another example, if the predicted lateral acceleration is based on a trajectory, the confidence value determination module 354 then calculates a difference between the predicted lateral acceleration data 368 and the actual lateral acceleration data 370 and evaluates the difference to calculate a confidence value. For example, if the difference is greater than a threshold, the confidence value determination module 354 decreases the confidence value, and the confidence value data 372 is generated based on this difference. In another example, if the difference is less than or equal to the threshold, the confidence value determination module 354 increases the confidence value and generates the confidence value data 372 based on this difference.
[0059] The longitudinal control module 356 receives as input the confidence value data 372. Based on the confidence value, the longitudinal control module 356 selects a longitudinal speed profile from the speed profile data store 358 with which to control the longitudinal speed of the vehicle 10. The longitudinal control module 356 then generates speed control data 376 used to control the vehicle 10 based on the selected speed profile.
[0060] For example, if the confidence value lies within a first range, e.g., a high range, the longitudinal velocity profile shapes the velocity according to the acceleration / deceleration rate based on an optimal velocity profile. If the confidence value lies within a second range, e.g., a medium range, the longitudinal velocity profile shapes the velocity according to a partially constrained velocity profile. If the confidence value lies within a third range, e.g., a low range, the longitudinal velocity profile shapes the velocity according to a constrained velocity profile. As can be imagined, any number of ranges with any number of velocity profiles can be implemented in various embodiments.
[0061] With reference to Fig. 5 and with continued reference to Fig. 1-4 shows a flowchart of a process 400 performed by the speed control system 100 of the Fig. 1-4 according to the present description. As can be seen from the description, the sequence of operations within process 400 is not limited to the Fig. 5, but may be executed in one or more varying orders as applicable and consistent with the present description. In various embodiments, process 400 may be scheduled to run based on one or more predetermined events, and / or may run continuously during operation of autonomous vehicle 10, and / or may run offline prior to operation of vehicle 10.
[0062] In one example, process 400 may begin at 405. At 410, a determination is made as to whether longitudinal control is active, for example, by activating an autonomous or semi-autonomous function. If longitudinal control is not active at 410, process 400 may continue to monitor when longitudinal control is active at 410, or it may terminate. If longitudinal control is determined to be active at 410, a determination is made as to whether lane markings (for example, from camera data) are detected with sufficient confidence (for example, above a threshold) or whether a distance since the last seen lane markings is below a threshold at 420.
[0063] If the lane markings are identified with a confidence threshold at 420, an optimal trajectory based on the lane markings is determined at 430. Lateral acceleration is predicted at one or more look-ahead points along the trajectory at 440. The predicted lateral acceleration is compensated based on an active speed profile at 450. Observed lateral acceleration is determined at the look-ahead points based on the actual vehicle trajectory and / or steering data at 460.
[0064] The difference between the observed and desired lateral acceleration is then calculated and compared to a threshold at 470. If the difference is greater than the threshold at 470, the confidence value is decreased at 480. If the difference is less than or equal to the threshold at 470, the confidence value is increased at 490.
[0065] At 420, if the lane markings are not identified with a confidence threshold or the distance since the lane markings were lost is less than a threshold, a determination is made as to whether a speed profile is active at 500. If no speed profile is active at 500, the process 400 continues at 410. If a speed profile is active at 500, the confidence value is discretized at 510. The lateral acceleration for the current data point is determined based on the current vehicle trajectory and optionally compensated based on the active speed profile at 520. An observed lateral acceleration is determined for the current data point based on the actual vehicle path and / or steering data at 460.
[0066] Once the confidence value has been determined at 480, 490, or 510, process 400 proceeds to 530, where the confidence value is compared to three ranges to determine the appropriate speed profile. For example, if the confidence value is high or within a high range, the longitudinal speed is adjusted according to the optimal speed profile. If the confidence value is medium or within a medium range, the longitudinal speed is adjusted according to the speed profile that is partially constrained. If the confidence value is small or within a small range, the longitudinal speed is adjusted according to a speed profile that is constrained. After that, process 400 may end or return to the beginning at 410.
Claims
[1] A method for providing driving assistance in a vehicle (10), comprising: Determining, by means of a processor (44), a trajectory of the vehicle (10) along a roadway; Determining, by means of the processor (44), a confidence value based on a predicted lateral acceleration and an actual lateral acceleration at a point along the trajectory; Determining, by means of the processor (44), longitudinal speed data based on the confidence value; and Generating, by means of the processor (44), control signals for vehicle actuators (30) to control the vehicle (10) based on the longitudinal speed data; Receiving, by means of the processor (44), sensor data (360) from a sensor system (28) of the vehicle (10), wherein the sensor data (360) comprises camera data and wherein determining the trajectory from the camera data is based on an identification of lane markings on a roadway in front of the vehicle (10); wherein, if the lane markings are not identified from the camera data, determining the confidence value comprises decreasing the confidence value; comparing the confidence value with three ranges to determine an appropriate speed profile; where, if the confidence value is high or within a high range, the longitudinal speed is adjusted according to an optimal speed profile; where, if the confidence value is medium or within a medium range, the longitudinal speed is adjusted according to a speed profile that is partially constrained; and where, if the confidence value is small or within a small range, the longitudinal speed is adjusted according to a speed profile that is limited. [2] The method of claim 1, wherein determining the confidence value is based on a difference between the predicted lateral acceleration and the actual lateral acceleration at the point along the trajectory, wherein if the difference is above a threshold, the confidence value is increased, and wherein if the difference is below the threshold, the confidence value is decreased. [3] The method of claim 1, further comprising determining the predicted lateral acceleration based on a radial point along the trajectory. [4] The method of claim 1, further comprising determining the actual lateral acceleration based on steering data. [5] The method of claim 1, wherein the point is a point in front of the vehicle (10) along the trajectory. [6] The method of claim 1, wherein the point is an instantaneous point of the vehicle trajectory. [7] The method of claim 1, wherein determining the longitudinal speed data is based on a speed profile defined by a current speed, a target speed, and a desired speed. [8] A system for a vehicle (10) for providing driving assistance, comprising: a controller (34) comprising non-transitory computer-readable media (46) and configured, by means of a processor (44): to determine a trajectory of the vehicle (10) along a roadway; determine a confidence value based on a predicted lateral acceleration and an actual lateral acceleration at a point along the trajectory; to determine longitudinal speed data based on the confidence value; and generate control signals for vehicle actuators (30) to control the vehicle (10) based on the longitudinal speed data; to receive sensor data (360) from a sensor system (28) of the vehicle (10), wherein the sensor data (360) comprises camera data and wherein determining the trajectory from the camera data is based on an identification of lane markings on a roadway in front of the vehicle (10); wherein, if the lane markings are not identified from the camera data, determining the confidence value comprises decreasing the confidence value; where, if the confidence value is high or within a high range, the longitudinal speed is adjusted according to an optimal speed profile; where, if the confidence value is medium or within a medium range, the longitudinal speed is adjusted according to a speed profile that is partially constrained; and where, if the confidence value is small or within a small range, the longitudinal speed is adjusted according to a speed profile that is limited.
Citation Information
Patent Citations
Distance regulating system operating method for vehicle, involves activating event mode during target loss that occurs within event region, and determining event region for ahead-lying route region
DE102007036417A1
IN-VEHICLE TRAFFIC ASSISTANCE
DE102018125207A1
