CN112394325A - Doppler frequency offset estimation system, method and device for ultrasonic positioning signal - Google Patents

Doppler frequency offset estimation system, method and device for ultrasonic positioning signal Download PDF

Info

Publication number
CN112394325A
CN112394325A CN201910758469.4A CN201910758469A CN112394325A CN 112394325 A CN112394325 A CN 112394325A CN 201910758469 A CN201910758469 A CN 201910758469A CN 112394325 A CN112394325 A CN 112394325A
Authority
CN
China
Prior art keywords
ultrasonic
signal
frequency
positioning
frequency offset
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201910758469.4A
Other languages
Chinese (zh)
Other versions
CN112394325B (en
Inventor
向玮晨
刘广松
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Suzhou Touchair Technology Co ltd
Original Assignee
Suzhou Touchair Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Suzhou Touchair Technology Co ltd filed Critical Suzhou Touchair Technology Co ltd
Priority to CN201910758469.4A priority Critical patent/CN112394325B/en
Publication of CN112394325A publication Critical patent/CN112394325A/en
Application granted granted Critical
Publication of CN112394325B publication Critical patent/CN112394325B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/18Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic, or infrasonic waves
    • G01S5/24Position of single direction-finder fixed by determining direction of a plurality of spaced sources of known location

Abstract

The invention provides a Doppler frequency offset estimation system, a Doppler frequency offset estimation method and a Doppler frequency offset estimation device for ultrasonic positioning signals. The method comprises the following steps: receiving a main ultrasonic positioning signal, a secondary ultrasonic positioning signal and a frequency calibration signal which are transmitted by an ultrasonic transmitting unit; calculating the Doppler frequency offset of the frequency calibration signal in a phase-locked loop mode; and calculating the Doppler frequency offset of the main ultrasonic positioning signal and the secondary ultrasonic positioning signal based on the Doppler frequency offset of the first central frequency, the second central frequency and the frequency calibration signal, wherein the Doppler frequency offset of the main ultrasonic positioning signal is equal to that of the secondary ultrasonic positioning signal. Frequency offset correction aiming at the main ultrasonic positioning signal and the secondary ultrasonic positioning signal is realized based on the frequency calibration signal, so that the cost can be saved.

Description

Doppler frequency offset estimation system, method and device for ultrasonic positioning signal
Technical Field
The embodiment of the invention relates to the technical field of positioning, in particular to a Doppler frequency offset estimation system, a Doppler frequency offset estimation method and a Doppler frequency offset estimation device for ultrasonic positioning signals.
Background
With the increasing demand of personal navigation and positioning services, indoor positioning systems have been expanded from initial positioning functions to many aspects, such as business services and security management, which have requirements for higher positioning accuracy and wider coverage area for the navigation positioning of people in various environments. At present, an ultrasonic positioning system becomes one of mainstream positioning systems due to high positioning accuracy and a simple structure which can reach centimeter level, but the ultrasonic positioning system facing a large indoor scene usually needs a plurality of ultrasonic transmitting units to cooperate to completely cover the positioning service in the area.
With respect to the problem of eliminating or reducing the doppler effect of a predetermined spatial localization system, the current solutions are generally: the Doppler shift is estimated and the estimated frequency deviation is compensated. For the estimation of the doppler frequency offset, many solutions have been proposed in the industry and academia, such as adding a measuring device to directly calculate the frequency offset, adding an additional receiver to calculate the frequency offset, and estimating the joint doppler frequency offset and carrier frequency offset based on three-dimensional beamforming.
However, the frequency offset is directly calculated by adding an additional single device, so that the cost is greatly increased.
Disclosure of Invention
In view of this, the embodiments of the present invention provide a system, a method and an apparatus for estimating doppler frequency offset of an ultrasonic positioning signal.
The technical scheme of the embodiment of the invention is as follows:
a system for doppler frequency offset estimation of an ultrasonic locating signal, comprising:
the ultrasonic transmitting unit comprises a main transmitting module, a secondary transmitting module and a controller; the main transmitting module comprises a main ultrasonic transmitter and a frequency calibration signal transmitter; the secondary transmitting module comprises at least three secondary ultrasonic transmitters; a primary ultrasound transmitter is arranged at the geometric center of the at least three secondary ultrasound transmitters, and frequency calibration signal transmitters are arranged at the periphery of the primary ultrasound transmitter; the main ultrasonic emitter is used for emitting a main ultrasonic positioning signal; the frequency calibration signal transmitter is used for transmitting a frequency calibration signal; the secondary ultrasonic emitter is used for emitting a secondary ultrasonic positioning signal; the controller is used for controlling the main ultrasonic transmitter, the frequency calibration signal transmitter and the secondary ultrasonic transmitter to simultaneously transmit according to preset frequency; wherein the primary and secondary ultrasonic locating signals are modulated onto a first carrier having a first center frequency; modulating a frequency calibration signal onto a second carrier wave with a second center frequency, wherein the second center frequency is greater than the first center frequency, the first carrier wave and the second carrier wave are not overlapped, and the frequency calibration signal is a narrow-band signal;
the intelligent terminal is used for receiving the main ultrasonic positioning signal, the secondary ultrasonic positioning signal and the frequency calibration signal transmitted by the ultrasonic transmitting unit, calculating the Doppler frequency offset of the frequency calibration signal in a phase-locked loop mode, and calculating the Doppler frequency offset of the main ultrasonic positioning signal and the secondary ultrasonic positioning signal based on the Doppler frequency offset of the first central frequency, the second central frequency and the frequency calibration signal, wherein the Doppler frequency offset of the main ultrasonic positioning signal is equal to the Doppler frequency offset of the secondary ultrasonic positioning signal.
A Doppler frequency offset estimation method of ultrasonic positioning signals is suitable for Doppler frequency offset estimation of ultrasonic positioning signals transmitted by an ultrasonic transmitting unit, wherein the ultrasonic transmitting unit comprises a main transmitting module, a secondary transmitting module and a controller; the main transmitting module comprises a main ultrasonic transmitter and a frequency calibration signal transmitter; the secondary transmitting module comprises at least three secondary ultrasonic transmitters; a primary ultrasound transmitter is arranged at the geometric center of the at least three secondary ultrasound transmitters, and frequency calibration signal transmitters are arranged at the periphery of the primary ultrasound transmitter; the main ultrasonic emitter is used for emitting a main ultrasonic positioning signal; the frequency calibration signal transmitter is used for transmitting a frequency calibration signal; the secondary ultrasonic emitter is used for emitting a secondary ultrasonic positioning signal; the controller is used for controlling the main ultrasonic transmitter, the frequency calibration signal transmitter and the secondary ultrasonic transmitter to simultaneously transmit according to preset frequency; wherein the primary and secondary ultrasonic locating signals are modulated onto a first carrier having a first center frequency; modulating a frequency calibration signal onto a second carrier wave with a second center frequency, wherein the second center frequency is greater than the first center frequency, the first carrier wave and the second carrier wave are not overlapped, and the frequency calibration signal is a narrow-band signal; the method comprises the following steps:
receiving a main ultrasonic positioning signal, a secondary ultrasonic positioning signal and a frequency calibration signal which are transmitted by an ultrasonic transmitting unit;
calculating the Doppler frequency offset of the frequency calibration signal in a phase-locked loop mode;
and calculating the Doppler frequency offset of the main ultrasonic positioning signal and the secondary ultrasonic positioning signal based on the Doppler frequency offset of the first central frequency, the second central frequency and the frequency calibration signal, wherein the Doppler frequency offset of the main ultrasonic positioning signal is equal to that of the secondary ultrasonic positioning signal.
An apparatus for estimating doppler frequency offset of an ultrasonic locating signal, comprising a processor, a memory and a computer program stored on the memory and executable on the processor, wherein the computer program, when executed by the processor, implements the steps of the method for estimating doppler frequency offset of an ultrasonic locating signal as described in any one of the above.
A computer readable storage medium, on which a computer program is stored which, when being executed by a processor, carries out the steps of the method of doppler frequency offset estimation of ultrasound positioning signals as set forth in any of the above.
From the above technical solutions, embodiments of the present invention provide a system, a method, and an apparatus for estimating doppler frequency offset of an ultrasonic positioning signal. The method comprises the following steps: receiving a main ultrasonic positioning signal, a secondary ultrasonic positioning signal and a frequency calibration signal which are transmitted by an ultrasonic transmitting unit; calculating the Doppler frequency offset of the frequency calibration signal in a phase-locked loop mode; and calculating the Doppler frequency offset of the main ultrasonic positioning signal and the secondary ultrasonic positioning signal based on the Doppler frequency offset of the first central frequency, the second central frequency and the frequency calibration signal, wherein the Doppler frequency offset of the main ultrasonic positioning signal is equal to that of the secondary ultrasonic positioning signal. Therefore, frequency offset correction aiming at the ultrasonic positioning signal is realized based on the frequency calibration signal, additional monomer equipment is not required to be introduced, and cost can be saved. Moreover, the intensity comparison results of the signals are calibrated according to the frequencies of different ultrasonic transmitting units so as to select different positioning strategies, and the positioning precision can be improved. In addition, the correction of Doppler frequency offset is added into the positioning system, so that the positioning effect is improved. In addition, the intelligent terminal in the weak positioning signal area is accurately positioned, and the wide coverage of the ultrasonic positioning system is improved.
Drawings
FIG. 1 is an exemplary block diagram of an ultrasound positioning system according to the present invention.
Fig. 2 is an exemplary block diagram of an ultrasound transmission unit according to the present invention.
Fig. 3 is an exemplary frequency distribution plot of an ultrasound locating signal and a frequency calibration signal in accordance with the present invention.
FIG. 4 is an exemplary flow chart for determining a Doppler shift of an ultrasonic locating signal in accordance with the present invention.
Fig. 5 is a schematic diagram of the distribution of the positioning signals of the ultrasonic transmitting unit network according to the invention.
Fig. 6 is a flow chart of a first positioning strategy according to the present invention.
Fig. 7 is a flow chart of a second positioning strategy according to the present invention.
Fig. 8 is a flow chart of a third positioning strategy according to the present invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention is further described in detail with reference to the accompanying drawings.
For simplicity and clarity of description, the invention will be described below by describing several representative embodiments. Numerous details of the embodiments are set forth to provide an understanding of the principles of the invention. It will be apparent, however, that the invention may be practiced without these specific details. Some embodiments are not described in detail, but rather are merely provided as frameworks, in order to avoid unnecessarily obscuring aspects of the invention. Hereinafter, "including" means "including but not limited to", "according to … …" means "at least according to … …, but not limited to … … only". In view of the language convention of chinese, the following description, when it does not specifically state the number of a component, means that the component may be one or more, or may be understood as at least one.
The embodiment of the invention provides a positioning scheme for self-adapting a positioning strategy based on the intensity of an ultrasonic positioning signal. In addition, the embodiment of the invention also provides an ultrasonic positioning system based on Doppler frequency offset correction in a complex environment, which can perform double verification on each ultrasonic positioning signal in an overlapping area of a plurality of ultrasonic positioning signals by using the Doppler frequency offset of the frequency calibration signal. Moreover, in the embodiment of the invention, based on Doppler frequency offset correction, the ultrasonic transmitting set is created by using a super-resolution method, so that the intelligent terminal in the weak positioning signal area is accurately positioned, and the wide coverage of the ultrasonic positioning system is further improved.
FIG. 1 is an exemplary block diagram of an ultrasound positioning system according to the present invention.
As shown in fig. 1, the system includes:
a plurality of ultrasound transmission units arranged at respective fixed positions, each for transmitting a respective ultrasound localization signal;
the intelligent terminal is used for comparing the intensity of the ultrasonic positioning signals received from the ultrasonic transmitting units and determining to execute one of the following positioning strategies based on the comparison result: the intensity of the ultrasonic positioning signal transmitted by one ultrasonic transmitting unit is obviously stronger than that of the ultrasonic positioning signals transmitted by other ultrasonic transmitting units; a second positioning strategy that at least two ultrasonic transmitting units transmit strong ultrasonic positioning signals; and the weak ultrasonic positioning signals transmitted by the at least two ultrasonic transmitting units are mutually mashup.
In one embodiment, the number of the ultrasound transmission units is 4, and the arrangement points of the 4 ultrasound transmission units constitute a square.
In one embodiment, the ultrasound localization signals include a primary ultrasound localization signal, a secondary ultrasound localization signal, and a frequency calibration signal (the frequency calibration signal is also an ultrasound signal); the ultrasonic transmitting unit comprises a main transmitting module, a secondary transmitting module and a controller; the main transmitting module comprises a main ultrasonic transmitter and a frequency calibration signal transmitter; the secondary transmitting module comprises at least three secondary ultrasonic transmitters; a primary ultrasound transmitter disposed at a geometric center of at least three secondary ultrasound transmitters, a frequency calibration signal transmitter disposed at a periphery of (e.g., attached to) the primary ultrasound transmitter; the main ultrasonic emitter is used for emitting a main ultrasonic positioning signal; the frequency calibration signal transmitter is used for transmitting a frequency calibration signal; the secondary ultrasonic emitter is used for emitting a secondary ultrasonic positioning signal; the controller is used for controlling the main ultrasonic transmitter, the frequency calibration signal transmitter and the secondary ultrasonic transmitter to simultaneously transmit according to preset frequency.
In one embodiment, the intelligent terminal is configured to:
when the difference value between the amplitude of the frequency calibration signal transmitted by one ultrasonic transmitting unit and the amplitude of the frequency calibration signal transmitted by the ultrasonic transmitting units except the ultrasonic transmitting unit is larger than a preset first threshold value, determining to execute a first positioning strategy; or
When the amplitudes of the frequency calibration signals transmitted by the two ultrasonic transmitting units are both larger than a preset second threshold value and the difference value of the frequency calibration signals transmitted by the two ultrasonic transmitting units is smaller than a preset third threshold value, determining to execute a second positioning strategy;
and when the amplitude of the frequency calibration signal transmitted by each ultrasonic transmitting unit is smaller than a preset fourth threshold, or the difference value of the amplitudes of the frequency calibration signals transmitted by any two ultrasonic transmitting units is smaller than a preset fifth threshold, determining to execute a third positioning strategy. Preferably, the first positioning policy includes: calculating the Doppler frequency offset of the main ultrasonic positioning signal transmitted by the ultrasonic transmitting unit which is obviously stronger than the intensity of other ultrasonic positioning signals; performing frequency offset correction on the main ultrasonic positioning signal and the secondary ultrasonic positioning signal which are transmitted by the ultrasonic transmitting unit and have the intensity which is obviously stronger than that of other ultrasonic positioning signals by using the Doppler frequency offset; selecting three secondary ultrasonic positioning signals from the secondary ultrasonic positioning signals after the frequency offset correction according to the sequence of the signal-to-noise ratio from large to small; and calculating the coordinates of the intelligent terminal based on the frequency offset corrected main ultrasonic positioning signal and the selected three secondary ultrasonic positioning signals. Preferably, the second positioning strategy comprises: calculating respective Doppler frequency offsets of frequency calibration signals transmitted by at least two ultrasonic transmitting units for transmitting strong ultrasonic positioning signals; respectively carrying out frequency offset correction on the frequency calibration signals transmitted by the at least two ultrasonic transmitting units by using respective Doppler frequency offsets; comparing the signal-to-noise ratios of the main ultrasonic positioning signals of the at least two ultrasonic transmitting units after the frequency offset correction, and selecting the ultrasonic transmitting unit corresponding to the main ultrasonic positioning signal with the largest signal-to-noise ratio as a target ultrasonic transmitting unit; selecting three secondary ultrasonic positioning signals from the secondary ultrasonic positioning signals after the frequency offset correction of the target ultrasonic transmitting unit according to the sequence of the signal-to-noise ratio from large to small; and calculating the coordinates of the intelligent terminal based on the main ultrasonic positioning signal and the selected three secondary ultrasonic positioning signals after the frequency offset correction of the target ultrasonic transmitting unit. Preferably, the third positioning strategy comprises: calculating respective Doppler frequency offsets of the frequency calibration signals transmitted by all the ultrasonic transmitting units; respectively carrying out frequency offset correction on the frequency calibration signals transmitted by all the ultrasonic transmitting units by utilizing the respective Doppler frequency offsets; and calculating the coordinates of the intelligent terminal based on the frequency calibration signals which are corrected by the frequency offset and transmitted by all the ultrasonic transmitting units.
Fig. 2 is an exemplary block diagram of an ultrasound transmission unit according to the present invention. The ultrasound transmission unit includes: the ultrasonic diagnosis device comprises a main ultrasonic transmitting module, a secondary ultrasonic transmitting module and a controller. The primary ultrasonic transmitting module comprises a primary ultrasonic transmitter and a frequency calibration signal transmitter, and the secondary ultrasonic transmitting module comprises at least three secondary ultrasonic transmitters. The primary ultrasound transmitter is disposed at the geometric center of each secondary ultrasound transmitter and the frequency calibration signal transmitter is located next to the primary ultrasound transmitter. Exemplarily, in fig. 2, the respective secondary ultrasound generators are arranged at respective vertices of a cross centered on the primary ultrasound transmitter. In fact, each secondary ultrasound generator may be disposed on a geometric shape such as a circle, a triangle, a hexagon, etc. centered on the primary ultrasound transmitter, which is not limited by the embodiments of the present invention.
The main ultrasonic emitter is used for emitting a main ultrasonic positioning signal S0,kContaining the positioning information and the ID of the ultrasound transmission unit, where k denotes the kth ultrasound transmission unit. The frequency calibration signal transmitter is used for transmitting a frequency calibration signal Sf,k;Sf,kRepresenting the frequency calibration signal S of the kth ultrasound transmission unitf. Four secondary ultrasonic transmitters, each for transmitting a secondary ultrasonic positioning signal, S, containing positioning information1,k、S2,k、S3,k、S4,kIn which S is1,kFor the kth ultrasonic emissionA secondary ultrasound locating signal emitted by a 1 st secondary ultrasound transmitter of the unit; s2,kA secondary ultrasound locating signal at a 2 nd secondary ultrasound transmitter frequency of a kth ultrasound transmitting unit; and so on. The controller is used for controlling all the transmitters (including the main ultrasonic transmitter, the frequency calibration signal transmitter and the secondary ultrasonic transmitter) to simultaneously transmit signals according to preset frequencies, and can be regarded as the clock synchronization of the ultrasonic transmitting unit networking.
The doppler frequency offset estimation process of the ultrasonic positioning signal is explained below.
Assume that in one ultrasound transmission unit shown in fig. 2: the main ultrasonic emitter emits a main ultrasonic positioning signal S0,S0The ID of the ultrasonic transmitting unit and the positioning information are contained; frequency calibration signal transmitter transmits a frequency calibration signal Sf,kWherein k represents the kth ultrasound transmission unit; the secondary ultrasonic emitter emits a secondary ultrasonic locating signal S1、S2、S3、S4In which S is1、S2、S3、S4Respectively containing positioning information; the controller is used for controlling all the transmitters (including the main ultrasonic transmitter, the secondary ultrasonic transmitter and the frequency calibration signal transmitter) to simultaneously transmit signals according to a preset frequency, and can be regarded as the clock synchronization of the ultrasonic transmitting unit networking.
Fig. 3 is an exemplary frequency distribution plot of an ultrasound locating signal and a frequency calibration signal in accordance with the present invention.
As can be seen in fig. 3, wherein:
(1) characteristics of the primary and secondary ultrasound localization signals:
assuming that the same ultrasound transmitting unit comprises one main ultrasound transmitter and four sub-ultrasound transmitters, the main ultrasound locating signal and the sub-ultrasound locating signal S transmitted by the ultrasound transmitting unit0,S1,S2,S3,S4Including a main ultrasonic locating signal S0And four secondary ultrasonic positioning signals S1、S2、S3、S4. Primary and secondary ultrasonic locating signals S0,S1,S2,S3,S4Are respectively implemented as CDMThe A orthogonal spread spectrum code has a baseband bandwidth of 1500Hz, can simultaneously serve a plurality of users without information conflict, and can be used as a signal time synchronization technology to measure the arrival time of a signal. The baseband signals of the primary and secondary ultrasonic transmitters are both modulated to a frequency FC,0On a 18500Hz carrier wave, ultrasonic locating signal S0,S1,S2,S3,S4The occupied band bandwidth is 3 kilohertz (KHz), and the frequency range is 17KHz-20 KHz.
(2) Frequency calibration signal characteristics:
transmitting an ultrasonic locating signal S0,S1,S2,S3,S4The ultrasound transmission unit of (a) also transmits a frequency calibration signal. The frequency calibration signal is implemented as BPSK modulated Gold code using a frequency band greater than 20KHz (i.e., greater than the maximum frequency of the ultrasonic positioning signal). Each frequency calibration signal bandwidth occupies hundreds of Hz, and the preferred bandwidth interval is [200Hz,500Hz ]]And a narrowband signal.
When multiple ultrasound transmission units are included in an ultrasound positioning system, then there are multiple frequency calibration signals S of different center frequenciesf,k(ii) a Where k denotes the kth ultrasound transmission unit. Frequency calibration signal S of 1 st ultrasonic transmitting unitf,1Having a center frequency of FC,1(ii) a Frequency calibration signal S of 2 nd ultrasonic transmitting unitf,2Having a center frequency of FC,2.... and so on, the frequency calibration signal S of the kth ultrasound transmission unitf,kHaving a center frequency of FC,kAnd k is a positive integer of at least 1.
A guard interval is arranged between two adjacent frequency calibration signals, the bandwidth of the guard interval occupying a few hundred Hz, preferably 200Hz-400 Hz. The center frequencies may be set in advance for the frequency calibration signals corresponding to the respective ultrasonic transmission units, respectively, so that it is possible to determine to which ultrasonic transmission unit the detected frequency calibration signal corresponds by detecting the center frequency of the frequency calibration signal.
For example, the correspondence between the number of the ultrasound transmission unit and the frequency calibration signal transmitted by the ultrasound transmission unit is set in such a manner that the center frequency increases.Examples are: sf,1Central frequency F ofC,120600 Hz; sf,2Central frequency F ofC,2(20000+600 x 2) Hz; … Sf,kCentral frequency F ofC,kIs (20000+600k) Hz, wherein Sf,kOccupies 375Hz bandwidth; then, adjacent Sf,kThe transmitting frequency bands are sequentially separated by 600Hz, namely the guard bandwidth between two adjacent groups of frequency calibration signals is 225 Hz.
In fig. 3, the frequency range of the rectangular frame 60 is 17KHZ to 20KHZ, which is the carrier frequency band of the ultrasonic positioning signal. To the right of the rectangular frame 60 are shown exemplary four small rectangular frames. After the corresponding relation between the serial number of the ultrasonic transmitting unit and the frequency calibration signal transmitted by the ultrasonic transmitting unit is set in a mode of increasing the central frequency, the four small rectangular frames are sequentially four frequency calibration signals Sf,1、Sf,2、Sf,3And Sf,4. Wherein, in the order of the direction of the rectangular frame 60, the frequency ranges corresponding to the four small rectangular frames are Sf,1、Sf,2、Sf,3And Sf,4The carrier band of (c). The frequency range of the rectangular frame 70 farthest from the rectangular frame 60 is Sf,4The carrier frequency band of (c); the frequency range of the rectangular frame 61 closest to the rectangular frame 60 is Sf,1The carrier band of (c). That is, the nth small rectangular frame detected based on the direction of the distance from the rectangular frame 60 is the frequency calibration signal of the nth ultrasound transmitting unit.
While four frequency calibration signals corresponding to four ultrasound transmitting units are exemplarily described above, those skilled in the art can appreciate that as the number of ultrasound transmitting units increases, the number of frequency calibration signals also increases accordingly, and the embodiment of the present invention is not limited thereto.
FIG. 4 is an exemplary flow chart for determining a Doppler shift of an ultrasonic locating signal in accordance with the present invention. The method is suitable for performing Doppler frequency offset estimation on an ultrasonic transmitting unit, wherein the ultrasonic transmitting unit comprises a main transmitting module, a secondary transmitting module and a controller; the main transmitting module comprises a main ultrasonic transmitter and a frequency calibration signal transmitter; the secondary transmitting module comprises at least three secondary ultrasonic transmitters; a primary ultrasound transmitter is arranged at the geometric center of the at least three secondary ultrasound transmitters, and frequency calibration signal transmitters are arranged at the periphery of the primary ultrasound transmitter; the main ultrasonic emitter is used for emitting a main ultrasonic positioning signal; the frequency calibration signal transmitter is used for transmitting a frequency calibration signal which is also an ultrasonic signal; the secondary ultrasonic emitter is used for emitting a secondary ultrasonic positioning signal; the controller is used for controlling the main ultrasonic transmitter, the frequency calibration signal transmitter and the secondary ultrasonic transmitter to simultaneously transmit according to preset frequency; the method comprises the following steps:
step 401: receiving a main ultrasonic positioning signal, a secondary ultrasonic positioning signal and a frequency calibration signal which are transmitted by the ultrasonic transmitting unit; wherein the primary and secondary ultrasonic locating signals are modulated onto a first carrier having a first center frequency; modulating a frequency calibration signal onto a second carrier wave with a second center frequency, wherein the second center frequency is greater than the first center frequency, the first carrier wave and the second carrier wave are not overlapped, and the frequency calibration signal is a narrow-band signal;
step 402: the doppler frequency offset of the frequency calibration signal is calculated by a Phase Lock Loop (PLL) method.
Step 403: and calculating the Doppler frequency offset of the main ultrasonic positioning signal and the secondary ultrasonic positioning signal based on the Doppler frequency offset of the first central frequency, the second central frequency and the frequency calibration signal, wherein the Doppler frequency offset of the main ultrasonic positioning signal is equal to that of the secondary ultrasonic positioning signal.
Specifically, the method comprises the following steps: firstly, calculating a frequency calibration signal S of a kth (k is a positive integer greater than or equal to 1) ultrasonic transmitting unit by using a phase-locked loop (PLL)f,kDoppler frequency shift FD,k(ii) a Then, calculating the Doppler frequency offset F of the main ultrasonic positioning signal of the kth ultrasonic transmitting unitD,0Wherein:
Figure BDA0002169513370000101
the Doppler frequency offset of the main ultrasonic positioning signal and the secondary ultrasonic positioning signal of the same ultrasonic transmitting unit is equal and is FD,0;FC,0Is the center frequency of the first carrier; fC,kIs the center of the second carrierFrequency. As can be seen, the number of the first carriers is one, and all the primary ultrasonic positioning signals and all the secondary ultrasonic positioning signals of all the ultrasonic transmitting units are carried on the first carriers; the number of the second carriers is equal to the number of the ultrasonic transmitting units, wherein one second carrier corresponds to one ultrasonic transmitting unit.
For example, when k is 1, the signal S is calibrated based on the frequency of the 1 st ultrasound transmission unitf,1Calculating the Doppler frequency offset of the ultrasonic positioning signal of the 1 st ultrasonic transmitting unit to be FD,1. Then, calculating the Doppler frequency offset F of the ultrasonic positioning signal of the 1 st ultrasonic transmitting unitD,0Wherein
Figure BDA0002169513370000102
FC,0Is the center frequency of the first carrier; fC,1Starting from the direction of the rectangle 60 away, the center frequency of the first subcarrier 61.
For example, when k is 2, the signal S is calibrated based on the frequency of the 2 nd ultrasound transmission unitf,2Calculating the Doppler frequency offset of the ultrasonic positioning signal of the 2 nd ultrasonic transmitting unit to be FD,2. Then, calculating Doppler frequency offset F of ultrasonic positioning signal of 2 nd ultrasonic transmitting unitD,0Wherein
Figure BDA0002169513370000103
FC,0Is the center frequency of the first carrier; fC,1Starting from the direction of the rectangle 60 away, the center frequency of the second subcarrier 62.
When the above doppler frequency offset calculation method is applied to an ultrasonic positioning system, the following steps may be performed: the method comprises the following steps: in the ultrasonic positioning system, an ultrasonic emitter emits an ultrasonic positioning signal, a frequency calibration signal emitter emits a frequency calibration signal at the same time, and all signals are synchronously emitted; step two: the intelligent terminal receives an ultrasonic positioning signal and a frequency calibration signal; step three: the intelligent terminal calculates the Doppler frequency offset of the frequency calibration signal; step four: the intelligent terminal estimates the Doppler frequency offset of the ultrasonic positioning signal based on the Doppler frequency offset of the frequency calibration signal; step five: compensating ultrasonic positioning signalThe Doppler frequency offset of the intelligent terminal is calculated by utilizing the CDMA technology; step six: estimating the relative position of the intelligent terminal by using a TDOA algorithm; step seven: and obtaining the coordinates of the intelligent terminal in the indoor environment, and realizing the accurate positioning of the intelligent terminal. Exemplary, the correction process includes: firstly, the band pass filtering is carried out on the frequency band where the target signal is located so as to eliminate out-of-band noise and interference. Multiplying the signal after band-pass filtering by the original sending carrier wave and performing low-pass filtering to obtain a target baseband signal S (n) which is not subjected to frequency offset correction; for the signal to be corrected, the frequency offset correction formula is:
Figure BDA0002169513370000111
wherein S (n) is the nth value of the complex sequence of the target signal demodulated to the baseband, FDIs the frequency offset, F, of the estimated target signalSFor the frequency at which the audio signal is sampled,
Figure BDA0002169513370000112
and the nth value of the target signal is obtained after the frequency offset correction.
Fig. 5 is a schematic diagram of the distribution of the positioning signals of the ultrasonic transmitting unit network according to the invention. In fig. 5, four ultrasound transmission units as shown in fig. 2 are included, respectively ultrasound transmission unit 10, ultrasound transmission unit 20, ultrasound transmission unit 30, and ultrasound transmission unit 40, wherein ultrasound transmission unit 10, ultrasound transmission unit 20, ultrasound transmission unit 30, and ultrasound transmission unit 40 are respectively arranged on the vertices of a square.
The shadowless area 41, the shadowless area 42, the shadowless area 43 and the shadowless area 44 respectively have a strongest ultrasonic positioning signal, which can be approximately regarded as that the intelligent terminal only receives the ultrasonic positioning signal service of the ultrasonic transmitting unit above the corresponding area, thereby achieving a better accurate positioning effect. For example, in the unshaded area 41, the ultrasonic positioning signal transmitted by the ultrasonic transmitting unit 10 has the strongest signal, so that the intelligent terminal roaming to the unshaded area 41 can be regarded as only receiving the ultrasonic positioning signal service of the ultrasonic transmitting unit 10; in the unshaded area 42, the ultrasonic positioning signal transmitted by the ultrasonic transmitting unit 20 has the strongest signal, so that the intelligent terminal roaming to the unshaded area 42 can be regarded as only receiving the ultrasonic positioning signal service of the ultrasonic transmitting unit 20; in the unshaded area 43, the ultrasonic positioning signal transmitted by the ultrasonic transmitting unit 30 has the strongest signal, so that the intelligent terminal roaming in the unshaded area 43 can be regarded as only receiving the ultrasonic positioning signal service of the ultrasonic transmitting unit 30; in the unshaded area 44, the ultrasonic locating signal transmitted by the ultrasonic transmitting unit 40 has the strongest signal, so the intelligent terminal roaming in the unshaded area 44 can be regarded as only receiving the ultrasonic locating signal service of the ultrasonic transmitting unit 40.
In the unshaded area 41, the unshaded area 42, the unshaded area 43, and the unshaded area 44, a first positioning strategy is performed in which the intensity of the ultrasonic positioning signal transmitted by one ultrasonic transmission unit is significantly stronger than the intensity of the ultrasonic positioning signal transmitted by the other ultrasonic transmission unit.
In diagonally shaded area 51, diagonally shaded area 52, diagonally shaded area 53, and diagonally shaded area 54, there are a plurality of strong ultrasonic locating signals. Also, in the square shaded area 60, there are a plurality of weak positioning signal mashups. In each of the diagonally shaded area 51, the diagonally shaded area 52, the diagonally shaded area 53, the diagonally shaded area 54, and the square shaded area 60, there is a large amount of interference, and the positioning effect is generally not good. For this purpose, the embodiment of the present invention implements the second positioning strategy in which at least two ultrasound transmitting units transmit strong ultrasound positioning signals in the diagonally shaded area 51, the diagonally shaded area 52, the diagonally shaded area 53, and the diagonally shaded area 54.
In the square hatched area 60, a third positioning strategy of mutually mashup of weak ultrasonic positioning signals emitted by the plurality of ultrasonic emitting units is performed. When the intelligent terminal roams to the networking environment of the ultrasonic emission unit, the intelligent terminal determines to adopt a first positioning strategy, a second positioning strategy or a third positioning strategy based on the intensity of the received ultrasonic positioning signal. Since the frequency calibration signal has a better reference value and detection range than the primary ultrasonic positioning signal and the secondary ultrasonic positioning signal, the frequency calibration signal is preferably used as a signal basis for determining whether to adopt the first positioning strategy, the second positioning strategy or the third positioning strategy.
Assume that the frequency calibration signal has N sampling points, Af,1、Af,2、......、Af,kThe amplitude of the frequency calibration signal collected for each sampling point represents the magnitude of the frequency calibration signal energy collected for each sampling point, in dB.
Area judgment conditions:
Figure BDA0002169513370000121
wherein the content of the first and second substances,
Figure BDA0002169513370000122
is Af,iIs determined by the average value of (a) of (b),
Figure BDA0002169513370000123
is Af,jAverage value of (d); if the condition is met
Figure BDA0002169513370000131
The signal intensities of the two ultrasonic transmitting units are considered to be equivalent; on the contrary, the signal intensity of one ultrasonic transmitting unit is considered to be significantly greater than that of the other ultrasonic transmitting unit, and the intelligent terminal is judged to be closer to the transmitter of the stronger frequency calibration signal.
Intelligent terminal resolves average amplitude of received frequency calibration signal
Figure BDA0002169513370000132
And a comparison is made. When no j signal meets the judgment condition for any i signal, namely the intelligent terminal is in the unshaded area 41, the unshaded area 42, the unshaded area 43 or the unshaded area 44, determining to adopt a first positioning strategy; when only one pair of i and j meets the judgment condition, the intelligent terminal is positioned in a slash shadow area 51, a slash shadow area 52, a slash shadow area 53 and a slash shadow area 54, so that a second positioning strategy is determined to be adopted; when for any i signal, storeIf the 3 j signals meet the above area judgment condition, that is, the signal strength is equivalent, the intelligent terminal is in the square shadow area 60, and therefore, the third positioning strategy is determined to be adopted.
The first positioning strategy, the second positioning strategy and the third positioning strategy are respectively explained in detail below.
1. A first positioning strategy:
in the unshaded area 41, the unshaded area 42, the unshaded area 43, and the unshaded area 44, the judgment condition that the intensity of the ultrasonic positioning signal transmitted by one ultrasonic transmitting unit is significantly stronger than the intensity of the ultrasonic positioning signal transmitted by the other ultrasonic transmitting unit is satisfied, respectively, and thus the first positioning strategy is executed in the unshaded area 41, the unshaded area 42, the unshaded area 43, and the unshaded area 44.
In the unshaded area 41, the unshaded area 42, the unshaded area 43 and the unshaded area 44, since the installation height of the ultrasonic transmitting unit is much larger than the distance between the main ultrasonic transmitter and the secondary ultrasonic transmitter, the doppler frequency shifts generated by the motion state of the intelligent terminal relative to the ultrasonic transmitting units are very close, and it can be assumed that the doppler frequency shifts of the ultrasonic positioning signals received by the intelligent terminal are equal.
The method comprises the following steps: intelligent terminal resolves average amplitude of received frequency calibration signal
Figure BDA0002169513370000133
And a comparison is made. When there is no j signal meeting the judgment condition for any i signal
Figure BDA0002169513370000134
i≠j,i∈[1,k],j∈[1,k]Namely, the intelligent terminal is in an unshaded area 41, an unshaded area 42, an unshaded area 43 and an unshaded area 44.
Step two: estimating Doppler frequency offset F of each main ultrasonic positioning signal by using phase-locked loop (PLL)D,0,kFrequency deviation correction can be carried out on the original main ultrasonic positioning signal and the secondary ultrasonic positioning signal, wherein k represents the kth ultrasonic transmitting unit;
step three: based on the CDMA communication principle, obtaining the time for the ultrasonic positioning signal after the frequency offset correction to reach the intelligent terminal;
step four: based on the TDOA positioning principle, the accurate positioning of the intelligent terminal is realized.
The first positioning strategy is explained below by way of example.
In fig. 5, it is assumed that the 1 st ultrasonic transmission unit (i.e., the ultrasonic transmission unit 10) is arranged in the unshaded region 41 in the upper left corner, the 2 nd ultrasonic transmission unit (i.e., the ultrasonic transmission unit 20) is arranged in the unshaded region 42 in the upper right corner, the 3 rd ultrasonic transmission unit (i.e., the ultrasonic transmission unit 30) is arranged in the unshaded region 43 in the lower left corner, and the 4 th ultrasonic transmission unit (i.e., the ultrasonic transmission unit 40) is arranged in the unshaded region 44 in the lower right corner.
Assuming that the intelligent terminal is located in the unshaded area 41 at the upper left corner, the intelligent terminal receives the ultrasonic positioning signal and the frequency calibration signal of the 1 st ultrasonic transmitting unit and the adjacent ultrasonic transmitting units around the ultrasonic transmitting unit.
The method comprises the following steps: the intelligent terminal resolves the average amplitude of each received frequency calibration signal
Figure BDA0002169513370000141
Finding a frequency calibration signal transmitted by an ultrasound transmission unit 10
Figure BDA0002169513370000142
Is much larger than the average amplitude of the frequency calibration signals transmitted by other ultrasound transmitting units, then the intelligent terminal is in the upper left-hand non-shaded area 41 and decides to adopt the first positioning strategy.
Step two: the intelligent terminal uses a phase-locked loop (pll) to estimate the doppler frequency offset F of the main ultrasonic positioning signal of the ultrasonic transmitting unit 10 (i.e. the 1 st ultrasonic transmitting unit, K is 1)D,0,1
Step three: at this time, the frequency shifts of the primary and secondary ultrasonic positioning signals of the 1 st ultrasonic transmitting unit are equal, i.e., FD,0,1≈FD,1,1≈FD,2,1≈FD,3,1≈FD,4,1Therefore, it should beBy FD,0,1And correcting the frequency deviation of all the ultrasonic positioning signals (including the primary ultrasonic positioning signal and the secondary ultrasonic positioning signal) of the 1 st ultrasonic transmitting unit.
Step four: the intelligent terminal analyzes the ID of the transmitting unit based on the CDMA technology and calculates the main positioning signal after frequency offset correction
Figure BDA0002169513370000151
Delay time t to reach intelligent terminal0
Step five: the intelligent terminal calculates the secondary positioning signal after each frequency offset correction based on the ID of the transmitting unit and the CDMA technology
Figure BDA0002169513370000152
Selecting three corrected secondary positioning signals with the maximum SNR as a first secondary positioning signal, a second secondary positioning signal and a third secondary positioning signal respectively;
step six: the intelligent terminal respectively calculates the first delay time t of the first positioning signal to reach the intelligent terminal based on the CDMA technology1Second delay time t when second positioning signal reaches intelligent terminal2And a third delay time t when the third positioning signal reaches the intelligent terminal3
Step seven: the intelligent terminal acquires relative coordinates (x) of a first-time ultrasonic transmitter for transmitting a first-time positioning signal to the cloud based on the ID of the transmitting unit1,y1,z1) Relative coordinates (x) of a second ultrasonic transmitter for transmitting a second positioning signal2,y2,z2) Relative coordinates (x) of a third ultrasonic transmitter for transmitting a third locating signal3,y3,z3) Relative coordinates (x) of the primary ultrasound transmitter transmitting the primary locating signal0,y0,z0) (ii) a Based on respective delay times t0,t1,t2,t3And respective relative coordinates (x)0,y0,z0)、(x1,y1,z1)、(x2,y2,z2)、(x3,y3,z3) Computing the phase of an intelligent terminal using a TDOA algorithmTo coordinate (x)c,yc,zc). The intelligent terminal will relative coordinate (x)c,yc,zc) And sending the relative coordinates to a cloud end, wherein the cloud end corresponds the relative coordinates to an indoor map, and shares the relative map to an intelligent terminal in an indoor environment.
2. A second positioning strategy:
in the diagonally shaded area 51, diagonally shaded area 52, diagonally shaded area 53, diagonally shaded area 54, the judgment conditions for at least two ultrasound transmission units to transmit strong ultrasound positioning signals are satisfied, respectively, and thus the second positioning strategy is executed. In the diagonally shaded area 51, the diagonally shaded area 52, the diagonally shaded area 53, and the diagonally shaded area 54, a plurality of strong positioning signal interferences exist.
The method comprises the following steps: intelligent terminal resolves average amplitude of received frequency calibration signal
Figure BDA0002169513370000153
Only one pair of i and j meets the judgment condition
Figure BDA0002169513370000154
i≠j,i∈[1,k],j∈[1,k]Then the intelligent terminal is in diagonally shaded area 51, diagonally shaded area 52, diagonally shaded area 53, diagonally shaded area 54.
Step two: at this time, the phase-locked loop (PLL) is used to calculate the frequency calibration signal Sf,kDoppler frequency shift FD,f,kWherein k represents the kth ultrasound transmission unit;
step three: based on Doppler frequency offset FD,f,kCalculating Doppler frequency offset F of ultrasonic positioning signalD,0,k
Figure BDA0002169513370000161
Wherein, FC,0,kLocating a signal S for ultrasound0,k、S1,k…S4,kThe center frequency of (d); fC,f,kFor frequency-calibrating signal Sf,kThe center frequency of (d);
step four: performing frequency offset correction on the corresponding ultrasonic positioning signals;
step five: the intelligent terminal respectively estimates the signal-to-noise ratio of each frequency offset corrected main ultrasonic positioning signal based on the CDMA technology, and selects the group of positioning signals with larger signal-to-noise ratio;
step six: based on the CDMA communication principle, the time of the ultrasonic positioning signal after frequency offset correction reaching the intelligent terminal is obtained, and based on the TDOA positioning principle, the accurate positioning of the intelligent terminal is realized.
The second positioning strategy is explained below by way of example.
Assuming that the intelligent terminal is in the diagonally shaded area 52, the ultrasonic positioning signals and the frequency calibration signals of the peripheral ultrasonic transmitting units are received.
The method comprises the following steps: intelligent terminal resolves average amplitude of received frequency calibration signal
Figure BDA0002169513370000162
In which only two frequency calibration signals S are presentf,1、Sf,2The condition is met, and the method meets the requirement,
Figure BDA0002169513370000163
it is determined that the intelligent terminal is in diagonally shaded area 52 and decides to employ a second positioning strategy.
Step two: the ultrasonic positioning signals of the 1 st ultrasonic transmitting unit and the 2 nd ultrasonic transmitting unit have similar strength and are obviously larger than the ultrasonic positioning signals of other ultrasonic transmitting units, and the intelligent terminal calculates the frequency calibration signal S of the 1 st ultrasonic transmitting unit and the 2 nd ultrasonic transmitting unit by using a phase-locked loop (PLL)f,1、Sf,2Respective Doppler frequency shift FD,f,1、FD,f,2
Step three: frequency calibration signal S based on 1 st and 2 nd ultrasonic emission unitsf,1、Sf,2Respective Doppler frequency shift FD,f,1、FD,f,2Intelligent terminal application formula
Figure BDA0002169513370000164
Doppler for calculating main ultrasonic positioning signals of 1 st and 2 nd ultrasonic transmitting units respectivelyFrequency deviation FD,0,1、FD,0,2
Step four: doppler frequency offset F of main ultrasonic positioning signal of intelligent terminal based on 1 st ultrasonic transmitting unitD,0,1Performing frequency offset correction on the primary ultrasonic positioning signal and the secondary ultrasonic positioning signal of the 1 st ultrasonic transmitting unit; doppler frequency offset F of main ultrasonic positioning signal of intelligent terminal based on 2 nd ultrasonic transmitting unitD,0,2And frequency deviation correction is carried out on the main ultrasonic positioning signal and the secondary ultrasonic positioning signal of the 2 nd ultrasonic transmitting unit.
Step five: the intelligent terminal analyzes the ID of the transmitting unit based on the CDMA technology and calculates the main positioning signal after each frequency deviation is corrected
Figure BDA0002169513370000171
Selecting the group of positioning signals with larger signal-to-noise ratio (SNR); assuming a positioning signal
Figure BDA0002169513370000172
Has a signal-to-noise ratio greater than
Figure BDA0002169513370000173
And selecting the 1 st ultrasonic transmitting unit to carry out position calculation on the intelligent terminal.
Step six: intelligent terminal calculates main positioning signal after frequency offset correction based on CDMA technology
Figure BDA0002169513370000174
Delay time t to reach intelligent terminal0
Step seven: the intelligent terminal calculates the secondary positioning signal after each frequency offset correction based on the ID of the transmitting unit and the CDMA technology
Figure BDA0002169513370000175
The three corrected sub-positioning signals with the highest SNR are selected as the first sub-positioning signal, the second sub-positioning signal and the third sub-positioning signal, respectively.
Step eight: the intelligent terminal respectively calculates the first positioning signal to reach the intelligent terminal based on the CDMA technologyFirst delay time t of terminal1Second delay time t when second positioning signal reaches intelligent terminal2And a third delay time t when the third positioning signal reaches the intelligent terminal3
Step nine: the intelligent terminal acquires relative coordinates (x) of a first-time ultrasonic transmitter for transmitting a first-time positioning signal to the cloud based on the ID of the transmitting unit1,y1,z1) Relative coordinates (x) of a second ultrasonic transmitter for transmitting a second positioning signal2,y2,z2) Relative coordinates (x) of a third ultrasonic transmitter for transmitting a third locating signal3,y3,z3) Relative coordinates (x) of the primary ultrasound transmitter transmitting the primary locating signal0,y0,z0) (ii) a Based on respective delay times t0,t1,t2,t3And respective relative coordinates (x)0,y0,z0)、(x1,y1,z1)、(x2,y2,z2)、(x3,y3,z3) Calculating relative coordinates (x) of intelligent terminal by using TDOA algorithmc,yc,zc). The intelligent terminal will relative coordinate (x)c,yc,zc) And sending the relative coordinates to a cloud end, wherein the cloud end corresponds the relative coordinates to an indoor map, and shares the relative map to an intelligent terminal in an indoor environment.
3. A third positioning strategy:
in the square hatched area 60, a third positioning strategy of mutually mashup of weak ultrasonic positioning signals emitted by the plurality of ultrasonic emitting units is performed. The square shaded area 60 is a complex environment where there is a plurality of weak localization SIGNAL interferences, the SIGNAL-to-NOISE RATIO (SNR) of each ultrasound localization SIGNAL is low, there are many errors, and the estimation of the SIGNAL arrival time using the CDMA technique has a large error. In the embodiment of the invention, an ultrasonic emission group is created and positioned by utilizing a super-resolution method through the existing ultrasonic positioning system equipment.
The method comprises the following steps: intelligent terminal resolves average amplitude of received frequency calibration signal
Figure BDA0002169513370000181
And a comparison is made. When there are 3 j signals satisfying the above area judgment condition for an arbitrary i signal
Figure BDA0002169513370000182
i≠j,i∈[1,k],j∈[1,k]I.e., the signal strength is comparable, the intelligent terminal is in the square shaded area 60 and determines to employ the third positioning strategy.
Step two, at this time, the phase-locked loop (PLL) is used to calculate the frequency calibration signal Sf,kDoppler frequency shift FD,f,kWherein k represents the kth ultrasound transmission unit;
step three: for corresponding frequency calibration signal Sf,kAnd performing frequency offset correction.
Step four: an ultrasound transmit group is created. The ultrasonic emission group comprises frequency calibration signal emitters of 4 ultrasonic emission units as shown in FIG. 1, and the positioning signal of the ultrasonic emission group is frequency calibration signal corrected by frequency offset
Figure BDA0002169513370000183
Step five: estimating the time of arrival of the positioning signals of the ultrasonic emission group at the intelligent terminal by using a super-resolution method, such as a MUSIC-CC method (Multiple Signal classification algorithm);
step six: based on the TDOA positioning principle, the accurate positioning of the intelligent terminal is realized.
The third positioning strategy is explained below by way of example.
Assume that the smart terminal is in the square shaded area 60. The intelligent terminal receives all the ultrasonic positioning signals and frequency calibration signals of the 1 st, 2 nd, 3 rd and 4 th ultrasonic transmitting units, but the signal intensity is low.
The method comprises the following steps: intelligent terminal resolves average amplitude of received frequency calibration signal
Figure BDA0002169513370000184
And a comparison is made. When there are four frequenciesRate calibration signal Sf,1、Sf,2、Sf,3、Sf,4The judgment condition is met,
Figure BDA0002169513370000191
i≠j,i∈[1,4],j∈[1,4]and if the signal strength is equivalent, the intelligent terminal is in the square shaded area 60, and the third positioning strategy is determined to be adopted.
Step two: at this time, the intelligent terminal calculates the frequency calibration signal S by using a phase-locked loop (pll)f,1、Sf,2、Sf,3、Sf,4Doppler frequency shift FD,f,1、FD,f,2、FD,f,3、FD,f,4(ii) a Step three: frequency offset correction is carried out on the frequency calibration signals of the 1 st, 2 nd, 3 th and 4 th ultrasonic transmitting units;
step four: an ultrasound transmit group is created. The ultrasonic transmitting group consists of frequency calibration signal transmitters of 1 st, 2 nd, 3 th and 4 th ultrasonic transmitting units, and the positioning signal of the ultrasonic transmitting group is the frequency calibration signal after frequency deviation correction
Figure BDA0002169513370000192
Step five: the intelligent terminal respectively estimates the first positioning signals based on the MUSIC-CC super-resolution algorithm
Figure BDA0002169513370000193
First delay time t of reaching intelligent terminal1Second positioning signal
Figure BDA0002169513370000194
Second delay time t of reaching the intelligent terminal2Third positioning signal
Figure BDA0002169513370000195
Third delay time t of reaching the intelligent terminal3Fourth positioning signal
Figure BDA0002169513370000196
Third delay time t of reaching the intelligent terminal4
Step six: the intelligent terminal acquires relative coordinates (x) of a first main ultrasonic transmitter for transmitting a first positioning signal to the cloud end1,y1,z1) Relative coordinates (x) of a second primary ultrasound transmitter transmitting a second locating signal2,y2,z2) Relative coordinates (x) of a third primary ultrasound transmitter transmitting a third locating signal3,y3,z3) And a fourth master ultrasound transmitter relative coordinate (x) transmitting a fourth locating signal4,y4,z4) (ii) a Based on respective delay times t1、t2、t3、t4And respective relative coordinates (x)1,y1,z1)、(x2,y2,z2)、(x3,y3,z3)、(x4,y4,z4) Calculating the relative coordinates (x) of the intelligent terminal by using the TDOA algorithmc,yc,zc). The intelligent terminal will relative coordinate (x)c,yc,zc) And sending the relative coordinates to a cloud end, wherein the cloud end corresponds the relative coordinates to an indoor map, and shares the relative map to an intelligent terminal in an indoor environment.
Based on the above description, the embodiment of the invention also provides an ultrasonic positioning method. The method is applied to an ultrasonic positioning system, and the ultrasonic positioning system comprises: a plurality of ultrasound transmission units and intelligent terminals arranged at respective fixed positions; the method comprises the following steps: the intelligent terminal is enabled to compare the intensity of the ultrasonic positioning signals received from the ultrasonic transmitting units; enabling the intelligent terminal to determine to execute one of the following positioning strategies based on the comparison result: the intensity of the ultrasonic positioning signal transmitted by one ultrasonic transmitting unit is obviously stronger than that of the ultrasonic positioning signals transmitted by other ultrasonic transmitting units; a second positioning strategy that at least two ultrasonic transmitting units transmit strong ultrasonic positioning signals; and the weak ultrasonic positioning signals transmitted by the at least two ultrasonic transmitting units are mutually mashup. In one embodiment, the number of the ultrasound transmission units is 4, and the arrangement points of the 4 ultrasound transmission units constitute a square. Preferably, the ultrasonic positioning signal comprises a primary ultrasonic positioning signal, a secondary ultrasonic positioning signal and a frequency calibration signal; the ultrasonic transmitting unit comprises a main transmitting module, a secondary transmitting module and a controller; the main transmitting module comprises a main ultrasonic transmitter and a frequency calibration signal transmitter; the secondary transmitting module comprises at least three secondary ultrasonic transmitters; a primary ultrasound transmitter is arranged at the geometric center of the at least three secondary ultrasound transmitters, and frequency calibration signal transmitters are arranged at the periphery of the primary ultrasound transmitter; the main ultrasonic transmitter is used for transmitting the main ultrasonic positioning signal; the frequency calibration signal transmitter is used for transmitting the frequency calibration signal; the secondary ultrasonic transmitter is used for transmitting the secondary ultrasonic positioning signal; the controller is used for controlling the main ultrasonic transmitter, the frequency calibration signal transmitter and the secondary ultrasonic transmitter to simultaneously transmit according to preset frequency.
Fig. 6 is a flow chart of a first positioning strategy according to the present invention. As shown in fig. 6, the method includes: step 601: calculating the Doppler frequency offset of the main ultrasonic positioning signal transmitted by the ultrasonic transmitting unit which is obviously stronger than the intensity of other ultrasonic positioning signals; step 602: performing frequency offset correction on the main ultrasonic positioning signal and the secondary ultrasonic positioning signal which are transmitted by the ultrasonic transmitting unit and have the intensity which is obviously stronger than that of other ultrasonic positioning signals by using the Doppler frequency offset; step 603: selecting three secondary ultrasonic positioning signals from the secondary ultrasonic positioning signals after the frequency offset correction according to the sequence of the signal-to-noise ratio from large to small; step 604: and calculating the coordinates of the intelligent terminal based on the frequency offset corrected main ultrasonic positioning signal and the selected three secondary ultrasonic positioning signals.
Fig. 7 is a flow chart of a second positioning strategy according to the present invention.
As shown in fig. 7, the method includes: step 701: calculating respective Doppler frequency offsets of frequency calibration signals transmitted by at least two ultrasonic transmitting units for transmitting strong ultrasonic positioning signals; step 702: respectively carrying out frequency offset correction on the main ultrasonic positioning signal and the secondary ultrasonic positioning signal transmitted by the at least two ultrasonic transmitting units by using respective Doppler frequency offsets; step 703: comparing the signal-to-noise ratios of the main ultrasonic positioning signals of the at least two ultrasonic transmitting units after the frequency offset correction, and selecting the ultrasonic transmitting unit corresponding to the main ultrasonic positioning signal with the largest signal-to-noise ratio as a target ultrasonic transmitting unit; step 704: selecting three secondary ultrasonic positioning signals from the secondary ultrasonic positioning signals after the frequency offset correction of the target ultrasonic transmitting unit according to the sequence of the signal-to-noise ratio from large to small; step 705: and calculating the coordinates of the intelligent terminal based on the main ultrasonic positioning signal and the selected three secondary ultrasonic positioning signals after the frequency offset correction of the target ultrasonic transmitting unit.
Fig. 8 is a flow chart of a third positioning strategy according to the present invention. As shown in fig. 8, the method includes:
step 801: calculating respective Doppler frequency offsets of the frequency calibration signals transmitted by all the ultrasonic transmitting units; step 802: respectively carrying out frequency offset correction on the frequency calibration signals transmitted by all the ultrasonic transmitting units by utilizing the respective Doppler frequency offsets; step 803: and calculating the coordinates of the intelligent terminal based on the frequency calibration signals which are corrected by the frequency offset and transmitted by all the ultrasonic transmitting units.
The embodiment of the present invention further provides an ultrasonic positioning apparatus, which includes a processor, a memory, and a computer program stored on the memory and executable on the processor, and when the computer program is executed by the processor, the steps of the ultrasonic positioning method as described in any one of the above are implemented. It should be noted that not all steps and modules in the above flows and structures are necessary, and some steps or modules may be omitted according to actual needs. The execution order of the steps is not fixed and can be adjusted as required. The division of each module is only for convenience of describing adopted functional division, and in actual implementation, one module may be divided into multiple modules, and the functions of multiple modules may also be implemented by the same module, and these modules may be located in the same device or in different devices. The hardware modules in the various embodiments may be implemented mechanically or electronically. For example, a hardware module may include a specially designed permanent circuit or logic device (e.g., a special purpose processor such as an FPGA or ASIC) for performing specific operations. A hardware module may also include programmable logic devices or circuits (e.g., including a general-purpose processor or other programmable processor) that are temporarily configured by software to perform certain operations. The implementation of the hardware module in a mechanical manner, or in a dedicated permanent circuit, or in a temporarily configured circuit (e.g., configured by software), may be determined based on cost and time considerations. The present invention also provides a machine-readable storage medium storing instructions for causing a machine to perform a method as described herein. Specifically, a system or an apparatus equipped with a storage medium on which a software program code that realizes the functions of any of the embodiments described above is stored may be provided, and a computer (or a CPU or MPU) of the system or the apparatus is caused to read out and execute the program code stored in the storage medium. Further, part or all of the actual operations may be performed by an operating system or the like operating on the computer by instructions based on the program code. The functions of any of the above-described embodiments may also be implemented by writing the program code read out from the storage medium to a memory provided in an expansion board inserted into the computer or to a memory provided in an expansion unit connected to the computer, and then causing a CPU or the like mounted on the expansion board or the expansion unit to perform part or all of the actual operations based on the instructions of the program code. Examples of the storage medium for supplying the program code include floppy disks, hard disks, magneto-optical disks, optical disks (e.g., CD-ROMs, CD-R, CD-RWs, DVD-ROMs, DVD-RAMs, DVD-RWs, DVD + RWs), magnetic tapes, nonvolatile memory cards, and ROMs. Alternatively, the program code may be downloaded from a server computer or the cloud by a communication network. The above-listed detailed description is only a specific description of a possible embodiment of the present invention and is not intended to limit the scope of the present invention, and equivalent embodiments or modifications such as combinations, divisions or repetitions of the features without departing from the technical spirit of the present invention are included in the scope of the present invention.
The above description is only a preferred embodiment of the present invention, and is not intended to limit the scope of the present invention. Any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.

Claims (11)

1. A system for estimating doppler frequency offset of an ultrasonic locating signal, comprising:
the ultrasonic transmitting unit comprises a main transmitting module, a secondary transmitting module and a controller; the main transmitting module comprises a main ultrasonic transmitter and a frequency calibration signal transmitter; the secondary transmitting module comprises at least three secondary ultrasonic transmitters; a primary ultrasound transmitter is arranged at the geometric center of the at least three secondary ultrasound transmitters, and frequency calibration signal transmitters are arranged at the periphery of the primary ultrasound transmitter; the main ultrasonic emitter is used for emitting a main ultrasonic positioning signal; the frequency calibration signal transmitter is used for transmitting a frequency calibration signal; the secondary ultrasonic emitter is used for emitting a secondary ultrasonic positioning signal; the controller is used for controlling the main ultrasonic transmitter, the frequency calibration signal transmitter and the secondary ultrasonic transmitter to simultaneously transmit according to preset frequency; wherein the primary and secondary ultrasonic locating signals are modulated onto a first carrier having a first center frequency; modulating a frequency calibration signal onto a second carrier wave with a second center frequency, wherein the second center frequency is greater than the first center frequency, the first carrier wave and the second carrier wave are not overlapped, and the frequency calibration signal is a narrow-band signal;
the intelligent terminal is used for receiving the main ultrasonic positioning signal, the secondary ultrasonic positioning signal and the frequency calibration signal transmitted by the ultrasonic transmitting unit, calculating the Doppler frequency offset of the frequency calibration signal in a phase-locked loop mode, and calculating the Doppler frequency offset of the main ultrasonic positioning signal and the secondary ultrasonic positioning signal based on the Doppler frequency offset of the first central frequency, the second central frequency and the frequency calibration signal, wherein the Doppler frequency offset of the main ultrasonic positioning signal is equal to the Doppler frequency offset of the secondary ultrasonic positioning signal.
2. The system of claim 1, wherein the number of the ultrasound transmitting units is 4, and the arrangement points of the 4 ultrasound transmitting units form a square.
3. The system for Doppler frequency offset estimation of ultrasonic locating signals according to claim 1,
the intelligent terminal is used for comparing the strength of the frequency calibration signals received from the ultrasonic transmitting units and determining to execute one of the following positioning strategies based on the comparison result: a first positioning strategy in which the intensity of the frequency calibration signal transmitted by one ultrasound transmitting unit is significantly stronger than the intensity of the frequency calibration signals transmitted by the other ultrasound transmitting units; a second positioning strategy that at least two ultrasonic transmitting units transmit strong frequency calibration signals; and a third positioning strategy for mutual mixing of the weak frequency calibration signals transmitted by the at least two ultrasonic transmitting units.
4. The system for Doppler frequency offset estimation of ultrasonic locating signals according to claim 3,
the intelligent terminal is used for:
when the difference value between the amplitude of the frequency calibration signal transmitted by one ultrasonic transmitting unit and the amplitude of the frequency calibration signal transmitted by the ultrasonic transmitting units except the ultrasonic transmitting unit is larger than a preset first threshold value, determining to execute a first positioning strategy; or
When the amplitudes of the frequency calibration signals transmitted by the two ultrasonic transmitting units are both larger than a preset second threshold value and the difference value of the frequency calibration signals transmitted by the two ultrasonic transmitting units is smaller than a preset third threshold value, determining to execute a second positioning strategy;
and when the amplitude of the frequency calibration signal transmitted by each ultrasonic transmitting unit is smaller than a preset fourth threshold, or the difference value of the amplitudes of the frequency calibration signals transmitted by any two ultrasonic transmitting units is smaller than a preset fifth threshold, determining to execute a third positioning strategy.
5. The system for Doppler frequency offset estimation of ultrasonic locating signals according to any one of claims 1 to 4,
and the intelligent terminal is used for performing frequency offset correction on the main ultrasonic positioning signal and the secondary ultrasonic positioning signal based on the Doppler frequency offset of the main ultrasonic positioning signal and the secondary ultrasonic positioning signal, and calculating the coordinates of the intelligent terminal based on the main ultrasonic positioning signal after the frequency offset correction and the secondary ultrasonic positioning signal after the frequency offset correction.
6. A Doppler frequency offset estimation method of ultrasonic positioning signals is characterized by being suitable for performing Doppler frequency offset estimation on the ultrasonic positioning signals transmitted by an ultrasonic transmitting unit, wherein the ultrasonic transmitting unit comprises a main transmitting module, a secondary transmitting module and a controller; the main transmitting module comprises a main ultrasonic transmitter and a frequency calibration signal transmitter; the secondary transmitting module comprises at least three secondary ultrasonic transmitters; a primary ultrasound transmitter is arranged at the geometric center of the at least three secondary ultrasound transmitters, and frequency calibration signal transmitters are arranged at the periphery of the primary ultrasound transmitter; the main ultrasonic emitter is used for emitting a main ultrasonic positioning signal; the frequency calibration signal transmitter is used for transmitting a frequency calibration signal; the secondary ultrasonic emitter is used for emitting a secondary ultrasonic positioning signal; the controller is used for controlling the main ultrasonic transmitter, the frequency calibration signal transmitter and the secondary ultrasonic transmitter to simultaneously transmit according to preset frequency; wherein the primary and secondary ultrasonic locating signals are modulated onto a first carrier having a first center frequency; modulating a frequency calibration signal onto a second carrier wave with a second center frequency, wherein the second center frequency is greater than the first center frequency, the first carrier wave and the second carrier wave are not overlapped, and the frequency calibration signal is a narrow-band signal; the method comprises the following steps:
receiving a main ultrasonic positioning signal, a secondary ultrasonic positioning signal and a frequency calibration signal which are transmitted by an ultrasonic transmitting unit;
calculating the Doppler frequency offset of the frequency calibration signal in a phase-locked loop mode;
and calculating the Doppler frequency offset of the main ultrasonic positioning signal and the secondary ultrasonic positioning signal based on the Doppler frequency offset of the first central frequency, the second central frequency and the frequency calibration signal, wherein the Doppler frequency offset of the main ultrasonic positioning signal is equal to that of the secondary ultrasonic positioning signal.
7. The method of estimating Doppler frequency offset of an ultrasonic locating signal of claim 6, further comprising:
and performing frequency offset correction on the main ultrasonic positioning signal and the secondary ultrasonic positioning signal based on the Doppler frequency offset of the main ultrasonic positioning signal and the secondary ultrasonic positioning signal, and calculating the coordinates of the intelligent terminal based on the frequency offset corrected main ultrasonic positioning signal and the frequency offset corrected secondary ultrasonic positioning signal.
8. The method of estimating Doppler frequency offset of an ultrasonic locating signal according to claim 6,
the bandwidth of the first carrier wave is 3KHZ, and the frequency band of the first carrier wave is 17KHz-20 KHz;
and the bandwidth interval of the second carrier wave is [200Hz,500Hz ].
9. The method of estimating Doppler frequency offset of an ultrasonic locating signal according to claim 6,
the number of the second carriers is multiple, a guard interval is arranged between adjacent second carriers, and the bandwidth range of the guard interval is [200Hz, 400Hz ].
10. An apparatus for doppler frequency offset estimation of an ultrasonic locating signal, comprising a processor, a memory and a computer program stored on the memory and executable on the processor, the computer program, when executed by the processor, implementing the steps of the method for doppler frequency offset estimation of an ultrasonic locating signal according to any one of claims 6 to 9.
11. A computer-readable storage medium, on which a computer program is stored which, when being executed by a processor, carries out the steps of the method of doppler frequency offset estimation of ultrasound localization signals of any of claims 6 to 9.
CN201910758469.4A 2019-08-16 2019-08-16 Doppler frequency offset estimation system, method and device for ultrasonic positioning signals Active CN112394325B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910758469.4A CN112394325B (en) 2019-08-16 2019-08-16 Doppler frequency offset estimation system, method and device for ultrasonic positioning signals

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910758469.4A CN112394325B (en) 2019-08-16 2019-08-16 Doppler frequency offset estimation system, method and device for ultrasonic positioning signals

Publications (2)

Publication Number Publication Date
CN112394325A true CN112394325A (en) 2021-02-23
CN112394325B CN112394325B (en) 2023-11-28

Family

ID=74602019

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910758469.4A Active CN112394325B (en) 2019-08-16 2019-08-16 Doppler frequency offset estimation system, method and device for ultrasonic positioning signals

Country Status (1)

Country Link
CN (1) CN112394325B (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114884781A (en) * 2022-03-30 2022-08-09 西安电子科技大学 Carrier frequency offset estimation method based on linear programming and multi-signal classification algorithm

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1968236A (en) * 2005-11-15 2007-05-23 中国科学技术大学 Doppler frequency offset estimation method
CN101867386A (en) * 2009-04-20 2010-10-20 大唐移动通信设备有限公司 Method, system and device for pre-calibrating frequency deviation
CN105704076A (en) * 2014-11-24 2016-06-22 中兴通讯股份有限公司 Frequency offset correction method and device
CN105873211A (en) * 2016-04-29 2016-08-17 安徽华米信息科技有限公司 Positioning method and device
CN108173736A (en) * 2016-12-06 2018-06-15 苏州触达信息技术有限公司 A kind of interactive system and method based on indoor positioning
CN109199448A (en) * 2018-09-04 2019-01-15 深圳市理邦精密仪器股份有限公司 Pulsed-Wave Doppler imaging method and device based on HPRF

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1968236A (en) * 2005-11-15 2007-05-23 中国科学技术大学 Doppler frequency offset estimation method
CN101867386A (en) * 2009-04-20 2010-10-20 大唐移动通信设备有限公司 Method, system and device for pre-calibrating frequency deviation
CN105704076A (en) * 2014-11-24 2016-06-22 中兴通讯股份有限公司 Frequency offset correction method and device
CN105873211A (en) * 2016-04-29 2016-08-17 安徽华米信息科技有限公司 Positioning method and device
CN108173736A (en) * 2016-12-06 2018-06-15 苏州触达信息技术有限公司 A kind of interactive system and method based on indoor positioning
CN109199448A (en) * 2018-09-04 2019-01-15 深圳市理邦精密仪器股份有限公司 Pulsed-Wave Doppler imaging method and device based on HPRF

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114884781A (en) * 2022-03-30 2022-08-09 西安电子科技大学 Carrier frequency offset estimation method based on linear programming and multi-signal classification algorithm

Also Published As

Publication number Publication date
CN112394325B (en) 2023-11-28

Similar Documents

Publication Publication Date Title
Luo et al. Indoor positioning systems based on visible light communication: State of the art
US10411524B2 (en) Systems, methods and apparatuses for guidance and alignment in electric vehicles wireless inductive charging systems
KR101992469B1 (en) Method for estimating the distance of a receiver from a radio transmitter, relative methods for calculating the position of a mobile terminal, mobile terminal and localization device
KR102166578B1 (en) Partially synchronized multilateration/trilateration method and system for positional finding using rf
KR102166575B1 (en) Partially synchronized multilateration or trilateration method and system for positional finding using rf
US9829560B2 (en) Determining the position of a mobile device using the characteristics of received signals and a reference database
US8314736B2 (en) Determining the position of a mobile device using the characteristics of received signals and a reference database
JP5558241B2 (en) Method and apparatus for estimating position of radio station using multi-beam
US9551775B2 (en) Enhancing client location via beacon detection
US9482740B2 (en) Determining location of a receiver with a multi-subcarrier signal
WO2018068753A1 (en) Time difference of arrival (tdoa) measurement method and apparatus, tdoa control apparatus and method, and terminal
JP2018531568A6 (en) System, method and apparatus for induction and alignment in a wireless electromagnetic induction charging system of an electric vehicle
WO2017192206A2 (en) Doppler location of signal leaks in an hfc network
Sheu et al. A distributed location estimating algorithm for wireless sensor networks
WO2017058107A1 (en) Transmitter array, receiver, and positioning system
CN107634810B (en) Satellite energy detection cognitive method and system based on radio environment map
CN112394325B (en) Doppler frequency offset estimation system, method and device for ultrasonic positioning signals
CN112393726B (en) Ultrasonic positioning system, method, device and computer readable storage medium
US7965237B2 (en) Mobile system and method for position estimation
KR20190106674A (en) Method and Apparatus for using tone channel in wireless distributed communication systems
US20230305093A1 (en) Adaptive doppler-nulling digitization for high-resolution
US20230333193A1 (en) Dns spatial discoveries with on-going traffic
Beck et al. RadioBOT: A spatial cognitive radio testbed
TW202403337A (en) Dns spatial discoveries with on-going traffic
Serna Santiago Passive Positioning Approaches in the Future Positioning Systems

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
CB02 Change of applicant information
CB02 Change of applicant information

Address after: 215000 room 2104, block a, Suzhou Central Plaza, No. 58, Suxiu Road, Suzhou Industrial Park, Jiangsu Province

Applicant after: SUZHOU TOUCHAIR TECHNOLOGY Co.,Ltd.

Address before: Room 801, building 6, creative industry park, 328 Xinghu street, Suzhou Industrial Park, Jiangsu Province 215000

Applicant before: SUZHOU TOUCHAIR TECHNOLOGY Co.,Ltd.

GR01 Patent grant
GR01 Patent grant