This application is based on and claims priority from Korean Patent Application No. 10-2012-0121565, filed on Oct. 30, 2012 in the Korean Intellectual Property Office, the disclosure of which is incorporated herein in its entirety by reference.
1. Field of the Invention
The present invention relates to an apparatus and a method for is estimating a velocity of a vehicle, and more particularly, to an apparatus and a method for estimating a velocity of a vehicle based on a relative velocity between the vehicle and fixed bodies in the vicinity of the vehicle.
2. Description of the Prior Art
Generally, velocity of a vehicle is estimated based on a velocity sensor mounted on a steering wheel, an acceleration sensor, or a difference between past and current positions of a vehicle that are acquired through a GPS. Recently, velocity estimates have been made by analyzing an image of a bottom of a vehicle or attaching an encoder to a wheel of a vehicle.
For example, Korean Patent Application No. 2010-0033581 describes a technique in which deceleration and acceleration of a vehicle are estimated by using engine torque information and sensor information, such as brake pressure and the like, according to a driving condition and a control condition of the vehicle. Based on the estimated deceleration and acceleration, an estimate of the reference velocity of the vehicle is made
However, with these techniques, errors and difficulties may occur. For example, in the technique which utilizes a velocity sensor mounted on a steering wheel, an error may result from sliding of the wheel at the time the velocity is measured through the sensors. I In the case of GPS, it is difficult to estimate velocity of a vehicle in a shadowy area. Further, in the technique which analyzes an image of a bottom of a vehicle, expensive equipment is necessary for processing the image.
The present invention provides an apparatus and a method for estimating velocity of a vehicle which utilizes information acquired from objects in the vicinity of the vehicle. In particular, the present method facilitates estimation of relative velocity by classifying and grouping distance information acquired from objects in the vicinity of the vehicle, wherein each distance information of the same objects or adjacent objects is grouped according to a specific reference.
The present invention further provides an apparatus and a method for estimating velocity of a vehicle that simplifies a velocity estimation calculation without requiring a separate apparatus and system. In particular, by comparing velocity values calculated for each group to estimate velocity values of fixed bodies (relative to the vehicle), an estimated velocity of the vehicle is calculated.
In one aspect of the present invention, there is provided an apparatus for estimating velocity of a vehicle, including: a surrounding environment information acquisition unit configured for acquiring surrounding environment information of the vehicle from at least one sensor mounted in the vehicle; a distance information extraction unit configured for extracting distance information (distance between the vehicle and objects in the vicinity of the vehicle) from among the surrounding environment information acquired by the sensor; a group setting unit that classifies and groups the distance information between the vehicle and the objects in the vicinity of the vehicle according to a preset reference; a velocity calculation is unit that calculates relative velocities between the vehicle and the objects for each group set by the group setting unit; and a velocity estimation unit that estimates the velocity of the vehicle based on velocity values having the highest generation frequency among the relative velocities between the vehicle and the objects calculated for each group.
According to various embodiments, the surrounding objects include fixed bodies, and the velocity value having the highest generation frequency (the velocity value that is calculated most frequently) is a relative velocity between the fixed bodies located in the vicinity of the vehicle and the vehicle.
According to various embodiments, the group setting unit classifies the distance information based on a relative position of the surrounding objects and a continuing change in distance values.
According to various embodiments, the distance information is based on the acquired position of surrounding objects and distance values between the objects and the vehicle. As such, the group setting unit may be configured to classify the distance information in the same group when a difference between the distance values of adjacent positions is within a reference value. The group setting unit may further be configured to classify the distance information in different groups when the difference of distance values of adjacent positions exceeds the reference value.
According to various embodiments, the sensor is a sensor, such as, LIDAR, ToF camera, and the like, that transmits the distance value of the surrounding objects as data.
In another aspect of the present invention, there is provided a is method for estimating velocity of a vehicle, including: acquiring surrounding environment information of the vehicle from at least one sensor mounted in the vehicle; extracting distance information between the vehicle and objects in the vicinity of the vehicle from among the surrounding environment information acquired by the sensor; classifying and grouping the distance information (distance between the vehicle and the objects in the vicinity of the vehicle) according to a preset reference value; calculating a relative velocity between the vehicle and the objects for each group; and estimating the velocity of the vehicle based on velocity values having the highest generation frequency from among the relative velocities (velocities between the vehicle and the objects) calculated for each group.
The above and other objects, features and advantages of the present invention will be more apparent from the following detailed description taken in conjunction with the accompanying drawings, in which:
In the figures, reference numbers refer to the same or equivalent parts of the present invention throughout the several figures of the drawing.
Hereinafter, preferred embodiments of the present invention will be described in detail with reference to the accompanying drawings.
It is understood that the term “vehicle” or “vehicular” or other similar term as used herein is inclusive of motor vehicles in general such as passenger automobiles including sports utility vehicles (SUV), buses, trucks, various commercial vehicles, watercraft including a variety of boats and ships, aircraft, and the like, and includes hybrid vehicles, electric vehicles, plug-in hybrid electric vehicles, hydrogen-powered vehicles and other is alternative fuel vehicles (e.g. fuels derived from resources other than petroleum). As referred to herein, a hybrid vehicle is a vehicle that has two or more sources of power, for example both gasoline-powered and electric-powered vehicles.
Additionally, it is understood that the below methods are executed by at least one controller. The term controller refers to a hardware device that includes a memory and a processor. The memory is configured to store the modules and the processor is specifically configured to execute said modules to perform one or more processes which are described further below.
Furthermore, the control logic of the present invention may be embodied as non-transitory computer readable media on a computer readable medium containing executable program instructions executed by a processor, controller or the like. Examples of the computer readable mediums include, but are not limited to, ROM, RAM, compact disc (CD)-ROMs, magnetic tapes, floppy disks, flash drives, smart cards and optical data storage devices. The computer readable recording medium can also be distributed in network coupled computer systems so that the computer readable media is stored and executed in a distributed fashion, e.g., by a telematics server or a Controller Area Network (CAN).
The terminology used herein is for the purpose of describing particular embodiments only and is not intended to be limiting of the invention. As used herein, the singular forms “a,” “an” and “the” are is intended to include the plural forms as well, unless the context clearly indicates otherwise. It will be further understood that the terms “comprises” and/or “comprising,” when used in this specification, specify the presence of stated features, integers, steps, operations, elements, and/or components, but do not preclude the presence or addition of one or more other features, integers, steps, operations, elements, components, and/or groups thereof. As used herein, the term “and/or” includes any and all combinations of one or more of the associated listed items.
Unless specifically stated or obvious from context, as used herein, the term “about” is understood as within a range of normal tolerance in the art, for example within 2 standard deviations of the mean. “About” can be understood as within 10%, 9%, 8%, 7%, 6%, 5%, 4%, 3%, 2%, 1%, 0.5%, 0.1%, 0.05%, or 0.01% of the stated value. Unless otherwise clear from the context, all numerical values provided herein are modified by the term “about.
Here, the surrounding objects may correspond to mobile bodies M and fixed bodies F. According to an embodiment, the surrounding objects correspond to the fixed bodies F when there are no mobile bodies M in the vicinity of a vehicle. In other words, according to an embodiment of the present invention, it is assumed that fixed bodies F are necessarily located in the vicinity of the vehicle 10. In order to accurately estimate velocity of the vehicle, it is preferred that a large number of fixed bodies F are located in the vicinity of the vehicle 10.
For example, as illustrated in
In this case, the apparatus for estimating velocity of a vehicle acquires surrounding environment information detected by at least one surrounding environment detection sensor 15. The apparatus is configured to extract the distance information from among the surrounding environment information and to group the distance information according to preset conditions. After extracting and grouping the distance information, the apparatus then compares relative velocity values for each group and estimates, as the velocity of the vehicle 10, a velocity value having a high generation frequency (a most common velocity value, also referred to as a mode).
A configuration of an apparatus for estimating velocity of a vehicle 10 according to an embodiment of the present invention will be described below in detail with reference to
Referring to
The surrounding environment information acquisition unit 120 is in connection with at least one surrounding environment detection sensor 15 mounted in the vehicle 10. The surrounding environment information is acquisition unit 120 is configured so as to acquire the surrounding environment information of the vehicle 10 from the surrounding environment detection sensor 15. As described above, the surrounding environment detection sensor 15 includes at least one sensor for measuring a distance such as LIDAR, ToF, and the like. The surrounding environment information detected by the surrounding environment detection sensor 15 includes distance information on the surrounding objects. Preferably, the surrounding environment information includes the distance information on fixed bodies F in the vicinity of the vehicle 10.
The output unit 130 is configured to output operation status data of the apparatus 100 and estimated results of velocity of the vehicle 10. Here, the output unit 130 may correspond to a vehicle display, a speaker, and the like, and may display the estimated results of velocity of the vehicle 10 on the vehicle display or may output the estimated results as a voice signal through the speaker.
The storage unit 140 is configured for storing a setting value for the operation of the apparatus 100 for estimating velocity of a vehicle, and the like. According to various embodiments, the storage unit stores operation result values, for example, surrounding environment information, group information, velocity information, and the like.
The distance information extraction unit 150 is configured for extracting the distance information from among the surrounding environment information acquired by the surrounding environment detection sensor 15. In particular, the distance information extraction unit 150 can be configured to extract the distance information on the is surrounding objects located in the vicinity of the vehicle, for example, the mobile bodies M and the fixed bodies F.
The group setting unit 160 is configured for classifying and grouping the distance information on the surrounding objects according to the preset reference. In this case, the group setting unit 160 may classify the distance information based on the relative position of the surrounding objects and the change in the distance values (the continued positions of the objects as the vehicle travels). In particular, the group setting unit 160 may be configured to classify the distance information in the same group when the difference between the distance values of the adjacent positions is within a reference value (based on the acquired position and distance values). The group setting unit 160 would then classify the distance information as different groups when the difference of the distance values of the adjacent positions exceeds the reference value (based on the acquired position and distance values).
The velocity calculation unit 170 is configured for calculating the relative velocities between the vehicle and the surrounding objects for each of groups that are set by the group setting unit 160. For example, the velocity calculation unit 170 can be configured to calculates the relative velocities between the vehicle and the surrounding objects within each group by dividing distance change vectors of each group by time.
The velocity estimation unit 180 is configured for estimating the velocity of the vehicle based the velocity value having the highest generation frequency (mode) from among the relative velocities of each group calculated by the velocity calculation unit 170. According to certain embodiments, the fixed bodies F are located more in the vicinity of a vehicle than the mobile bodies M and therefore, the velocity value having the highest generation frequency becomes the relative velocity values between the fixed bodies F located in the vicinity of a vehicle and the vehicle.
In some cases, the velocity estimation unit 180 is configured to estimate the velocity values extracted from a predetermined time, that is, the average value of the velocity values having the highest generation frequency from among the relative velocities of each group. In some cases, if a velocity value has a large difference in its average value as compared with relative velocities of each group, the velocity value may be considered to be an erroneous calculation and may be temporarily extracted.
For example, the apparatus 100 for estimating velocity of the vehicle may group the distance information G1 from the fixed bodies F1 located in the left direction of the vehicle 10, and may group the distance information is from the mobile bodies M1 located in the left diagonal direction as G2. In this case, the distance information from the fixed bodies F1 and the distance information from the mobile bodies M1 are classified as different groups since the fixed bodies and the mobile bodies are adjacent to each other, or the difference in the distance change (change in distance between the bodies, F1 and M1, and the vehicle 10 as the vehicle travels) is large. For example, because the fixed body F1 does not move as the vehicle 10 travels, the distance change (change in distance between the vehicle 10 and the fixed body F1) will generally by larger as compared to the distance change (change in distance between the vehicle 10 and the mobile body M1) as the vehicle 10 travels if the mobile body M1 moves along the same direction as the vehicle 10.
Similarly, the apparatus for estimating velocity of a vehicle groups the distance information from the mobile bodies M2 located in the right diagonal direction of the vehicle 10 as G3, groups the distance information from the fixed bodies F2 located in the right diagonal direction as G4, and groups the distance information from the fixed bodies F3 located in the right direction as G5.
In this case, the distance information from the mobile bodies M2 located in the right diagonal direction and the distance information from the fixed bodies F2, F3 are classified as different groups since the fixed bodies F2, F3 and the mobile bodies M2 are adjacent to each other, or the difference in the distance change (change in distance between the bodies, F2, F3 and M2, and the vehicle 10 as the vehicle travels) is large. Further, the distance information from the fixed bodies F2 located in the right is diagonal direction and the fixed bodies F3 located in the right direction are classified as different groups since the fixed bodies F2, F3 and the mobile bodies M2 are adjacent to each other or the difference in the distance change is large. If the two fixed bodies F2, F3 are adjacent to each other and thus, the difference in the distance change is not large, the distance information from the two fixed bodies F2, F3 may be grouped into one group.
As illustrated in
In
In this case, the apparatus for estimating velocity of the vehicle 10 calculates velocity using the distance change vectors for each group. In this case, the velocity information calculated by the apparatus for estimating velocity of a vehicle is illustrated in
Referring to
Meanwhile, since the mobile body M1 of the G2 group moves by “b” per time and the vehicle 10 moves by “a” per unit time, the velocity is calculated based on the distance change vector of the mobile body M1 of the G2 group and the vehicle 10. In this case, the calculated velocity of the G2 group becomes b−a.
Further, since the mobile body M2 of the G3 group moves by “c” per time and the vehicle 10 moves by “a” per unit time, the velocity is calculated based on the distance change vector of the mobile body 2 of the G3 group and the vehicle 10. In this case, the calculated velocity of the G3 group becomes c−a.
In the case of the embodiment shown by
For example,
In this case, the apparatus for estimating velocity of a vehicle 10 groups the distance information on the first fixed body as G1, the distance information on the mobile body as G2, the distance information on the second fixed body as G3, the distance information on the second mobile body as G4, the corresponding distance information on the third fixed body as G5, and the distance information on the fourth fixed body as G6.
In
In this case, the apparatus 100 for estimating velocity of the vehicle 10 calculates velocity using the distance change vectors for each group and the calculated velocities for each group based on each distance change vector are illustrated in
Referring to
Meanwhile, since the first mobile body moves by “b” per unit time and the vehicle moves by “a” per unit time, the velocity of the G2 group is is calculated based on the distance change vector of the first mobile body and the vehicle 10. In this case, the calculated velocity of the G2 group becomes b−a. Further, since the second mobile body moves by “c” per unit time and the vehicle 10 moves by “a” per unit time, the velocity of the G4 group is calculated based on the distance change vector of the second mobile body and the vehicle 10. In this case, the calculated velocity of the G4 group becomes c−a.
Thus, in the case of
A method for estimating velocity of a vehicle according to the embodiment of the present invention configured as described above will be described below in more detail.
In this case, the apparatus 100 acquires the distance information between the surrounding objects from among the surrounding environment information acquired in ‘S100’ (S110), and groups the distance information acquired in ‘S110’ according to the relative positions of the surrounding objects, the degree of change of continued distance values, and the like (S120).
Next, the apparatus 100 calculates the velocities for each group by using the distance change vector of the surrounding objects and the vehicle (S130), and extracts the velocity value having the highest generation frequency from among the values calculated in ‘S130’ (S140). The apparatus 100 then estimates the velocity of the vehicle 10 as the velocity value having the highest generation frequency (S150).
‘S100’ to ‘S150’ may be repeatedly performed while driving the vehicle 10 until a separate ending command is input. When the ending command is input (S160), all the related operations end.
According to the embodiment of the present invention, the distance information acquired from objects in the vicinity of a vehicle is classified and grouped according to distance information of the same objects or adjacent objects according to the specific reference, thereby facilitating the estimation of relative velocity for each group. The velocity values of fixed bodies may be estimated as the velocity of the vehicle by comparing the velocity values calculated for each group. As a result, the velocity of a vehicle can be more accurately estimated. Further, a separate apparatus and system for estimating the velocity of a vehicle is not required, thereby saving costs.
The apparatus and method for estimating velocity of a vehicle according to the embodiment of the present invention are described with reference to the illustrated drawings, but the present invention is not limited to the embodiments and drawings disclosed in the present specification and therefore, may be variously modified within the technical scope of the present invention.
Number | Date | Country | Kind |
---|---|---|---|
10-2012-0121565 | Oct 2012 | KR | national |