# US 2021/0341624 A1 · Navigation Apparatus and Method in Which Measurement Quantization Errors are Modeled as States

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

- Number: US 2021/0341624 A1
- Document ID: US20210341624A1
- Status: Published application
- Kind: A1
- Application number: 17/235,856
- Filed: 2021-04-20
- Published: 2021-11-04
- Earliest claimed: 2020-05-01
- Assignees: Deere & Company
- Applicants: Deere & Company
- Inventors: Stephen F. Rounds
- Web page: https://patentgrep.com/patent/US20210341624A1

## CPC

- G01C 21/188: {for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems}
- G01S 19/07: providing data for correcting measured positioning data, e.g. DGPS [differential GPS] or ionosphere corrections
- B60W 60/001: {Planning or execution of driving tasks}
- G01C 21/16: by integrating acceleration or speed, i.e. inertial navigation
- G01S 19/14: specially adapted for specific applications
- G01S 19/25: involving aiding data received from a cooperating element, e.g. assisted GPS
- G01S 19/45: by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- B60W 2556/50: of positioning data, e.g. GPS [Global Positioning System] data
- G01C: MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY (measuring liquid level G01F; radio navigation, determining distance or velocity by use of propagation effects, e.g. Doppler effects, propagation time, of radio waves, analogous arrangements using other waves G01S)
- 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
- B60W: CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT

## Abstract

A navigation apparatus determines an estimated position of an object. Navigation information that includes a sequence of quantized measurements is received. Each quantized measurement has a corresponding quantization error that is negatively correlated with the quantization error of a prior quantized measurement. The apparatus iteratively performs a navigation update operation that includes determining a state and a covariance matrix of the object for a current iteration based on a state and covariance matrix in a prior iteration. The state includes an end quantization error and a start quantization error. The covariance matrix includes end and start covariance values corresponding to the end and start quantization errors, respectively. Determining the state and the covariance matrix for the current iteration includes replacing the start quantization error with the end quantization error determined in a prior iteration, and updating the state and the covariance matrix via a Kalman filter update operation.

## Claims

### Claim 1

A navigation apparatus for determining an estimated position of an object, comprising:
one or more measurement receivers for receiving navigation information corresponding to a position or change in position of the object, wherein a first measurement receiver of the one or more measurement receivers receives, over time, navigation information comprising a sequence of quantized measurements, each having a corresponding quantization error;
one or more processors;
memory storing one or more programs, the one or more programs including instructions for, iteratively, at a sequence of times separated by time intervals, performing a navigation update operation, including:
determining an estimated state of the object and an estimated state covariance matrix of the object for a current time in the sequence of times based on an estimated state and estimated state covariance matrix of the object for a prior time in the sequence of times, wherein
the estimated state of the object includes a first portion that includes at least estimated position values and estimated velocity values, and a second portion that includes an interval end quantization error value and an interval start quantization error value;
the estimated state covariance matrix of the object includes a first portion that includes covariance values for the first portion of the estimated state, and a second portion that includes end and start covariance values corresponding to the interval end and interval start quantization error values, respectively, in the second portion of the estimated state; and
determining the estimated state of the object and the estimated state covariance matrix of the object for the current time comprises:
replacing the interval start quantization error value in the estimated state with the interval end quantization error value determined in a prior iteration of the navigation update operation; and
updating the estimated state and the estimated state covariance matrix in accordance with a predefined Kalman filter update operation to generate the estimated state of the object and the estimated state covariance matrix of the object for the current time.

### Claim 2 (depends on 1)

The navigation apparatus of claim 1, wherein the quantization error of each quantized measurement is negatively correlated with the quantization error of one or more prior quantized measurements in the sequence of quantized measurements.

### Claim 3 (depends on 1)

The navigation apparatus of claim 1, wherein updating the estimated state and the estimated state covariance matrix comprises updating the estimated state and the estimated state covariance matrix, using the predefined Kalman filter update operation, in accordance with a most recent quantized measurement in the sequence of quantized measurements.

### Claim 4 (depends on 1)

The navigation apparatus of claim 1, wherein determining the estimated state of the object and the estimated state covariance matrix of the object for the current time includes replacing an element of the estimated state covariance matrix corresponding to the interval end quantization error value with a first predefined value.

### Claim 5 (depends on 1)

The navigation apparatus of claim 1, wherein determining the estimated state of the object and the estimated state covariance matrix of the object for the current time, includes replacing an element of the estimated state covariance matrix corresponding to the interval start quantization error value with a covariance value determined in a prior iteration of the navigation update operation.

### Claim 6 (depends on 1)

The navigation apparatus of claim 1, wherein determining the estimated state of the object and the estimated state covariance matrix of the object for the current time includes replacing the interval end quantization error value in the estimated state with a second predefined value.

### Claim 7 (depends on 1)

The navigation apparatus of claim 1, wherein:
updating the estimated state and the estimated state covariance matrix in accordance with the predefined Kalman filter update operation includes using a Kalman gain function that includes a noise measurement matrix corresponding to the first measurement receiver; and
the noise measurement matrix corresponding to the first measurement receiver is zero.

### Claim 8 (depends on 1)

The navigation apparatus of claim 1, wherein:
updating the estimated state and the estimated state covariance matrix in accordance with the predefined Kalman filter update operation includes using a Kalman gain function that includes a sensitivity matrix;
the sensitivity matrix includes an interval end quantization error sensitivity value corresponding to the interval end quantization error value and an interval start quantization error sensitivity value corresponding to the interval start quantization error value; and
the interval end quantization error sensitivity value and the interval start quantization error sensitivity value are equal in magnitude and opposite in sign.

### Claim 9 (depends on 1)

The navigation apparatus of claim 1, wherein the one or more programs including instructions for generating one or more figures of merit, each figure of merit based on one or more diagonal elements of the estimated state covariance matrix.

### Claim 10 (depends on 1)

The navigation apparatus of claim 1, wherein:
the estimated state covariance matrix further includes covariance values for any of: sensor bias errors, attitude of the object, and sensor errors.

### Claim 11 (depends on 1)

The navigation apparatus of claim 1, wherein the one or more programs including instructions for reporting at least a portion of the estimated state of the object to a reporting apparatus.

### Claim 12 (depends on 1)

The navigation apparatus of claim 1, wherein the object is a mobile object.

### Claim 13 (depends on 1)

The navigation apparatus of claim 1, wherein the time intervals separating the sequence of times have a predetermined value.

### Claim 14 (depends on 1)

The navigation apparatus of claim 1, wherein the object includes at least one of the one or more measurement receivers.

### Claim 15

A method for determining an estimated position of an object, the method comprising:
at a navigation apparatus for determining an estimated position of an object:
receiving navigation information corresponding to a position or change in position of the object, including receiving, over time, navigation information comprising a sequence of quantized measurements, each having a corresponding quantization error;
at a sequence of times separated by time intervals, iteratively performing a navigation update operation, including:
determining an estimated state of the object and an estimated state covariance matrix of the object for a current time in the sequence of times based on an estimated state and estimated state covariance matrix of the object for a prior time in the sequence of times, wherein
the estimated state of the object includes a first portion that includes at least estimated position values and estimated velocity values, and a second portion that includes an interval end quantization error value and an interval start quantization error value;
the estimated state covariance matrix of the object includes a first portion that includes covariance values for the first portion of the estimated state, and a second portion that includes end and start covariance values corresponding to the interval end and interval start quantization error values, respectively, in the second portion of the estimated state; and
determining the estimated state of the object and the estimated state covariance matrix of the object for the current time comprises:
replacing the interval start quantization error value in the estimated state with the interval end quantization error value determined in a prior iteration of the navigation update operation; and
updating the estimated state and the estimated state covariance matrix in accordance with a predefined Kalman filter update operation to generate the estimated state of the object and the estimated state covariance matrix of the object for the current time.

### Claim 16 (depends on 15)

The method of claim 15, wherein the quantization error of each quantized measurement is negatively correlated with the quantization error of one or more prior quantized measurements in the sequence of quantized measurements.

### Claim 17 (depends on 15)

The method of claim 15, wherein updating the estimated state and the estimated state covariance matrix comprises updating the estimated state and the estimated state covariance matrix, using the predefined Kalman filter update operation, in accordance with a most recent quantized measurement in the sequence of quantized measurements.

### Claim 18 (depends on 15)

The method of claim 15, wherein determining the estimated state of the object and the estimated state covariance matrix of the object for the current time includes replacing an element of the estimated state covariance matrix corresponding to the interval end quantization error value with a first predefined value.

### Claim 19 (depends on 15)

The method of claim 15, wherein determining the estimated state of the object and the estimated state covariance matrix of the object for the current time, includes replacing an element of the estimated state covariance matrix corresponding to the interval start quantization error value with a covariance value determined in a prior iteration of the navigation update operation.

### Claim 20

A non-transitory computer readable storage medium storing one or more programs including instructions that, when executed by one or more processors of a navigation apparatus for determining an estimated position of an object, cause the navigation apparatus to perform operations comprising:
receiving navigation information corresponding to a position or change in position of the object, including receiving, over time, navigation information comprising a sequence of quantized measurements, each having a corresponding quantization error;
at a sequence of times separated by time intervals, iteratively performing a navigation update operation, including:
determining an estimated state of the object and an estimated state covariance matrix of the object for a current time in the sequence of times based on an estimated state and estimated state covariance matrix of the object for a prior time in the sequence of times, wherein
the estimated state of the object includes a first portion that includes at least estimated position values and estimated velocity values, and a second portion that includes an interval end quantization error value and an interval start quantization error value;
the estimated state covariance matrix of the object includes a first portion that includes covariance values for the first portion of the estimated state, and a second portion that includes end and start covariance values corresponding to the interval end and interval start quantization error values, respectively, in the second portion of the estimated state; and
determining the estimated state of the object and the estimated state covariance matrix of the object for the current time comprises:
replacing the interval start quantization error value in the estimated state with the interval end quantization error value determined in a prior iteration of the navigation update operation; and
updating the estimated state and the estimated state covariance matrix in accordance with a predefined Kalman filter update operation to generate the estimated state of the object and the estimated state covariance matrix of the object for the current time.
