# US 5,708,438 A · Angular velocity calculating apparatus for navigation apparatus

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

- Number: US 5,708,438 A
- Document ID: US5708438A
- Status: Granted
- Kind: A
- Application number: 08/559,154
- Filed: 1995-11-17
- Granted: 1998-01-13
- Earliest claimed: 1994-11-25
- Assignees: Sony Corporation
- Inventors: Tamiya Tanaka; Masashi Ohkubo; Katsuhiko Nunokawa
- Web page: https://patentgrep.com/patent/US5708438A

## CPC

- G01P 3/44: for measuring angular speed (G01P3/56 takes precedence)
- G01C 21/28: with correlation of data from several navigational instruments
- G01P 3/56: for comparing two speeds
- G01P: MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT (measuring or recording blood flow A61B5/02, A61B8/06; monitoring speed or deceleration of electrically-propelled vehicles B60L3/00; vehicle lighting systems adapted to indicate speed B60Q1/54; determining position or course in navigation, measuring ground distance in geodesy or surveying G01C; combined measuring devices for measuring two or more variables of movement G01C23/00; measuring velocity of sound G01H; measuring velocity of light G01J7/00; measuring direction or velocity of solid objects by reception or emission of radiowaves or other waves and based on propagation effects, e.g. Doppler effect, propagation time, direction of propagation, G01S; measuring speed of nuclear radiation G01T; measuring acceleration of gravity G01V; {measuring or recording the speed of trains B61L23/00; speed indicators incorporated in motor vehicles B60K35/00; measuring frequency or phase G01R; traffic control G08G})
- 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)

## Abstract

An angular velocity calculating apparatus which is low-priced and capable of obtaining an angular velocity with high accuracy is realized. Two velocity detectors which are substantially small in offset error, noise, or the like, unlike the conventionally employed gyroscope, is disposed at portions on the moving matter or in the vicinity thereof, and the angular velocity is obtained on the basis of the velocity information obtained from these detectors. Accordingly, the angular velocity calculating apparatus and a navigation apparatus can be realized which is higher in accuracy and cheaper as compared with the conventional ones.

## Claims

### Claim 1

A navigation apparatus for a mobile vehicle, comprising:
plural velocity detectors each for detecting a velocity of the moving vehicle;
processing means for deriving a value of a parameter determining an angular velocity of said moving vehicle;
angular velocity calculating means for calculating the velocity of said moving vehicle based on the value of said parameter from said processing means;
velocity calculating means for calculating a mean velocity of said moving vehicle from outputs of said plural velocity detectors;
digital storage means for storing digital map data;
display means for displaying a map and a position of said vehicle on said map; and
a central processing unit for calculating a position of a vehicle based on said angular velocity determined by said angular velocity calculating means and said mean velocity determined by said velocity calculating means, for reading digital map data from said digital storage means, and for generating an output signal to said display means so that said display means displays said map and said position of said vehicle on said map.

### Claim 2 (depends on 1)

The navigation apparatus for a mobile vehicle according to claim 1, wherein each of said velocity detectors comprises:
a transmitter for transmitting a first electro-magnetic wave;
a receiver for receiving a second electro-magnetic wave, said second electro-magnetic wave being generated by reflecting said first electro-magnetic wave off of a surface; and
an antenna coupled to both said transmitter and said receiver.

### Claim 3 (depends on 1)

The navigation apparatus for a mobile vehicle according to claim 1, wherein said processing means derives the value for a radius of movement of said moving object.

### Claim 4 (depends on 3)

The navigation apparatus for a mobile vehicle according to claim 3, wherein said processing means derives the value for the radius of movement by using a first value of the radius, calculating an angle of said movement with the first value of the radius, calculating a distance of a projection between said plural velocity detectors, calculating a second value of said radius, and comparing the first value of said radius with said second value.

### Claim 5

An angular velocity calculating method, comprising the steps of:
detecting plural velocities of a moving matter at plural positions on said moving matter, respectively;
deriving a value of a parameter which determines an angular velocity of the moving matter; and
calculating an angular velocity of the moving matter based on the value of the parameter, wherein said deriving step comprises the steps of:
deriving a first value for the radius;
calculating an angle of movement of the moving matter;
calculating a distance of a projection between the plural velocity detectors;
calculating a second value of said radius; and
comparing a value of said first value of said radius with the second value of said radius.

### Claim 6 (depends on 5)

The angular velocity calculating method according to claim 5, wherein said step of detecting plural velocities comprises the steps of:
transmitting a first electro-magnetic wave;
receiving a second electro-magnetic wave, said second electro-magnetic wave being generated by reflecting the first electro-magnetic wave off of a surface; and
calculating the velocity of said moving matter from the second electro-magnetic wave by considering Doppler effect.

### Claim 7 (depends on 5)

The angular velocity calculating method according to claim 5, wherein said step of calculating the angular velocity comprises the steps of:
calculating an angle of movement of the moving matter by a following formula
.theta.=sin.sup.-1 (S/r),
where S is a distance from a back edge of said moving matter to a point of measure of said velocity and r is said radius;
calculating a distance of a projection between plural velocity detectors by a following formula
d=t.multidot.cos .theta.;
where t is a distance between plural velocity detectors; and
calculating the angular velocity by a following formula
.omega.=(v.sub.L -v.sub.R)/d
where v.sub.L and v.sub.R are velocities detected by two of said plural velocity detectors, respectively.

### Claim 8 (depends on 5)

The method as set forth in claim 5, wherein said step of comparing determines whether a difference between the second value of the radius and the first value of the radius is approximately equal to zero.

### Claim 9 (depends on 8)

The method as set forth in claim 8, wherein if the difference is not approximately equal to zero, then said method further comprises the steps of deriving a third value of the radius based on the difference, calculating a second angle of movement with the third value of the radius, calculating the distance of the projection between the plural velocity detectors with the second angle, calculating a fourth value of the radius, and determining whether a difference between the third and fourth values of the radius is approximately equal to zero.

### Claim 10

A navigation apparatus, comprising:
first and second velocity detectors mounted on a vehicle for acquiring first and second velocities of said vehicle;
a velocity calculating unit for determining a mean velocity of the vehicle based on the first and second velocities;
a processing unit for deriving a radius of movement of the vehicle based on the first and second velocities;
an angular velocity calculating unit for determining the angular velocity of the vehicle based on the radius of movement derived by the processing unit;
a central processing unit for obtaining a current position of the vehicle based on the mean velocity of the vehicle and the angular velocity of the vehicle;
a storage device for storing map information; and
a display;
wherein said central processing unit reads map information from the storage device and provides data to the display so that the display indicates the current position of the vehicle superimposed on the map information.

### Claim 11 (depends on 10)

The navigation apparatus as set forth in claim 10, wherein said storage device comprises a CD-ROM.

### Claim 12 (depends on 10)

The navigation apparatus as set forth in claim 10, further comprising an input device for receiving an initial position of the vehicle.
