Floor patterns for navigation corrections

• US 9,581,449 B1
• Filed: 01/25/2016
• Issued: 02/28/2017
• Est. Priority Date: 01/26/2015
• Status: Active Grant

• Current Assignee: George W. Batten Jr
• Original Assignee: George W. Batten Jr
• Inventors: Batten, George W. Jr.
• Primary Examiner(s): Kan, Yuri
• Application Number:
  US15/005,399
• Time in Patent Office: 400 Days
• US Class Current: 1/1
• CPC Class Codes: G01B 11/002 for measuring two or more coordinates
• CPC Class Codes: G01C 21/005 with correlation of navigation data from several sources, e.g. map or contour matching G01C21/30 takes precedence
• CPC Class Codes: G01C 21/20 Instruments for performing navigational calculations G01C21/24, G01C21/26 take precedence
• CPC Class Codes: G05D 1/0234 using optical markers or beacons optical beacons per se G01S1/70

Abstract

For a vehicle using dead reckoning or some other type of navigation which accumulates error as the vehicle moves, this invention provides a simple, single-sensor, low-cost, highly-accurate system for correcting navigation errors. The system uses a marker structure with optical density which is formed from one or more periodic patterns. The vehicle'"'"'s navigation computer records the density, measured by the sensor, as the sensor moves on a line over a marker at a known location, then it processes the recorded density function to get the correct navigation parameters. If the vehicle'"'"'s usual path passes over a marker, that path can be used without change for acquiring navigation corrections.

Claims

1. An automatic system for determining a position and direction-of-motion of a vehicle, which system comprises

set of position markers fixed in known positions,

a density sensor mounted on the vehicle and positioned so it determines density along a line as the vehicle moves,

a computer receiving density values determined by the density sensor, and maintaining an estimate of the position and direction-of-motion of the vehicle, and

a computer control system that directs the computer to perform computations for estimating the position and direction-of-motion of the vehicle from the density values as the sensor passes across any one of the position markers;

each of the position markers comprising one or more density patterns in a finite two-dimensional region;

each of the density patterns filling a two-dimensional region of a position marker;

each of the density patterns having a known orientation vector;

in the two-dimensional region, a density of each density pattern being a known periodic function of position in a direction of its orientation vector, and independent of position in a direction orthogonal to its orientation vector;

at each point of the two-dimensional region the position marker having a density which is a combination of its density-pattern densities at the same point;

the computer storing the density values it receives as a path density function until it determines that it has a quantity of them that is sufficient for performing the computations needed to estimate a current position and direction-of-motion of the vehicle;

the computer then performing mathematical operations necessary to determine frequency, phase, and amplitude values of various sinusoidal components of the path density function;

the computer then using so-determined amplitude value of each sinusoidal component of the path density function to determine which density pattern corresponds to that sinusoidal component;

the computer then performing mathematical operations necessary to use so-determined frequency and phase values of sinusoidal components of the path density function and spatial frequency and phase values of corresponding known density patterns of position markers to determine the vehicle'"'"'s direction-of-motion and an offset of a current estimate of the vehicle'"'"'s position from a vehicle'"'"'s actual position, and then using that offset to correct the current estimate of the vehicle'"'"'s position.

2. A system as in claim 1 for which a density-determining periodic function of a density pattern is a sinusoid.

3. A system as in claim 1 for which

at each point of the two-dimensional region the position marker has a density which is a constant plus a weighted sum of its density-pattern densities at the same point.

4. A system as in claim 1 for which

the density of each of the density patterns is between zero and one;

and at each point of the two-dimensional region the position marker has a density which is a multiplicative product of the densities of the density patterns at the same point,

with adjustment of a range of densities.

5. A system as in claim 1 for which

a set of position markers are positioned so the density sensor passes over them sequentially.

6. A system as in claim 1 for which

the frequencies, phases, and amplitudes of the sinusoidal components of the computer-stored path-density function are determined by using the Discrete Fourier Transform.