# US 2013/0158871 A1 · Fusion of road geometry model information gathered from disparate sources

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

- Number: US 2013/0158871 A1
- Document ID: US20130158871A1
- Status: Published application
- Kind: A1
- Application number: 13/329,439
- Filed: 2011-12-19
- Published: 2013-06-20
- Earliest claimed: 2011-12-19
- Assignees: Ford Global Technologies, LLC
- Inventors: Peter Gyumyeong Joh
- Web page: https://patentgrep.com/patent/US20130158871A1

## CPC

- G01C 21/28: with correlation of data from several navigational instruments
- B60W 40/072: Curvature of the road
- B60W 2552/20: Road profile, i.e. the change in elevation or curvature of a plurality of continuous road segments
- B60W 2552/30: Road curve radius
- 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)
- 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

The inventive subject matter is directed to implementing the fusion of road geometry model information in different forms from different sources in a manner that is comprehensive, efficient, and effective. Such fused road geometry model information for a particular vehicle (i.e., an ego vehicle) provides for improved performance of active safety functionality. Examples of active safety functionalities include, but are not limited to, curve speed warning, selection of target objects that are potential threats to the ego vehicle by helping the ego vehicle's path prediction, and the like.

## Claims

### Claim 1

A method, comprising:
receiving road geometry model information generated by each one of a plurality of road geometry model information sources of a vehicle, wherein the road geometry model information of each one of the road geometry model information sources characterizes a geometry of an approaching segment of a roadway over which the vehicle is traveling; and
creating a synthetic road geometry model dependent upon the road geometry model information of a first one of the road geometry model information sources and the road geometry model information of a second one of the road geometry model information sources in response to determining that the road geometry model information of the first one of the road geometry model information sources and the road geometry model information of the second one of the road geometry model information sources each suitably approximate the geometry of the approaching segment of the roadway.

### Claim 2 (depends on 1)

The method of claim 1 wherein:
the first and second road geometry model information sources provide respective road geometry model information in different spatial information forms; and
creating the synthetic road geometry model includes altering a spatial information form of at least one of the road geometry model information of the first one of the road geometry model information sources and the road geometry model information of the second one of road geometry model information sources such that the road geometry model information of the first and second road geometry model information sources are in compatible spatial information forms.

### Claim 3 (depends on 2)

The method of claim 2 wherein:
the road geometry model information of the first one of the road geometry model information sources is configured in terms of a geographic coordinate system; and
the road geometry model information of the second one of road geometry model information sources is configured in terms of road curvature parameters.

### Claim 4 (depends on 2)

The method of claim 2 wherein altering the spatial information form includes:
translating a road shape line defined by the road geometry model information of the first one of the road geometry model information sources such that the road shape line passes through a central reference point of the vehicle; and
rotating the road shape line for causing a coordinate system of the road shape line to become aligned with a coordinate system utilized by the road geometry model information of the second one of road geometry model information sources.

### Claim 5 (depends on 4)

The method of claim 4 wherein:
the coordinate system of the road shape line is a first two-dimensional orthogonal coordinate system;
the coordinate system utilized by the road geometry model information of the second one of road geometry model information sources is a second two-dimensional orthogonal coordinate system;
the first and second two-dimensional orthogonal coordinate systems lie in a common plane; and
the first two-dimensional orthogonal coordinate system is skewed with respect to the second two-dimensional orthogonal coordinate system prior to rotation of the road shape line.

### Claim 6 (depends on 4)

The method of claim 4 wherein:
the road shape line is defined by a plurality of road shape points each expressed using a geographic coordinate system; and
altering the spatial information form includes converting geographic coordinates of each one of the road shape points to Cartesian coordinates having an origin defined by the central reference point of the vehicle.

### Claim 7 (depends on 1)

The method of claim 1 wherein:
the road geometry model information of the first one of the road geometry model information sources includes a plurality of road shape points defining a road shape line;
each one of the road shape points is expressed using geographic coordinates within a geographic coordinate system; and
creating the synthetic road geometry model includes converting the geographic coordinates of each one of the road shape points to Cartesian coordinates having an origin defined by the central reference point of the vehicle thereby defining the road shape line in Cartesian coordinates, translating the road shape line such that the road shape line passes through a central reference point of the vehicle after converting the geographic coordinates, and rotating the road shape line after translating the road shape line thereby causing a coordinate system of the road shape line to become aligned with a coordinate system utilized by the road geometry model information of the second one of road geometry model information sources.

### Claim 8 (depends on 7)

The method of claim 7 wherein creating the synthetic road geometry model includes comparing a quantitative characterization of the road geometry model information of the first one of the road geometry model information sources with a quantitative characterization of the road geometry model information of the second one of the road geometry model information sources after rotating the road shape line for determining if the road geometry model information of the first one of the road geometry model information sources and the road geometry model information of the second one of the road geometry model information sources each suitably approximate the geometry of the approaching segment of the roadway, wherein the road geometry model information of the first one of the road geometry model information sources and the road geometry model information of the second one of the road geometry model information sources each suitably approximate the geometry of the approaching segment of the roadway when a difference between the quantitative characterization of the road geometry model information of the first one of the road geometry model information sources and the quantitative characterization of the road geometry model information of the second one of the road geometry model information sources is less than a characterization difference threshold.

### Claim 9 (depends on 1)

The method of claim 1 wherein creating the synthetic road geometry model includes comparing a quantitative characterization of the road geometry model information of the first one of the road geometry model information sources with a quantitative characterization of the road geometry model information of the second one of the road geometry model information sources for determining if the road geometry model information of the first one of the road geometry model information sources and the road geometry model information of the second one of the road geometry model information sources each suitably approximate the geometry of the approaching segment of the roadway, wherein the road geometry model information of the first one of the road geometry model information sources and the road geometry model information of the second one of the road geometry model information sources each suitably approximate the geometry of the approaching segment of the roadway when a difference between the quantitative characterization of the road geometry model information of the first one of the road geometry model information sources and the quantitative characterization of the road geometry model information of the second one of the road geometry model information sources is less than a characterization difference threshold.

### Claim 10 (depends on 9)

The method of claim 9 wherein:
the first and second road geometry model information sources provide respective road geometry model information in different spatial information forms; and
creating the synthetic road geometry model includes altering a spatial information form of at least one of the road geometry model information of the first one of the road geometry model information sources and the road geometry model information of the second one of road geometry model information sources such that the road geometry model information of the first and second road geometry model information sources are in compatible spatial information forms.

### Claim 11

A vehicle, comprising:
a plurality of road geometry model information sources each generating respective road geometry model information defining a respective road geometry model characterizing a geometry of an approaching segment of a roadway over which the vehicle is traveling; and
a road geometry model fusing module coupled to each one of the road geometry model information sources, wherein the road geometry model fusing module compares a first road geometry model generated by a first one of the a first one of the road geometry model information sources to a second road geometry model generated by a second one of the road geometry model information sources and, in response to determining that the first road geometry model and the second road geometry model each suitably approximate the geometry of the approaching segment of the roadway, creates a synthetic road geometry model dependent upon the first road geometry model and the second road geometry model.

### Claim 12 (depends on 11)

The vehicle of claim 11 wherein:
the first and second road geometry model information sources provide the respective road geometry, model information in different spatial information forms; and
creating the synthetic road geometry model includes altering a spatial information form of at least one of the road geometry model information of the first one of the road geometry model information sources and the road geometry model information of the second one of road geometry model information sources such that the road geometry model information of the first and second road geometry model information sources are in compatible spatial information forms.

### Claim 13 (depends on 12)

The vehicle of claim 12 wherein altering the spatial information form includes:
translating a road shape line defined by the road geometry model information of the first one of the road geometry model information sources such that the road shape line passes through a central reference point of the vehicle; and
rotating the road shape line for causing a coordinate system of the road shape line to become aligned with a coordinate system utilized by the road geometry model information of the second one of road geometry model information sources.

### Claim 14 (depends on 13)

The vehicle of claim 13 wherein:
the coordinate system of the road shape line is a first two-dimensional orthogonal coordinate system;
the coordinate system utilized by the road geometry model information of the second one of road geometry model information sources is a second two-dimensional orthogonal coordinate system;
the first and second two-dimensional orthogonal coordinate systems lie in a common plane; and
the first two-dimensional orthogonal coordinate system is skewed with respect to the second two-dimensional orthogonal coordinate system prior to rotation of the road shape line.

### Claim 15 (depends on 14)

The vehicle of claim 14 wherein:
the road shape line is defined by a plurality of road shape points each expressed using a geographic coordinate system; and
altering the spatial information form includes converting geographic coordinates of each one of the road shape points to Cartesian coordinates having an origin defined by the central reference point of the vehicle.

### Claim 16 (depends on 11)

The vehicle of claim 11 wherein creating the synthetic road geometry model includes comparing a quantitative characterization of the first road geometry model with a quantitative characterization of the second road geometry model for determining if the first road geometry model and the second road geometry model each suitably approximate the geometry of the approaching segment of the roadway, wherein the first road geometry model and the second road geometry model each suitably approximate the geometry of the approaching segment of the roadway when a difference between the quantitative characterization of the first road geometry model and the quantitative characterization of the second road geometry model is less than a characterization difference threshold.

### Claim 17

A processor-readable medium having tangibly embodied thereon and accessible therefrom a set of instructions interpretable by at least one data processing device, the processor-readable medium being non-transient, the set of instructions configured for causing the at least one data processing device to carry out operations for:
receiving road geometry model information generated by each one of a plurality of road geometry model information sources of a vehicle, wherein the road geometry model information of each one of the road geometry model information sources characterizes a geometry of an approaching segment of a roadway over which the vehicle is traveling; and
creating a synthetic road geometry model dependent upon the road geometry model information of a first one of the road geometry model information sources and the road geometry model information of a second one of the road geometry model information sources in response to determining that the road geometry model information of the first one of the road geometry model information sources and the road geometry model information of the second one of the road geometry model information sources each suitably approximate the geometry of the approaching segment of the roadway.

### Claim 18 (depends on 17)

The processor-readable medium of claim 17 wherein:
the first and second road geometry model information sources provide respective road geometry model information in different spatial information forms; and
creating the synthetic road geometry model includes altering a spatial information form of at least one of the road geometry model information of the first one of the road geometry model information sources and the road geometry model information of the second one of road geometry model information sources such that the road geometry model information of the first and second road geometry model information sources are in compatible spatial information forms.

### Claim 19 (depends on 18)

The processor-readable medium of claim 18 wherein altering the spatial information form includes:
translating a road shape line defined by the road geometry model information of the first one of the road geometry model information sources such that the road shape line passes through a central reference point of the vehicle; and
rotating the road shape line for causing a coordinate system of the road shape line to become aligned with a coordinate system utilized by the road geometry model information of the second one of road geometry model information sources.

### Claim 20 (depends on 19)

The processor-readable medium of claim 19 wherein:
the coordinate system of the road shape line is a first two-dimensional orthogonal coordinate system;
the coordinate system utilized by the road geometry model information of the second one of road geometry model information sources is a second two-dimensional orthogonal coordinate system;
the first and second two-dimensional orthogonal coordinate systems lie in a common plane; and
the first two-dimensional orthogonal coordinate system is skewed with respect to the second two-dimensional orthogonal coordinate system prior to rotation of the road shape line.

### Claim 21 (depends on 19)

The processor-readable medium of claim 19 wherein:
the road shape line is defined by a plurality of road shape points each expressed using a geographic coordinate system; and
altering the spatial information form includes converting geographic coordinates of each one of the road shape points to Cartesian coordinates having an origin defined by the central reference point of the vehicle.

### Claim 22 (depends on 17)

The processor-readable medium of claim 17 wherein:
the road geometry model information of the first one of the road geometry model information sources includes a plurality of road shape points defining a road shape line;
each one of the road shape points is expressed using geographic coordinates within a geographic coordinate system; and
creating the synthetic road geometry model includes converting the geographic coordinates of each one of the road shape points to Cartesian coordinates having an origin defined by the central reference point of the vehicle thereby defining the road shape line in Cartesian coordinates, translating the road shape line such that the road shape line passes through a central reference point of the vehicle after converting the geographic coordinates, and rotating the road shape line after translating the road shape line thereby causing a coordinate system of the road shape line to become aligned with a coordinate system utilized by the road geometry model information of the second one of road geometry model information sources.

### Claim 23 (depends on 22)

The processor-readable medium of claim 22 wherein creating the synthetic road geometry model includes comparing a quantitative characterization of the road geometry model information of the first one of the road geometry model information sources with a quantitative characterization of the road geometry model information of the second one of the road geometry model information sources after rotating the road shape line for determining if the road geometry model information of the first one of the roadgeometry model information sources and the road geometry model information of the second one of the road geometry model information sources each suitably approximate the geometry of the approaching segment of the roadway, wherein the road geometry model information of the first one of the road geometry model information sources and the road geometry model information of the second one of the road geometry model information sources each suitably approximate the geometry of the: approaching segment of the roadway when a difference between the quantitative characterization of the road geometry model information of the first one of the road geometry model information sources and the quantitative characterization of the road geometry model information of the second one of the road geometry model information sources is less than a characterization difference threshold.

### Claim 24 (depends on 17)

The processor-readable medium of claim 17 wherein creating the synthetic road geometry model includes comparing a quantitative characterization of the road geometry model information of the first one of the road geometry model information sources with a quantitative characterization of the road geometry model information of the second one of the road geometry model information sources for determining if the road geometry model information of the first one of the road geometry model information sources and the road geometry model information of the second one of the road geometry model information sources each suitably approximate the geometry of the approaching segment of the roadway, wherein the road geometry model information of the first one of the road geometry model information sources and the road geometry model information of the second one of the road geometry model information sources each suitably approximate the geometry of the approaching segment of the roadway when a difference between the quantitative characterization of the road geometry model information of the first one of the road geometry model information sources and the quantitative characterization of the road geometry model information of the second one of the road geometry model information sources is less than a characterization difference threshold.

### Claim 25 (depends on 24)

The processor-readable medium of claim 24 wherein:
the first and second road geometry model information sources provide respective road geometry model information in different spatial information forms; and
creating the synthetic road geometry model includes altering a spatial information form of at least one of the road geometry model information of the first one of the road geometry model information sources and the road geometry model information of the second one of road geometry model information sources such that the road geometry model information of the first and second road geometry model information sources are in compatible spatial information forms.
