1. Introduction
Vehicles are important tools in everyday life. An increasing number of vehicle applications are being developed, such as autonomous vehicles. Many manufacturers have joined the research and development of autonomous vehicles. These vehicles are based on the existing vehicle architecture for innovation. The vehicle requires a control center to plan the driving strategy. The computer used for this strategy requires some position information to allow it to understand where the vehicle is. The positioning system can provide the vehicle with location information. There are various methods by which to provide reliable location information for autonomous vehicles. Every application system has the possibility of the occurrence of a system fault. The positioning system also has the problem of potential failures. Vehicle applications should consider this situation and design functions to detect faults. On-board diagnostics (OBD) is one such approach [
1], but there are few discussions of fault detection methods for positioning systems in the study of the application of positioning systems.
In this paper, the influence of the fault detection mechanism on the data fusion of the positioning system is discussed. This method is developed based on the sensor configured by the WinBus [
2]. The WinBus is an autonomous vehicle that integrates many application systems. This fault detection mechanism is discussed using positioning methods developed by on-board sensors. Different sensing systems have different coordinate values. The coordinate system must be unified for this mechanism to work. The coordinate system uses 3D coordinates (X, Y, and Z). This coordinate system is unified in the WinBus application. This coordinate system allows this method to have the same benchmark that can be used for cross-validation. In addition to the sensors provided by the vehicle, there are also many studies using the “Internet of vehicles” system to complete the positioning method. The experimental field did not have road equipment linked to the Internet of vehicles. Therefore, this paper does not address the issues related to the Internet of vehicles; instead, it focuses more on the positioning system application of the vehicle itself.
The fault detection mechanism proposed in this paper is an extension based on the abovementioned method to improve the reliability of the positioning system. This paper consists of five sections.
Section 2 is the literature review.
Section 3 describes the positioning system’s experimental platform, i.e., the WinBus.
Section 4 presents the positioning fault detection methods. The method used includes a procedure and algorithm that are described in this section.
Section 5 presents the verification results. The final section reports the conclusions and development plan.
2. Literature Review
Each positioning system uses different sensors to implement the navigation functions. The vehicles deploy many sensors that provide the autonomous vehicle strategy center with information required to plan control strategies. For example, real-time kinematic (RTK) positioning, inertial measurement units (IMU), 2D lidar, 3D lidar, radars, and cameras are the sensors of the applications. These sensors can also provide useful information for different positioning methods. RTK provides coordinate information to end applications. There are various studies regarding the development of technology based on this system [
3,
4,
5,
6,
7,
8]. Some methods integrate many sensors, while others use more RTK systems to reduce data loss. Researchers try to improve the usefulness and accuracy of RTK information, which is the goal. These methods require many application systems to support them to correct coordinate information. Each application system has a damage probability. In this paper, we propose a system fault-finding mechanism, and the coordinate accuracy is verified based on this mechanism. This mechanism references some related application systems’ information for implementation. The reference system is part of WinBus, so there is no additional cost of the sensor in this method.
Simultaneous localization and mapping (SLAM) is another currently applied technology in autonomous vehicle positioning. Some studies have discussed this technology. This technology is based on the 3D lidar for implementation [
9,
10,
11,
12,
13,
14,
15]. There are many types of research that discuss the 3D lidar SLAM. The 3D lidar provides scan information of the surrounding environment to support the SLAM calculation. SLAM uses some deep learning methods for implementation, such as convolutional neural networks (CNN). This method provides some position information for the applications. There is autonomous vehicle research based on this method for implementation. This method supports autonomous vehicles in a scenario where there is no GPS signal support. This is one of the advantages of the autonomous vehicle application described in this study. Systems based on 3D lidar applications require many hardware computing resources. SLAM alone cannot achieve autonomous vehicles according to the previous application experience and literature. Similarly, when the system responsible for SLAM fails, how the decision-making control system of the self-driving car is informed is relatively less discussed. The fault detection mechanism proposed in this paper is a possible solution for autonomous vehicle applications.
Communication is an indispensable element in autonomous vehicle applications. The communication interface includes wired communication and wireless communication. Control area networks (CAN) and the eEhernet are the wired communication interfaces [
16,
17,
18]. The CAN bus is used for message transmission between the power chain, chassis, and body. The International Standards Organization also defines the corresponding communication specifications, but the information on the positioning system applications is only partially defined. The CAN bus bandwidth cannot transmit a lot of information from the sensor. The autonomous vehicle requires the communication interface to be the Ethernet. In recent years, there has been much research on positioning systems in the Internet of vehicles (IoV). Communication interfaces used in the Internet of vehicles, such as dedicated short-range communication (DSRC), cellular-vehicle-to-everything (C-V2X), and fifth-generation mobile networks (5G) have positioning-related information [
19,
20,
21]. Most of the positioning-related information follows the specifications of SAE J2735 [
22]. A part of the communication interface applied by IoV belongs to the wireless communication interface. The IoV method is based on RSU and vehicle coordinates for implementation. There are also studies implementing positioning systems using the SLAM and IoV techniques discussed earlier. The deployment of hardware facilities is the key to the positioning system implemented using these technologies. This research used the wired network inside the vehicle to collect and transmit information. Limited by the problem of hardware deployment in the experimental field, discussion of the positioning system discussion of the Internet of vehicles is temporarily excluded from this research.
Some accurate and reliable location data are necessary for autonomous vehicles’ requirements. It can be seen from the previous discussion that positioning information alone cannot meet these requirements. Researchers have proposed many information fusion methods to solve the accuracy problem [
23,
24,
25]. The information fusion method can solve some of the system’s disadvantages. This method integrates multiple sensor systems that can provide some positioning information in different scenarios. To address these shortcomings, researchers have used different approaches to solve them. Information fusion combines some of the benefits of other systems, making the positioning system more precise and reliable. GPS and IMU integrate the extended Kalman filter (EKF) as one of the methods. In addition, the coordinate data fusion method has the function of repairing inaccurate information coordinates. The additional error detection mechanism of the positioning system correcting the coordinate information is a method by which to solve the error of the positioning system. There are still some differences between these methods.
We propose a method that can be used to improve the stability and reliability of positioning systems; it supports the positioning system with an error detection mechanism. Considering the sensing systems and methods configured on the vehicle, this mechanism is based on the RTK, SLAM, IMU, and chassis systems for implementation of the function.
4. Positioning Fault Detection Methods
How to increase positioning accuracy is a problem that researchers and developers wish to solve. This positioning system combines RTK and SLAM to aid the autonomous vehicle’s strategy-building process. The positioning fusion algorithm references the RTK and SLAM information to provide the location data. For precision, these two systems work together as a team. However, every application system has the possibility of failure. In this research, we propose a strategy by which to determine the fault detection mechanism and discuss the relationship between coordinate data fusion and faults. Here, we take advantage of the interdependence of the data to achieve this. Finding faults requires some mechanisms and a relatively stable device to support them. Taking speed information as an example, there are devices in the vehicle that provide speed information, such as the ABS (antilock braking system), IMU, and GPS. The ABS is a more stable provider of speed signals than the IMU and GPS. Based on this concept, the speed of the fault detection method references the ABS speed information. The detection method integrates the IMU and ABS to help the system to find the faults. A prediction algorithm with heading and velocity information can provide reference information to the positioning fusion algorithm. This information is a reference message that helps the fusion algorithm determine the correctness of the positioning data from the RTK. The SLM fault detection method references the RTK information to detect the fault.
Figure 3 shows the functional blocks of the positioning system and the fault detection method. The time t
n is the current time, and t
n+1 is the following time. The predicted coordinates reference the previous credible coordinates for the fault detection method of RTK and SLAM and are used as reference sources. The prediction data reference the vehicle speed and heading. Coordinate data, which must be reliable information derived from a prediction method, are referred to by the positioning system fault detection algorithm. The speed and heading information are from the ABS and IMU. The application of these two devices on a vehicle results in a relatively stable device. This method is suitable for use as a reference for estimating messages in positioning system fault detection.
The fault detection function block is shown in
Figure 4. This method of obtaining reference data must be chosen following the positioning system’s features, for example, whether the fault detection algorithm used in the RTK uses the input coordinate data from the RTK or whether the method used in SLAM and the input coordinate data will be replaced with SLAM coordinate data. The reference coordinates for SLAM and RTK are both from the prediction coordinates. The positioning error condition is the error level condition. This condition defines the allowable error range of the positioning system. The data output are fault information and positioning data that the positioning fusion algorithm will reference.
The coordinate information allows the system to have a reference position. The positioning system of the WinBus fuses the RTK and SLM information to generate location information for the autonomous application. These data are used by the vehicle to determine its location. The original fusion algorithm refers to Equation (1), where
is the position data that can be latitude or longitude information. This position information is calculated from the fusion algorithm.
Prtk is the position information from RTK.
Pslam is the position information from SLAM.
Prtk and
Pslam can be the latitude or longitude information.
Wrtk is the weight for the RTK.
Wslam is the weight for SLAM. The weight parameter can adjusted by the application. RTK has a large weight in this system. Each application has the primary trust information. The weight parameter can allow the strategy process to switch the primary position system when a system is damaged.
We designed a prediction method to find reference information for autonomous vehicle applications. Reference information must be stable and reliable. This method integrates some information from the chassis and other sensors, such as the positioning system, the ABS sensor, and the IMU. We took into account that the RTK is subject to weather. From the perspective of system stability, the ABS and IMU on the vehicle are more stable than the GPS-based positioning system. Referring to these two pieces of information in the fault detection mechanism is more reliable. The positioning system provides previous valid position data. The ABS sensor provides the final speed information. The IMU provides the heading information to the algorithm. The latitude and longitude prediction algorithm equation is represented by Equation (2). The parameter
is the estimated latitude data, and
is the current latitude data. The parameter
is the estimated longitude data, and
is the current longitude data. The parameter
V is the vehicle speed. The parameter
is the heading of the vehicle. Equation (3) defines
and
as belonging to
. The distance calculation algorithm is shown in Equation (4) The parameter
is the distance between the prediction position and the current position.
The fault result is shown in Equation (5), which is another indicator function. The parameter
is the fault detection result.
can be a level that triggers the fault condition. If
is less than
, the result is 1. The fault detection algorithm generates an error message to the self-driving application stating that an error has occurred in the positioning system. Equation (5) fits different applications that can be rewritten. If the fault detection mechanism is used in SLAM, the parameter
can be rewritten as
. If the fault detection mechanism is used in RTK, the parameter
can be rewritten as
.
Equation (1) can be rewritten as Equation (6) based on Equation (5). This equation integrates the positioning fusion algorithm and fault detection algorithm for the autonomous application. It allows the strategy process to have a positional reference for planning the control rule to control the vehicle.
5. Results
The experimental field was in the Chang Hua Coastal Industrial Park. The route is shown in
Figure 5. The route is 7.5 km long. The positioning system was deployed in the WinBus. The fault detection algorithm was integrated with the system in the WinBus. This experiment obtained three results from three positioning methods: the RTK, SLAM, and prediction. The results were used to compare the different positioning methods for the coordinate results’ effect.
The result compares the SLAM and RTK information shown in
Figure 6. The figure was generated from the latitude and longitude data. The red line presents the SLAM result, and the yellow line shows the RTK. This finding shows that these two positioning systems indicate the two trajectories in the figure. By comparing the actual route with the results, we can see that the SLAM system contained some errors. We discuss the failure detection mechanism below, as well as how to use this mechanism to increase the accuracy of the positioning system.
Figure 7 compares the RTK, SLAM, fusion, and prediction results. The fusion result is the blue line from Equation (1), shown in
Figure 7. The prediction result is the green line, shown in
Figure 7. This result is from Equations (2) and (3). There were some errors detected without a fault detection method that were compared the RTK result. The prediction result showed that the track was similar to the RTK. Another comparison between the RTK and prediction data showed that the information was similar to the actual trajectory. This also proved that the prediction results and RTK are reliable information for autonomous applications in this field.
Figure 8 includes all of the above results for comparison. The purple line is the fusion with the fault detection mechanism. Here, we discuss the impact of the fault detection mechanism of the positioning system. From the previous discussion, it can be seen that this prediction method is feasible. Finally, we compared the actual path, the predicted path, and the results of the fusion algorithm based on the fault detection mechanism. The results showed that the fault detection mechanism can effectively correct the coordinate results of the positioning system.
Figure 9 (longitude) and
Figure 10 (latitude) compare each result. In the figures, lines of different colors represent RTK, SLAM, fusion, prediction, and fusion with the diagnostic mechanism results. The result showed that the SLAM and fusion without any fault detection mechanisms had some problems.
We also performed a more detailed comparison regarding the location of anomalous coordinates.
Figure 11 and
Figure 12 show the parts with abnormal coordinates in
Figure 9 and
Figure 10, respectively.
Figure 11 and
Figure 12 show the results of the longitude and latitude coordinates of each method’s coordinates, respectively. These diagrams show the coordinates of the anomalous parts for further discussion. The results showed that the coordinates results of SLAM cannot satisfy the requirements for autonomous vehicle applications. SLAM has the greatest number of mistakes after comparing all the methods. Due to the deviation of the coordinates, the system’s operation may be faulty.
The coordinate fusion method was based on Equation (1). The grey line shows the result obtained by the original fusion algorithm. This result is compared with the SLAM and RTK results, shown in
Figure 11 and
Figure 12. The original fusion result was without reference fault information. This result showed that the fusion algorithm was able to correct the biases in the coordinate information, but it was not sufficient. The original fusion algorithm only considered the weights occupied by the various positioning systems. The erroneous value was still included in the evolutionary algorithm’s calculations when one of the positioning systems failed. Due to the influence of SLAM, the trajectory of the coordinates was biased.
The correct path in this situation was the most similar to that of the RTK. Thus, the result of using the RTK here is the benchmark. The coordinate prediction results (yellow line) were similar to the RTK results, proving that the prediction mechanism was efficient. The fusion results and the diagnosis mechanism (light blue line) were combined with reference to the results of RTK, SLAM, and data fusion. Equation (7) describes the positioning system results. This result is close to the coordinates of the correct route.
The positioning error was calculated from Equation (4). The RTK position coordinates were compared with those obtained using SLAM, the original fusion algorithm, prediction, and fusion with a diagnostic mechanic. The results are shown in
Figure 13.
Table 1 shows a comparison between the values of each method. In order to compare trends and reduce errors caused by noise, 100 records were averaged from the peak in the comparison of the results. The average distance by which SLAM deviated in this test was 91.8 m.
The original algorithm was able to correct the error value correctly. However, the magnitude of the correction was limited. The maximum error was 18.3 m after correction. The original algorithm corrected the error at a rate of 80%. The prediction coordinate was from Equation (2). The prediction of the coordinates was based on the previously valid coordinates, with reference to the speed and heading of the vehicle. The error between the RTK coordinates and the predicted value was about 0.64 m. As can be seen from
Figure 13, this result is very similar to the coordinate value of RTK. It can be used as reference data for the fault detection mechanism. Equation (6) presents the fusion algorithm with the diagnostic mechanism. The coordinate result of this algorithm differed from the RTK coordinate value by 0.25 m. The results showed that the error was further corrected.
Finally, the positioning errors of the algorithms were considered. A 2 m lateral error was set in the experiment by considering the lane width. Comparing the values, the difference between the RTK and the diagnostic mechanism was 2.25 m. This method corrected 89.8% of the errors. This result proves that our proposed method is useful.
6. Conclusions
Autonomous vehicles use relatively accurate positioning information to formulate control strategies and improve vehicle safety. Positioning systems have the problem of positioning errors. There are many methods implemented using only a single positioning method. There are certain risks in autonomous vehicles that rely on a single positioning system. Therefore, scholars have discussed a variety of options. Coordinate information fusion is one possible solutions. There are still some problems to be solved in positioning systems, such as fault problems.
In this paper, we have proposed a fault detection method to support coordinate fusion and compared the differences between the errors of various positioning methods and the proposed method. In the application, the concept of data fusion was used for error correction so that the autonomous vehicle had relatively accurate coordinate values as a reference. The coordinate information obtained by the original fusion algorithm still had an error problem. This was due to the fact that the original algorithm only focused on the weight allocation of the coordinate information. It did not consider the impact of system failures on information fusion. The fault detection mechanism referenced a prediction coordinate. SLAM was found to have more errors in all the positioning systems after comparing this coordinate. After observing these phenomena, we changed part of the algorithm. The adjusted coordinate fusion algorithm corrected 89.8% of errors. The experiments demonstrated that the method was able to detect errors when the positioning system had failed. The fault detection and correction mechanism was used to correct the coordinate. The results showed that this mechanism was able to support the positioning system in certain conditions and was able to correct the coordinate data.
We used the WinBus as the experimental platform. The scope of the WinBus experiment was mainly limited to Chang Hua Coastal Industrial Park. The use of sensors configured in the vehicle and the application equipment configured in the experiment field were limited. Not every vehicle had the same sensors. In this method, there will be gaps in the parameters of the vehicle dynamics, and there will be differences in the threshold values of the positioning system’s fault detection. Artificial intelligence (AI) may be used to support the proposed fault detection and correction methods in the future. There are AI tools available that can be used to determine the most suitable setting value for each car.