Position tracking system and method using radio signals and inertial sensing
An RF position tracking system for wirelessly tracking the three-dimensional position of a tracked object. The tracked object has at least one mobile antenna and at least one inertial sensor. The system uses a plurality of base antennas which communicate with the mobile antenna using radio signals. The tracked object also incorporates the inertial sensor to improve position stability by allowing the system to compare position data from radio signals to data provided by the inertial sensor.
1. A self-positioning mobile device comprising:
an inertial and magnetic detection subsystem (IMDS) configured to determine position and orientation information of the mobile device by monitoring inertia over time;
a primary positioning and tracking mechanism including at least one receiver antenna receiving radiofrequency (RF) signals from at least three spaced apart RF transmitter antennae, each RF transmitter antennae being disposed at a known three-dimensional location; and
at least one processor configured to calculate position and orientation of the mobile device from the RF signals received from the at least three spaced-apart RF transmitter antennae, to receive the position and orientation information from the IMDS, and to merge only the position and orientation of the mobile device calculated from the received RF signals with the position and orientation information received from the IMDS into a corrected position and orientation of the mobile device.
2. The self-positioning mobile device of claim 1 , wherein the mobile device is an unmanned aerial vehicle.
3. The self-positioning mobile device of claim 1 , wherein the IMDS comprises one or more accelerometers, zero or more gyroscopes, and zero or more magnetic sensors.
4. The self-positioning mobile device of claim 1 , wherein the at least one processor uses a Kalman filter to merge the position and orientation of the mobile device calculated from the received RF signals with the position and orientation information received from the IMDS into the corrected position and orientation of the mobile device.
5. The self-positioning mobile device of claim 1 , wherein the at least one processor is further configured to reduce power to the at least one receiver antenna when the inertial and magnetic detection subsystem (IMDS) does not detect motion for a period.
6. The self-positioning mobile device of claim 5 , wherein the at least one processor is further configured to restore the at least one receiver antenna to full power when the inertial and magnetic detection subsystem (IMDS) detects motion.
7. The self-positioning mobile device of claim 5 , wherein the at least one processor is further configured to keep track of a last calculated corrected position and orientation of the mobile device and, when the IMDS detects motion, to correct the last calculated position and orientation of the mobile device based on measurements made by the IMDS until the at least one receiver antenna returns to operation.
8. A method for tracking a position of a mobile device, the method comprising:
determining, by the mobile device, a position and orientation of the mobile device from radiofrequency (RF) signals received by a primary positioning and tracking mechanism including at least one RF receiver antenna of the mobile device from at least three spaced apart RF transmitter antennae;
determining, by the mobile device, a position and orientation of the mobile device from inertia measurements made over time by the mobile device; and
merging only the position and orientation of the mobile device determined from the received RF signals with the position and orientation determined from the inertia measurements into a corrected position and orientation of the mobile device.
9. The method of claim 8 , wherein the mobile device is an unmanned aerial vehicle.
10. The method of claim 8 , further comprising the step of applying a Kalman filter to merge the position and orientation of the mobile device determined from the received RF signals with the position and orientation information received from the IMDS into the corrected position and orientation of the mobile device.
11. The method of claim 8 , further comprising the step of reducing power to the at least one receiver antenna when the inertial and magnetic detection subsystem (IMDS) does not detect motion of the mobile device for a period.
12. The method of claim 8 , further comprising the step of restoring the at least one receiver antenna to full power when the inertial and magnetic detection subsystem (IMDS) detects motion of the mobile device.
13. The method of claim 12 , further comprising the step of keeping track of a last calculated corrected position and orientation of the mobile device and, when the IMDS detects motion of the mobile device, to correct the last calculated position and orientation of the mobile device based on measurements made by the IMDS until the at least one receiver antenna returns to operation.
14. The method of claim 8 , further comprising weighing RF data obtained from the RF signals based on a match with inertial data obtained from the measurements made by the IMDS.
15. A system for tracking a position of a mobile device, the system comprising:
an inertial and magnetic detection subsystem (IMDS) attached to the mobile device, the IMDS being configured to determine position and orientation information of the mobile device by monitoring inertia over time;
a radiofrequency (RF) tracking system comprising:
at least one RF transmitter antenna on the mobile device, and
at least three RF receiver antennae spaced apart from each other, wherein the RF tracking system is adapted to calculate a distance between each of the at least one RF transmitter antenna on the mobile device and each of the at least three RF receiver antennae, and to calculate position and orientation of the mobile device from the calculated distances; and
a fusion algorithm processor configured to merge the position and orientation information determined by the IMDS with the position and orientation information calculated by the RF tracking system into a corrected position and orientation of the mobile device.
16. The system of claim 15 , wherein the fusion algorithm processor is further configured to reduce power to the RF tracking system when the inertial and magnetic detection subsystem (IMDS) does not detect motion for a period.
17. The system of claim 16 , wherein the fusion algorithm processor is further configured to restore the RF tracking system to full power when the inertial and magnetic detection subsystem (IMDS) detects motion.
18. The system of claim 16 , wherein the fusion algorithm processor is further configured to keep track of a last calculated corrected position and orientation of the mobile device and, when the IMDS) detects motion, to correct the last calculated position and orientation of the mobile device based on measurements made by the IMDS until the RF tracking system returns to operation.
19. The system of claim 15 , wherein the IMDS comprises one or more accelerometers, zero or more gyroscopes, and zero or more magnetic sensors.
20. The system of claim 15 , wherein the mobile device is an unmanned aerial vehicle.