Beacon localization method
10006980 ยท 2018-06-26
Assignee
Inventors
Cpc classification
G01S5/06
PHYSICS
G01S5/0244
PHYSICS
G01S13/878
PHYSICS
International classification
G01S5/06
PHYSICS
H04W64/00
ELECTRICITY
Abstract
The method for localizing a beacon consists in transmitting, by a first transceiver, an initiation signal, which is received by second and third transceivers, in calculating, by means of said initiation signal, errors between a reference frequency of the first transceiver and reference frequencies of the second and third transceivers, in transmitting, by the beacon, a first pulsed signal, which is received by the first, second and third transceivers, in transmitting, by the first transceiver, a second pulsed signal, which is received by the second and third transceivers, in calculating differences in the times-of-flight of the first and second pulsed signals, each time-of-flight difference being calculated in a time base provided by a local oscillator of the first transceiver by means of reference frequency errors, and in calculating a beacon position by means of the times-of-flight.
Claims
1. A method for localizing a beacon by first, second and third transceivers, each of the beacon, the first, the second and the third transceivers comprising a local oscillator oscillating at different reference frequencies due to frequency drifts, the method comprising: transmitting, by a first transceiver, an initiation signal, said initiation signal being received by second and third transceivers, calculating, using the initiation signal, errors between a reference frequency of the first transceiver and reference frequencies of the second and third transceivers as frequency reference errors, transmitting, by the beacon, a first pulsed signal, said first pulsed signal being received by the first, second and third transceivers, transmitting, by the first transceiver, a second pulsed signal, said second pulsed signal being received by the second and third transceivers, calculating, using the frequency reference errors, at least three differences between times-of-flight of the first and second pulsed signals, each time-of-flight difference being calculated in a base time of the first transceiver, and calculating a position of the beacon by time-of-flight differences.
2. The localization method according to claim 1, further comprising performing autocorrelation steps, of the first and second pulsed signals received by the first, second and third transceivers, the autocorrelation steps allowing detection and selection of autocorrelation peaks, and the time-of-flight differences being calculated of said autocorrelation peaks.
3. The localization method according to claim 2, wherein each autocorrelation step including a selection of the first peak detected on a time scale, from among a plurality of detectable autocorrelation peaks.
4. The localization method according to claim 2, wherein each performance of the autocorrelation steps of a pulsed signal further comprises: calculating a frequency spectrum of the pulsed signal, multiplying said frequency spectrum with a second frequency spectrum at a frequency f.sub.0+f.sub.Sel, where f.sub.0 is a frequency of the pulsed signal, and f.sub.Sel is a reference frequency error between the device having transmitted the pulsed signal and a transceiver having received said pulsed signal, said second frequency spectrum being called a selected prototype, and transposing in a time domain a product sequence which is a result of the multiplication.
5. The localization method according to claim 4, wherein each of the autocorrelation steps of a pulsed signal including a sub-step of interpolation of the product sequence.
6. The localization method according to claim 1, further comprising steps, performed on a reception of initiation signal by the beacon, of: transmitting, by the beacon, an activation signal, including a request for activation of the receiver modules of the first, second and third transceivers, said modules acquiring the first and second pulsed signals, and calculating, using said initiation signal, of errors between a reference frequency of the beacon and reference frequencies of the first, second and third transceivers.
7. The localization method according to claim 6, wherein each step of calculating a reference frequency error between a device having transmitted the initiation signal or the activation signal and a transceiver receiving a signal further comprises: analyzing a temporal evolution of a frequency spectrum of signals received by the transceiver, to identify a characteristic line of the initiation signal, calculating, in a time base provided by a local oscillator of the transceiver, a range of error between a modulation frequency of the initiation signal, and a frequency of said characteristic line of the initiation signal, and calculating the reference frequency error by ranges of error.
8. The localization method according to claim 1, wherein the initiation signal has a different frequency than the second pulsed signal.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) The objects, advantages and features of the beacon localization method will appear more clearly in the following description, with reference to the drawings, in which:
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
DETAILED DESCRIPTION OF THE INVENTION
(14) In the following description, all those elements of the self-synchronizing beacon localization system that are well known to those skilled in the art in this technical field will be described only in a simplified manner.
(15)
(16) First transceiver A, second transceiver B, third transceiver C and beacon X each comprise a local oscillator oscillating at a reference frequency f.sub.ref, for example 26 MHz, used to provide a time base to their electronic components. Theoretically, this reference frequency f.sub.ref is common to the four devices A, B, C, X. In practice, the local oscillators are subject to frequency drifts, which will be greater the lower the quality of the oscillator. The reference f.sub.refA refers to the reference frequency of first transceiver A, f.sub.refB to the reference frequency of second transceiver B, f.sub.refC to the reference frequency of third transceiver C, f.sub.refx to the reference frequency of beacon X. The localization system allows precise localization of the beacon despite these frequency drifts, as is explained below.
(17) As represented in
(18) Further, the first, second and third transceivers A, B, C and beacon X each comprise a module for transmitting FSK signals EmA_Fsk, EmB_Fsk, EmC_Fsk, EmX_Fsk, called the FSK transmitter module. Together the FSK transmission and receiver modules form a communication system. Modules EmB_Fsk, EmC_Fsk of the second and third transceivers B, C communicate to transceiver A the intermediate results of correlations calculated in transceivers B and C. The carrier frequency on which the FSK modulations are based is called communication frequency f.sub.0. Communication frequency f.sub.0 is, for example, at 2.4 GHz, and the frequency deviation encoding the 0 or 1 states of a binary sequence is 50 kHz.
(19) Further, first, second and third transceivers A, B, C each comprise a module for receiving binary phase shift keyed signals RcA_Bpsk, RcB_Bpsk, RcC_Bpsk. This modulation is known as BPSK. For ease of reading, these modules are called BPSK receiver modules, and a carrier that is modulated in phase with a binary sequence using the principle of BPSK modulation is referred to as a BPSK signal. For example, when a carrier at frequency f.sub.0 is modulated by the 1 state of a binary sequence, the resulting signal is of zero-phase; when the carrier is modulated by a 0 state of the binary sequence, the resulting signal is of phase .
(20) Further, first transceiver A and beacon X each comprise a module for transmitting BPSK signals EmA_Bpsk, EmX_Bpsk, called the BPSK transmitter module. Together the BPSK transmission and receiver modules form a communication system. The carrier frequency on which the BPSK modulations are based is the communication frequency f.sub.0 which has a value, for example of 2.4 GHz.
(21)
(22) Further, as set out above, first transceiver A comprises an FSK transmitter module EmA_Fsk and an FSK receiver module RcA_Fsk, for high sensitivity FSK signal transmission and reception in low rate mode. FSK transmitter module EmA_Fsk and receiver module FSK RcA_Fsk are, for example, based on the EM Microelectronics transceiver EM9209. FSK transmitter module EmA_Fsk and receiver module FSK RcA_Fsk are connected to a first terminal of switch SW and use as time base the reference frequency f.sub.refA provided by a quartz oscillator OSC of first transceiver A.
(23) The second and third transceivers B, C also each include an FSK transmitter module EmB_Fsk and EmC_FSK and an FSK receiver module RcB_Fsk and RcC_FSK for high sensitivity FSK signal transmission and reception in low rate mode. These transmission and receiver modules are also based on the EM Microelectronics transceiver EM9209.
(24) First transceiver A also comprises a BPSK receiver module RcA_Bpsk. BPSK receiver module RcA_Bpsk comprises a low noise amplifier (or LNA) AMPf connected to a second terminal of switch SW for amplifying a BPSK signal picked up by antenna ANT.
(25) BPSK receiver module RcA_Bpsk then comprises a demodulation stage for demodulating the incoming BPSK signal. The demodulation stage comprises a first mixer ML1 whose first input is connected to an output of LNA AMPf, and whose second input is connected to a low phase noise synthesizer GEN belonging to first transceiver A. The demodulation stage also includes a second mixer ML2 whose first input is connected to the output of LNA AMPf, and whose second input is connected to synthesizer GEN. Synthesizer GEN supplies to first mixer ML1 a demodulation signal LOi at communication frequency f.sub.0, and to second mixer ML1 a quadrature signal LOq with demodulation signal LOi. The first and second mixers ML1, ML2 then output a signal that is the sum of the useful signal and a signal modulated at frequency 2.Math.f.sub.0.
(26) The demodulation stage then comprises a first low-pass filter LP1 and a second low-pass filter LP2, respectively connected to the outputs of first mixer ML1 and second mixer ML2. Low-pass filters LP1, LP2 filter the spectral components at 2.Math.f.sub.0 of the signals output by mixers ML1, ML2.
(27) BPSK receiver module RcA_Bpsk then comprises a sampling stage for sampling the incoming demodulated BPSK signal. The sampling stage comprises a first variable gain amplifier AMP1 and a second variable gain amplifier AMP2, respectively connected to the outputs of first low-pass filter LP1 and second low pass filter LP2. The sampling stage then comprises a first analogue-to-digital converter (ADC) AD1 and a second analogue-to-digital converter AD2, respectively connected to the first variable gain amplifier AMP1 and second variable gain amplifier AMP2. It is noted that the gain of variable gain amplifiers AMP1, AMP2 is regulated by a programmable circuit CLP of the field programmable gate array type, belonging to first transceiver A. The variable gain amplifiers AMP1, AMP2 attenuate the input signal of analogue-to-digital converters AD1, AD2 in order to decrease the resolution of analogue-to-digital converters AD1, AD2 without affecting their dynamic performance.
(28) Further, first transceiver A includes a BPSK transmitter module EmA_Bpsk, including a BPSK modulator.
(29) Finally, first transceiver A comprises a digital signal processor PSC, for example for performing reference frequency error calculations, autocorrelation calculations, or positioning calculations for beacon X.
(30) In a non-limiting embodiment, second transceiver B and third transceiver C are identical to first transceiver A. Alternatively, they comprise all the components of first transceiver A, with the exception of the BPSK transmitter module.
(31)
(32) In a step Etp_Em_FskA represented in
(33) In a step Etp_Cal_e.sub.AB, second transceiver B calculates a range of error e.sub.AB between its reference frequency f.sub.refB and that of first transceiver A f.sub.refA, using incoming initiation signal FskA. To achieve this, step Etp_Cal_e.sub.AB includes the following sub-steps: In a sub-step Etp_Cal_e.sub.AB.sub._An, second transceiver B analyses the dynamic evolution of the frequency spectrum of the signals continuously received by its FSK receiver module RcB_Fsk, said frequency spectrum being centred on the aforementioned communication frequency f.sub.0. The frequency spectrum is advantageously obtained by discrete Fourier transform of the incoming signals. When a line subjected to characteristic frequency hopping (on the order of a few kilohertz for example) is identified, this line is attributed to initiation signal FskA. In a sub-step Etp_Cal_e.sub.AB.sub._Ec, second transceiver B calculates the deviation between this characteristic line and the central frequency of the frequency spectrum. Indeed, if the reference frequency of first transceiver A and the reference frequency of second transceiver B were perfectly synchronized, the characteristic line would be at the centre of the frequency spectrum. However, because the resolution of the frequency spectrum is limited, the deviation cannot be precisely calculated: it is only possible to calculate a range of deviation. This deviation range is the range of error e.sub.AB between reference frequency f.sub.refB of second transceiver B and that f.sub.refA of first transceiver A.
(34) In a step Etp_Cal_e.sub.AC, third transceiver C calculates a range of error e.sub.AC between its reference frequency f.sub.refC and that of first transceiver A f.sub.refA, using incoming initiation signal FskA. This step is performed in a similar manner to step Etp_Cal_e.sub.AB.
(35) In a step Etp_Em_FskX represented in
(36) In a step Etp_Cal_e.sub.XA, first transceiver A calculates a range of error e.sub.XA between its reference frequency f.sub.refA and that f.sub.refX of beacon X, using the incoming activation signal FskX. This step is performed in a similar manner to step Etp_Cal_e.sub.AB.
(37) In a step Etp_Cal_e.sub.XB, second transceiver B calculates a range of error e.sub.XB between its reference frequency f.sub.refB and that f.sub.refX of beacon X, using the incoming activation signal FskX. This step is performed in a similar manner to step Etp_Cal_e.sub.AB.
(38) In a step Etp_Cal_e.sub.XC, third transceiver C calculates a range of error e.sub.XC between its reference frequency f.sub.refC and that f.sub.refX of beacon X, using the incoming activation signal FskX. This step is performed in a similar manner to step Etp_Cal_e.sub.AB.
(39) In a step Etp_Act_Bpsk, in response to reception of activation request RqAct, transceivers A, B, C activate their BPSK receiver modules RcA_Bpsk, RcB_Bpsk, RcC_Bpsk, which are then in detection mode Md_Det_Bpsk, as represented in
(40) In a step Etp_Em_BpskX represented in
(41) In a step Etp_Aut_P.sub.XA represented in
(42) In both cases, prototype selection sub-step Etp_Aut_P.sub.XA.sub._Sel includes the following sub-steps: In a sub-step Etp_Aut_P.sub.XA.sub._Sel_Mult, frequency spectrum SpecX is multiplied by each of the R prototypes (Proto.sub.i).sub.i=1 . . . R, which generates R product signals (Sgp.sub.i).sub.i=1 . . . R. In a sub-step Etp_Aut_P.sub.XA.sub._Sel_Trans, each product signal (Sgp.sub.i).sub.i=1 . . . R is transposed in the time domain. Each product signal (Sgp.sub.i).sub.i=1 . . . R presents a peak, which is actually an autocorrelation peak (Pc.sub.i).sub.i=1 . . . R. Indeed, multiplication in the frequency domain is equivalent to correlation in the time domain. Further, it is noted that fewer calculations have to be performed to effect a multiplication in the frequency domain than to effect a correlation in the time domain: the complexity of the correlation algorithm in the time domain is O(n.sup.2), whereas it is O(n.Math.log(n)) in the frequency domain. In a sub-step Etp_Aut_P.sub.XA.sub._Sel_Comp, the amplitude of the autocorrelation peaks (Pc.sub.i).sub.i=1 . . . R is compared. The prototype Proto.sub.Sel whose product signal Sgp.sub.Sel presents the highest autocorrelation peak Pc.sub.Sel is selected. The selected prototype Proto.sub.Sel is therefore that which maximises the autocorrelation peak-to-noise ratio for the most reliable possible autocorrelation peak identification. It is noted that the frequency deviation f.sub.Sel of the selected prototype Proto.sub.Sel is an estimate of the error e.sub.XA between the reference frequency of the beacon X f.sub.refX and that of first transceiver A f.sub.refA. This estimate is more accurate the higher R is. In a sub-step Etp_Aut_P.sub.XA.sub._AjM, M samples of zero value are added to the centre of frequency spectrum SpecX, in accordance with the principle of zero-padding, so as to create an extended frequency spectrum including N+M+N samples, M being a positive integer number. This sub-step allows the sampling frequency of first pulsed signal BpskX to be artificially increased, in order to interpolate the signal in the time domain. If N has a value of 19000, M=1 048 576-39000 points are added for example. Interpolation makes it possible to finely determine the shape of the maxima of the temporal signal corresponding to the frequency spectrum. In a sub-step Etp_Aut_P.sub.XA.sub._Mult, the extended frequency spectrum is multiplied by the extended selected prototype, which generates a product sequence Seq.sub.Prod. The extended selected prototype is the selected prototype Proto.sub.Sel to the centre of which M samples of zero value have been added. In a sub-step Etp_Aut_P.sub.XA.sub._Trans, the product sequence is transposed in the time domain, for example by an inverse fast Fourier transform (IFFT). The product sequence presents an autocorrelation peak, first autocorrelation peak P.sub.XA. First autocorrelation peak P.sub.XA is of high resolution as a result of sub-step Etp_Aut_P.sub.XA.sub._AjM, and low amplitude as a result of sub-step Etp_Aut_P.sub.XA.sub._Sel. It is noted that the transposed product sequence may have several autocorrelation peaks as a result of multipath radio signal propagation, particularly because of refractions or reflections of first signal BpskX on various obstacles between beacon X and first transceiver A. First autocorrelation peak P.sub.XA is then the first of the peaks detected in time.
(43) In a step Etp_Aut_P.sub.XB second transceiver B performs an autocorrelation of the first pulsed signal BpskX received, in which a second autocorrelation peak P.sub.XB is detected. Second autocorrelation peak P.sub.XB is represented in
(44) In a step Etp_Aut_P.sub.XC, third transceiver C performs an autocorrelation of the first pulsed signal BpskX received, in which a third autocorrelation peak P.sub.XC is detected. Third autocorrelation peak P.sub.XC is represented in
(45) In a step Etp_Em_BpskA represented in
(46) In a step Etp_Aut_P.sub.AB, second transceiver B performs an autocorrelation of the second pulsed signal BpskA received, in which a fourth autocorrelation peak P.sub.AB is detected. Fourth autocorrelation peak P.sub.AB is represented in
(47) In a step Etp_Aut_P.sub.AC, third transceiver C performs an autocorrelation of the second pulsed BPSK signal BpskA received, in which a fifth autocorrelation peak P.sub.AC is detected. Fifth autocorrelation peak P.sub.AC is represented in
(48) In a step Etp_Cal_T.sub.A, first transceiver A calculates a time difference T.sub.A between the time associated with first autocorrelation peak P.sub.XA (which is the time of reception by first transceiver A of first pulsed signal BpskX sent by beacon X), and the time of transmission of second pulsed signal BpskA by first transceiver A. Time difference T.sub.A is represented in
(49) In a step Etp_Cal_T.sub.B, second transceiver B calculates a time difference T.sub.B between the time associated with second autocorrelation peak P.sub.XB (which is the time of reception by second transceiver B of first pulsed signal BpskX sent by beacon X), and the time associated with fourth autocorrelation peak P.sub.AB (which is the time of reception by second transceiver B of second pulsed signal BpskA sent by first transceiver A). Naturally, this time difference T.sub.A is expressed in the time base provided by the local oscillator of second transceiver B. Time difference T.sub.B is represented in
(50) In a step Etp_Cal_T.sub.B, second transceiver B caculates a time difference T.sub.B corresponding to the transposition of time difference T.sub.B in the time base provided by the local oscillator of first transceiver A. Time difference T.sub.B is equal to time difference T.sub.B multiplied by error e.sub.AB between reference frequency f.sub.refA of first transceiver A and that f.sub.refB of second transceiver B:
T.sub.B=T.sub.B.Math.e.sub.AB
(51) In a step Etp_Tr_T.sub.B represented in
(52) In a step Etp_Cal_T.sub.C, third transceiver C calculates a time difference T.sub.C between the time associated with third autocorrelation peak P.sub.XC (which is the time of reception by third transceiver C of first pulsed signal BpskX sent by beacon X), and the time associated with fifth autocorrelation peak P.sub.AC (which is the time of reception by third transceiver C of second pulsed signal BpskA sent by first transceiver A). Naturally, this time difference T.sub.C is expressed in the time base provided by the local oscillator of third transceiver C. Time difference T.sub.C is represented in
(53) In a step Etp_Cal_T.sub.C, third transceiver C calculates a time difference T.sub.C corresponding to the transposition of time difference T.sub.C in the time base provided by the local oscillator of first transceiver A. Time difference T.sub.C is equal to time difference T.sub.C multiplied by error e.sub.AC between reference frequency f.sub.refA of first transceiver A and that f.sub.refC of third transceiver C:
T.sub.C=T.sub.C.Math.e.sub.AC
(54) In a step Etp_Tr_T.sub.C represented in
(55) In a step Etp_Cal_t, first transceiver A calculates the times-of-flight t.sub.1, t.sub.2 and t.sub.3 defined by the following relations
XAAB=t.sub.1.Math.c.sub.0
XAXC=t.sub.2.Math.c.sub.0
XBXC=t.sub.3.Math.c.sub.0
(56) where XA is the (unknown) distance separating beacon X and first transceiver A, XB is the (unknown) distance separating beacon X and second transceiver B, XC is the (unknown) distance separating beacon X and third transceiver C, AB is the distance (known by transceiver A) separating beacon X and second transceiver B, c.sub.0 is the propagation speed of the signals exchanged between the various devices A, B, C, X.
(57) Time-of-flight difference t.sub.1 therefore corresponds to the difference of the time between transmission of first pulsed signal BpskX by beacon X and reception thereof by first transceiver A, and of the time between transmission of second pulsed signal BpskA by first transceiver A and reception thereof by second transceiver B. Further, time-of-flight difference t.sub.2 corresponds to the difference of the time between transmission of first pulsed signal BpskX by beacon X and reception thereof by first transceiver A, and of the time between transmission of first pulsed signal BpskX by beacon X and reception thereof by third transceiver C. Finally, time-of-flight difference t.sub.3 corresponds to the difference of the time between transmission of first pulsed signal BpskX by beacon X and reception thereof by second transceiver B, and of the time between transmission of first pulsed signal BpskX by beacon X and reception thereof by third transceiver C.
(58) Time-of-flight differences t.sub.1, t.sub.2 and t.sub.3 are calculated by first transceiver A according to the following formulae:
t.sub.1=T.sub.A(T.sub.BAB/c.sub.0)
t.sub.2=T.sub.A(T.sub.CAC/c.sub.0)
t.sub.3=T.sub.BAB/c.sub.0(T.sub.CAC/c.sub.0)
(59) In a step Etp_Cal_PosX, first transceiver A solves the following system of three equations with 3 unknowns (XA, XB, XC):
XA=t.sub.1.Math.c.sub.0+AB
XC=XAt.sub.2.Math.c.sub.0
XB=t.sub.3.Math.c.sub.0+XC
and a position PosX of beacon X is deduced.
(60) All the preceding steps may be performed again, so that first transceiver A has at least two positions of beacon X. Method METH then includes an additional step Etp_Filt_PosX of calculating a final position from the at least two positions, for example via a mean.
(61) In a step Etp_Tr_PosX represented in
(62) Naturally, the order of the steps presented above is not limiting, as the steps can be performed in any other technically possible order.
(63) From the description that has just been given, several variants of the method and system for localizing a beacon can be devised by those skilled in the art without departing from the scope of the invention defined by the claims. For example, a 2D localization system comprising three transceivers A, B, C was presented. However, by integrating an additional transceiver in the localization system, it is possible to achieve 3D localization of a beacon, i.e. localization of a beacon not necessarily at zero height. The fundamental localization principles remain the same however.