This non-provisional application claims priority under 35 U.S.C. § 119(a) on Patent Application No(s). 111129058 filed in Republic of China (ROC) on Aug. 3, 2022, the entire contents of which are hereby incorporated by reference.
This disclosure relates to a vehicle positioning abnormality inspection method and car computer.
Generally, vehicles are sent back to manufacturers for repairs or maintenance when encountering the following conditions: the mileage of the vehicle increases by 5,000 kilometers, the dashboard of the vehicle lights up with a warning sign, or an accident happens. Currently, many vehicle manufacturers have begun to sell electric vehicles, and self-driving vehicles are also being developed. However, whether it is a general gasoline vehicle, an electric vehicle or a self-driving vehicle, maintenance is only performed when the above conditions are encountered. In other words, drivers usually only find out that the vehicle has abnormal conditions after the vehicle is under maintenance or even an accident has happened, which means vehicle safety is still insufficient.
According to one or more embodiment of this disclosure, a vehicle positioning abnormality inspection method, performed by a processing device includes: obtaining a plurality of groups of driving data, wherein each of the groups of driving data includes at least three vehicle positions, a steering wheel angle and a vehicle speed, performing a deviation calculation procedure on each of the groups of driving data to obtain a plurality of deviation data, and in response to a sum of the deviation data greater than a tolerance value, outputting an abnormal notification. The present disclosure further proposes a car computer.
According to one or more embodiment of this disclosure, a car computer includes a controller area network (CAN bus) and a processing device connected to the CAN bus. The CAN bus is configured to obtain a plurality of groups of driving data from a vehicle, wherein each of the groups of driving data includes at least three vehicle positions, a steering wheel angle and a vehicle speed. The processing device is configured to obtain the groups of driving data from the CAN bus, perform a deviation calculation procedure on each of the groups of driving data to obtain a plurality of deviation data, and in response to a sum of the deviation data greater than a tolerance value, output an abnormal notification.
The present disclosure will become more fully understood from the detailed description given hereinbelow and the accompanying drawings which are given by way of illustration only and thus are not limitative of the present disclosure and wherein:
In the following detailed description, for purposes of explanation, numerous specific details are set forth in order to provide a thorough understanding of the disclosed embodiments. According to the description, claims and the drawings disclosed in the specification, one skilled in the art may easily understand the concepts and features of the present invention. The following embodiments further illustrate various aspects of the present invention, but are not meant to limit the scope of the present invention.
Please refer to
To explain determining whether four-wheel alignment of the vehicle is abnormal in more detail, please refer to both
As shown in
In step S1, the CAN bus 11 is configured to obtain the groups of driving data from the vehicle, and the processing device 12 obtains the groups of driving data through the CAN bus 11, wherein the groups of driving data are preferably data generated in a chronological order. The CAN bus 11 may be in communication connection with a satellite positioning system to obtain a vehicle position, and the steering wheel angle and the vehicle speed may be obtained through the following means. Specifically, data frame of the CAN bus may have an identification (ID) information of 11 bits and data information of 8 bytes, wherein different ID corresponds to different vehicle information. Please refer to table 1 below, wherein table 1 is a data format of the CAN bus. For example, ID “0xB6” represents driving speed of the vehicle, and ID “0x10B” represents the steering wheel angle of the vehicle. Therefore, according to table 1, the processing device 12 may determine that data from bit 24 to bit 39 of ID “0xB6” in the data frame is data of the driving speed of the vehicle, and determine that data from bit 8 to bit 24 of ID “0x10B” in the data frame is data of the steering wheel angle of the vehicle. It should be noted that, table 1 only exemplarily shows data format of the CAN bus to explain method of obtaining the steering wheel angle and the vehicle speed of the driving data in more detail.
Then, in step S3, the processing device 12 performs the deviation calculation procedure on each of the groups of driving data to obtain the deviation data. After obtaining the deviation data of each group of driving data, in step S5, the processing device 12 determines whether a sum of the deviation data is greater than the tolerance value, to determine whether four-wheel alignment of the vehicle is deviated. The tolerance value indicates the value of the maximum allowed deviated distance, and may be set according to the total traveling distance of the vehicle. For example, assuming the total traveling distance of the vehicle determined based on the vehicle positions of the groups of driving data is 100 meters, the tolerance value may be set as 3 meters; assuming the total traveling distance of the vehicle determined based on the vehicle positions of the groups of driving data is 500 meters, the tolerance value may be set as 5 meters. In other words, the tolerance value may be greater when the total traveling distance is greater, but one or more embodiments of the present disclosure does not limit the specific method of setting the tolerance value.
In response to the result of step S5 is “no”, it means the four-wheel alignment of the vehicle is normal, and the processing device 12 may perform step S1 again to continuously monitor the condition of the four-wheel alignment of the vehicle.
In response to the result of step S5 is “yes”, it means the four-wheel alignment of the vehicle may be abnormal or malfunctioning, causing the accumulated deviation of the predicted positon to reach the tolerance value, wherein the predicted positon is generated according to parameters including the steering wheel angle and the target position obtained from the satellite positioning system. Therefore, in step S7, the processing device 12 outputs the abnormal notification, wherein the abnormal notification indicates the four-wheel alignment of the vehicle might be abnormal. Method of the processing device 12 outputting the abnormal notification may include: controlling an indicator of the vehicle to flash via the CAN bus 11, and/or outputting the abnormal notification to a cloud database or a server accessible to the user and/or the vehicle manufacturer. One or more embodiments of the present disclosure does not limit the method of the processing device 12 outputting the abnormal notification.
To further elaborate the deviation calculation procedure, please further refer to
As shown in
In step S31, the processing device 12 obtains a moving direction a1 and a target position P2 according to a first vehicle position P0, a second vehicle position P1 and a third vehicle position P2, wherein the first vehicle position P0, the second vehicle position P1 and the target position P2 are positions of the vehicle, and the moving direction a1 is the travel direction of the vehicle. It should be noted that, the first vehicle position P0 corresponds to the first time stamp; the second vehicle position P1, the vehicle speed and the steering wheel angle correspond to the second time stamp; the target position P2 corresponds to the third time stamp; and the second time stamp is later than the first time stamp, and the third time stamp is later than the second time stamp. In short, the first vehicle position P0, the second vehicle position P1 and the target position P2 may be data generated in a chronological order. In addition, the processing device 12 may also obtain the moving direction and the target position according to the above three vehicle positions. For example, the processing device 12 may obtain the moving direction a1 according to more than two vehicle positions, and setting the vehicle position corresponding to the latest time stamp among the more than two vehicle positions as the target position P2.
In step S33, the processing device 12 obtains the predicted position P2′ according to the moving direction a1, the vehicle speed and the steering wheel angle, wherein the predicted position P2′ is the position where the processing device 12 predicts the vehicle will be at the third time stamp.
In step S35, the processing device 12 determines a difference between the predicted position P2′ and the target position P2 as one piece of deviation data. The deviation data may be a deviation vector (distance with a direction) from the predicted position P2′ to the target position P2, or a deviation vector (distance with a direction) from the target position P2 to the predicted position P2′.
Take part (a) and part (b) of
In part (a), even though some of the directions indicated by the steering wheel angles are slightly shifted to the left and right, the vectors deviated to the left and right can be cancelled by each other, so that the overall direction indicated by the steering wheel angles is still approximately the same as the actual travel direction of the vehicle. Therefore, the processing device 12 may obtain a determination result that the deviation data between consecutive predicted positions and the corresponding target positions is not larger than the tolerance value (the result of step S5 in
Accordingly, a function of instant self-testing of the vehicle may be realized, and the abnormal notification is outputted when determining the four-wheel alignment of the vehicle is abnormal. Therefore, the driver and the manufacturer may determine the four-wheel alignment may be malfunctioning even before the vehicle is sent back to the manufacturer for regular inspection. Accordingly, safety benefits may be brought to the field of autonomous vehicles.
Please refer to
The report rate of the satellite positioning system does not necessarily equal to the report rate of the steering wheel angle and/or the vehicle speed. For example, currently, common report rate of the satellite positioning system is about 1 Hz, and the report rate of the steering wheel angle and/or the vehicle speed is about 10 Hz. Therefore, in response to the report rate of the satellite positioning system is smaller than the report rate of the steering wheel angle and/or the vehicle speed, the processing device 12 may determine that among the time stamps corresponding to the steering wheel angles of the groups of driving data, one or more time stamps may not have a corresponding vehicle position data.
For each time stamp that does not have a corresponding vehicle position data, the processing device 12 performs steps S313 to S319. In steps S313 and S315, the processing device 12 determines the previous time stamp and the subsequent time stamp that have the corresponding vehicle positions and are the closest to the time stamp not having a corresponding vehicle position. In steps S317 and S319, the processing device 12 performs interpolation on the vehicle position of the previous time stamp and the vehicle position of the subsequent time stamp to obtain the interpolated position, and sets the interpolated position as the vehicle position of the time stamp not having a corresponding vehicle position, thereby compensating the missing vehicle position. In short, in steps S317 and S319, the processing device 12 may determine the previous time stamp and the subsequent time stamp that are next to said time stamp, and perform interpolation on the vehicle position of the previous time stamp and the vehicle position of the subsequent time stamp. Therefore, the processing device 12 may set the interpolated position as the vehicle position of the time stamp that is missing a vehicle position. It should be noted that, in
Please refer to
Take
Please refer to
Take
θ=a tan 2(sin Δλ·cos φ1,cos φ0·sin φ1−sin φ0·cos φ1·cos Δλ) [equation (1)]
wherein θ is the forward azimuth (clockwise from the north); φ0 is the latitude of the first vehicle position P0; φ1 is the latitude of the second vehicle position P1; Δλ is a difference between the longitude of the first vehicle position P0 and the longitude of the second vehicle position P1.
In steps S333b and S335b, the processing device 12 sets a sum of the steering wheel angle and the forward azimuth θ as the deviation direction a2′, and obtains the predicted distance.
In step S337b, the processing device 12 may determine the predicted position P2′ according to the predicted distance and the deviation direction a2′ through the following equation (2) and equation (3), wherein the deviation direction a2′ is represented by “α” in equation (2) and equation (3):
φ2=α sin(sin φ1·cos δ+cos φ1·sin δ·cos α) [equation (2)]
λ2=λ1+a tan 2(sin α·sin δ·cos φ1,cos δ−sin φ1·sin φ2) [equation (3)]
wherein φ2 is the latitude of the target position P2; λ2 is the longitude of the target position P2; λ1 is the longitude of the second vehicle position P1; α is the angle of the deviation direction a2′; δ is an angle, where δ=d/R, d is the predicted distance, and R is earth radius.
Accordingly, the processing device 12 may obtain a more accurate predicted position P2′.
Please refer to
The positioning component 13 may be electrically connected to the CAN bus 11 or in communication connection with the CAN bus 11, to be connected to the processing device 12 through the CAN bus 11. The positioning component 13 may be a module of the satellite positioning system as described above, such as global navigation satellite system
(GNSS), global positioning system (GPS), Russian satellite navigation system (GLONASS), Galileo positioning system or BeiDou navigation satellite system (BDS) etc. The processing device 12 may obtain the vehicle position through the positioning performed by the positioning component 13, and thereby determining whether the amount of data (the vehicle position) obtained is enough to perform one or more embodiments of the vehicle positioning abnormality inspection method of as described above.
To further elaborate the embodiment of the processing device 12 determining whether the amount of data is enough, please refer to
In step S01a, the processing device 12 obtains positioning data from the positioning component 13 of the vehicle to set the positioning data as the starting position. In step S03a, the processing device 12 obtains another piece of positioning data from the positioning component 13 of the vehicle to set the another piece of positioning data as the sampling position, wherein the difference between the sampling time point corresponding to the sampling position and the sampling time point corresponding to the starting position is the sampling time interval. The sampling time interval depends on the report rate of the satellite positioning system as described above. The sampling time point is the time point of the positioning component 13 generating the starting position/the sampling position. In other words, the higher the report rate of the satellite positioning system is, the shorter the sampling time interval is, and the present disclosure does not limit the actual value of the sampling time interval. In short, in step S01a and step S03a, the processing device 12 sets the first positioning data as the starting position, and the positioning data obtained after said first positioning data is used as the sampling position.
Then, the processing device 12 performs a distance determination procedure, wherein the distance determination procedure includes step S05a and step S07a. In step S05a, the processing device 12 calculates a sampling distance between the starting position and the sampling position (referred to as “first sampling position” hereinafter), and performs the distance determination procedure. In step S07a, the processing device 12 determines whether the sampling distance is equal to or greater than the default distance, wherein the default distance is, for example, 500 meters or 1000 meters, but the present disclosure is not limited thereto.
In response to the sampling distance is equal to or greater than the default distance, it means the starting position, the first sampling position as well as a plurality of positions between the starting position and the first sampling position corresponding to this the sampling distance is enough to determine an accurate predicted position. Therefore, in step S09a, the processing device 12 may obtain the at least three vehicle positions of each one of the groups of driving data according to the starting position, the first sampling position as well as the positions between the starting position and the first sampling position. Then, the processing device 12 may perform step S03a again.
In response to the sampling distance is not equal to and not greater than the default distance, it means the starting position, the first sampling position as well as a plurality of positions between the starting position and the first sampling position corresponding to this sampling distance are still not enough to determine an accurate predicted position. Therefore, in step S011a, the processing device 12 may obtain another sampling position (referred to as “second sampling position” hereinafter) from the positioning component 13, wherein a difference between the sampling time point corresponding to the second sampling position and the sampling time point of the first sampling position is also the sampling time interval, and the sampling time point corresponding to the second sampling position is later than the sampling time point of the first sampling position. Then, the processing device 12 may perform the distance determination procedure again.
In short, in response to in step S07a, the processing device 12 determines that the sampling distance reaches the default distance, the processing device 12 sets all of the positions as the obtained vehicle positions of the driving data; if, in step S07a, the processing device 12 determines that the sampling distance does not reach the default distance, the processing device 12 obtains another sampling position from the positioning component 13, until a distance between the starting position and a sampling position reaches the default distance.
To further elaborate another embodiment of the processing device 12 determining whether the amount of data is enough, please refer to
In step S01b, the processing device 12 may obtain the starting time point corresponding to the starting position, wherein the starting time point is the time point of the satellite positioning system generating the starting position, and the processing device 12 may obtain the starting position from the positioning component 13. In step S03b, the processing device 12 may calculate the traveling distance of the vehicle departing from the starting position according to the starting time point and the vehicle speed obtained from the CAN bus 11. In step S05b, the processing device 12 may continuously calculate the traveling distance through the current positioning on the vehicle. When the processing device 12 determines that the traveling distance is equal to or greater than the default distance, the processing device 12 obtains the at least three vehicle positions of each one of the groups of driving data according to the starting position, the destination position corresponding to the traveling distance as well as the positions between the destination position and the starting position.
It should be noted that, assuming the positions between the starting position and the sampling position (or the destination position) are first position to fourth position, the processing device 12 may set the starting position, the first position and the second position as the three vehicle positions of one group of the driving data, and set the first position, the second position and the third position as the three vehicle positions of another group of the driving data, and so on. Or, the processing device 12 may set the starting position, the first position and the second position as the three vehicle positions of one group of the driving data, and set the third position, the fourth position and the sampling position (or the destination position) as the three vehicle positions of another group of the driving data.
In view of the above, the vehicle positioning abnormality inspection method and car computer according to one or more embodiments of the present disclosure may realize a function of instant self-testing of the vehicle, and an abnormal notification is outputted when determining the four-wheel alignment of the vehicle is abnormal. Therefore, safety benefits may be brought to the field of autonomous vehicles. In addition, by the embodiment of determining whether data amount is enough before determining the predicted position, the predicted position may be more accurate, to avoid the car computer from sending the abnormal notification by mistake.
Number | Date | Country | Kind |
---|---|---|---|
111129058 | Aug 2022 | TW | national |
Number | Name | Date | Kind |
---|---|---|---|
4727492 | Reeve | Feb 1988 | A |
5615116 | Gudat | Mar 1997 | A |
5934407 | Shimizu | Aug 1999 | A |
20120259507 | Fink | Oct 2012 | A1 |
20150343951 | Kim | Dec 2015 | A1 |
20170255843 | Elwart | Sep 2017 | A1 |
20190325290 | Tong | Oct 2019 | A1 |
20200029490 | Bertucci | Jan 2020 | A1 |
Number | Date | Country |
---|---|---|
109523830 | Mar 2019 | CN |
113053112 | Jun 2021 | CN |
113419258 | Sep 2021 | CN |
Entry |
---|
Gao; Machine translation of CN-109523830-A; Mar. 2019; espacenet.com (Year: 2019). |
Wang; Machine Translation of CN-113053112-A; Jun. 2021; espacenet.com (Year: 2021). |
Chen; Machine Translation of CN-113419258-A; Sep. 2021; espacenet.com (Year: 2021). |
Number | Date | Country | |
---|---|---|---|
20240046713 A1 | Feb 2024 | US |