The present invention relates to the positioning technology, particularly to a graphic information positioning system for recognizing roadside features and a method using the same.
A self-driving car, also known as an autonomous vehicle (AV), is a vehicle that is capable of sensing its environment and moving safely with little or no human input. Self-driving cars combine a variety of sensors to perceive their surroundings, such as radar, lidar, sonar, computer vision, and inertial measurement units. Advanced control systems interpret sensory information to identify appropriate navigation paths, as well as obstacles and relevant signage.
The common methods for positioning vehicles include a triangulation method, a simultaneous localization and mapping (SLAM) technology, a tag positioning method, and a fingerprint based map. The triangulation method needs to measure distances among an object and three reference points whose positions are known and obtain intersections of three circles whose centers are the reference points. However, the triangulation method has three or more reference points and lower positioning precision rather than heading information. The SLAM uses lidars to scan a point-cloud map for a driving path and estimate the position of a vehicle based on point-cloud matching. Nevertheless, establishing the point-cloud map is very time-consuming. The point-cloud map has a very high data volume. For example, the point-cloud map has 150 MB per kilometer. In an environment with less point-cloud features, the vehicle is not positioned using the SLAM. Thus, a differential global positioning system (DGPS) and a vehicle steering dynamic model are needed to correct the absolute heading direction of the vehicle. Based on trigonometric function, the tag positioning method uses lidars to scan tags at known points to derive the position of the vehicle. For example, the coordinate of a known bus stop is (x, y), the distance between the bus stop and the vehicle is d, an inclined angle is θ, and the position of the vehicle is (x-d sin θ, y-d cos θ). However, the technology also needs a DGPS and a vehicle steering dynamic model to correct the absolute heading direction of the vehicle. Besides, the arrangement of tags is difficultly established since the tags are easily shielded by street trees, pedestrians, or other obstructions. For the fingerprint based map, a first vehicle uses lidars to scan a point-cloud map for a driving path and a second vehicle estimates the position of the vehicle based on point-cloud matching. However, establishing the point-cloud map is time-consuming Although the data volume of the fingerprint based map is less than that of the SLAM, the fingerprint based map encodes data step by step and thus needs a larger operation volume. In an environment with less point-cloud features, the technology does also not position the vehicle.
To overcome the abovementioned problems, the present invention provides a graphic information positioning system for recognizing roadside features and a method using the same.
The primary objective of the present invention is to provide a graphic information positioning system for recognizing roadside features and a method using the same, which overlook a load to obtain a road imaging map, retrieve the point-cloud map of a driving planar environment, use the space superposed technology to rapidly divide the road imaging map into a road space and a roadside space and obtain the space information for specific objects, filter out dynamic objects not required, use static objects remaining as roadside featured points, and establish positioning graphic information with high precision and less data volume.
Another objective of the present invention is to provide a graphic information positioning system for recognizing roadside features and a method using the same, which use a drone to retrieve a road imaging map and use a high-resolution camera to capture low-cost aerial photographs, thereby obtaining a high-precision road map.
Further objective of the present invention is to provide a graphic information positioning system for recognizing roadside features and a method using the same, which use roadside featured points as reference points to calculate the heading angle of a moving vehicle, thereby precisely positioning the moving vehicle.
To achieve the abovementioned objectives, the present invention provides a graphic information positioning method for recognizing roadside features comprising: using at least one first detector to overlook and detect a road, thereby establishing a road imaging map, wherein the road imaging map includes a plurality of featured points; installing at least one second detector on at least one moving vehicle to detect a driving environment around the at least one moving vehicle to obtain a point-cloud map when the at least one moving vehicle runs, using the at least one second detector to determine whether the point-cloud map includes the plurality of featured points, filter out at least one dynamic object of the plurality of featured points, set featured attributes of a plurality of roadside featured points, and establish positioning graphic information according to the road imaging map, the remains of the plurality of featured points of the point-cloud map, and the featured attributes; storing the positioning graphic information into the at least one moving vehicle, using a graphic information positioning system installed in the at least one moving vehicle to scan a front road and recognize at least two roadside featured points of the plurality of roadside featured points according to the positioning graphic information when the at least one moving vehicle runs, and using the positioning graphic information to calculate a moving-vehicle heading angle based on the at least two roadside featured points as reference points; and using the moving-vehicle heading angle and the at least two roadside featured points to calculate a position of the moving vehicle.
In an embodiment of the present invention, a method of establishing the positioning graphic information further comprises: overlaying the road imaging map with the point-cloud map to recognize a road space and at least one roadside space; filtering out the at least one dynamic object of the plurality of featured points and a plurality of static objects of the plurality of featured points remaining as the plurality of roadside featured points; setting the featured attributes of the plurality of roadside featured points; and establishing the positioning graphic information according to a superposed map of overlaying the road imaging map with the point-cloud map, the plurality of roadside featured points, and the featured attributes.
In an embodiment of the present invention, the at least one roadside space, divided into at least two of a sidewalk, a bicycle lane, and an overhang of a storefront from inside to outside, includes a first roadside space and a second roadside space. The featured attributes include latitudes, longitudes, shapes, sizes, and heights.
In an embodiment of the present invention, the at least one moving vehicle captures a roadside image when the at least one moving vehicle runs, the at least one moving vehicle recognizes at least one target object, and the graphic information positioning system of the at least one moving vehicle determines whether the at least one target object is one of the plurality of roadside featured points according to the featured attributes of the positioning graphic information.
The present invention also provides a graphic information positioning system installed in an on-board system of a moving vehicle. The system positions the moving vehicle and comprises: a database storing positioning graphic information, which includes a plurality of roadside featured points and the featured attributes of the plurality of roadside featured points; a roadside featured recognition module scanning a front road and determining at least two roadside featured points of the plurality of roadside featured points corresponding to the featured attributes according to the positioning graphic information; a moving-vehicle heading angle estimation module calculating a moving-vehicle heading angle based on the at least two roadside featured points as reference points; and a moving-vehicle position estimation module using the moving-vehicle heading angle and the at least two roadside featured points to calculate the position of the moving vehicle.
Below, the embodiments are described in detail in cooperation with the drawings to make easily understood the technical contents, characteristics and accomplishments of the present invention.
The present invention provides a graphic information positioning system for recognizing roadside features and a method using the same, which overlook a road to obtain a road imaging map with high precision, overlays the road imaging map with a point-cloud map around a moving vehicle, rapidly positions a road space and a roadside space, filter out dynamic objects not required, and use remaining static objects, thereby greatly reducing the data volume of positioning graphic information. The present invention uses only two reference points to calculate the position of the vehicle rather than uses a triangulation method, thereby greatly reducing the operation complexity. Applied to positioning an autonomous vehicle, the precision of the present invention reaches a range of 1-10 centimeters. The precision of the conventional global positioning system has an error range of 1-2 meters. Compared with the global positioning system, the precision of the present invention may be still accepted. Thus, the method for using the positioning graphic information of the present invention may guarantee the precision and safety of the autonomous vehicle.
Referring to
Referring
There is no static object in the roadside space, which represents that no the roadside featured points exist. As a result, the roadside space is directly eliminated and the road space remains, thereby greatly reducing the data volume of the positioning graphic information.
Referring
The featured attributes of the roadside featured points depend on different objects. For example, all of the size, height, and shape of a traffic light, a bus stop, and a signboard at a store are recorded in the positioning graphic information.
After establishing the positioning graphic information, the positioning graphic information is stored into a cloud platform or a graphic information positioning system of the moving vehicle. The graphic information positioning system periodically updates the latest positioning graphic information from the cloud platform. The graphic information positioning system, installed in an on-board system of the moving vehicle, computes the positioning graphic information to output the position information of the moving vehicle. As shown in
In Step S12 of
If the heading direction of the moving vehicle is not parallel to the direction of the road, the distance between the moving vehicle and the road is longer and longer when the moving vehicle runs. In order to precisely position the moving vehicle, Step S14 of
x
v1
=x
1
−R
1 sin(θv+ϕ1)=x1−R1 sin θv cos ϕ1−R1 cos θv sin ϕ1=x1−(R1 cos ϕ1)α−(R1 sin ϕ1)β
y
v1
=y
1
−R
1 sin(θv+ϕ1)=y1−R1 sin θv cos ϕ1−R1 cos θv sin ϕ1=y1−(R1 cos ϕ1)α−(R1 sin ϕ1)β
Wherein, α=sin θv, β=cos θv.
Similarly, the coordinate of another roadside featured point is (x0,y0) and the coordinate of the moving vehicle is calculated as follows:
x
v0
=x
0−(R0 cos ϕ0)α−(R0 sin ϕ0)β
y
v0
=y
0−(R0 sin ϕ0)α−(R0 cos ϕ0)β
Since xv0=xv1 and yv0=yv1, Y=HX, wherein X=[α/β]T,
Thus, x=H−1Y.
Since xv0=xv1 and yv0=yv1, θv is obtained. That is to say, the inclined angle between the heading direction of the moving vehicle and a direction that the moving vehicle straightly runs, namely the moving-vehicle heading angle, is obtained. The triangulation method requires the three reference points to calculate the position of the moving vehicle. The present invention is different from the triangulation method. Based on the calculation process, only required two of the roadside featured points as the reference points can be used to calculate the position of the moving vehicle.
Afterwards, in Step S16 of
In conclusion, the graphic information positioning system for recognizing roadside features and the method using the same of the present invention use a low-cost aerial photograph to retrieve a high-precision road imaging map, overlay the road imaging map with the point-cloud map established by the driving environment around the vehicle to classify the road space, the roadside space, the dynamic objects, and the static objects, eliminate the dynamic objects and the empty roadside space to greatly reduce the data volume, and require only two roadside featured points as the reference points to calculate the heading angle and the position of the moving vehicle. The present invention has low operation complexity and high reliability. Without using the GPS, the present invention has the precision of centimeters and positions and navigates an autonomous vehicle.
The embodiments described above are only to exemplify the present invention but not to limit the scope of the present invention. Therefore, any equivalent modification or variation according to the shapes, structures, features, or spirit disclosed by the present invention is to be also included within the scope of the present invention.