The invention relates generally to position tracking systems and method. More particularly, the invention relates to systems and methods for wireless position tracking of mobile handheld, wireless, and wired devices.
Position tracking involves identifying an entity's location in a predefined environment (e.g., two dimensional or three dimensional). Certain methods for position tracking involve a transmitter (e.g., an electronic tag) that is tracked by an array of receiver devices. For example, one method to track the position of a radio signal emitting tag is to use the amplitude of the tag signal at the various receiver devices to determine the position of the tag. By comparing the signal strength at each receiver position, a position tracking system can use triangulation or trilateration to determine the position of the tag.
In one aspect, the invention features a position tracking system comprising a radio frequency (RF) transmitter transmitting an RF signal, an RF receiver in communication with the RF transmitter to receive the RF signal, and a controller in communication with the RF receiver to receive the RF signal and to perform a time of flight estimation of the RF signal from the transmitter to receiver and to measure phase shift for sub-wavelength determination. A computing system, in communication with the controller, receives the time of flight estimation and the measured phase shift and determines a position of the RF transmitter with respect to the RF receiver in response to the time of flight estimation and measured phase shift.
In another aspect, the invention features a position tracking system comprising a transmitting antenna transmitting a radio frequency (RF) signal and at least one receiving antenna acquiring the RF signal. One of the at least one receiving antenna and the transmitting antenna is designated a reference antenna. A processing unit determines a phase difference between the RF signal received by each receiving antenna and the reference antenna. The processing unit computes a position of the transmitting antenna with respect to the at least one receiving antenna in response to the phase difference determined for each receiving antenna.
In another aspect, the invention features a method of tracking position of a transmitting antenna comprising receiving a radio frequency (RF) signal, transmitted by the transmitting antenna, by at least one receiving antenna. One of the antennae is designated as a reference antenna. A phase difference is determined between the RF signal received by each receiving antenna and the reference antenna. A position of the transmitting antenna with respect to the at least one receiving antenna is computed in response to each phase difference determined for each receiving antenna.
In still another aspect, the invention features a method of tracking position comprising receiving a radio frequency (RF) signal, transmitted by a transmitting antenna, by a receiving antenna, performing a time of flight estimation of the RF signal from the transmitting antenna to the receiving antennae, measuring phase shift between the transmitted RF signal and the received RF signal at each receiving antenna, and determining a position of the transmitting antenna with respect to the receiving antennae in response to the time of flight estimation and the measured phase shift at each receiving antenna.
Position tracking systems described herein comprise a plurality of distinct, physically separated receivers, with antenna and hardware, and one or more transmitters, with antenna and hardware. To track a single transmitter (antenna), some embodiments of the position tracking systems include three receiver antennae for two-dimensional tracking and at least four receiver antennae for three-dimensional tracking. The receiver antennae provide a position reference frame in which the transmitter antenna is tracked. The receiver antennae are fixed in the tracking environment at known locations. Additional receiver antennae provide better coverage and more accuracy than fewer antennae, with additional complexity and cost. In one embodiment, the receiver antennae receive signals from a wireless transmitter and use the time of arrival information of those signals to calculate device position. The timing information is calculated using the carrier signal phase information of the transmitter, received at each receiver antenna, to compare time of arrival at each receiver antenna.
More transmitter antennae attached to or embedded in a tracked object allow the orientation of the object to be calculated based on geometric principles. For example, two transmitter antennae, separated by a distance d, yield a pointer, because the two transmitter antennae form a line with known direction. Three transmitter antennae provide enough information to calculate a three-dimensional orientation. The configuration of the position tracking system can be reversed, with the receiver antennae being tracked and the transmitter antennae providing the reference frame.
In brief, the three receivers 20 and transmitter 12 are used to determine the three-dimensional position of the object within the tracking environment. The transmitter 12 associated with an object continuously transmits pseudo noise (PN) code modulated RF (radio frequency) signals. The antenna 22 of each receiver 20 receives the modulated signals from the transmitter 12. The LNAs 24 amplify the received CDMA (Code Division Multiple Access) signals and send them to the controller 16 over communication links 26 (e.g., cables).
The controller 16 obtains a set of PN code correlative pulses through a correlation process and detects the carrier signals. The PN code correlative pulses and carrier signals are supplied to a code discriminator and a carrier phase discriminator, respectively, within controller 16. The code discriminator and carrier phase discriminator provide the coarse and fine measurement of the time difference of arrival of the transmitted RF signal, respectively. Combining the coarse and fine time differences of arrival eliminates ambiguity and provides highly accuracy position determination. The controller 16 sends the data to the computer system 18 to calculate the transmitter antenna position (x, y, z). The computer system 18 can display the position on a computer screen (e.g., as a cursor) or provide the transmitter position to an application for further use.
During operation, the reference oscillator or clock 40 produces a stable reference clock signal, which passes to the PN generator 42 and to the RF source 32. Based on the reference clock signal, the RF source 32 produces an RF signal and the PRN code generator 42 produces a PN code. The Bi-Phase Shift Key (BPSK) modulator 34 combines the RF signal received from the RF source and the PN code received from the PRN code generator 42 to produce a modulated CDMA signal for transmission. The amplifier 36 receives and amplifies the CDMA signal. The power divider 38 delivers the CDMA signal to the transmit antenna 38 for RF transmission and to the controller 16 over a communication link 26.
The reference signal generator 50 provides a set of carrier signals 70 to the carrier phase discriminator 52 and code synchronizing signals 72 to the code timing circuit 54. The code timing circuit 54 performs a coarse measurement of time difference of arrival to provide an absolute position measurement at low resolution. The carrier phase discriminator 52 produces a fine measurement of the time difference of arrival to achieve high resolution of the object position. The ADC circuit 66 receives and digitizes the set of measured carrier phase information from the carrier phase discriminator 52 and the code time difference information received from the code timing circuit 54. The buffer 68 buffers this digitized information, which is sent to the computer system 18 for object position calculations.
The receiver antenna 22 acquires the RF signal 106 transmitted by the transmitter 12. The amplifier (LNA) 24 of the receiver 20 amplifies the received signal 106. The BPSK demodulator 56 of the controller 16 demodulates the RF signal to recover the 5.8 GHz carrier signal 112, phase (time) shifted. For recovering the carrier signal 112, the PN code generator 64 provides a 10 MHz 10-bit pseudo-noise (PN) sequence 110, clocked by the DLL 63 (
The multiplier 104 of the carrier phase discriminator 52 uses the carrier reference signal 70 received from the reference generator 50 to demodulate the real component (in-phase (I)) 116 of the recovered carrier signal 112. An integrator 118 integrates the real component 116 for a period corresponding to an integral number of cycles of the recovered carrier signal 112, and provides the integrated real component 120 to the A/D circuit 66.
The carrier phase discriminator 52 also includes a multiplier 114, which receives the carrier reference signal 70 shifted by 90 degrees by the phase shifter 102, and uses the phase-shifted signal to demodulate the imaginary component (out-of-phase (Q)) 122 of the recovered carrier signal 112. An integrator 124 integrates the imaginary component 122 for a period corresponding to an integral number of cycles of the recovered carrier signal 112, and provides the integrated imaginary component 126 to the A/D circuit 66. The ratio of the two demodulated integrated signals 120, 126 yields the phase shift of the recovered carrier signal 112, which provides the fine measurement of the time of flight.
Additional receivers or receiver antennae can be utilized to provide additional information to the algorithm that calculates the position of the transmitter. Additional transmitter antennae or transmitters can be rigidly attached to provide a marker, where two rigidly attached antennae or transmitters can provide vector orientation information (line between the antennae) and 3 or more non-concentric antennae can provide three-dimensional orientation (multiple axes). A system containing a single transmitter with multiple antennae and/or markers can be used in medical procedures to provide the position and/or orientation of a medical object. A medical object can be a living entity, a provider of medical or surgical services, a medical instrument or a medical device. Multiple markers can also be tracked using other PN codes to minimize interference. Multiple medical objects can be tracked using multiple antennae and/or markers and relative measurements can be determined from the position and orientation of the various antennae/markers. Such a system can also be used for registering medical imaging with real time or non-real time surgical procedures and for real time data fusion. As would be appreciated in the art, the system described can be reversed, that is, one receiver being associated with an object that is to be tracked and multiple transmitters emitting CDMA signals.
As known in the art, there are many variations possible to achieve the same functionality. Many of the noted components can be part of the computer system 168. For example, the computer system 168 can generate the sine wave 150 and the PN sequence 152. The multipliers 162 and integrators 164 can be disposed after the A/D 166 and be performed in a DSP (digital signal processing device). Other embodiments can use low pass filters instead of the integrators 164.
The P&O algorithm 170 is based on a best-fit method to the underlying equations. In this phase-based position tracking system 10′, the phase is used to measure distance, absolute and/or relative transmitter position. The sine wave generator 150 can generate signals between 10MHz and 10GHz. This corresponds to wavelengths (λ) ranging from 30m to 0.03m. 360° corresponds to one wavelength, and the distance is calculated by measuring the phase differences of the transmitter signal recorded at two receiver antennae. In the following equations, the variables r1, r2, r3, and r4 represent the distances between the receiver antennae positions and the transmitter position and are represented by the phases. Receiver positions are denoted as rcvr_posreceiver number,position coordinate, and are fixed, known quantities. Position coordinate 1, 2, 3 represent x, y, z, respectively.
These four equations are used to solve for x1, x2, and x3, which represents the x,y,z, position of the transmitter, respectively. This can be solved in a least squares algorithm, such as Levenberg-Marquardt, in a Kalman filter or similar algorithms.
When the wavelength is less than the tracking range, multiple cycles of the sine wave 150 occupy the tracking volume. To work in this environment, the P&O algorithm 170 starts at a known location and tracks through the cycle-to-cycle variation in order to maintain absolute tracking. Because phase shifts are typically computed using the arctangent function, a phase discontinuity occurs every ±180° (as shown in
At the end of each cycle, at step 196, Smn is compared to Spn. If the difference exceeds a tolerance, this indicates that the filter is lost, for example, because of multipath or to a complete loss of signal. If the filter is lost, Ŝn and Ûn are set to zero at step 198 and processing continues at step 190. Otherwise, Xn-1 is set to Xn at step 200 and processing repeats with new data obtained at step 184. Each phase difference gets its own unwrapping. The unwrapping typically occurs in a processor.
Whereas CDMA techniques help to mitigate multipath interference, additional techniques can be used to increase the robustness of the position tracking system. One technique uses additional receiver antennae. The additional receiver antennae provide additional information in the event the signals of another receiver are corrupted by multipath effects. A loss or corruption of signal indicates that a particular signal should not be used in the computation of the P&O algorithm 170. Another technique includes cycling the designation of the reference antenna through the receiver antennae. When the reference antenna is blocked, all the phase difference signals are deemed corrupt. Cycling through the different receiver antennae gives the position tracking system an opportunity to find a good reference. It may then be possible to re-acquire signals on the next cycle. This can require more multiplexing paths, and additional bookkeeping, but increases system robustness.
Another technique to make the position tracking system more robust, especially when the wavelength is less than the tracking volume (i.e., range), is to keep track of signals that may be lost because of multipath effects or signal blockage. After a valid solution to the P&O algorithm 170 is available, the solution is used to calculate the expected phase difference for the different channels. Under normal conditions, these calculated values closely agree to the measured values. When a signal is lost, these calculated values can be used instead of the measured values shown in step 184. That way, after the channel signal is unblocked and received again, it can resume being used without losing track of the correct phase difference.
These methods can also be subsumed by a Kalman filter implementation of the unwrapping and the P&O algorithm. Because the tracking equations (Eq. 1-Eq. 4) can be formulated in a Kalman framework, both the P&O algorithm 170 and unwrapping can be performed in one consistent algorithm. Because dynamic estimates are available in Kalman formulations, these can be used to detect when signals are degraded and/or lost. Means for performing Kalman filtering are described in “Optimal Estimation with an Introduction to Stochastic Control Theory,” by Frank Lewis, Wiley-Interscience, 1986.
The sine wave 150 in
Receivers 212-1, 212-2 are part of the receiver network. Coordinates of each phase center of the receivers' antennae 218 are predetermined and used as coordinate references for correlating the coordinate location of the transmitter 214 within the receiver network. Also, the phase center of the transmitter antenna is used as a reference for the coordinate location of the transmitter 214.
In this tracking and/or communication system, the transmitter 214 continuously transmits pulsed signals in the form of multiple frequencies, and the receivers 212-1, 212-2 receive the signals, amplify, and send these signals to the central processing unit 216 via cables. In the central processing unit 216, one or more phase discriminators (not shown) are used to provide carrier phase difference information between received carrier signals or between received signals and reference signals. The central processing unit 216 also includes an analog-to-digital (A/D) converter (not shown) to digitize the phase differences. According to the carrier phase difference information, the identification of the transmitter 214, its physical position information, or both, can be determined.
The VCO 218 in the transmitter 214 generates a continuous RF or microwave signal that depends on the signal frequency produced by the DDS source 220. In this system, any frequency can be chosen depending on the requirement for the resolution of the coordinates (e.g., the higher the frequency, the higher the resolution). The DDS signal frequency depends on the Frequency Word controlled by the microprocessor 230. This DDS signal works as a reference clock for the VCO 218 to generate different frequencies for hopping.
Each limiting amplifier 240 is used to limit the amplitude of the pulsed RF or microwave signal coupled from the receivers 212-1, 212-2 so that the output of each phase discriminator 246 is dependent on the carrier phase differences. The power divider 242 divides one of the received signals for phase discriminating and pulse recovery. The phase discriminator 246 is used to discriminate phase differences of individual hopped frequencies. The analog-to digital converter 248 converts the carrier phase difference from analog to digital. The data buffer 250 functions as the storage space to store the digital data for the data processing. The control signals for the A/D converters 248 and the data buffer 250 come from the pulse recovery circuit 244.
The data collected from the data buffer 250 contains the phase differences of the different frequencies. As shown in the frequency-hopping pattern of
Although the preferred embodiments of the present invention have been described herein, the above description is merely illustrative. Further modification of the invention herein disclosed will occur to those skilled in the respective arts and all such modifications are deemed to be within the scope of the invention as defined by the appended claims.
This application is a division of, and claims priority to and the benefits under 35 U.S.C. §§ 120 and 121 of, co-pending U.S. application Ser. No. 14/354,833 filed Apr. 28, 2014 and titled “SYSTEMS AND METHODS OF WIRELESS POSITION TRACKING,” which claims the benefit of and priority to U.S. provisional application No. 61/558,032, filed Nov. 10, 2011 and titled “Wireless Tracking System using CDMA and Phase for Timing Comparisons,” and the benefit of and priority to U.S. provisional application No. 61/558,082, filed Nov. 10, 2011, titled “Radio Frequency Tracking Device,” the entireties of which applications are incorporated by reference herein for all purposes.
Number | Date | Country | |
---|---|---|---|
61558032 | Nov 2011 | US | |
61558082 | Nov 2011 | US |
Number | Date | Country | |
---|---|---|---|
Parent | 14354833 | Apr 2014 | US |
Child | 15953798 | US |