# US 2010/0141515 A1 · Position tracking device and method

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2010/0141515 A1
- Document ID: US20100141515A1
- Status: Published application
- Kind: A1
- Application number: 12/451,513
- Filed: 2007-06-22
- Published: 2010-06-10
- Earliest claimed: 2007-06-22
- Assignees: Trimble Terrasat GmbH
- Inventors: Ken Doucet; Ulrich Vollath
- Web page: https://patentgrep.com/patent/US20100141515A1

## CPC

- G01S 19/40: Correcting position, velocity or attitude
- G01S 19/393: {Trajectory determination or predictive tracking, e.g. Kalman filtering}
- G01S: RADIO 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

## Abstract

The present application relates to tracking a position of a device, e.g. for detecting slow and rapid earth deformation, by making use of a recursive filter having the filter characteristic adapted to a detected type of motion. If the motion of the position tracking device is rapid, the filter characteristic is set such that the rapid motion can be tracked with the necessary speed. On the other hand, if the motion is slow, e.g. during times of a normal tectonic drift, the filter characteristic is set such that the motion is slowly tracked with the advantage of efficient noise reduction, i.e. noise in the input signal is effectively barred and does not pass through the filter to the output signal. Thus, in times of rapid motion the convergence speed of the filter output signal to the input signal is set high for fast convergence and in times of slow motion the convergence speed of the filter output signal to the input signal is set low for a slow convergence. The filter may be a Kalman filter.

## Claims

### Claim 1

Position tracking device, including
means for receiving positioning signals from a plurality of satellites at known positions;
means for determining a position estimate using a recursive filter adapted to receive as an input the positioning signals and a convergence parameter; and
means for obtaining a displacement estimate of the position tracking device;
wherein the means for determining the position estimate is adapted to adjust the convergence parameter based on the displacement estimate.

### Claim 2 (depends on 1)

Position tracking device according to claim 1, wherein the recursive filter is a Kalman filter and wherein the convergence parameter is constituted by a position noise input to the Kalman filter.

### Claim 3 (depends on 2)

Position tracking device according to claim 2, wherein the convergence parameter is constituted by the displacement estimate multiplied by a constant.

### Claim 4

(canceled)

### Claim 5 (depends on 3)

Position tracking device according to claim 3, wherein the displacement estimate is determined based on at least one of:
a time sequence of displacement measurements;
a velocity vector describing a movement of the position tracking device;
a phase of the positioning signals from the satellites; and
a signal from a motion sensor.

### Claim 6

(canceled)

### Claim 7 (depends on 1)

Position tracking device according to claim 1, wherein the means for determining a position estimate is adapted to set the convergence parameter to a value indicating slow convergence, if the displacement estimate is below a predetermined detect threshold, and to set the convergence parameter to a value indicating fast convergence, if the displacement estimate exceeds the predetermined detect threshold.

### Claim 8 (depends on 1)

Position tracking device according to claim 1, wherein for indicating fast convergence the convergence parameter is determined based on the displacement estimate and for indicating slow convergence the convergence parameter is constituted by a predetermined constant.

### Claim 9 (depends on 1)

Position tracking device according to claim 1, wherein the means for determining a position estimate is adapted to:
perform a first recursive filtering process based on a first group of time sequences of positioning signals spaced by a first measurement time interval;
perform a second recursive filtering process based on a second group of time sequences of positioning signals
spaced by a second measurement time interval longer than the first measurement interval; and
use the determination result of the first recursive filtering process, if the displacement estimate exceeds a predetermined threshold, and to use the determination result of the second recursive filtering process, if the displacement estimate is below the predetermined threshold.

### Claim 10 (depends on 1)

Position tracking device according to claim 1, wherein the convergence parameter includes covariances of a displacement in different spatial directions.

### Claim 11

Method for tracking a position, including
receiving positioning signals from a plurality of satellites at known positions at a position tracking device;
obtaining a displacement estimate of the position tracking device;
adjusting a convergence parameter based on the displacement estimate; and
determining a position estimate using a recursive filter receiving as an input the positioning signals and the convergence parameter.

### Claim 12 (depends on 11)

Method of claim 11, wherein the recursive filter is a Kalman filter and wherein the convergence parameter is constituted by a position noise input to the Kalman filter.

### Claim 13 (depends on 11)

Method of claim 11, further including determining the convergence parameter by multiplying the displacement estimate with a constant.

### Claim 14

(canceled)

### Claim 15 (depends on 11)

Method of claim 11, further including determining the displacement estimate based on at least one of:
a time sequence of displacement measurements;
a velocity vector describing a movement of the position tracking device;
a phase of the positioning signals from the satellites; and
a signal from a motion sensor.

### Claim 16

(canceled)

### Claim 17 (depends on 11)

Method of claim 11, further including setting the convergence parameter to a value indicating slow convergence, if the displacement estimate is below a predetermined detect threshold, and setting the convergence parameter to a value indicating fast convergence, if the displacement estimate exceeds the predetermined detect threshold.

### Claim 18 (depends on 11)

Method of claim 11, further including determining the convergence parameter based on the displacement estimate for indicating fast convergence of the convergence parameter and defining the convergence parameter as a predetermined constant for indicating slow convergence.

### Claim 19 (depends on 11)

Method of claim 11, further including:
performing a first recursive filtering process based on a first group of time sequences of positioning signals spaced by a first measurement time interval;
performing a second recursive filtering process based on a second group of time sequences of positioning signals spaced by a second measurement time interval longer than the first measurement interval; and
using the determination result of the first recursive filtering process, if the displacement estimate exceeds a predetermined threshold, and using the determination result of the second recursive filtering process, if the displacement estimate is below the predetermined threshold.

### Claim 20 (depends on 11)

Method of claim 11, wherein the convergence parameter includes covariances of a displacement in different spatial directions.

### Claim 21

(canceled)

### Claim 22 (depends on 11)

A computer readable medium, in which a program is embodied, where the program is adapted to make a computer execute the method of claim 11.

### Claim 23 (depends on 22)

A computer program product comprising the computer readable medium according to claim 22.

### Claim 24 (depends on 1)

System for tracking tectonic drifts including a plurality of position tracking devices according to claim 1.

### Claim 25

Position tracking device, comprising:
a receiver to receive positioning signals from a plurality of satellites at known positions;
a recursive filter adapted to determine a position estimate using the positioning signals and a convergence parameter; and
a displacement estimation unit to obtain a displacement estimate of the position tracking device;
wherein the recursive filter is adapted to adjust the convergence parameter based on the displacement estimate.

### Claim 26 (depends on 25)

Position tracking device according to claim 25, wherein the recursive filter is a Kalman filter and wherein the convergence parameter is constituted by a position noise input to the Kalman filter.

### Claim 27 (depends on 25)

Position tracking device according to claim 25, wherein the convergence parameter is constituted by the displacement estimate multiplied by a constant.

### Claim 28 (depends on 25)

Position tracking device according to claim 25 wherein the displacement estimate is determined based on at least one of:
a time sequence of displacement measurements;
a phase of the positioning signals from the satellites;
a signal from a motion sensor; and
a velocity vector describing a movement of the position tracking device.

### Claim 29 (depends on 25)

Position tracking device according to claim 25, wherein the convergence parameter is set to a value indicating slow convergence if the displacement estimate is below a predetermined detect threshold, and to value indicating fast convergence if the displacement estimate exceeds the predetermined detect threshold.

### Claim 30 (depends on 25)

Position tracking device according to claim 25, wherein for indicating fast convergence the convergence parameter is determined based on the displacement estimate and for indicating slow convergence the convergence parameter is constituted by a predetermined constant.

### Claim 31 (depends on 25)

Position tracking device according to claim 25, wherein the recursive filter is adapted to:
perform a first recursive filtering process based on a first group of time sequences of positioning signals spaced by a first measurement time interval;
perform a second recursive filtering process based on a second group of time sequences of positioning signals spaced by a second measurement time interval longer than the first measurement interval; and
use the determination result of the first recursive filtering process if the displacement estimate exceeds a predetermined threshold, and to use the determination result of the second recursive filtering process if the displacement estimate is below the predetermined threshold.

### Claim 32 (depends on 25)

Position tracking device according to claim 25, wherein the convergence parameter includes covariances of a displacement in different spatial directions.
