DEVICES AND METHODS FOR 3D POSITION DETERMINATION

Abstract

A receiving unit is disclosed, including at least three receivers, each configured to receive an ultrasonic signal with a wavelength λ from the transmitting unit. A first receiver is arranged at a distance of at most one half wavelength λ/2 of the ultrasonic signal from a second receiver and from a third receiver. The at least three receivers are arranged in one plane. A processor is configured to determine the respective time-of-flight from the ultrasonic signal received at each of the at least three receivers. The respective time-of-flight is a time that the ultrasonic signal requires from the transmitting unit at a defined start time to the respective receiver. The processor is further configured to determine the three-dimensional position and/or direction of the transmitting unit from the determined times-of-flight and the arrangement of the at least three receivers.

Claims

1. A receiving unit for determining a three-dimensional position and/or direction of a transmitting unit, wherein the receiving unit comprises: at least three receivers, each configured to receive an ultrasonic signal with a wavelength λ from the transmitting unit, wherein a first receiver is arranged at a distance of at most one half wavelength λ/2 of the ultrasonic signal from a second receiver and from a third receiver, and wherein the at least three receivers are arranged in one plane; and a processor that is configured to determine a respective time-of-flight from the ultrasonic signal received at each of the at least three receivers, wherein the respective time-of-flight is a time that the ultrasonic signal requires from the transmitting unit at a defined start time to the respective receiver, and wherein the processor is further configured to determine the three-dimensional position and/or direction of the transmitting unit from the determined times-of-flight and the arrangement of the at least three receivers.

2. The receiving unit according to claim 1, wherein the receiving unit is further configured to transmit a synchronization signal prior to receiving the ultrasonic signal to initiate transmission of the ultrasonic signal by the transmitting unit and to define the start time, and wherein the processor is further configured to start a timer for each of the at least three receivers upon transmission of the synchronization signal to determine the respective times-of-flight.

3. The receiving unit according to claim 1, wherein the processor is further configured to determine the time of reception of the ultrasonic signal at the first receiver by intersection to determine the respective time-of-flight, wherein the intersection comprises polynomial interpolation through respective inflection points of positive and negative sides of a transient process of an amplitude of the received ultrasonic signal, wherein only the inflection points which are above a certain first limit value of the positive amplitude and wherein only the inflection points which are below a certain second limit value of the negative amplitude are used, wherein the first limit value is equal to the second limit value.

4. The receiving unit according to claim 1, wherein the processor is further configured to determine the respective time-of-flight based on a phase shift between the received ultrasonic signals and/or wherein the processor is further configured to determine the three-dimensional position of the transmitting unit based on intersecting circular paths and to determine a radius of the circular paths based on the respective time-of-flight.

5. The receiving unit according to claim 4, wherein determining the phase shift between the received ultrasonic signals comprises: determining the phase shift between respective inflection points of positive and negative sides of a transient process of an amplitude of the ultrasonic signal received at the first receiver and the ultrasonic signal received at the second receiver, and between the respective inflection points of the positive and negative sides of a transient process of the amplitude of the ultrasonic signal received at the first receiver and the ultrasonic signal received at the third receiver, and formation of a respective average value of the phase shift, and wherein the respective average values are added, in each case, to the time of reception of the ultrasonic signal at the first receiver to determine the respective time-of-flight of the ultrasonic signal to the second and third receivers.

6. The receiving unit according to claim 1, wherein the processor is further configured to determine a signal quality of the received ultrasonic signals, wherein determination of the signal quality comprises: determining first times t.sub.fn between successive inflection points of the received ultrasonic signals from a first inflection point to an n-th inflection point; determining second times t.sub.pn between the first inflection point and third through n-th inflection points; and determining the signal quality by comparing the times t.sub.fn and t.sub.pn with a respective predetermined target value t.sub.fn_target and t.sub.pn_target.

7. The receiving unit according to claim 1, wherein the first receiver and the second receiver are arranged on a first straight line and the first receiver and the third receiver are arranged on a second straight line, wherein the first straight line and the second straight line form an angle of 80° to 100° to one another.

8. A method for determining a three-dimensional position and/or direction of a transmitting unit, comprising: receiving an ultrasonic signal with a wavelength λ from the transmitting unit at at least three receivers of a receiving unit, wherein a first receiver is arranged at a distance of at most one half wavelength of the ultrasonic signal λ/2 from a second receiver and from a third receiver, and wherein the at least three receivers are arranged in one plane; determining respective time-of-flight from the ultrasonic signals received at each of the at least three receivers, wherein the respective time-of-flight is a time taken for the ultrasonic signal to travel from the transmitting unit to the respective receiver at a defined start time; and determining the three-dimensional position and/or direction of the transmitting unit from the determined times-of-flight as well as the arrangement of the at least three receivers.

9. The method according to claim 8, further comprising a step of transmitting a synchronization signal from the receiving unit prior to receiving the ultrasonic signal to initiate transmission of an ultrasonic pulse by the transmitting unit and to define the start time, and comprising a step of starting a timer for each of the at least three receivers to determine the respective times-of-flight after transmission of the synchronization signal.

10. The method according to claim 8, wherein the determination of the respective time-of-flight comprises a determination of the time of reception of the ultrasonic signal at the first receiver by intersection, wherein the intersection comprises polynomial interpolation through respective inflection points of positive and negative sides of a transient process of an amplitude of the received ultrasonic signal, wherein only the inflection points which are above a certain first limit value of the positive amplitude and wherein only the inflection points which are below a certain second limit value of the negative amplitude are used, wherein the first limit value is equal to the second limit value.

11. The method according to claim 8, wherein the determination of the three-dimensional position of the transmitting unit is performed based on a phase shift between the received ultrasonic signals and/or wherein the determination of the three-dimensional position of the transmitting unit is performed based on intersecting circular paths and a radius of the circular paths is determined based on the respective time-of-flight.

12. The method according to claim 11, wherein determining the phase shift between the received ultrasonic signals comprises: determining the phase shift between respective inflection points of positive and negative sides of a transient process of an amplitude of the ultrasonic signal received at the first receiver and the ultrasonic signal received at the second receiver, and between the respective inflection points of the positive and negative sides of a transient process of the amplitude of the ultrasonic signal received at the first receiver and the ultrasonic signal received at the third receiver, and formation of a respective average value of the phase shift, and wherein the respective average values are added, in each case, to the time of reception of the ultrasonic signal at the first receiver to determine the respective time-of-flight of the ultrasonic signal to the second and third receivers.

13. The method according to claim 8, further comprising: determining a signal quality of the received ultrasonic signals, wherein determining the signal quality comprises: determining first times t.sub.fn between successive inflection points of the received ultrasonic signals from a first inflection point to an n-th inflection point; determining second times t.sub.pn between the first inflection point and third through n-th inflection points; and determining the signal quality by comparing the times t.sub.fn and t.sub.pn with a respective predetermined target value t.sub.fn_target and t.sub.pn_target.

14. The method according to claim 8, wherein the first receiver and the second receiver are arranged on a first straight line and the first receiver and the third receiver are arranged on a second straight line, wherein the first straight line and the second straight line form an angle of 80° to 100° to one another.

15. A non-transitory computer-readable storage medium storing a computer program comprising instructions which, when executed by a computer, cause the computer to execute the method according to claim 8.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0092] The present invention is explained in more detail by means of exemplary embodiments and the figures below. In the figures:

[0093] FIG. 1 shows a schematic representation of the receiving unit according to an embodiment of the invention,

[0094] FIG. 2 shows a flowchart with steps that the receiving unit performs according to an embodiment of the invention,

[0095] FIG. 3 shows a schematic representation of the transmitting unit according to an embodiment of the invention,

[0096] FIG. 4 shows a flowchart with steps that the transmitting unit performs according to an embodiment of the invention,

[0097] FIG. 5 shows a schematic representation of the arrangement of the three receivers of the receiving unit according to an embodiment of the invention,

[0098] FIG. 6 shows a schematic representation for determining the x-coordinate of the transmitting unit according to the embodiment according to FIG. 5 of the invention,

[0099] FIG. 7 shows a schematic representation for determining the y-coordinate of the transmitting unit according to the embodiment according to FIG. 5 of the invention,

[0100] FIG. 8 shows a schematic representation for determining the z-coordinate of the transmitting unit according to the embodiment according to FIG. 5 of the invention,

[0101] FIG. 9 shows a schematic representation of the arrangement of the three receivers of the transmitting unit according to a further embodiment of the invention,

[0102] FIG. 10 shows a schematic representation of the propagation of the signal from the transmitting unit to the receiving unit according to an embodiment of the invention,

[0103] FIG. 11a shows an energy-time diagram of the received signals at the three receivers of the receiving unit according to an embodiment of the invention,

[0104] FIGS. 11b-11g show schematic representations of the signal processing at the three receivers of the receiving unit according to an embodiment of the invention,

[0105] FIG. 12 shows a schematic representation for determining the x-coordinate of the transmitting unit according to the embodiment according to FIG. 9 of the invention,

[0106] FIG. 13 shows a schematic representation for determining the y-coordinate of the transmitting unit according to the embodiment according to FIG. 9 of the invention, and

[0107] FIG. 14 shows a schematic representation for determining the z-coordinate of the transmitting unit according to the embodiment according to FIG. 9 of the invention.

DETAILED DESCRIPTION

[0108] FIG. 1 shows the schematic structure of a receiving unit 100 of the present invention with a first receiver 110 (also referred to as “Mic 1”), a second receiver 120 (also referred to as “Mic 2”) and a third receiver 130 (also referred to as “Mic 3”).

[0109] The receivers 110, 120, 130 can be designed, for example, as microphones or sensors for receiving ultrasonic signals.

[0110] The receiving unit 100 also has an amplifying and filtering unit 111, 121, 131, which are each connected to one of the receivers 110, 12, 130. The amplifying and filtering units 111, 121, 131 are configured to receive the signals received at the respective receiver 110, 120, 130 and to amplify or filter them.

[0111] The amplifying and filtering units 111, 121, 131 are configured in particular to improve the signal-to-noise ratio by amplifying or filtering out the actual measurement signal from any interference signals.

[0112] Although the amplifying and filtering units 111, 121, 131 are shown as one unit each in FIG. 1, the amplifying and filtering units 111, 121, 131 can also be formed as separate units.

[0113] The receiving unit 100 also has a processor 140 which is connected to the amplifying and filtering units 111, 121, 131 and which is configured to receive and process the signals from the respective amplifying and filtering units 111, 121, 131.

[0114] The processor 140 can receive and process further data, such as parameter settings of the receiving unit 100.

[0115] The processor 140 is configured in particular to determine the position of the transmitting unit (described in more detail below with reference to FIGS. 3 and 4) and preferably to output the corresponding “x, y, z”-coordinates of the transmitting unit. The implementation of the position determination of the transmitting unit is described in more detail below with reference to FIGS. 5 to 10.

[0116] Additional functions of the processor 140 become clear from the following description of FIGS. 2 to 14.

[0117] The processor 140 is further connected to a radio module 150. The radio module 150 is, in particular, configured to transmit a synchronization signal. The transmission of the synchronization signal can be initiated by the processor 140, for example, to provide a defined start time for the time-of-flight measurements described in more detail below.

[0118] The radio module 150 can communicate with the processor 140 and report a successful transmission of the synchronization signal to the processor 140. Furthermore, the radio module 150 can receive an acknowledgement from the transmitting unit, wherein the acknowledgement confirms the receipt of the synchronization signal.

[0119] FIG. 2 shows a flowchart with steps that the receiving unit 100 performs according to an embodiment of the invention.

[0120] In step S110, a synchronization signal is transmitted by the radio module 150 of the receiving unit 100. The synchronization signal can, for example, be a radio signal, a flash of light, etc.

[0121] In step S120, three timers are started, wherein one timer is assigned to one of the receivers 110, 120, 130 in each case. Preferably, the timers are started essentially at the same time as the synchronization signal is transmitted, in order to determine the respective time-of-flight of the signal from the transmitting unit to the respective receiver 110, 120, 130.

[0122] In step S130, the signals received by the respective receivers 110, 120, 130 are searched for the ultrasonic signal from the transmitting unit. In other words, the receivers 110, 120, 130 receive incoming ultrasonic signals, which are forwarded to the processor 140 through the subsequent amplifying and filtering units 111, 121, 131. The processor 140 is configured to process the signals and to identify, among the various signals, those signals received from the transmitting unit directly at the respective receiver 110, 120, 130.

[0123] Possible interference signals can, for example, originate from reflected signals corresponding to signals reflected on surfaces from the signal transmitted by the transmitting unit.

[0124] In step S140, a respective time-of-flight of the signal from the transmitting unit to the respective receiver 110, 120, 130 is determined by the processor 140 using the aforementioned timers. The respective time-of-flight corresponds to the time that the signal, which was transmitted by the transmitting unit, needs to reach the respective receiver 110, 120, 130.

[0125] In step S150, the 3D coordinates of the transmitting unit are determined by the processor 140 based on the determined three times-of-flight. The determination of the 3D coordinates based on the determined times-of-flight is described in more detail below.

[0126] In step S160, the determined 3D coordinates are output by the processor 140 and the method can be performed again.

[0127] FIG. 3 shows a schematic representation of the transmitting unit 200 according to an embodiment of the invention. The transmitting unit 200 comprises a transmitter 210, a driver stage 220, a processor 230 and a radio module 240.

[0128] The transmitter 210 is configured to transmit an ultrasonic signal. The transmitter is connected to a driver stage 220 which drives the transmitter 210.

[0129] The processor 230 is connected to the driver stage 220. The processor 230 is connected to a radio module 240. The processor 230 essentially takes over the control of the components of the transmitting unit 200.

[0130] The radio module 240 is configured to receive a synchronization signal, e.g. a radio signal or flash of light, etc., and to report the receipt of the synchronization signal to the processor 230.

[0131] FIG. 4 shows a flowchart with steps that the transmitting unit 200 performs according to an embodiment of the invention.

[0132] In step S210, the transmitting unit 200 waits for a synchronization signal from the receiving unit 100. This could be referred to as a stand-by mode, wherein the transmitter 210 does not transmit an ultrasonic signal in this mode.

[0133] In step S220, it is determined whether a synchronization signal has been received by the radio module 240. If no synchronization signal was received at the radio module 240, the method goes back to step S210 and performs steps S210 and S220 again.

[0134] Steps S210 and S220 can, for example, be repeatedly performed at predetermined intervals.

[0135] If a synchronization signal is received at the radio module 240, the method proceeds to step S230.

[0136] An ultrasonic signal is transmitted by the transmitter 210 in step S230. After the ultrasonic signal has been transmitted, the method goes back to step S210 and the steps described above can be performed again.

[0137] With reference to FIGS. 5 and 6, the arrangement of the receivers 110, 120, 130 of the receiving unit 100 according to an embodiment is described in more detail below.

[0138] FIG. 5 shows a schematic representation of the arrangement of the three receivers 110, 120, 130 of the receiving unit 100 according to an embodiment of the invention.

[0139] In the representation of FIG. 5, the receiver 110 is located at the point (s, k.sub.Mic1, e.sub.1) in relation to a predetermined coordinate origin (0, 0, 0) of an x, y, z coordinate system. The receiver 120 is located at point (M.sub.x, k.sub.Mic2, e.sub.2). The receiver 130 is located at a distance My (k.sub.Mic3, M.sub.y, e.sub.3).

[0140] The distances between the receivers 110, 120, 130 are at most equal to λ/2, wherein λ corresponds to the wavelength of the signal transmitted by the transmitting unit 200, i.e.:

[00001] $\sqrt{{(M_{x} - s)}^{2} + {(k_{Mic 2} - k_{Mic 1})}^{2} + {(e_{2} - e_{1})}^{2}} \leq \frac{λ}{2},$ $\sqrt{{(k_{Mic 3} - s)}^{2} + {(M_{y} - k_{Mic 1})}^{2} + {(e_{3} - e_{1})}^{2}} \leq \frac{λ}{2} .$

[0141] It will be clear to the person skilled in the art that the position of the aforementioned coordinate system can be chosen at will. For the following description it is assumed that the receivers 110, 120, 130 are located in one plane, i.e. e.sub.1=e.sub.2=e.sub.3=0.

[0142] The propagation of the signal from the transmitting unit 200 is shown in FIG. 9 and a corresponding received signal from the three receivers 110, 120, 130 is shown in FIG. 10. FIGS. 9 and 10 will be described in more detail below based on a further exemplary embodiment, but apply in an equivalent manner to the exemplary embodiment described here with reference to FIGS. 5 to 8.

[0143] The calculation of the 3D coordinates of the transmitting unit 200 is described in more detail below with reference to FIGS. 6 to 8.

[0144] FIG. 6 shows a schematic representation for determining the x-coordinate of the transmitting unit according to an embodiment of the invention. FIG. 7 shows a schematic representation for determining the y-coordinate of the transmitting unit according to an embodiment of the invention. FIG. 8 shows a schematic representation for determining the z-coordinate of the transmitting unit according to an embodiment of the invention.

[0145] FIG. 6 shows the receiver 110 (also referred to as the first receiver 110), the receiver 120 (also referred to as the second receiver 120), and the transmitter 210. The previously determined times-of-flight U.sub.1 and U.sub.2 of the signal from the transmitter 210 to the respective receiver 110, 120 correspond to the radii of two circular paths U.sub.1 and U.sub.2 around the respective receiver 110, 120, as shown in FIG. 6.

[0146] The corresponding coordinate equations with the coordinate origin at the location of the first receiver 110 for the circular paths U.sub.1 and U.sub.2 shown in FIG. 6 are as follows:

U.sub.1.sup.2=xv.sup.2+z.sub.2D.sup.2,

U.sub.2.sup.2=(xv−M.sub.xv).sup.2+z.sub.2D.sup.2.

[0147] M.sub.xv designates the distance between the first receiver 110 and the second receiver 120. U.sub.1 and U.sub.2 designate the respective radius of the circular paths. xv designates the xv-coordinate of the transmitter 210 and z.sub.2D designates the z-component of the transmitter 210 in an xv, z.sub.2D-coordinate system, wherein the xv-axis is defined by the first receiver 110 and the second receiver 120.

[0148] The coordinate equations above can be rearranged to make z.sub.2D the subject and then equated, resulting in the following equation:

U.sub.1.sup.2−xv.sup.2=U.sub.2.sup.2−(xv−M.sub.xv).sup.2.

[0149] The line segment M.sub.xv between the first receiver 110 and the second receiver 120 is calculated as follows:

M.sub.xv=√{square root over ((M.sub.x−s).sup.2+(k.sub.Mic2−k.sub.Mic1).sup.2)}.

[0150] The equated coordinate equations can be rearranged to make xv the subject and inserting M.sub.xv results in:

[00002] $x v = \frac{U_{1}^{2} - U_{2}^{2} + {(M_{x} - s)}^{2} + {(k_{Mic 2} - k_{Mic 1})}^{2}}{2 \sqrt{{(M_{x} - s)}^{2} + {(k_{Mic 2} - k_{Mic 1})}^{2}}} .$

[0151] Thus, the xv-coordinate of the transmitter 210 can be determined in the xv,.sub.z2D-coordinate system.

[0152] FIG. 7 shows the receiver 110 (also referred to as the first receiver 110), the receiver 120 (also referred to as the second receiver 120), the receiver 130 (also referred to as the third receiver 130), and the transmitter 210. FIG. 9 shows the determination of the x-coordinate and the y-coordinate of the transmitter 210.

[0153] First, the rotation angle α of the line segment xv to the origin coordinate system is determined as:

[00003] $α = \arctan (\frac{k_{Mic 2} - k_{Mic 1}}{M_{x} - s}) .$

[0154] The rotation angle α can be used to determine the line segment M.sub.yv and the line segment kv.sub.Mic3 as follows:

M.sub.yv=−(k.sub.Mic3−s)sin(α)+(M.sub.y−k.sub.Mic1)cos(α),

kv.sub.Mic3=(k.sub.Mic3−s)cos(α)+(M.sub.y−k.sub.Mic1)sin(α).

[0155] The coordinate equations for the spherical surfaces of the spheres with the radius of the respective times-of-flight U.sub.1 and U.sub.2 are as follows:

U.sub.1.sup.2=xv.sup.2+yv.sup.2+z.sup.2 and

U.sub.3.sup.2=(xv−kv.sub.Mic3).sup.2+(yv−M.sub.yv).sup.2+z.sup.2.

[0156] The coordinate equations can be rearranged to make z the subject and equated:

U.sub.1.sup.2−xv.sup.2−yv.sup.2=U.sub.3.sup.2−(xv−kv.sub.Mic3).sup.2−(yv−M.sub.yv).sup.2.

[0157] The equated coordinate equations can be rearranged to make yv the subject as follows:

[00004] $y v = \frac{U_{1}^{2} - U_{3}^{2} + M_{y v}^{2} - x v^{2} + {(x v - k v_{Mic 3})}^{2}}{2 M_{y v}} .$

[0158] The xv- and yv-coordinates can be traced back to the corresponding x- and y-coordinates using the rotation around the angle α:

x=xv cos(α)−yv sin(α)+s,

y=xv sin(α)−yv cos(α)+k.sub.Mic1.

[0159] FIG. 8 shows the line segment U.sub.1 between the receiver 110 and the transmitter 210. The line segment U.sub.1 can be expressed as a vector {right arrow over (U.sub.1)}:

[00005] $\overset{.fwdarw.}{U_{1}} = (\begin{matrix} x \\ y \\ z \end{matrix}) .$

[0160] The magnitude of the vector {right arrow over (U.sub.1)} corresponds to the time-of-flight of the signal:

√{square root over (|U.sub.1|)}=√{square root over (x.sup.2+y.sup.2+z.sup.2)}.

[0161] This equation can be rearranged to make z the subject, resulting in the following equation for the z-coordinate of the transmitter 210:

z=√{square root over (U.sub.1.sup.2−x.sup.2−y.sup.2)}.

[0162] The z-coordinate of the transmitter 210 can thus be determined using the previously determined x-coordinate and y-coordinate as well as the time-of-flight U.sub.1.

[0163] The calculations described above are preferably performed by the processor 140 of the receiving unit 100. The aforementioned calculation was described in relation to the transmitter 210. It is clear to the person skilled in the art that the aforementioned calculation relates to the transmitting unit 200, which comprises the transmitter 210.

[0164] With reference to FIGS. 9 to 11a, the arrangement of the receivers 110, 120, 130 of the receiving unit 100 and the propagation and reception of the signal of a further exemplary embodiment are described in more detail below.

[0165] FIG. 9 shows a schematic representation of the arrangement of the three receivers 110, 120, 130 of the receiving unit 100 according to an embodiment of the invention. FIG. 10 shows a schematic representation of the propagation of the signal from the transmitting unit 200 to the receiving unit 100 according to an embodiment of the invention. FIG. 11a shows an energy-time diagram of the received signals at the three receivers 110, 120, 130 of the receiving unit 100 according to an embodiment of the invention.

[0166] In the representation of FIG. 9, the receiver 110 is located at the origin (0,0,0) of an “x, y, z”-coordinate system. The receiver 120 is located at a distance Mx (Mx,0,0) from the receiver 110. The receiver 130 is located at a distance My (0,My,0) from the receiver 110. The distances Mx and My between the receivers 110, 120, 130 are at most equal to λ/2, wherein λ corresponds to the wavelength of the signal transmitted by the transmitting unit 200. Thus, the receivers 110, 120, 130 are arranged in one plane and the distances Mx and My are at most equal to λ/2.

[0167] Furthermore, the receivers 110 and 120 are arranged on a first straight line and the receivers 110 and 130 are arranged on a second straight line, wherein the first straight line and the second straight line are at right angles to one another. This orthogonal arrangement of the receivers 110, 120, 130 enables the calculation of the three coordinates described below via the azimuth and elevation angles, which are always at right angles to one another.

[0168] It will be clear to the person skilled in the art that the position of the aforementioned coordinate system can be chosen at will and was selected here merely as an example to explain the following calculations. The propagation of the signal from the transmitting unit 200 is shown in FIG. 10. As shown in FIG. 10, the receivers 110, 120, 130 of the receiving unit 100 receive the signal transmitted by the transmitting unit 200 at different points in time due to their spatial arrangement.

[0169] A corresponding received signal from the three receivers 110, 120, 130 is shown in FIG. 11a. By arranging the receivers 110, 120, 130 at a distance of at most one half the wavelength of the transmitted signal, a clear assignment of the received signals to the respective receiver 110, 120, 130 is possible.

[0170] The time-of-flight in the receiver 110 (Mic1) is determined as follows. First, the first inflection point of the envelope is determined. Then the first local maximum of the signal is determined, which exceeds a predetermined detection threshold. This is the time-of-flight of the signal in the receiver 110.

[0171] The detection threshold value is preferably determined before the actual time-of-flight measurement as the mean value of the received ambient/system noise. The accuracy of the times-of-flight in the receivers (Mic3) 130 and 120 (Mic2) or the differences in time-of-flight to the receiver 110 is decisive for determining the coordinates. The signals in different receivers do not resonate evenly. If the times-of-flight in the receiver 120 (Mic2) and the receiver 130 (Mic3) were assigned to the first local maximum of the signal in the receiver 110, it could happen that the phases of the individual signals in the three receivers have not yet stabilized. This assignment would then supply suboptimal values, i.e. less precise values, of the times-of-flight in the receiver 130 (Mic3) and the receiver 120 (Mic2). For this reason, it is advantageous if the phase differences or differences in time-of-flight in the receiver 120 (Mic2) and in the receiver 130 (Mic3) are determined by assigning the signals in the receiver 120 and the receiver 130 to the local maximum on the right to the first local maximum in the receiver 110, if the maximum exceeds a certain offset value to the detection threshold value (determined purely heuristically).

[0172] The “actual” times-of-flight in the receiver 120 (Mic2) and in the receiver 130 (Mic3) are preferably calculated by adding their differences in time-of-flight to the actual time-of-flight in the receiver 110.

[0173] In other words, the phase differences or time-of-flight differences in the receiver 120 (Mic2) and in the receiver 130 (Mic3) are determined by assigning the signals in the receiver 120 and the receiver 130 to the local maximum on the right to the first local maximum in the receiver 110. This is because the phase of the signals may not have stabilized at the beginning when the signal in the receiver 110 has exceeded the detection threshold. After the calculation of the phase or differences in time-of-flight of the receiver 110 to the receiver 120 and of the receiver 110 to the receiver 130, these are added back to the determined time-of-flight of the signal in the receiver 110. Thus, the times-of-flight of the signals in the receivers 120 and 130 are also obtained.

[0174] In other words, by arranging the receivers 110, 120, 130 at a distance of at most one half the wavelength of the transmitted signal, an incorrect assignment of the signals can be avoided. In particular, it should be noted that the measurement of the phases or differences in time-of-flight is relative and has nothing to do with the actual envelope maxima of the individual channels. The unambiguous assignment of the signals is not always possible at a distance greater than one half wavelength, since, for example, it is possible to receive the signals from at least two different directions with exactly the same phase position. This susceptibility to errors can be avoided by arranging the receivers 110, 120, 130 at a distance of at most one half the wavelength of the transmitted signal, as described here.

[0175] The signal processing described above is explained in more detail below with reference to FIGS. 11b-g.

[0176] FIG. 11b shows a predetermined measuring range of the time-of-flight (ToF) of the first receiver 110. The sound packet (signal) which was transmitted by the transmitting unit 200 is searched for and marked in this measuring range. Methods known from the background of the art can be used for this purpose.

[0177] The time-of-flight axis in FIG. 11b is given in ADC samples. This can be converted into the time-of-flight using the known sampling rate (samples per second).

[0178] According to an embodiment, the predetermined measuring range can be predefined/specified in the method. The measuring range can also be redefined before each individual measurement. For example, it can be specified that the beacon (ultrasonic transmitter) should be tracked within a radius of 1 m to 5 m during the first measurement. For the second measurement, it can be specified, for example, that a range of 7 m to 10 m should be tracked. With this method, the sound signal is evaluated for the time that corresponds to the measuring range.

[0179] In an alternative embodiment, e.g. only one beacon (ultrasonic transmitter) can be used in the method and the measurement can be performed up to the detection of the one beacon (ultrasonic transmitter). For example, the maximum measuring range can be set from 0 to 10 m. If the beacon is detected at 4 m, the measurement is ended and evaluated, and the measuring range for this measurement is dynamically set to 4 m.

[0180] The aforementioned values in connection with the measuring range are only given as examples to explain the general method and are not intended to restrict the content of the disclosure to the extent that the invention is restricted to these exemplary values.

[0181] According to FIG. 11c, the sound packet is divided into a transient process and a decay process and marked accordingly. The transient process can be defined, for example, as the part of the sound packet in which the magnitude of the amplitude of the oscillations increases. Accordingly, the decay process can be defined as the part of the sound packet in which the magnitude of the amplitude of the oscillations decreases. Thus, the oscillation with the greatest amplitude (magnitude of the amplitude) can define the boundary between the transient process and the decay process. The starting point or end point of the respective transient or decay process can be the first or last amplitude value≠0 (or a predetermined limit value>0).

[0182] FIG. 11d shows an enlarged section of the transient process. The inflection points of the sound signal are determined in the area of the transient process that was previously marked. The determination of the inflection points of the sound signal is limited to the inflection points that are above (positive amplitude) or below (negative amplitude) a previously defined limit value (“threshold of the noise level”). The inflection points are marked with circles in FIG. 11d and identified with arrows accordingly.

[0183] According to FIG. 11e, a polynomial interpolation is performed using the inflection points on the positive side and on the negative side. The intersection of the two polynomial functions defines the starting point (beginning) of the sound signal. The time-of-flight of the signal (sound packet) from the transmitting unit 200 to the first receiver 110 can thus be precisely determined.

[0184] The determination of the phase differences or differences in time-of-flight is described in more detail below with reference to FIG. 11f. In FIG. 11f, channel 1 designates the signal at the first receiver 110, channel 2 the signal at the second receiver 120 and channel 3 the signal at the third receiver 130.

[0185] To determine the time-of-flight (ToF) of the individual channels, i.e. at the individual receivers 110, 120, 130, the phase (time difference) between the channels is determined. In this regard, channel 1 (signal at the first receiver 110) defines the starting point. The respective inflection points of channel 1 define the centre of a search window (dashed lines in FIG. 11f) which is less than or equal to one half of the wavelength. Thus, the respective time differences between channel 1 and channel 2 and between channel 1 and channel 3 can be determined.

[0186] The corresponding time differences between the channels are determined for a plurality (preferably a predetermined number) of inflection points and the mean value is formed in order to determine a mean value for the time difference between channel 1 and channel 2 and between channel 1 and channel 3. The respective mean value can then be added to the time-of-flight of channel 1 (start time of the sound packet at the first receiver 110), determined as described above, in order to calculate the times-of-flight of the signal of channel 2 (second receiver 120) and of channel 3 (third receiver 130).

[0187] The determination of the signal quality of the signal received in the respective receiver 110, 120, 130 is described in more detail below with reference to FIG. 11g.

[0188] The signal geometry is disturbed by, for example, the transmitter, interference signals, noise and the transmission medium, which can change the frequency. These disturbances can lead to errors in the calculation of the phase difference. In order to be able to evaluate the signal quality and thus be able to detect the error, the times t.sub.fn and t.sub.pn identified in FIG. 11g are determined and compared with a target value.

[0189] If the identified times t.sub.fn and t.sub.pn are within a predetermined tolerance range, the associated inflection point is used for the averaging described above, otherwise the inflection point is discarded.

[0190] In particular, the target values (t.sub.fn_target and t.sub.pn_target) are determined from the transmitted signal or derived from a known ideal signal (mathematical function). Thus, it is possible to perform signal coding in the form of frequency coding.

[0191] To determine the signal quality, a tolerance range is predefined, e.g. by appropriate series of measurements. If the identified times t.sub.fn and t.sub.pn are within the tolerance range, the associated inflection point is used for the further calculation, otherwise the inflection point is discarded.

[0192] The number of inflection points used for further calculation results in a confidence value/reliability value. Utilizing the confidence value/reliability value determined in this manner, it is possible to perform the filtering/division/weighting using the confidence value/reliability value determined after the application of the method or to discard one or more inflection points completely or also to discard the coordinates completely at the end of the determination.

[0193] After determining the confidence value/reliability value and outputting the coordinates (with or without the confidence value/reliability value) or after discarding the coordinates, the sensor system is ready to carry out a new measurement.

[0194] With reference to FIGS. 12 to 14, the calculation of the 3D coordinates of the transmitting unit 200 of the exemplary embodiment according to FIGS. 9 to 11 is described in more detail below.

[0195] FIG. 12 shows a schematic representation for determining the x-coordinate of the transmitting unit according to an embodiment of the invention. FIG. 13 shows a schematic representation for determining the y-coordinate of the transmitting unit according to an embodiment of the invention. FIG. 14 shows a schematic representation for determining the z-coordinate of the transmitting unit according to an embodiment of the invention.

[0196] FIG. 12 shows the receiver 110 (also referred to as the first receiver 110), the receiver 120 (also referred to as the second receiver 120), and the transmitter 210. The previously determined times-of-flight U.sub.1 and U.sub.2 of the signal from the transmitter 210 to the respective receiver 110, 120 correspond to the radii of two circular paths U.sub.1 and U.sub.2 around the respective receiver 110, 120, as shown in FIG. 12.

[0197] The corresponding coordinate equations for the circular paths U.sub.1 and U.sub.2 shown in FIG. 12 are as follows:

U.sub.1.sup.2=x.sup.2+z.sub.2D.sup.2,

U.sub.2.sup.2=(x−M.sub.x).sup.2+z.sub.2D.sup.2.

[0198] M.sub.x designates the distance between the first receiver 110 and the second receiver 120. U.sub.1 and U.sub.2 designate the respective radius of the circular paths. x designates the x-coordinate of the transmitter 210 and z.sub.2D designates the z-component of the transmitter 210.

[0199] The coordinate equations above can be rearranged to make z.sub.2D the subject and then equated, resulting in the following equation:

U.sub.1.sup.2−x.sup.2=U.sub.2.sup.2−(x−M.sub.x).sup.2.

[0200] This equation can be solved for x, which results in the following equation:

[00006] $x = \frac{U_{1}^{2} - U_{2}^{2} + M_{x}^{2}}{2 M_{x}} .$

[0201] The x-coordinate of the transmitter 210 can thus be determined by determining the two times-of-flight U.sub.1 and U.sub.2 and the distance M.sub.x between the first receiver 110 and the second receiver 120.

[0202] FIG. 13 shows the receiver 110 (also referred to as the first receiver 110), the receiver 130 (also referred to as the third receiver 130), and the transmitter 210. In a manner analogous to FIG. 12, FIG. 13 shows the determination of the y-coordinate of the transmitter 210.

[0203] The previously determined times-of-flight U.sub.1 and U.sub.3 of the signal from the transmitter 210 to the respective receiver 110, 130 correspond to the radii of two circular paths U.sub.1 and U.sub.3 around the respective receiver 110, 130, as shown in FIG. 13.

[0204] The corresponding coordinate equations for the circular paths shown in FIG. 12 are as follows:

U.sub.1.sup.2=y.sup.2+z.sub.2D.sup.2,

U.sub.3.sup.2=(y−M.sub.y).sup.2+z.sub.2D.sup.2.

[0205] M.sub.y designates the distance between the first receiver 110 and the third receiver 130. U.sub.1 and U.sub.3 designate the respective radius of the circular paths. y designates the y-coordinate of the transmitter 210 and z.sub.2D designates the z-component of the transmitter 210.

[0206] The coordinate equations above can be rearranged to make z.sub.2D the subject and then equated, resulting in the following equation:

U.sub.1.sup.2−y.sup.2=U.sub.3.sup.2−(y−M.sub.y).sup.2.

[0207] This equation can be solved for y, which results in the following equation:

[00007] $y = \frac{U_{1}^{2} - U_{3}^{2} + M_{y}^{2}}{2 M_{y}} .$

[0208] The y-coordinate of the transmitter 210 can thus be determined by determining the two times-of-flight U.sub.1 and U.sub.3 and the distance M.sub.y between the first receiver 110 and the third receiver 130.

[0209] FIG. 14 shows the line segment U.sub.1 between the receiver 110 and the transmitter 210. The line segment U.sub.1 can be expressed as a vector {right arrow over (U.sub.1)}:

[00008] $\overset{.fwdarw.}{U_{1}} = (\begin{matrix} x \\ y \\ z \end{matrix}) .$

[0210] The magnitude of the vector {right arrow over (U.sub.1)} corresponds to the time-of-flight of the signal:

√{square root over (|U.sub.1|)}=√{square root over (x.sup.2+y.sup.2+z.sup.2)}.

[0211] This equation can be rearranged to make z the subject, resulting in the following equation for the z-coordinate of the transmitter 210:

z=√{square root over (U.sub.1.sup.2−x.sup.2−y.sup.2)}.

[0212] The z-coordinate of the transmitter 210 can thus be determined using the previously determined x-coordinate and y-coordinate as well as the time-of-flight U.sub.1.

[0213] The calculations described above are preferably performed by the processor 140 of the receiving unit 100. The aforementioned calculation was described in relation to the transmitter 210. It is clear to the person skilled in the art that the aforementioned calculation relates to the transmitting unit 200, which comprises the transmitter 210.

[0214] In addition to the three-dimensional position of the transmitter, the direction of the transmitter can also be determined if needed. Determining the direction of the transmitter does not require a synchronization signal, as described above, since the difference in times-of-flight is relative and does not depend on a defined start time of the time-of-flight measurement. The differences in time-of-flight of the received signals are determined as described. The difference in times-of-flight clearly indicates the azimuth or elevation angle relative to the plane of the receiver. In this way, the direction of the transmitter can be determined.

[0215] While the present invention has been described and illustrated here with reference to preferred embodiments thereof, it will be apparent to persons skilled in the art that various modifications and changes can be made therein without departing from the scope of the invention. In this manner, it is intended that the present invention cover the modifications and changes to the present invention insofar as they fall within the scope of the appended claims and their equivalents. Furthermore, features described in connection with a particular embodiment are not to be construed exclusively in connection with other features of that embodiment. Rather, it shall be clear that a combination of features from different embodiments is also possible. Also, a feature described in connection with another feature may be present without the other feature in a possible embodiment according to the present invention.

DEVICES AND METHODS FOR 3D POSITION DETERMINATION

Inventors

Cpc classification

Classification Explorer

G01S3/808

PHYSICS

Classification Explorer

G01S5/20

PHYSICS

Classification Explorer

G01S7/53

PHYSICS

Classification Explorer

G01S3/8083

PHYSICS

Classification Explorer

G01S5/22

PHYSICS

International classification

Classification Explorer

G01S3/808

PHYSICS

Classification Explorer

G01S5/22

PHYSICS

Classification Explorer

G01S5/20

PHYSICS

Classification Explorer

G01S7/53

PHYSICS

Abstract

Claims

Description