# US 2010/0164807 A1 · System and method for estimating state of carrier

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

- Number: US 2010/0164807 A1
- Document ID: US20100164807A1
- Status: Published application
- Kind: A1
- Application number: 12/398,187
- Filed: 2009-03-05
- Published: 2010-07-01
- Earliest claimed: 2008-12-30
- Assignees: Industrial Technology Research Institute
- Inventors: Kuo-Shih Tseng; Chih-Wei Tang; Chin-Lung Lee; Chia-Lin Kuo; An-Tao Yang
- Web page: https://patentgrep.com/patent/US20100164807A1

## CPC

- G01S 5/0284: {Relative positioning}
- G01C 21/1656: {with passive imaging devices, e.g. cameras}
- G01S 5/0247: {Determining attitude}
- 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
- 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

A system and a method for estimating a state of a carrier are provided. The system includes the carrier, an electromagnetic wave sensing device, a motion sensing device, and a controller. The electromagnetic wave sensing device detects an electromagnetic wave emitted by at least one feature object in an environment around the carrier. The motion sensing device detects motion information of the carrier moving in the environment. The controller estimates state information of the carrier in the environment through a probabilistic algorithm according to the electromagnetic wave and motion information detected by aforementioned sensing devices. Thereby, in the present invention, the location and posture of the carrier in the environment can be precisely estimated according to the motion information of the carrier and existing information of the environment around the same.

## Claims

### Claim 1

A carrier state estimation method, suitable for estimating state information of a carrier, the carrier state estimation method comprising:
detecting an electromagnetic wave emitted by at least one feature object in an environment around the carrier, so as to calculate a relative position between the carrier and each of the feature objects;
detecting motion information of the carrier moving in the environment; and
estimating the state information of the carrier in the environment through a probabilistic algorithm according to the relative position and the motion information.

### Claim 2 (depends on 1)

The carrier state estimation method according to claim 1, wherein before the step of detecting the electromagnetic wave emitted by the feature object in the environment, the carrier state estimation method further comprises:
obtaining a map of the environment, wherein the map comprises location information of the feature object in the environment.

### Claim 3 (depends on 2)

The carrier state estimation method according to claim 2, wherein the step of obtaining the map of the environment comprises:
detecting the electromagnetic wave before and after a time interval to obtain two image information of the environment; and
calculating location information of the feature object in the environment by using the image information, so as to establish the map of the environment.

### Claim 4 (depends on 3)

The carrier state estimation method according to claim 3, wherein after the step of obtaining the image information of the environment, the method further comprises:
performing one or a combination of noise removal, illumination correction, image rectification, feature extraction, image description, and eye comparison to the image information.

### Claim 5 (depends on 1)

The carrier state estimation method according to claim 1, wherein the step of calculating the relative position between the carrier and each of the feature objects comprises:
estimating a distance between the carrier and the feature object according to a power or a geometric distance of the detected electromagnetic wave; and
calculating the relative position between the carrier and the feature object according to two of the distances estimated consecutively and an angle of the electromagnetic wave.

### Claim 6 (depends on 1)

The carrier state estimation method according to claim 1, wherein the step of detecting the motion information of the carrier moving in the environment comprises:
detecting posture angles of the carrier corresponding to three coordinate axes.

### Claim 7 (depends on 6)

The carrier state estimation method according to claim 6, wherein the step of estimating the state information of the carrier in the environment through the probabilistic algorithm according to the relative position and the motion information comprises:
integrating the posture angles to calculate a displacement and a speed of the carrier corresponding to each of the coordinate axes; and
determining a location and a posture of the carrier in the environment according to the posture angle, the displacement, and the speed of the carrier on each of the coordinate axes and serving the location and the posture of the carrier as the state information of the carrier in the environment.

### Claim 8 (depends on 7)

The carrier state estimation method according to claim 7, wherein the step of estimating the state information of the carrier in the environment through the probabilistic algorithm according to the relative position and the motion information further comprises:
correcting the location of the carrier in the environment through the probabilistic algorithm according to the relative position between the carrier and the feature object.

### Claim 9 (depends on 1)

The carrier state estimation method according to claim 1, wherein the motion information comprises a speed, an acceleration, an angular speed, or an angular acceleration.

### Claim 10 (depends on 1)

The carrier state estimation method according to claim 1 further comprising:
emitting a mechanical wave from the carrier to the environment, and receiving the mechanical wave reflected by the feature object in the environment, so as to calculate the relative position between the carrier and the feature object.

### Claim 11 (depends on 10)

The carrier state estimation method according to claim 10, wherein the step of calculating the relative position between the carrier and the feature object comprises:
estimating a distance between the carrier and the feature object according to a power or a geometric distance of the mechanical wave reflected by the feature object in the environment; and
calculating the relative position between the carrier and the feature object by using two of the distances estimated consecutively and an angle of the mechanical wave.

### Claim 12

A carrier state estimation system, comprising:
a carrier;
an electromagnetic wave sensing device, disposed in the carrier, for detecting an electromagnetic wave emitted by at least one feature object in an environment around the carrier;
a motion sensing device, disposed in the carrier, for detecting motion information of the carrier moving in the environment; and
a controller, disposed in the carrier and coupled to the electromagnetic wave sensing device and the motion sensing device, for estimating state information of the carrier in the environment through a probabilistic algorithm according to the electromagnetic wave and the motion information.

### Claim 13 (depends on 12)

The carrier state estimation system according to claim 12 further comprising:
a storage unit, disposed in the carrier, for recording a map of the environment and providing the map to the controller for estimating the state information, wherein the map comprises location information of the feature object in the environment.

### Claim 14 (depends on 13)

The carrier state estimation system according to claim 13, wherein the electromagnetic wave sensing device detects the electromagnetic wave before and after a time interval to obtain two image information of the environment, and the controller calculates the location information of the feature object in the environment by using the image information so as to establish the map of the environment.

### Claim 15 (depends on 12)

The carrier state estimation system according to claim 12, wherein the controller comprises:
a quaternion calculation unit, for receiving angular displacements of the carrier corresponding to three coordinate axes of the carrier detected by the motion sensing device and converting the angular displacements into a plurality of operators;
a direction cosine calculation unit, for performing a direction cosine calculation on the operators to obtain a posture angle of the carrier corresponding to each of the coordinate axes;
a gravity component extraction unit, for calculating an acceleration of the carrier corresponding to each of the coordinate axes according to the posture angle of the carrier corresponding to the coordinate axis;
an acceleration integration unit, for calculating a speed of the carrier on each of the coordinate axes according to the acceleration of the carrier corresponding to the coordinate axis and the angular displacements of the carrier corresponding to the three coordinate axes of the carrier detected by the motion sensing device;
a speed integration unit, for calculating a displacement of the carrier on each of the coordinate axes according to the speed of the carrier on the coordinate axis;
a coordinate conversion unit, for converting the coordinate axes of the displacement of the carrier into the coordinate axes of the environment;
a data association unit, for calculating a plurality of environment features on the coordinate axes corresponding to features currently detected by the carrier according to the displacement of the carrier on each of the converted coordinate axes through data association; and
a digital filter, for calculating a posture angle, a speed, and a displacement of the carrier on each of the coordinate axes according to the environment features of the carrier on the coordinate axis, and generating a plurality of operators and sending the operators back to the quaternion calculation unit.

### Claim 16 (depends on 15)

The carrier state estimation system according to claim 15, wherein the controller further comprises:
an environment feature calculation unit, for estimating a distance between the carrier and the feature object according to a power or a geometric distance of the electromagnetic wave detected by the electromagnetic wave sensing device, and calculating the relative position between the carrier and the feature object by using two of the distances estimated consecutively and an angle of the electromagnetic wave, so as to calculate a location and a posture of the carrier in the environment.

### Claim 17 (depends on 16)

The carrier state estimation system according to claim 16, wherein the digital filter further corrects the displacement of the carrier on each of the coordinate axes through a probabilistic algorithm according to the location and the posture of the carrier in the environment calculated by the environment feature calculation unit.

### Claim 18 (depends on 15)

The carrier state estimation system according to claim 15, wherein the digital filter further sends the speed and the displacement of the carrier on each of the coordinate axes back to the acceleration integration unit and the speed integration unit.

### Claim 19 (depends on 15)

The carrier state estimation system according to claim 15, wherein the digital filter comprises a Kalman filter, a particle filter, or a Bayesian filter.

### Claim 20 (depends on 12)

The carrier state estimation system according to claim 12 further comprising:
a mechanical wave transceiver device, disposed in the carrier, for emitting a mechanical wave from the carrier to the environment and receiving the mechanical wave reflected by the feature object in the environment.

### Claim 21 (depends on 20)

The carrier state estimation system according to claim 20, wherein the controller calculates the state information of the carrier in the environment according to the mechanical wave received by the mechanical wave transceiver device.

### Claim 22 (depends on 21)

The carrier state estimation system according to claim 21, wherein the mechanical wave transceiver device comprises an ultrasound, an ultrasound array, or a sonar.

### Claim 23 (depends on 12)

The carrier state estimation system according to claim 12, wherein the electromagnetic wave sensing device comprises a visible light vision sensor, an invisible light vision sensor, an electromagnetic wave sensor, or an infrared sensor.

### Claim 24 (depends on 12)

The carrier state estimation system according to claim 12, wherein the motion sensing device comprises an accelerometer, a gyroscope, or a rotational speed sensor.

### Claim 25 (depends on 12)

The carrier state estimation system according to claim 12, wherein the carrier comprises an automobile, a motorcycle, a bicycle, or a robot.
