System and method for managing the location of autonomous vehicles
The method and system for autonomous vehicles estimate and manage position using a complete vehicle model, addressing sensor malfunctions by predicting safe positions and activating emergency braking, ensuring reliable and safe operation.
Patent Information
- Application Number
- KR1020227017582
- Authority / Receiving Office
- KR · KR
- Patent Type
- Patents
- Current Assignee / Owner
- Priority Date
- 2019-10-30
- Filing Date
- 2020-10-30
- Publication Date
- 2026-11-06
- Estimated Expiration
- 2040-10-30
AI Technical Summary
Existing autonomous vehicle positioning systems rely on expensive sensors like lidar-based, RTK-DGPS-based, or INS-based sensors, which can malfunction and lead to loss of control, and current prediction methods only account for single future time intervals without considering the vehicle's controller state.
A method and system that estimates the vehicle's position using a complete model of the vehicle, including internal control logic, continuously checks for accuracy discrepancies, and activates emergency braking when thresholds are exceeded, utilizing longitudinal and lateral models in a closed loop to calculate subsequent safe positions.
Enables reliable and safe elimination of transient errors without additional sensors, predicting vehicle state in both short and long terms, and ensuring safe operation by activating emergency braking when necessary.
Smart Images

Figure 112022055138774-PCT00015_ABST
Abstract
Description
Technology Field
[0001] The present invention relates to a system for managing the location of an autonomous vehicle. The present invention also relates to an autonomous vehicle comprising such a management system. The present invention also relates to a method for managing the location of an autonomous vehicle. The present invention further relates to a warning system for a driver or a remote operator, in particular a visual, tactile, or acoustic warning system. Finally, the present invention relates to a data synthesis system. Background Technology
[0002] Autonomous vehicles are generally equipped with a certain number of sensors to enhance their performance. A positioning system is typically provided to determine the vehicle's position in a local or global reference coordinate system. Algorithms for detecting and tracking the vehicle's movement, along with path planners, are often integrated with this positioning system. Therefore, it is important to provide an accurate positioning system for autonomous vehicles.
[0003] However, additional sensors commonly used in autonomous vehicles, such as lidar-based, RTK-DGPS-based, or INS-based sensors, are expensive and may malfunction and / or fail. As a result, there is a risk of losing control of the autonomous vehicle.
[0004] Document JP2004271293 discloses a navigation device and method utilizing positioning information provided by a Global Positioning System (GPS) along with the positioning history of the autonomous vehicle. Based on the positioning data and positioning history of the autonomous vehicle itself, the GPS data is defined as the current position of the autonomous vehicle only when the autonomous vehicle is within an expected vehicle positioning range. Otherwise, the expected vehicle positioning is set as the current vehicle position. Various threshold values are determined for the distance traveled and the orientation angle for various speed values. The expected vehicle position is calculated from point-based motion mathematical formulas for a given speed and orientation angle.
[0005] However, this solution has disadvantages. In particular, the state of the autonomous vehicle can be predicted only for its current state without considering the controller. This solution only enables the prediction of the autonomous vehicle's state at a single future time interval.
[0006] The object of the present invention is to provide a system and method for managing the position of an autonomous vehicle that resolves the aforementioned disadvantages and improves upon systems and methods known from the prior art. In particular, the present invention makes it possible to show a system and method that enables the reliable and safe elimination of transient errors in a positioning system without using additional sensors.
[0007] To achieve this purpose, the present invention relates to a method for managing the location of a vehicle, and said method,
[0008] - A step of estimating the first position of the vehicle at various times,
[0009] - A step of measuring the second position of the vehicle at the same various times mentioned above,
[0010] - A step of considering the first position as the current vehicle position at various times when the first position and the second position do not coincide,
[0011] - A step of incrementing the counter when a discrepancy between the first position and the second position exists simultaneously,
[0012] - Step of placing the vehicle in safe mode when the above counter reaches a threshold value
[0013] Includes
[0014] The above estimation step is,
[0015] - A step of combining the longitudinal and lateral models of a vehicle in a closed loop to calculate the subsequent safety state of the vehicle, in particular the subsequent position of the vehicle, and
[0016] - Steps to create a safe state of the vehicle, specifically a safe position of the vehicle
[0017] It may include.
[0018] In the present invention, the safety state is a calculated future or subsequent vehicle safety position corresponding to operating modes that are preferably intended to mitigate various instances of degradation of a position identification system using sensors.
[0019] This may be a typical case, for example, where satellite positioning degrades from a centimeter-unit error to an absolute error of 40 centimeters when a vehicle passes through a tunnel that negatively affects positioning accuracy. At the same time, immediately after passing through the tunnel, the lane width decreases from 3.5 meters to 2.5 meters, and thus the accuracy generally sufficient for a highway scenario is insufficient to keep the vehicle still following the lane. In this case, the method according to the present invention may be implemented in such a way that accuracy is increased while lowering the speed profile to allow the GPS positioning system time to recover its maximum capability. The estimated value according to the present invention is continuously compared with the actual value, and once the centimeter-unit precision of the GPS is recovered, the solution method based on the sensors is returned, and the method and the counter are restarted.
[0020] Another case of degradation may be when the sensor-based positioning system is not fully operational but the vehicle must continue driving in autonomous mode until it reaches a safe stopping position. For example, the activation of the safety pilot, which is indicated by a color change in the HMI, is prevented. Subsequently, the length of the remaining path of the navigation system is considered to generate a deceleration profile to stop the vehicle at the end of the remaining path of the navigation system, and the present invention replaces the positioning system so that the lateral error for said path is calculated by considering the current vehicle position each time. The safety state enables the definition of smooth vehicle deceleration until as much reliable information as possible is obtained from the navigation system, thereby warning the driver via the HMI and allowing the driver to regain control.
[0021] As further described herein, the first position of the vehicle is determined from the accuracy ellipse, that is, by converging multiple safe positions. Accordingly, the first position of the vehicle is determined based on the multiple safe states of the vehicle.
[0022] Preferably, the "longitudinal model" refers to a mathematical model that enables the determination / estimation of the future longitudinal position of a vehicle from the current longitudinal position of the vehicle.
[0023] Preferably, "lateral model" means a mathematical model that enables determining / estimating the future lateral position of a vehicle from the current lateral position of a vehicle.
[0024] The above method may include the step of generating a synthetic data system to compensate for a single or multiple errors within an automatic positioning system of a positioning system.
[0025] In this document, synthetic data refers to positioning or positioning data generated according to the present invention based on a vehicle model called a complete model using lateral and longitudinal controllers within a single loop. The model is provided by the navigation system (or positioning system). This means that the same data is supplied to the vehicle controller (i.e., the actual vehicle controller) and is used to supply the vehicle model so that the actual position of the next vehicle corresponds to the GPS position of the next vehicle. The synthetic data has the same structure or substantially the same structure, preferably exactly the same structure, as the data from the positioning system (or positioning system) sufficient to control the vehicle, i.e., XY coordinates and heading. The synthetic data is data that defines the aforementioned safety states, i.e., each safety state is defined by a set of synthetic data.
[0026] One set of synthetic data is, for example, latitude, longitude, horizontal coordinate, vertical coordinate, or direction of travel. Each set of synthetic data is advantageously provided by the estimated safe position module described below. Therefore, a set of synthetic data makes it possible to define the safety status of the vehicle.
[0027] Regarding the method by which the above synthetic data can compensate for errors, consider, for example, the case of passing through a tunnel where the accuracy of the satellite positioning system deteriorates to an error of 40 cm, causing the vehicle to deviate from its lane if the present invention is not applied. However, since the present invention integrates all vehicle dynamics and control response, the present invention does not reliably prevent the vehicle from drifting in the lane over time, but because such drift is significantly lower than that of a GPS system, the present invention improves performance by reducing positioning uncertainty.
[0028] The above method may include the step of storing the safety states of the vehicle, in particular the safety positions of the vehicle.
[0029] The above method may include the step of determining an accuracy ellipse obtained from calculated safe positions.
[0030] The above estimation step may include a step of determining a first estimated position of a vehicle from the accuracy ellipse by converging a plurality of calculated safe positions.
[0031] The above method may include a step of considering there to be a discrepancy by comparing the second position with respect to the accuracy ellipse, particularly when the second position is outside the accuracy ellipse.
[0032] The present invention also relates to a system for managing the location of a vehicle, comprising means for implementing the method defined above.
[0033] The above system is,
[0034] - Elements indicating that there is an error in the automatic location verification system; and
[0035] - A component that activates emergency braking in the event of an error in the above automatic position verification system;
[0036] It may include.
[0037] The present invention also relates to an automobile comprising a system as defined above.
[0038] The present invention also relates to a computer program product comprising program code instructions stored on a computer-readable medium for implementing the steps of the method described above when the computer program is executed on a computer, or a computer program product downloaded from a communication network and stored on a data medium that enables the computer to implement the method described above when the computer program is executed by the computer.
[0039] The present invention also relates to a computer-readable data storage medium storing a computer program comprising program code instructions for implementing the method described above, or a computer-readable storage medium comprising instructions that cause the computer to implement the method described above when executed by a computer.
[0040] Finally, the present invention relates to a signal from a data storage medium that transports the computer program product defined above.
[0041] The attached drawings show, by way of example, an embodiment of a location management system according to the present invention and an embodiment of a location management method according to the present invention. Brief explanation of the drawing
[0042] Figure 1 is a flowchart showing an example of an implementation of a method for managing the location of a vehicle. Figure 2 is a diagram showing an example of a system for managing the location of an autonomous vehicle. Figure 3 is a drawing showing an example of an estimated safe position module of a location management system of the type of Figure 2. Figure 4 is a graph showing the longitudinal response of a vehicle based on a longitudinal model of the vehicle of the estimated safe position module of the type of Figure 3. Specific details for implementing the invention
[0043] The present invention provides a system for managing the position of an autonomous vehicle designed to continuously check the output of a system, particularly enabling the evaluation of accuracy.
[0044] Initially, predicted vehicle position data is calculated using the most recently available reliable position information. This prediction is made using a complete model of the vehicle, including its internal control logic. To determine if the new position data is sufficiently accurate, the estimated data and the actual data are compared to allow for the detection of any potential malfunctions at the frequency of the safety position determination system. If no errors are detected, the estimated safety data is assumed to be the correct vehicle position.
[0045] This results in two main functions of such a system for managing the location of a vehicle. The first function of the system is that it enables the system to find an accurate location value and indicate when to provide it. The second function of the system is that it enables the system to determine when it reaches a limit and, in particular, to potentially put the vehicle into a safe mode by activating emergency braking.
[0046] The present invention provides a system that uses a complete model of a vehicle and a control algorithm. Such a system can estimate subsequent safe positions of a vehicle at a higher frequency than commonly used positioning systems.
[0047] Such a system enables the acquisition of an envelope ellipse of temporary safe position points where the vehicle's next location must be found. This envelope ellipse takes into account the vehicle's current dynamics and its estimated future dynamics.
[0048] Such a vehicle location management system can utilize all available vehicle information. The complete vehicle model and control algorithm can consider the latest available information to estimate the remaining variables.
[0049] The present invention provides a method for managing the location of a vehicle, said method,
[0050] - A step of estimating the first position of the vehicle at various times,
[0051] - A step of measuring the second position of the vehicle at the same various times mentioned above,
[0052] - A step of considering the second position as the current vehicle position at various times when the first position and the second position do not coincide,
[0053] - A step of incrementing the counter when a discrepancy between the first position and the second position exists simultaneously,
[0054] - Step of placing the vehicle in safe mode when the above counter reaches a threshold value
[0055] Includes
[0056] The above estimation step is,
[0057] - A step of combining the longitudinal and lateral models of a vehicle in a closed loop to calculate the subsequent safety state of the vehicle, in particular the subsequent position of the vehicle, and
[0058] - Steps to create a safe state of the vehicle, specifically a safe position of the vehicle
[0059] It may include.
[0060] One embodiment of a method for managing the location of a vehicle is described below with reference to FIG. 1.
[0061] In the first step (E10), the counter is initialized at time (t).
[0062] In the second step (E20), the position of the vehicle at this time (t), called the first position, is estimated.
[0063] In the third step (E30), the position of the vehicle, referred to as the second position, is measured at the same time (t).
[0064] In step 4 (E40), the estimated first position and the measured second position are compared.
[0065] If the estimated first position and the measured second position do not coincide, in step (E51), the estimated first position is considered as the current vehicle position at this time (t). In step (E52), the counter is incremented. The estimated first position may consist of a set of positions contained within a geometric figure, in particular an ellipse, as described below. Therefore, if the measured position is outside the geometric figure, the estimated first position and the measured second position may be considered not to coincide.
[0066] After the step of increasing the counter (E52), if the counter does not reach the threshold value, the method is repeated from the second step (E20). If the counter reaches the threshold value, in step (E53), the vehicle is placed in safety mode.
[0067] If the estimated first position and the measured second position coincide, in step (E61), the measured second position is considered as the current vehicle position at this time (t). Therefore, if the measured position is within the geometric figure, the estimated first position and the measured second position may be considered to coincide.
[0068] After that, the above method is repeated from the first step (E10) to reset the counter.
[0069] One embodiment of a system for managing the location of a vehicle is,
[0070] - Means for estimating the first position of a vehicle at various times (7, 8),
[0071] - Means (3) for measuring the second position of the vehicle at the same various times as above,
[0072] - Comparison and interpretation means (9) that can consider the first position as the current vehicle position at various times when the first position and the second position do not coincide, and consider the second position as the current vehicle position at various times when the first position and the second position coincide,
[0073] - A counter (23) that can be incremented while there is a discrepancy between the first position and the second position simultaneously, and can be initialized when there is a match between the first position and the second position simultaneously,
[0074] - Means for placing the vehicle in safe mode when the above counter reaches a threshold value (25, 29)
[0075] Includes
[0076] If the counter has not yet reached the threshold, a short-term or temporary error occurs.
[0077] When the counter reaches the threshold, a long-term error or malfunction occurs.
[0078] The counter can be a mismatch occurrence counter or a time counter, specifically a time delay counter. The threshold can be 0.5 seconds or 5 seconds.
[0079] Advantageously, the above estimation means (7, 8) are,
[0080] - Means (7) for combining a longitudinal model and a lateral model of a vehicle in a closed loop that can calculate the subsequent safety state of the vehicle, in particular the subsequent position of the vehicle, and
[0081] - A means of generating a safe state of a vehicle, particularly a safe position of the vehicle (8)
[0082] Includes
[0083] The means for placing the above vehicle in a safe mode may include an emergency braking system (25).
[0084] The means (3) for measuring the second position of the vehicle may include, in particular, at least one position sensor of the GPS type.
[0085] The above system (1) may further include a storage module (6) capable of storing the safety status of the vehicle, in particular the safety location of the vehicle.
[0086] The above system (1) may further include a safety evaluator (8) capable of providing an accuracy ellipse based on a safety position calculated by the coupling means (7).
[0087] Advantageously, the estimation means converges a plurality of safe positions calculated by the combining means (7) to obtain the first position (p) of the vehicle estimated from the accuracy ellipse. e ) can be determined.
[0088] Advantageously, the means (9) for determining the current position of the vehicle may consider that the measured second position does not match the accuracy ellipse when compared to the accuracy ellipse, particularly when the second position is outside the accuracy ellipse.
[0089] The above system (1) comprises a device for measuring the steering wheel angle and an angular yaw rate (ω ν It may include a device for measuring ).
[0090] The present invention also relates to an autonomous vehicle, in particular an autonomous vehicle (100), comprising a system (1) for managing the location of a vehicle of the type described above.
[0091] An embodiment of a system (1) for managing the location of an autonomous vehicle (100) is described below with reference to FIG. 2.
[0092] The safety position determination system (1) may include an automated system (3) for verifying the position of the vehicle.
[0093] The automated system (3) for determining the location of the above vehicle includes, for example, one or more sensors, particularly, for example, GPS type location sensors.
[0094] The automated system (3) for verifying the location of the above vehicle can determine the current location or position of the vehicle.
[0095] The above safety position determination system (1) may include two main operating stages (10, 20).
[0096] In the first stage (10), the system (1) includes means for calculating at least one reliable safe position for the vehicle. This ensures a safe position for the autonomous vehicle.
[0097] In the second stage (20), the system (1) includes means for evaluating the position of the vehicle. The second stage (20) of the system (1) maintains the vehicle in an autonomous driving mode or the vehicle in a safety mode, particularly
[0098] - A safety mode in which driving is no longer autonomous and is controlled by the vehicle occupant through actions on the interface, and / or
[0099] - A safety mode in which the above system activates an automatic safety braking system to reduce the vehicle's speed and / or stop the vehicle, and / or
[0100] - A safety mode in which the system warns the driver or remote operator, particularly through a visual warning system, that there is a defect in the automated system (3) for verifying the location of the vehicle.
[0101] It enables placement as.
[0102] The above warning system may be of a different type, for example, a sound warning system or a tactile warning system, instead of being a visual warning system.
[0103] The above interface may include a vehicle steering wheel and / or a vehicle speed control pedal.
[0104] The second stage (20) of the above system (1) may include a display means (21). The display means (21) is intended to notify a vehicle driver or a remote operator.
[0105] The display means (21) may include, for example, a human-machine interface, particularly a head-up display.
[0106] The above display means (21) can be connected to, for example, a remote control center.
[0107] The first stage (10) of the above system (1) may include a module (9) for determining the position of a vehicle.
[0108] The second stage (20) of the above system (1) may include a position evaluation module (23).
[0109] The above module (9) uses the output of the automation system (3) that checks the location of the vehicle as a main input.
[0110] The automated system (3) for verifying the location of the vehicle is intended to provide information about the vehicle (XY coordinates, location, etc.). For simplicity, the following description focuses on XY coordinates, but it can be easily applied to any other variable.
[0111] The first stage (10) of the above system (1) may further include a block (5) for estimating a safe position.
[0112] The above block (5) is intended to calculate a number of subsequent safe positions of the vehicle based on safe position information previously stored in the storage module (6).
[0113] The above multiple subsequent safety positions can be calculated in the block (5) at a frequency that is less than or equal to the maximum frequency of the block (5).
[0114] The storage module (6) includes, for example, the previous position (t-θ) of the vehicle, where θ is the maximum time horizon at which the system (1) can operate.
[0115] The above-mentioned estimated safe position module (7) provides the μ x θ position of the vehicle at time (t), where μ is the frequency difference between the system (3) and the system (1). The frequency of the system (1) is, for example, about 10 Hz.
[0116] The estimated safe positions obtained from the output of the above module (7) can be grouped together in the safety evaluator (8).
[0117] The function of the above safety evaluator (8) is to provide an accuracy ellipse as a function of θ that enables all estimates provided by the above module (7) to converge to a single vehicle safety position point.
[0118] The above module (9) is intended to determine the current location of the vehicle. The current location of the vehicle is intended to be provided, in particular, to other automation modules of the vehicle (recognition, navigation, or control modules).
[0119] The current position of the vehicle is the position of the vehicle (p) obtained from the output of the system (3) in relation to the accuracy ellipse calculated by the safety evaluator (8). m It is selected from the above module (9) according to ).
[0120] The position of the vehicle (p) obtained from the output of the above system (3) m If ) is outside the accuracy ellipse calculated by the safety evaluator (8), the current position of the vehicle (p) provided by the module (9) f ) is the safe location point (p) calculated by the safety evaluator (8). e It corresponds to ).
[0121] The position of the vehicle (p) obtained from the output of the above system (3) m When ) is located inside the accuracy ellipse calculated by the safety evaluator (8), the current position of the vehicle (p) provided by the module (9) f ) is the position of the vehicle (p) obtained from the output of the above system (3). m It corresponds to ).
[0122] The above module (9) is a selected value (p f ) is transmitted (via feedback) to the position evaluation module (23) of the second stage (20) of the system (1) and the storage module (6) of the first stage (10) of the system (1).
[0123] The median value (p) generated in the above safety evaluator (8) e ) the vehicle's current location (p f If considered as ), all of his previous values are also collected in the storage module (6).
[0124] All data provided by the above module (9) can be stored in the module (6) up to the time horizon (θ) for the purpose of distinguishing between isolated malfunctions (i.e., minor failures) and longer malfunctions of the cycle, thereby enabling the system (3) to provide accurate data or determine whether failures and / or malfunctions occur during the time horizon (θ).
[0125] These data are reliable, up-to-date location data when the vehicle is located within the ellipse of the points where it is supposed to be located, or multiple previously predicted safe states of the vehicle when it is outside the ellipse, that is, corresponding to a malfunction of the vehicle's system (1). This makes it possible to obtain an assessment of the safe position for the short and long term. This enables the determination of potential deviations from the vehicle's current position and the accurate position. If necessary, these data can be used to activate the automatic braking system, in particular, to place the vehicle in a safe mode.
[0126] Advantageously, the second stage (20) of the system (1) may include an automatic safety braking system (25) or an emergency braking system, and its input is connected to the output of the position evaluation module (23).
[0127] Advantageously, the position evaluation module (23) of the second stage (20) of the system (1) may include a counter.
[0128] The counter of the above-mentioned position evaluation module (23) is configured to be triggered as soon as a malfunction is detected in the system (3). This information is the vehicle position (p) provided in the output of the module (9). f It is obtained from ).
[0129] The above counter is the position of the vehicle (p) provided with acceptable accuracy. f It can be done based on a given time or distance horizon by considering ).
[0130] The above position evaluation module (23) can provide two possible outputs.
[0131] The first output of the above module (23) corresponds to the case where the system (3) provides accurate data again to stop the counter.
[0132] The second output of the above module (23) corresponds to when the value supplied by the counter exceeds a given threshold that activates the automatic safety braking system (25).
[0133] The second stage (20) of the above system (1) may additionally include a vehicle path planner (27).
[0134] The output of the vehicle route planner (27) can also be provided as an input to the position evaluation module (23).
[0135] The second stage (20) of the above system (1) may have two functions.
[0136] The first function is to signal a malfunction of the system (1) by a warning signal included in the head-up display or human-machine interface (21) (or remote control center) of the vehicle.
[0137] The second function is the activation of the automatic safety braking system (25).
[0138] Preferably, the second stage (20) of the system (1) may further include an actuator (29) connected to the output of the automatic safety braking system (25). The actuator (29) is configured to correct the position of the vehicle, particularly in the event of a temporary error.
[0139] The above automatic safety braking system (25) may include an adaptive control algorithm. This adaptive control algorithm enables flexible braking maneuvers as a function of the most reliable path obtained from the output of the vehicle path planner (27).
[0140] The second stage (20) of the above system (1) enables maximizing the distance traveled completely safely without danger or in a deteriorated state. This enables minimizing longitudinal deceleration of the vehicle. As a result, passenger comfort is improved when the vehicle is placed in a safe mode.
[0141] The first warning function and the second braking function of the second stage (20) of the above system (1) each contribute to gradually warning the driver or remote operator and stopping the vehicle if necessary.
[0142] One advantage of the vehicle location management system of the type described above is that the vehicle's condition can be predicted in the short and long term, so appropriate decisions can be made, for example, to wait until the system (3) is operational again or to place the vehicle in a safe location.
[0143] An example of an estimated safe position module (7) of a vehicle position management system (1) of the type of FIG. 2 is described in more detail below with reference to FIG. 3.
[0144] The above-mentioned estimated safe position module (7) determines the safe position based on the known previous position using a complete model of the vehicle and a control system.
[0145] The present invention proposes an estimated safe position module (7) that uses a longitudinal model and a lateral model of a vehicle, wherein the longitudinal and lateral models are each associated with a longitudinal and lateral controller, respectively, and generate multiple vehicle safe positions based on information stored in the module (6).
[0146] To this end, the module (7) may include means for combining the longitudinal model and the lateral model of the vehicle in a closed loop to calculate the subsequent safety state of the vehicle, in particular the subsequent safety position of the vehicle.
[0147] Advantageously, the module (7) may include a transverse block (71) including a transverse model (30) of the vehicle and a longitudinal block (72) including a longitudinal model (40) of the vehicle.
[0148] The lateral block (71) of the module (7) including the lateral model (30) of the vehicle is described below.
[0149] The transverse block (71) of the above module (7) may include a steering wheel angle information selector (31).
[0150] The lateral model (30) of the vehicle is configured to receive a steering wheel angle measurement value provided by the selector (31) as an input.
[0151] The transverse block (71) of the above module (7) may further include a steering wheel actuator model (33).
[0152] The selector (31) is configured to check whether a new steering wheel angle measurement is available at the frequency of the estimated safe position module (7). If a new steering wheel angle measurement is not available, the value generated by the steering wheel actuator model (33) is used as an input to the vehicle's lateral model (30) as a steering wheel angle measurement.
[0153] The frequency of the above-mentioned estimated safe position module (7) is, for example, about 100 Hz.
[0154] The lateral model (30) of the above vehicle is particularly a measured angular yaw rate (ω ν It is designed to provide ).
[0155] To this end, the following mathematical formulas can be used.
[0156]
[0157]
[0158] Here, u ν is steering wheel angle control.
[0159] The state vector is as follows.
[0160]
[0161] Here,
[0162] y ν is the lateral position of the vehicle, and
[0163] ν y is the lateral velocity, and
[0164] ψ ν is this angle, and
[0165] ω ν is the angle yaw rate.
[0166] The matrices of the above system (A ν , B ν , C ν This is explained below.
[0167]
[0168]
[0169]
[0170] Here,
[0171] C f and C r is the cornering stiffness of the front and rear wheels, respectively, and
[0172] ν x is the speed of the vehicle, and
[0173] m is the mass of the vehicle, and
[0174] l Z is the moment of inertia, and
[0175] a and b are the distances between the vehicle's center of gravity and the front and rear wheels, respectively.
[0176] As input, the lateral model (30) uses the steering wheel angle measurement on one side and the longitudinal speed obtained from the longitudinal model (40) on the other.
[0177] The above lateral velocity (ν y ) and the above angle yaw rate (ω ν ) is obtained from the output of the above-mentioned transverse model (30).
[0178] These two data outputs from the above lateral model (30), namely the lateral velocity (ν y ) and angle yaw rate (ω ν ) is used to calculate the subsequent position of the vehicle in the safety position computer (50).
[0179] The lateral block (71) of the above module (7) may further include a lateral controller (35) for an autonomous vehicle.
[0180] The operation of this lateral controller (35) is an angular yaw rate (ω) between the vehicle's current path and the vehicle's desired path. ν It can be achieved based on the minimization of ). The desired path can be calculated based on data from a camera (or any other sensor) to generate a set of waypoints.
[0181] On the one hand, the above lateral controller (35) is an angle yaw rate (ω) provided by the above lateral model (30). ν It is configured to receive as input an angular yaw rate provided by another model of the vehicle (corresponding to the reference path). The lateral controller (35) is configured to compare these two angular yaw rate values corresponding to the desired path and the reference path, respectively.
[0182] This makes it possible to adjust the performance of the above-mentioned lateral controller (35) in particular according to the following mathematical formula.
[0183]
[0184] Here, k gain is a speed-dependent parameter that enables achieving good tracking performance for the desired path.
[0185] Steering wheel angle control (u) obtained from the output of the above lateral controller (35) ν ) is provided as an input to the above steering wheel actuator model (33).
[0186] As a result, a lateral entire system or block (71) including a vehicle lateral model (30), a vehicle lateral controller (35), and a steering wheel actuator model (33) is obtained.
[0187] One advantage of this lateral block (71), which includes the lateral model (30) of the vehicle, is related to the fact that it makes it possible to obtain a realistic model by taking various limitations into account. The vehicle lateral controller (35) and the steering wheel actuator model (33) play an important role because the vehicle lateral model (30) alone provides overly optimistic results regarding actual road performance.
[0188] A longitudinal block (72) of the module (7) including a longitudinal model (40) of the vehicle is described below.
[0189] The longitudinal block (72) of the above module (7) may include a speed information selector (41).
[0190] The longitudinal block (72) of the above module (7) may further include a longitudinal controller (45) for an autonomous vehicle.
[0191] The longitudinal model (40) of the above vehicle is configured to receive a speed control command provided by the longitudinal controller (45) of the vehicle as an input.
[0192] The operation of the longitudinal controller (45) of the above vehicle is the longitudinal speed (ν) provided by the speed information selector (41). x It can be achieved based on minimizing the speed error between the desired speed on the reference path and the above reference path.
[0193] The longitudinal speed value (ν) used in the longitudinal controller (45) of the vehicle, the lateral model (30) of the vehicle, and the safety position computer (50). x ) can be provided by the speed information selector (41) above.
[0194] One of the functions of the speed information selector (41) is to check whether a new longitudinal speed measurement is available at the frequency of the estimated safe position module (7). If a new longitudinal speed measurement is not available, the measured safe speed value generated by the longitudinal model (40) of the vehicle is used.
[0195] The longitudinal model (40) of the above vehicle is a safety speed measurement value (V) as an output. x It is designed to provide ).
[0196] The longitudinal model (40) of the above vehicle is the speed control command (V c (s)) the above speed measurement (V x It can be described as a second-order transfer function linked to (s).
[0197]
[0198] Here,
[0199] ω n is the natural frequency in units of rad / s, and ζ is the damping factor.
[0200] These values depend particularly on the design of the low-level controller, throttle, and brake pedal offset.
[0201] One advantage of the longitudinal model (40) of the type of vehicle described above is that it makes it possible to describe the longitudinal response of the vehicle in an optimal way.
[0202] FIG. 4 is a given speed control command profile (V c )(curve (101)), speed measured by on-board sensors (curve (102)), and speed (V) obtained from the vehicle longitudinal model (40). x Allows for comparison of the curve (103). As can be clearly seen in FIG. 4, the longitudinal model (40) perfectly follows the actual response of the vehicle.
[0203] First, the above angle yaw rate (ω ν ) and the above lateral velocity (ν y ) is obtained from the transverse block (71) and the longitudinal velocity (ν) x When ) is obtained from the longitudinal block (72), these values are used as inputs to the safe position computer (50).
[0204] The above safety position computer (50) uses the following general motion mathematical formula to derive the derivatives of the safety position coordinates ( , It enables obtaining ).
[0205]
[0206]
[0207] The above safe position coordinates (X, Y) are their corresponding derivatives ( , It is obtained by integrating ).
[0208] The values (X, Y) obtained from the output of the above safe position computer (50) are the outputs of the above estimated safe position module (7).
[0209] At the final reliable location, the module (7) estimates the next location in frequency and updates the available data (path or speed or steering wheel angle measurement) between two consecutive location points. Consequently, a set of X, Y locations is obtained and transmitted to the safety evaluator (8) to obtain the ellipse where the vehicle should be located and its median.
[0210] The output of the above safety evaluator (8) is checked against the current position of the vehicle obtained from the system (3), thereby determining the quality of the current position of the vehicle obtained from the system (3), and at this time, the final position (p) of the vehicle f ) is provided. The output of the module (9) is used as the new location of the vehicle returned to the safe location storage module (6) (by feedback) as a single point (if the current location of the vehicle obtained from the system (3) is reliable) or as a point cloud (if the system (3) provides two or more incorrect location values).
[0211] One advantage of the type of system (1) described above is that it makes it possible to predict the state of the vehicle while considering the dynamic model of the controller and the vehicle in the future time horizon. As a result, the movement of the vehicle can be predicted while considering the operation of the controller in the future. This suppresses vibrations of the system (1) and improves the lateral response of the vehicle.
[0212] Another advantage of the type of system (1) described above is that it makes it possible to maximize the safety of the autonomous vehicle without using autonomous driving sensors.
[0213] Another advantage of the type of system (1) described above is that it makes it possible to estimate the future position of the vehicle more accurately. This system (1) can estimate the subsequent safe position of the vehicle at a frequency of up to 100 Hz, that is, at a frequency significantly higher than that of a commonly used positioning system.
[0214] This system (1) operates in short and long horizons to identify a temporary fault (i.e., short-term error) or a malfunction (i.e., long-term error) in an automatic system for verifying the position of a vehicle (3), and to take measures to correct these errors or to place the vehicle in a safe mode, particularly in the event of a malfunction, to perform an automatic safety braking action.
[0215] If the above counter has not yet reached the threshold, a short-term or temporary error occurs.
[0216] If the above counter reaches the threshold, a long-term error or malfunction occurs.
[0217] The above system (1) may include means for correcting the position of the vehicle in the event of a temporary error.
[0218] The above system (1) may include a warning system for a driver or remote operator, in particular a visual, tactile, or sound warning system, to indicate a long-term error or malfunction and to activate an emergency braking maneuver. The warning system, in particular a visual, tactile, or sound warning system may include an indicator that can be installed on the display means (21).
[0219] Although the present invention has been described in the case of an autonomous vehicle, it is evident that the present invention applies to any type of autonomous vehicle, such as a bus or a truck.
Claims
Claim 1 A method for managing the position of a vehicle (100), the method comprises: - a step (E20) of estimating an accuracy ellipse representing the position of the vehicle by converging multiple safe position coordinates at various times; - a step (E30) of measuring a second position of the vehicle at the same various times; - a step (E51) of considering the position of the vehicle relative to the accuracy ellipse at the various times as the current position of the vehicle when the accuracy ellipse and the second position do not coincide (E40); - a step (E52) of simultaneously incrementing a counter when there is a discrepancy between the accuracy ellipse and the second position; and - a step (E53) of placing the vehicle in a safe mode when the counter reaches a threshold value, wherein the estimation step (E20) comprises: - a step of combining the longitudinal model (40) and the lateral model (30) of the vehicle in a closed loop to calculate the multiple safe position coordinates; and - a longitudinal velocity (V x The above longitudinal model (40) outputting ) and lateral velocity (V y Based on the lateral model (30) that outputs ), the step of generating the plurality of safe position coordinates is included, and the estimation step (E20) converges the calculated plurality of safe position coordinates to obtain the first estimated position (p) of the vehicle from the precision ellipse. e A vehicle location management method characterized by including a step of determining ). Claim 2 delete Claim 3 A vehicle location management method according to claim 1, characterized in that the vehicle location management method comprises the step of generating a synthetic data system to compensate for a single or multiple errors within an automatic location verification system of a location verification system. Claim 4 In claim 1, the vehicle location management method comprises the step of storing the safety location coordinates or the second locations. Claim 5 A vehicle position management method according to claim 1, comprising the step of determining an accuracy ellipse obtained from the calculated plurality of safety position coordinates. Claim 6 delete Claim 7 A vehicle position management method according to claim 1, wherein the vehicle position management method includes the step of considering there to be a discrepancy by comparing the second position with respect to the accuracy ellipse when the second position is outside the accuracy ellipse. Claim 8 A vehicle location management system (1) comprising means for implementing a method described in any one of paragraphs 1, 3 through 5 and 7. Claim 9 In claim 8, the vehicle position management system comprises: - an element indicating that there is an error in the automatic position verification system (3); and - an element activating an emergency braking maneuver when there is an error in the automatic position verification system (3). Claim 10 A vehicle (100) including the system (1) described in paragraph 8. Claim 11 A computer program comprising program code instructions stored on a computer-readable medium for implementing the steps of the method described in any one of claims 1, 3 through 5 and 7 when the computer program is executed on a computer, Claim 12 A computer-readable data storage medium storing a computer program comprising program code instructions for implementing a method described in any one of claims 1, 3 through 5 and 7.
Citation Information
Patent Citations
Controller for travel of unmanned vehicle
JP2002215236A
Navigation system, and position detecting method
JP2008020365A
Vehicle positioning system
JP2017003395A
Satellite navigation / dead-reckoning navigation integrated positioning device
WO2009101843A1
