This application claims the benefit of priority under 35 U.S.C. § 119 of German Application DE 10 2004 027 250.6 filed Jun. 3, 2004, the entire contents of which are incorporated herein by reference.
The invention pertains to a method and a device for the assisted steering, particularly the assisted maneuvering and parking, of a motor vehicle.
So-called driver assistance systems for assisting the driver of a motor vehicle in maneuvering, parking in and/or parking out are known from the state of the art. A driver assistance system typically comprises a sensor arrangement that surveys the surroundings of the motor vehicle, for example, by means of ultrasonic sensors. Known driver assistance systems are designed, in particular, for surveying a parking spot and for assisting the driver in parking the motor vehicle in a parking spot.
A parking assistant is known, for example, from DE 198 09 416 A1. In this case, a driving maneuver calculated by a data processing unit is displayed to the driver of the motor vehicle and information on steering the motor vehicle to a certain destination is provided. In a method carried out with this system, a potential parking spot is approached and surveyed by sensors arranged on the motor vehicle. Subsequently, it is determined whether or not the size of the parking spot suffices for parking in the respective motor vehicle based on stored reference values. If the parking spot has a sufficient size, a parking strategy is calculated in dependence on the dimensions of the parking spot and displayed to the driver of the motor vehicle on a display unit. The driver is then able to execute the proposed parking strategy. While the motor vehicle is maneuvered into the parking spot, a comparison between actual and nominal values is carried out such that a corrected parking strategy can be calculated in dependence on possible deviations. However, the method described in DE 198 09 416 A1 does not provide any information as to how such a correction is carried out.
A parking aid for a motor vehicle is also known from DE 38 13 083 C3. This parking aid comprises distance measuring devices, a data processing unit, control devices and a display unit. Information on a parking maneuver is made available to the driver of the motor vehicle such that the motor vehicle can be steered to a certain destination.
A system-planned driving maneuver basically corresponds to a geometric curve that is composed of at least one, usually of more than one, segment in the shape of a circular arc and/or a straight line. This geometric curve is described by the movement of a certain point on the motor vehicle. The display of the driving maneuver refers to a nominal steering angle and a nominal driving distance for each segment. For example, if a driver executes a system-planned driving maneuver, the actual motor vehicle position and the actual motor vehicle orientation may deviate from the calculated nominal position and the calculated nominal orientation. In this context, the term orientation refers to the alignment of the longitudinal axis of the motor vehicle. Such deviations may occur, in particular, if the displayed nominal steering angle is not observed. Inaccurate steering movements by the driver of the motor vehicle, an inadequate observation of the displayed nominal steering angle and system-related tolerances, e.g., the steering wheel play, may be responsible for these deviations
The invention is based on the objective of developing a method and a device for the assisted steering of a motor vehicle which provide a reliable corrective option such that a planned driving maneuver can be executed accurately despite deviations.
According to the invention, this objective is attained with a method, in which a nominal driving path with a starting point and a destination point is determined, wherein said nominal driving path is output in the form of nominal steering angles and nominal driving distances. The motor vehicle is subsequently set in motion. After a certain distance has been traveled, an actual position of the motor vehicle is determined. If the actual position deviates from the nominal driving path that extends, in particular, along a circular arc, a deviant circular arc as well as a first and a second corrective circular arc are determined, wherein the second corrective circular arc represents a congruent projection of the deviant circular arc and ends at the destination point. Subsequently, a corrected nominal driving path is output based on both corrective circular arcs, wherein this corrected nominal driving path guides the motor vehicle to the intended destination in the properly oriented fashion.
In the method according to the invention, the already traveled driving path that may represent a deviant circular arc is taken into account, wherein a new nominal driving path is calculated, if so required, based on this driving path. The steering instructions of a driver assistance system, particularly a parking assistant, can be corrected on demand in this fashion. The deviant circular arc is defined by the starting point, the actual position of the motor vehicle, a curvature radius and the so called deviant steering angle resulting therefrom. The deviant steering angle is the angle that has been traveled by the motor vehicle on the deviant circular arc at the time the actual position is determined.
The utilization of the method according to the invention makes it possible to position the motor vehicle in question at the destination point such that its orientation corresponds to the orientation achieved by driving the motor vehicle along the originally calculated nominal driving path despite deviations of the actual driving path from the nominal driving path. The output of corrected steering angles and driving distances ensures that the driver of the motor vehicle is provided with sufficient information for positioning the motor vehicle at the destination point with the originally calculated orientation, namely even if deviations from the nominal driving path are unavoidable while a driving maneuver is executed, for example, based on the information displayed on a display unit. This may already occur, for example, if the driver does not turn the steering wheel until the vehicle is already in motion.
In the method according to the invention, the nominal driving path, the deviant circular arc and the corrective circular arcs preferably refer to trajectories, i.e., motion curves of the motor vehicle that are defined by the moving path of the center of the rear axle of the motor vehicle in question.
The nominal driving path typically represents a segment in the form of an ideally circular trajectory with directional information. Such a trajectory can be unequivocally defined by a starting point, a destination point and a center of rotation, wherein the trajectory extends over an angle formed by a line defined by the center of rotation and the starting point on the one hand and a line defined by the center of rotation and the destination point on the other hand. A segment in the form of a straight line occurs when the motor vehicle travels straight and represents a special instance, in which the center of rotation is spaced apart from the starting point and from the destination point by an infinite distance. It suffices to determine the starting point and the destination point in order to describe such a segment.
In one preferred embodiment of the method according to the invention, a deviant center of rotation for the deviant circular arc and a distance between the starting point and the deviant center of rotation are determined, wherein the deviant center of rotation lies on a line defined by the starting point and the nominal center of rotation. Due to these measures, it is easily possible to determine a segment in the form of a circular arc that is defined by the starting point, the actual position and the deviant center of rotation and can be used for calculating the second corrective circular arc in the region of the destination point. For this purpose, a compensative center of rotation assigned to the second corrective circular arc is advantageously determined, wherein this compensative center of rotation lies on a line defined by the destination point and the nominal center of rotation and is spaced apart from the destination point by a distance that corresponds to the distance between the starting point and the deviant center of rotation.
The center of rotation for the first corrective circular arc is advantageously determined by determining the intersecting point between a line defined by the actual position and the deviant center of rotation and a line defined by the compensative center of rotation and the deviant steering angle.
The method according to the invention preferably is carried out in accordance with a preadjusted clocking. The clocking may take place in a time-dependent and/or distance-dependent fashion. The interval between the clock pulses defines the accuracy of the driving maneuver to be executed, as well as the computing expenditure required for carrying out the method.
The nominal driving path and the corrected nominal driving path can be output by means of an optical, acoustical and/or mechanical/haptical indicating unit. For example, the driving or steering maneuvers to be executed can be displayed on a display unit and/or reproduced in the form of acoustic commands. It would also be conceivable to output information by influencing the steering behavior of the motor vehicle. For example, the respective steering angle to be adjusted by the driver can be defined by restricting the steering angle.
In one special embodiment of the method according to the invention, the information is output to an electronic steering aid that automatically adjusts the required steering angle. In this case, it is not necessary for the driver of the motor vehicle to actively influence the steering maneuver in order to optimally align the motor vehicle in accordance with the calculated nominal driving path.
The method according to the invention can be used, in particular, in the assisted parking of a motor vehicle in order to simplify the parking maneuver for the driver of the respective motor vehicle. For example, the method is utilized if the driver of the respective motor vehicle requires assistance in backing into a parking spot in order to parallelpark the motor vehicle. For this purpose, the parking spot is initially surveyed by means of suitable sensors arranged on the motor vehicle. The nominal driving path then corresponds to a parking strategy, according to which the motor vehicle can be parked in the parking spot without collisions and with the least steering and maneuvering effort possible. The parking strategy is developed by compiling several nominal driving paths that are composed of circular arcs and typically requires steering, acceleration and deceleration processes that can be specified for the driver by a system for carrying out the method according to the invention. The output of the parking strategy may be realized with display devices that are provided in the respective motor vehicle anyhow, e.g., the display of a navigation system.
The invention also pertains to a steering assistance device, in particular, for the assisted maneuvering and parking of a motor vehicle. This device comprises a data processing unit for determining a nominal driving path along a circular arc between a starting point and a destination point, an output unit for the nominal driving path and a device for determining a possible deviation between the actual position and the nominal driving path, as well as at least one displacement sensor. The device also comprises a unit that determines a deviant circular arc as well as a first and a second corrective circular arc if the actual position deviates from the nominal driving path, wherein the second corrective circular arc is a congruent projection of the deviant circular arc and ends at the destination point.
The device according to the invention represents, in particular, a parking assistance system that optimally corrects driver-related and/or system related deviations between a nominal driving path and an actual driving path during a parking maneuver.
In one special embodiment, the device according to the invention cooperates, in particular, with a steering angle sensor that makes it possible to take into account a deviation of an actual steering angle from a nominal steering angle in the calculation of the corrective circular arcs.
Alternatively or additionally to the steering angle sensor, the device according to the invention may also cooperate with at least two displacement sensors that are respectively arranged, for example, on the left rear wheel and the right rear wheel of the motor vehicle. Naturally, the displacement sensors may also be assigned to the front wheels.
The device according to the invention may also comprise a timing unit. The timing unit delivers a signal for triggering the determination of the actual position and, if so required, the calculation of a corrected driving path within predetermined intervals. Alternatively, the intervals for determining the actual position and for calculating a corrected driving path may also be determined in a distance-dependent fashion, i.e., by means of a displacement sensor. Naturally, it would also be conceivable to determine the intervals with a time-dependent and distance-dependent function.
The various features of novelty which characterize the invention are pointed out with particularity in the claims annexed to and forming a part of this disclosure. For a better understanding of the invention, its operating advantages and specific objects attained by its uses, reference is made to the accompanying drawings and descriptive matter in which preferred embodiments of the invention are illustrated.
Two embodiments of a device according to the invention and two embodiments of a method according to the invention are schematically illustrated in the figures and described in greater detail below. In the drawings:
Referring to the drawings in particular,
The data processing unit 1 is connected to an output unit 2 for outputting the calculated driving maneuver and the segments to be traveled. This output unit may consist, for example, of the display of a navigation system, wherein the driving maneuvers are displayed, for example, in the form of the respective nominal steering angle to be adjusted for each segment and the corresponding distance to be traveled.
The data processing unit 1 also cooperates with a memory 3 for storing the planned nominal driving maneuver that was calculated by the data processing unit 1 based on the data obtained from the sensor arrangement. This means that the segments to be traveled in order to execute the nominal driving maneuver are stored in the memory 3. These segments respectively represent a nominal driving path in the method according to the invention.
A nominal steering angle and a distance to be traveled or remaining distance, respectively, are displayed on the display unit 2 for each segment. The instructions displayed on the display unit 2 are executed by the driver of the motor vehicle and may comprise steering movements, braking maneuvers, acceleration maneuvers or the like.
The device also contains a system 4 for determining the actual steering angle, as well as a displacement sensor 5, in order to determine the respective actual motor vehicle position and thus, the distance traveled during a driving maneuver. The determination of the actual position may take place continuously or in intervals defined by a timing unit. The values determined by means of the system 4 and the displacement sensor 5 are transmitted to the data processing unit 1 in order to calculate, if so required, a deviant circular arc and a first and a second corrective circular arc for the respective segment to be traveled, namely in dependence on a deviation between the nominal values and the actual values. In this case, the second corrective circular arc represents a congruent projection of the deviant circular arc and ends at the destination point.
A driving maneuver to be executed in order to park the motor vehicle is typically composed of several segments or nominal driving paths in the form of circular arcs that are connected to one another by turning points. In order to exactly execute a driving maneuver that is composed of several segments, i.e., in order to maneuver the motor vehicle into the parking spot in question as easily as possible, the motor vehicle needs to be in a defined position and have a defined orientation at each turning point, i.e., at the starting point and the destination point of each segment.
If the driving path chosen by the driver of the respective motor vehicle deviates from the nominal driving path stored in the memory 3, the nominal center of rotation Dnominal is shifted to a deviant center of rotation DA. This means that the motor vehicle no longer moves along the nominal driving path X, but rather along a deviant circular arc KA. Consequently, the motor vehicle can only reach the destination point with the proper orientation if the nominal driving path is corrected.
The inventive correction of the deviation from the nominal driving path X is described below with reference to
The nominal driving path X, i.e., the planned segment, is output by the output unit in a first step A. Subsequently, the driver sets the motor vehicle in motion. An actual position W1 of the motor vehicle and an actual steering angle are determined at a time t that is defined by means of a timing unit and/or results from a certain distance traveled. If the actual position W1 does not lie on the nominal driving path X, a so called deviant circular arc KA is calculated in step B, wherein said deviant circular arc defines the arc on which the motor vehicle has traveled an angle γA between the starting point S and the actual position W1. In order to determine the deviant circular arc KA, the coordinates of the actual position W1 and the coordinates of a deviant center of rotation DA are initially determined on a line hi that is defined by the starting point S and the nominal center of rotation Dnominal. These coordinates can be determined, for example, by means of the actual steering angle and a displacement sensor or by means of two displacement sensors.
The distance between the starting point S and the deviant center of rotation DA results in a radius RA. A deviation A is obtained from the difference between the radius RA and the nominal radius Rnominal. A line g1 is defined by the actual position W1 and the deviant center of rotation DA. The deviant circular arc KA is defined by the starting point S, the actual position W1 and the deviant center of rotation DA. On this deviant circular arc KA, the motor vehicle has traveled an angle γA that is referred to as the deviant steering angle below.
A corrective circular arc K2 is determined in the next step C. For this purpose, a center of rotation D2 is initially determined which lies on a line h2 defined by the destination point Wnominal and the nominal center of rotation Dnominal and is spaced apart from the destination point Wnominal by the distance RA. Subsequently, a line g2 is determined which extends through the center of rotation D2 and forms the deviant steering angle γA with the line h2. The coordinates of an intermediate point W2 are then determined, wherein this intermediate point lies on the line g2 and is spaced apart from the center of rotation D2 by the distance RA. The corrective circular arc K2 consequently is defined by the intermediate point W2, the destination point Wnominal and the center of rotation D2, wherein said corrective circular arc represents a congruent projection of the deviant circular arc KA and ends at the destination point Wnominal.
A corrective circular arc K1 that connects the actual position W1 and the intermediate point W2 is determined in the next step D. The corrective circular arc K1 has a center of rotation D1 that lies at the intersecting point between the lines g1 and g2. The angle of rotation γA for the corrective circular arc K1 results from the difference between the slope of the line g2 and the slope of the line g1. The corrective circular arc K1 is defined by the center of rotation D1, the actual position W1 and the intermediate point W2.
The corrective circular arcs K1 and K2 are then written into the memory 3 for the planned nominal segments in the next step E. In this context, it is important that the corrective circular arc K1 is processed before the corrective circular arc K2. The corrective circular arcs K1 and K2 stored in the memory are then output in the form of driving instructions by the output unit of the device according to the invention in step A. Steps B through E can be repeated if another deviation of the actual motor vehicle position from the newly calculated nominal driving path occurs.
While specific embodiments of the invention have been shown and described in detail to illustrate the application of the principles of the invention, it will be understood that the invention may be embodied otherwise without departing from such principles.
Number | Date | Country | Kind |
---|---|---|---|
10 2004 027 250 | Jun 2004 | DE | national |
Number | Name | Date | Kind |
---|---|---|---|
4931930 | Shyu | Jun 1990 | A |
5029088 | Minami | Jul 1991 | A |
5563787 | Murayama | Oct 1996 | A |
6825880 | Asahi et al. | Nov 2004 | B2 |
6929082 | Kataoka et al. | Aug 2005 | B2 |
6950035 | Tanaka et al. | Sep 2005 | B2 |
7012548 | Ishii et al. | Mar 2006 | B2 |
Number | Date | Country |
---|---|---|
31 35 117 | Apr 1982 | DE |
38 13 083 | Nov 1989 | DE |
198 09 416 | Sep 1999 | DE |
199 40 007 | Mar 2001 | DE |
Number | Date | Country | |
---|---|---|---|
20050269145 A1 | Dec 2005 | US |