Method and device for identifying the height of an object
11313961 · 2022-04-26
Assignee
Inventors
Cpc classification
G01S15/876
PHYSICS
G01S17/87
PHYSICS
G01S17/42
PHYSICS
G01S15/42
PHYSICS
G01S13/878
PHYSICS
International classification
Abstract
A device and method for identifying a position of an object uses a comparison value is calculated based on a first distance and first angle measured by a first distance sensor. This value is compared with a second distance or a second angle measured by a second distance sensor. Based on the result of the comparison, it is concluded whether the object is located above or below a predefined height over a first sensor plane in which the first distance sensor is situated. An angle of greater than zero degrees is situated in this case between a first sensor axis of the first distance sensor and a second sensor axis of the second distance sensor.
Claims
1. A device comprising: a first distance sensor, a sensor axis of which is a first sensor axis that is situated in a first sensor plane, wherein the first distance sensor is configured to detect: a first distance, which is between the first distance sensor and an object; and a first angle, which is between the first sensor axis and a direction from the first distance sensor to a location of the object when the object is located in the first sensor plane; a second distance sensor, a sensor axis of which is a second sensor axis that is situated in a second sensor plane, wherein an angle that is greater than zero degrees exists between the first sensor axis and the second sensor axis and wherein the second distance sensor is configured to detect: a second distance, which is between the second distance sensor and the object; and/or a second angle, which is between the second sensor axis and a direction from the second distance sensor to a location of the object when the object is located in the second sensor plane; and an evaluation unit, wherein the evaluation unit is configured to determine, based on the first distance, the first angle, and at least one of the second distance and the second angle, whether the object is located above or below a predefined height over the first sensor plane, and calculate, based on the first distance and the first angle, a comparison value that corresponds to at least one of the second distance or the second angle when the object is located at a predefined height over the first sensor plane.
2. The device of claim 1, wherein the first sensor plane and the second sensor plane are parallel or identical planes.
3. The device of claim 1, wherein the first sensor plane and/or the second sensor plane are horizontal planes.
4. The device of claim 1, further comprising a third distance sensor, a sensor axis of which is a third sensor axis that is situated in a third sensor plane, wherein: the third sensor plane different than the first sensor plane and than the second sensor plane, and wherein the third distance sensor is configured to detect: a third distance, which is between the third distance sensor and the object, and/or a third angle, which is situated in the third sensor plane and which is between the third sensor axis and a direction from the third distance sensor and a location of the object; and the evaluation unit is configured to ascertain, based on the third distance and/or the third angle, whether the object is located above or below the first or second sensor plane.
5. The device of claim 1, wherein the first distance sensor and/or the second distance sensor is a radar sensor, an acoustic sensor, or a visual sensor.
6. A device comprising: a first distance sensor, a sensor axis of which is a first sensor axis that is situated in a first sensor plane, wherein the first distance sensor is configured to detect: a first distance, which is between the first distance sensor and an object; and a first angle, which is between the first sensor axis and a direction from the first distance sensor to a location of the object when the object is located in the first sensor plane; a second distance sensor, a sensor axis of which is a second sensor axis that is situated in a second sensor plane, wherein an angle that is greater than zero degrees exists between the first sensor axis and the second sensor axis and wherein the second distance sensor is configured to detect: a second distance, which is between the second distance sensor and the object; and/or a second angle, which is between the second sensor axis and a direction from the second distance sensor to a location of the object when the object is located in the second sensor plane; and an evaluation unit, wherein the evaluation unit is configured to determine, based on the first distance, the first angle, and at least one of the second distance and the second angle, whether the object is located above or below a predefined height over the first sensor plane, wherein the evaluation unit is configured to: calculate, based on the first distance and the first angle, a comparison value that corresponds to the second distance when the object is located at a predefined height over the first sensor plane; and compare the second distance and the comparison value to each other to determine whether the object is located above or below the predefined height over the first sensor plane.
7. The device of claim 6, wherein the comparison value is computed additionally based on the second angle.
8. The device of claim 6, wherein the comparison value is ascertained based on a table.
9. The device of claim 6, wherein the comparison value is ascertained based on a predefined distance between the first distance sensor and the second distance sensor.
10. A device comprising: a first distance sensor, a sensor axis of which is a first sensor axis that is situated in a first sensor plane, wherein the first distance sensor is configured to detect: a first distance, which is between the first distance sensor and an object; and a first angle, which is between the first sensor axis and a direction from the first distance sensor to a location of the object when the object is located in the first sensor plane; a second distance sensor, a sensor axis of which is a second sensor axis that is situated in a second sensor plane, wherein an angle that is greater than zero degrees exists between the first sensor axis and the second sensor axis and wherein the second distance sensor is configured to detect: a second distance, which is between the second distance sensor and the object; and/or a second angle, which is between the second sensor axis and a direction from the second distance sensor to a location of the object when the object is located in the second sensor plane; and an evaluation unit, wherein the evaluation unit is configured to determine, based on the first distance, the first angle, and at least one of the second distance and the second angle, whether the object is located above or below a predefined height over the first sensor plane, wherein the evaluation unit is configured to: calculate, based on the first distance and the first angle, a comparison value that corresponds to the second angle when the object is located at a predefined height over the first sensor plane; and compare the second angle and the comparison value to each other to determine whether the object is located above or below the predefined height over the first sensor plane.
11. The device of claim 10, wherein the comparison value is computed additionally based on the second distance.
12. The device of claim 10, wherein the comparison value is ascertained based on a table.
13. The device of claim 10, wherein the comparison value is ascertained based on a predefined distance between the first distance sensor and the second distance sensor.
14. A device comprising: a first distance sensor, a sensor axis of which is a first sensor axis that is situated in a first sensor plane, wherein the first distance sensor is configured to detect: a first distance, which is between the first distance sensor and an object; and a first angle, which is between the first sensor axis and a direction from the first distance sensor to a location of the object when the object is located in the first sensor plane; a second distance sensor, a sensor axis of which is a second sensor axis that is situated in a second sensor plane, wherein an angle that is greater than zero degrees exists between the first sensor axis and the second sensor axis and wherein the second distance sensor is configured to detect: a second distance, which is between the second distance sensor and the object; and/or a second angle, which is between the second sensor axis and a direction from the second distance sensor to a location of the object when the object is located in the second sensor plane; and an evaluation unit, wherein the evaluation unit is configured to determine, based on the first distance, the first angle, and at least one of the second distance and the second angle, whether the object is located above or below a predefined height over the first sensor plane, further comprising a third distance sensor, a sensor axis of which is a third sensor axis that is situated in a third sensor plane, wherein the third distance sensor is configured to detect a third distance, which is between the third distance sensor and the object, and wherein the evaluation unit is configured to validate, based on the third distance, whether it has been correctly determined whether the object is located above or below the predefined height over the first sensor plane.
15. A method performed using a device that includes (a) a first distance sensor, a sensor axis of which is a first sensor axis situated in a first sensor plane and (b) a second distance sensor, a sensor axis of which is a second sensor axis situated in a second sensor plane, wherein an angle of greater than zero degrees exists between the first sensor axis and the second sensor axis, the method comprising: detecting a first distance, which is between the first distance sensor and an object; detecting a first angle, which is between the first sensor axis and a direction from the first distance sensor to a location of the object when the object is located in the first sensor plane; detecting: a second distance, which is between the second distance sensor and the object; and/or a second angle, which is between the second sensor axis and a direction from the second distance sensor to a location of the object when the object is located in the second sensor plane; and determining, based on the first distance, the first angle, and at least one of the second distance and the second angle, whether the object is located above or below a predefined height over the first sensor plane, and calculating, based on the first distance and the first angle, a comparison value that corresponds to at least one of the second distance or the second angle when the object is located at a predefined height over the first sensor plane.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
DETAILED DESCRIPTION
(10) A device according to the present invention for identifying a position of an object 5 includes a first distance sensor 1, a second distance sensor 6, and an evaluation unit 10.
(11) First distance sensor 1 is schematically depicted in
(12) First distance sensor 1 is configured to detect a first distance 4 between first distance sensor 1 and an object 5. Object 5 is also depicted by way of example in
(13) First distance sensor 1 is further configured to detect a first angle φ.sub.1′, which is an angle between first sensor axis 3 and a direction in which object 5, starting from first distance sensor 1, is situated. First angle φ.sub.1′, for example, is an angle between first sensor axis 3 and a straight line, which connects object 5 to first distance sensor 1. Thus, first distance sensor 1 is suitable for ascertaining whether object 5, as viewed from first distance sensor 1, is situated to the left or to the right of main radiation axis 21 of first distance sensor 1. First distance sensor 1 in this first example embodiment is not suitable for ascertaining whether object 5 is situated over or under first sensor plane 2. However, since the signal from first distance sensor 1 is radiated not only in the first sensor plane, an emitted signal is also reflected by object 5 when object 5 is not situated in first sensor plane 2. Since first distance 4 is ascertained based on the propagation time of the signal, a correct value for first distance 4 is therefore also ascertained when object 5 is not situated in first sensor plane 2.
(14) Second distance sensor 6 is schematically depicted in
(15) Second distance sensor 6 is configured to detect a second distance 9 between second distance sensor 6 and object 5. Object 5 is also depicted by way of example in
(16) Second distance sensor 6 is further configured to detect a second angle φ.sub.2′, which is an angle between second sensor axis 8 and a direction, in which object 5, starting from second distance sensor 6, is located. Second angle φ.sub.2′, for example, is an angle between second sensor axis 8 and a straight line, which connects object 5 to second sensor axis 6. Second distance sensor 6 is thus suitable for ascertaining whether object 5, as viewed from second distance sensor 6, is situated to the left or to the right of main radiation axis 22 of second distance sensor 6. Second distance sensor 6 in this first example embodiment is not suitable for ascertaining whether object 5 is situated over or under second sensor plane 7. However, since the signal from second distance sensor 6 is radiated not only in second sensor plane 7, an emitted signal is also reflected by object 5 when object 5 is not situated in second sensor plane 7. Since second distance 9 is ascertained based on the propagation time of the signal, a correct value for second distance 9 is therefore also ascertained when object 5 is not situated in first sensor plane 2.
(17)
(18) First distance sensor 1 and second distance sensor 6 are connected to evaluation unit 10. Evaluation unit 10 is a processing unit, which is configured to process the output signals of first distance sensor 1 and of second distance sensor 6. First distance 4 and first angle φ.sub.1′ are thus transmitted to evaluation unit 10 by first distance sensor 1. Second distance 9 and second angle φ.sub.2′ are thus transmitted to evaluation unit 10 by second distance sensor 6. Object 5 is depicted in front of vehicle 12 in
(19) First sensor plane 2 is a horizontal plane in
(20) As previously described, first distance sensor 1 and second distance sensor 6 are suitable for detecting an angle, i.e., first angle φ.sub.1′ and second angle φ.sub.2′ in first sensor plane 2 and in second sensor plane 7. Angle γ depicted in
(21) To allow for such a distinction of low and tall object 5a, 5b, and thus to identify the position of object 5, evaluation unit 10 is configured to calculate a comparison value, which is continuously compared with a measured value of second distance sensor 6. Based on whether the measured value of second distance sensor 6 is greater or smaller than the comparison value, it is identified whether a low or tall object 5a, 5b is present, i.e., whether object 5 is located more or less at a predefined height 11 over first sensor plane 2.
(22) Predefined height 11 is a distance of object 5 relative to sensor plane 2. This is also depicted in
(23) To determine whether object 5 is located more or less than the predefined height 11 over first sensor plane 2, either a first comparison value or a second comparison value is calculated by evaluation unit 10. The calculation of the first comparison value and the calculation of the second comparison value are based in this case on the same mathematical principle, different parameters being utilized for a subsequent comparison, however.
(24) Thus, the first comparison value is calculated based on first distance 4, on first angle φ.sub.1′, and on second angle φ.sub.2′. The first comparison value corresponds to second distance 9 when object 5 is located at a predefined height 11 over first sensor plane 2. Accordingly, a comparison between second distance 9 detected by second distance sensor 6 and the first comparison value takes place, in order to determine whether object 5 is located above or below predefined height 11 over first sensor plane 2.
(25) The second comparison value, if it is calculated, is computed based on first distance 4, on second distance 9, and on first angle φ.sub.1′. The second comparison value corresponds to second angle φ.sub.2′ when object 5 is located at a predefined height 11 over first sensor plane 2. Accordingly, a comparison between second angle φ.sub.2′ detected by second distance sensor 6 and the second comparison value takes place in this case, in order to determine whether object 5 is located above or below predefined height 11 over first sensor plane 2.
(26) To describe the principle underlying the first and second comparison value, reference is made initially to
(27) A point P is depicted in
(28) Both first distance sensor 1 as well as second distance sensor 6 are configured to detect an angle φ, which describes a direction in which object 5, starting from first distance sensor 1, is situated when object 5 is situated in first sensor plane 2. For an evaluation of angle φ detected by one of distance sensors 1, 6, distance sensors 1, 6 also output a measured value for angle φ′ when object 5 is not situated in sensor plane 2, 7. The reason for this, among others, is that a signal emitted by distance sensors 1, 6 is not sharply delimited and, thus, is reflected in any case also outside the sensor plane and can be reflected back again to emitting distance sensor 1, 6. Therefore, angle φ′ is actually detected by distance sensors 1, 6, even if distance sensors 1, 6 are designed to merely detect an angle φ in associated sensor plane 2, 7.
(29) Angles φ and φ′ are defined relative to sensor axis (x-axis) in
(30)
(31) Where:
90°−φ′≤θ≤90°+φ′ and 90°−θ≤φ′≤90°+θ, for y≥0.
(32) First distance sensor 1 and second distance sensor 6 are depicted in a global coordinate system in
(33) First distance sensor 1 and second distance sensor 6 exhibit a distance relative to each other, which is referred to as sensor distance c. This distance corresponds to an x-value of the global coordinate system depicted in
(34) The following is applicable for a coordinate transformation with a counterclockwise rotation (mathematically positive direction of rotation) for the global coordinate system depicted in
x′.sub.p=x.sub.p.Math.cos(α)+y.sub.p.Math.sin(α)
y′.sub.p=x.sub.p.Math.sin(α)+y.sub.p.Math.cos(α)
z′.sub.p=z.sub.p
(35) The results are the following equations with the unknown height angles θ.sub.1 and θ.sub.2, which can be exactly determined by solving the equation system or can be estimated by comparison with a table. Thus, the following global equation system results for the global coordinate system depicted in
(36)
(37) As is apparent from
(38) Since first angle φ.sub.1′ and second angle φ.sub.2′ and distances r.sub.1 and r.sub.2 are detected by the two distance sensors 1, 6, it is possible to resolve the global equation system and height angles θ.sub.1 and θ.sub.2 are determined. In alternative example embodiments of the present invention, a mathematical resolution of the global equation system therefore takes place via evaluation unit 10, in order to thereby determine based on first distance 4, on second distance 9, on first angle φ.sub.1′, and on second angle φ.sub.2′ whether object 5 is located above or below a predefined height 11 over first sensor plane 2.
(39) In this example embodiment, however, a calculation of the first comparison value or of the second comparison value takes place. The comparison values describe a value for second distance 9 or for second angle φ.sub.2′ when object 5 is located at a predefined height 11 over first sensor plane 2. Such values for second distance 9 or for second angle φ.sub.2′ can be ascertained based on the global equation system, such values being assumed for height angles θ.sub.1 and θ.sub.2, which result when object 5 is located at a predefined height 11.
(40) In this example embodiment, therefore, the first and the second comparison values are continuously recomputed. Alternatively, the computations are carried out and stored in advance for different measured value combinations of distance sensors 1, 6. In this case, the first or the second comparison values can be retrieved from a table. The first comparison value ascertained for instantaneously detected measured values is compared with second distance 9. If the first comparison value equals second distance 9, it is then determined that object 5 is located at predefined height 11 over first sensor plane 2. The second comparison value ascertained for instantaneously detected measured values is compared with second angle φ.sub.2′. If the second comparison value equals second angle φ.sub.2′, then object 5 is located at predefined height 11 over first sensor plane 2.
(41) As previously described, first sensor axis 3 and second sensor axis 8 are tilted toward each other. This is in order to determine, based on the previously described mathematical principle, whether object 5 is located at predefined height 11 over first sensor plane 2. If first sensor axis 3 and second sensor axis 8 are not tilted toward each other, situations can occur in which it is not possible to clearly distinguish whether object 5 is located above or below predefined height 11.
(42) First distance sensor 1 is depicted in
(43) First angle φ.sub.1′ is an angle that describes a position of object 5 if the object is situated in first sensor plane 2. However, object 5 is not necessarily situated in first sensor plane 2. If object 5 moves out of first sensor plane 2, first angle φ.sub.1′ is still output by first distance sensor 1. Only when object 5 is situated in first sensor plane 2 does it result that first angle φ.sub.1′ corresponds to angle φ shown in
(44) Thus, starting from first distance 4 and angles φ.sub.1′, which have been detected by first distance sensor 1, object 5 could be situated anywhere on first circular path 14.
(45) If an angle of 0° were then to exist between first sensor axis 3 and second sensor axis 8, then a situation occurs in which the potential locations of object 5 defined by the measured values of distance sensor 1 coincide exactly with the potential locations of object 5 defined by second distance sensor 6. In other words, this means that a circular path, which defines potential locations 15 through 19 with respect to first distance sensor 1, i.e., first circular path 14, coincides with a circular path, for example, a second circular path 20, which defines potential locations of object 5 with respect to second distance sensor 6. The previously described case can occur for all positions of object 5.
(46) However, first distance sensor 1 is tilted with respect to second distance sensor 6. An angle of greater than 0° thus exists between first sensor axis 3 and second sensor axis 8. This is depicted by way of example in
(47) In
(48) It is apparent when viewing
(49) Since the computations necessary for this purpose, which would have to be carried out by evaluation unit 10, can be very complex, it is advantageous to ascertain the comparison value based on a table, in which first distance 4 and first angle φ.sub.1′ are each assigned a comparison value. Such a table can be calculated in advance. Accordingly, threshold values for output signals of second distance sensor 6 can be established and it can be determined via an analogous comparison whether a tall or a low object 5 has been detected.
(50) In order to determine whether object 5 is located above or below first or second sensor plane 2, 7, a third distance detected by a third distance sensor 13 and/or a third angle detected by a third distance sensor is evaluated by the evaluation unit in an alternative example embodiment. An exemplary arrangement of third distance sensor 13 is depicted in
(51) A validation can alternatively or additionally take place by third distance sensor 13, as to whether object 5 is actually located above or below predefined height 11 over first sensor plane 2. The previously described equation system is expanded and evaluated accordingly for this purpose. In this case, it is not necessary that a sensor plane of third distance sensor 13 is not equal to first sensor plane 2 and second sensor plane 7.
(52) This method can therefore be easily expanded to more than two distance sensors. A reference measurement is carried out using one distance sensor. All other sensors measure the distance and the horizontal angle. It is analyzed at which object height the measured additional sensor values are better suited. If multiple sensors are available, it is possible to always use the optimal sensor for reference measurement.