The experiments in this paper consist of two parts: a simulation experiment and a real vehicle experiment in a controlled scene.
4.1. Simulation Experiment
In this paper, the effectiveness of the designed camera rotation strategy based on monocular active environment sensing is verified by the joint simulation experiment of Carsim and Simulink. The front-wheel rotation angle measured by Carsim is transferred to Simulink, and the required yaw angle is calculated by the two-degrees-of-freedom vehicle dynamic model, which in turn achieves the control of camera rotation.
Figure 10 shows the relationship between the trajectory of the vehicle and the camera angle in the lane-change scene, with the horizontal coordinate representing the forward direction of the vehicle, i.e., the transverse displacement, and the vertical coordinate representing the direction of the vehicle’s lane change, i.e., the longitudinal displacement. It can be seen from
Figure 10 that, with the increasing of the horizontal and longitudinal displacement of the vehicle, the camera turning angle increases from 0 and then decreases to 0, which is in line with the operation of the vehicle under the actual working conditions.
Figure 11 shows the relationship between the trajectory of the vehicle and the camera angle in the turning scene, with the horizontal coordinate representing the forward direction of the vehicle after turning, i.e., the transverse displacement, and the vertical coordinate representing the forward direction of the vehicle before turning, i.e., the longitudinal displacement. As can be seen from
Figure 11, with the increasing transverse and longitudinal displacements of the vehicle, the camera turning angle changes from 0 to 90, which is in line with the operation of the vehicle under actual working conditions.
The feasibility of the camera rotation strategy method for active visual environment perception, as proposed in this paper, has been verified through simulation experiments. To further explore whether the effect of the method in real application scenes is in line with the results of the simulation experiments, real vehicle experiments are described in this paper.
4.2. Real Vehicle Experiment
The experimental vehicle is based on a pure electric vehicle as a platform, which is equipped with experimental equipment such as cameras, articulated motors, IMU (inertial measurement unit), electronic steer-by-wire, laptop, microcontroller, steering angle sensor, and others. The related equipment is as follows:
An MV-VDF300SC industrial digital camera is installed on the vehicle as a monocular vision sensor, which is mounted on the centerline in the front of the vehicle through a joint motor at a height of 75 cm above the ground. The camera recognizes the obstacles it tracks every 0.04 s; the turning-angle sensor, mounted on the turning column, measures the turning angle of the front wheels and converts it into a digital signal to be sent to the vehicle’s control system, which adjusts the rotation angle of the camera according to this digital signal; an HEC295IMU is installed at the bottom of the experimental vehicle, which is used to locate and read the motion status of the vehicle in real time; the laptop is used as a computing unit to perform real-time data processing, and the microcontroller outputs PWM according to the signals sent by the computing unit to control the angle of the joint motors, so as to realize the rotation of the camera. The camera model incorporates a USB2.0 standard interface with the advantages of high resolution, high precision, and high definition. The camera parameters are shown in
Table 1. The joint motor parameters are shown in
Table 2. The schematic diagram of the experimental vehicle equipment is shown in
Figure 12.
The front-wheel turning angle of the autonomous vehicle can be obtained from the turning-angle sensor, while the two-degrees-of-freedom vehicle dynamic model can obtain the yaw angle of the vehicle from this turning angle. In order to verify the feasibility and effectiveness of this study using actual road conditions, this paper carries out real vehicle experiments of lane changing and turning scenes based on the above principles.
In this paper, the resolution of the picture detected by the camera is 1600 × 1200. In the relationship of the distance of the obstacle from the center of the picture, because the width of the picture is 1600 pixels, the maximum value of the distance of the obstacle from the center of the picture is 800 pixels. The experiments in this paper take the upper left corner of the picture as the coordinate origin, with the right as the X-axis positive, and down as the Y-axis positive.
4.2.1. Lane-Change Scene Experiment
In this scene, the vehicle moves forward at 30 km/h and when an obstacle is detected in front of the home lane, the vehicle begins to change lanes. As the yaw angle of the vehicle changes, the camera rotates accordingly. When an obstacle is found in front of the lane the vehicle is about to enter, the camera tracks the obstacle. The selected experiment takes the difference in the position of the obstacle during the lane-changing process of the vehicle as a variable, and divides the position of the obstacle into two cases: the first case is that the obstacle is close to the vehicle, and the camera cannot detect the obstacle at the beginning of the lane-changing process of the vehicle (the obstacle is not in the detection range of the camera); the second case is that the camera can just detect the obstacle at the beginning of the lane-change process (the obstacle is at the edge of the detection range of the camera). In this study, the relationship between the longitudinal displacement of the vehicle and the distance between the center of the obstacle and the center of the picture in the obstacle information obtained by the camera when the vehicle changes lanes is verified by actual vehicle experiments. A diagram of the lane changing experiment scene is shown in
Figure 13.
Figure 14 depicts a comparison between the traditional obstacle detection method and the improved method in a lane-change scene. The upper five images show the effect of obstacle detection for the improved method in this paper, while the lower five images show the effect for the conventional obstacle detection method. The two images in each column are at the same moment in the vehicle lane-change process. The images in the first column show the effect of obstacle detection when the vehicle starts changing lanes, and the images in the fifth column show the effect of obstacle detection when the vehicle finishes changing lanes. In addition to these two moments, we can clearly see that the improved method in this paper is better than the traditional obstacle detection method, and the traditional obstacle detection method will also lose the obstacle information, as shown in the third image.
While the vehicle is on the road, the camera will detect any obstacles ahead. If an obstacle is found, the system will recognize it as a lane-change scene and track the obstacle. If the obstacle is not a pseudo-obstacle, the vehicle starts changing lanes. Before the vehicle starts changing lanes, the camera scans the left side of the road to determine whether it meets the conditions for changing lanes. If the lane-change condition is satisfied, the corresponding camera rotation strategy is formulated.
By analyzing
Figure 15a, it can be found that when the vehicle starts to change lanes in this case, i.e., when the longitudinal displacement of the vehicle is 0 m, the camera is unable to detect the information about obstacles existing in the road because the obstacles are not located in the detection range of the camera at the beginning of the lane change.
In the traditional visual obstacle detection method, the vehicle yaw angle increases as the vehicle changes lanes to the left. When the longitudinal displacement of the vehicle is 0.94 m, the camera detects the obstacle, and at this time the distance between the center of the obstacle and the center of the picture is −757 PIXEL. When the camera just detects the obstacles, the obstacles are all at the left edge of the picture, so the distance is negative. When the longitudinal displacement is 1.41 m, the distance of the obstacle center from the center of the picture is 756 PIXEL, and the camera loses the obstacle information. When the vehicle starts to drive into the left lane, the yaw angle of the vehicle decreases. When the longitudinal displacement of the vehicle is 2.33 m, the camera detects the obstacle, and at this time the distance between the center of the obstacle and the center of the picture is 751 PIXEL. In this case, when the camera detects the obstacles, the obstacles are all at the right edge of the picture, so the distance is positive. When the longitudinal displacement is 3.75 m, at this time the distance between the center of the obstacle and the center of the picture is 9 PIXEL, and the vehicle completes the lane-change process.
In the improved method of obstacle detection described in this paper, with the vehicle changing lanes to the left, the camera incorporates the vehicle system dynamic to compensate for the yaw angle change by generating a rotation opposite to that of the vehicle body so as to detect the presence of an obstacle in the left lane in advance. The camera detects the obstacle when the longitudinal displacement of the vehicle is 0.46 m. At this time, the distance between the center of the obstacle and the center of the picture is −753 PIXEL. In this case, when the camera just detects the obstacle, the obstacles are all at the left edge of the picture, so the distance is negative. The camera at this time rotates quickly to position the obstacle in the center of the picture and then tracks the obstacle. When the longitudinal displacement is 0.82 m, the distance between the center of the obstacle and the center of the picture is 52 PIXEL, and the camera rotates and overshoots. When the vertical displacement is 0.93 m, the distance between the center of the obstacle and the center of the picture is 6 PIXEL, and the camera starts to track the obstacle. When the longitudinal displacement of the vehicle is 0.93~1.80 m, the yaw angle of the vehicle becomes increasingly large as the vehicle starts to drive out of the current lane, so the distance fluctuation between the obstacle and the center of the picture increases gradually when the camera tracks the obstacle. Since the vehicle is rotating to the left at this time, the obstacle tends to move to the right when the camera is tracking the obstacle, so the obstacle is in the right half of the picture and the distance value is positive. When the longitudinal displacement of the vehicle is 1.80~2.99 m, the distance between the obstacle and the center of the picture changes from 291 PIXEL to −272.5 PIXEL. As the vehicle changes from turning to the left to turning to the right at this stage, the vehicle starts to move into the left lane. The obstacle then has a tendency to move to the left as the camera tracks the obstacle. So the obstacle is in the left half of the picture and the distance value is negative. When the longitudinal displacement of the vehicle is 2.99~3.75 m, the distance between the obstacle and the center of the picture changes from −272.5 PIXEL to −8 PIXEL at this time. This vehicle has moved into the left lane, and the vehicle yaw angle continues to decrease. So when the camera is tracking the obstacle, the fluctuation in the distance between the obstacle and the center of the picture is also decreases in size until the vehicle completes the lane-change process.
By analyzing
Figure 15b, it can be found that in the case when the vehicle starts to change lanes, i.e., when the longitudinal displacement of the vehicle is 0, the obstacle is at the edge of the detection range of the camera, and the camera is just able to detect the obstacle.
In the traditional method for visual obstacle detection, the yaw angle of the vehicle increases as the vehicle changes lanes to the left. When the longitudinal displacement of the vehicle is 0 m, the camera detects the obstacle, and at this time the distance between the center of the obstacle and the center of the picture is −732 PIXEL. In this case, when the camera has just detected the obstacle, the obstacles are all at the left edge of the picture, so the distance is negative. When the longitudinal displacement is 1.39 m, the distance of the obstacle center from the center of the picture is 764 PIXEL, and the camera loses the obstacle information. When the vehicle starts to drive into the left lane, the yaw angle of the vehicle continuously decreases. The camera detects the obstacle when the longitudinal displacement of the vehicle is 2.32 m. The distance between the center of the obstacle and the center of the picture is 764 PIXEL. In this case, when the camera detects the obstacles, the obstacles are all at the right edge of the picture, so the distance is positive. When the longitudinal displacement is 3.75 m, at this time the distance between the center of the obstacle and the center of the picture is 9 PIXEL, and the vehicle completes the lane-change process.
In the improved method of obstacle detection described in this paper, the camera detects the obstacle when the longitudinal displacement of the vehicle is 0 m. At this time, the distance between the center of the obstacle and the center of the picture is −757 PIXEL. In this case, when the camera just detects the obstacles, the obstacles are all at the left edge of the picture, so the distance is negative. At this time, the camera rotates quickly so that the obstacles are in the center of the picture and the obstacles are tracked. When the longitudinal displacement is 0.43 m, the distance between the center of the obstacle and the center of the picture is 15 PIXEL, and the camera rotates and overshoots. When the longitudinal displacement is 0.5 m, the distance between the center of the obstacle and the center of the picture is 6 PIXEL, the camera starts to track the obstacle. When the longitudinal displacement of the vehicle is 0.5~1.41 m, the yaw angle of the vehicle becomes increasingly larger as the vehicle starts to drive out of the current lane, so when the camera is tracking the obstacle, the fluctuation in the distance between the obstacle and the center of the picture also increases gradually. At this point, the vehicle is turning to the left, so the obstacle has a tendency to move to the right when the camera is tracking it. So the obstacle is in the right half of the picture and the distance value is positive. When the longitudinal displacement of the vehicle is 1.41~2.4 m, the distance between the obstacle and the center of the picture changes from 320 PIXEL to −320.5 PIXEL. At this stage, the vehicle turns from turning to the left to turning to the right, and the vehicle starts to move into the left lane. When the camera is tracking the obstacle, the obstacle has a tendency to move to the left, so the obstacle is in the left half of the picture and the distance value is negative. When the longitudinal displacement of the vehicle is 2.4~3.75 m, the distance between the obstacle and the center of the picture changes from −320.5 PIXEL to −5.5 PIXEL. The vehicle has moved into the left lane, and the yaw angle of the vehicle continues to decrease, so the fluctuation in the distance between the obstacle and the center of the picture gradually becomes smaller when the camera is tracking the obstacle until the vehicle completes the lane-change process.
4.2.2. Turning Scene Experiment
In this scene, the vehicle moves forward at 15 km/h. First, the camera detects the current environment as a turning scene. As the vehicle begins to turn, the camera rotates after the yaw angle changes to detect the information of obstacles existing in real time on the road. When an obstacle is found in front of the lane the vehicle is about to enter, the camera tracks the obstacle. The selected experiment takes the difference in the position of the obstacle during the turning of the vehicle as a variable, and divides the position of the obstacle into two cases: the first case is that the camera can just detect the obstacle at the beginning of the turning process of the vehicle (the obstacle is at the edge of the detection range of the camera); the second case is that the obstacle is close to the vehicle, and the camera cannot detect the obstacle at the beginning of the turning process of the vehicle (the obstacle is not in the detection range of the camera). In this study, the relationship between the longitudinal displacement of the vehicle and the distance between the center of the obstacle and the center of the picture in the obstacle information obtained by the camera when the vehicle turns is verified by actual vehicle experiments. A diagram of the turning experiment scene is shown in
Figure 16.
In
Figure 17, a comparison is presented between the conventional obstacle detection method and the improved method in a turning scene. The upper five images show the obstacle detection effect of the improved method described in this paper, while the lower five images show the effect of the conventional obstacle detection method. The two images in each column are at the same moment in the vehicle turning process. The images in the first column show the effect of obstacle detection when the vehicle starts turning, while the images in the fifth column show the effect of obstacle detection when the vehicle finishes turning. In addition to these two moments, we can clearly see that the improved method described in this paper is better than the traditional obstacle detection method, and the traditional obstacle detection method will also lose the obstacle information, as shown in the third image.
When the vehicle is traveling on the road, the camera detects that the front is about to turn and identifies the scene as a turning scene, and then the camera rotation strategy is formulated accordingly. As the vehicle turns to the right, the camera compensates for the change in the yaw angle by rotating in the same direction as the vehicle body in conjunction with the vehicle system dynamic to detect in advance the road information after the turn.
By analyzing
Figure 18a, it can be found that when the vehicle starts to turn in that case, i.e., when the longitudinal displacement of the vehicle is 0, the obstacle is at the edge of the detection range of the camera, and the camera is just able to detect the obstacle.
In the traditional visual obstacle detection method, when the longitudinal displacement of the vehicle is 0, the camera detects the obstacle, and at this time the distance between the center of the obstacle and the center of the picture is 758 PIXEL. In this case, when the camera detects the obstacles, the obstacles are all at the right edge of the picture, so the distance is positive. When the longitudinal displacement is 1.69 m, at this time the distance between the center of the obstacle and the center of the picture is 755 PIXEL. The camera loses the obstacle information because of the large change in longitudinal displacement of the vehicle and the small change in the yaw angle at this time. When the change in the longitudinal displacement of the vehicle is small and the change in the angle of the yaw is large, i.e., when the longitudinal displacement of the vehicle is 6.12 m, the camera detects the obstacle, and at this time the distance between the center of the obstacle and the center of the picture is 760 PIXEL. In this case, when the camera detects the obstacles, the obstacles are all at the right edge of the picture, so the distance is positive. When the vehicle begins to turn into the lane ahead, the yaw angle of the vehicle continues to decrease. When the longitudinal displacement is 8 m, the distance between the center of the obstacle and the center of the picture is 7 PIXEL, at which time the vehicle completes the turning process.
In the improved method of obstacle detection described in this paper, the camera detects the obstacle when the longitudinal displacement of the vehicle is 0 m. At this time, the distance between the center of the obstacle and the center of the picture is 762 PIXEL. At this time, the camera rotates quickly so that the obstacles are in the center of the picture and the obstacles are tracked. When the longitudinal displacement is 0.57 m, the distance between the center of the obstacle and the center of the picture is −20.5 PIXEL, and the camera rotates and overshoots. When the longitudinal displacement is 0.76 m, the distance between the center of the obstacle and the center of the picture is 8 PIXEL, the camera starts to track the obstacle. When the longitudinal displacement of the vehicle is 0.76~2.11 m, the distance between the obstacle and the center of the picture changes from 8 PIXEL to 162 PIXEL. Since the vehicle yaw angle is basically unchanged at this time and the longitudinal displacement changes more, the distance between the center of the obstacle and the center of the picture fluctuates increasingly more when the camera is tracking the obstacle. At this stage, when the camera is tracking the obstacle, the obstacle has a tendency to move to the right, so the obstacle is in the right half of the picture and the distance value is positive. As the vehicle’s turning process proceeds, the vehicle’s yaw angle begins to change, so when the longitudinal displacement of the vehicle is 2.11~2.78 m, the distance between the obstacle and the center of the picture changes from 162 PIXEL to 45 PIXEL. When the longitudinal displacement of the vehicle is 2.78~5.72 m, the distance between the obstacle and the center of the picture changes from 45 PIXEL to 323.5 PIXEL. Since at this time the vehicle yaw angle change is increasingly larger and the longitudinal displacement change is diminishing, but the magnitude of the vehicle yaw angle change is still smaller than the magnitude of the longitudinal displacement change, so the distance of the obstacle center from the center of the picture is positive. When the longitudinal displacement of the vehicle is 5.72~6.53 m, the distance between the obstacle and the center of the picture changes from 323.5 PIXEL to −117 PIXEL. At this time, the vehicle begins to turn into the lane ahead and the longitudinal displacement of the vehicle is basically unchanged, and the vehicle moves toward the right side of the rotation, so the camera tracking the obstacle has a tendency to move to the left, so the obstacle is in the left part of the picture, the distance value changes from a positive value to a negative value. When the longitudinal displacement of the vehicle is 6.53~8 m, the distance between the obstacle and the center of the picture changes from −117 PIXEL to −4 PIXEL. At this point, the vehicle has been turning into the lane ahead, the longitudinal displacement of the vehicle is basically unchanged, and the vehicle is turning to the right, so the fluctuation in the distance between the obstacle and the center of the picture diminishes while the camera is tracking the obstacle, until the vehicle completes the turning process.
By analyzing
Figure 18b, it can be found that when the vehicle starts to turn in this case, i.e., when the longitudinal displacement of the vehicle is 0 m, the camera is unable to detect the information about obstacles existing in the road because the obstacles are not located in the detection range of the camera at the beginning of the turn.
In the traditional visual obstacle detection method, in the first half of the turning process of the vehicle, the longitudinal change in the vehicle is large and the change in the yaw angle is small, so the camera cannot detect the obstacle. When the longitudinal displacement of the vehicle is 4.9 m, the camera detects the obstacle, and at this time the distance between the center of the obstacle and the center of the picture is 755 PIXEL. In this case, when the camera detects the obstacles, the obstacles are all at the right edge of the picture, so the distance is positive. At this point, the vehicle begins to turn into the lane ahead, and the vehicle’s yaw angle changes more, so the distance between the center of the obstacle and the center of the picture decreases more quickly. When the vehicle begins to turn into the lane ahead, the yaw angle of the vehicle decreases. When the longitudinal displacement is 8 m, the distance between the center of the obstacle and the center of the picture is 6 PIXEL, at which time the vehicle completes the turning process. At this point, the vehicle has been turning into the lane ahead, the vehicle’s yaw angle change is smaller, so the distance between the center of the obstacle and the center of the picture decreases more slowly.
In the improved method of obstacle detection described in this paper, with the vehicle turning to the right, the camera incorporates the vehicle system dynamic to compensate for the yaw angle change by generating a rotation opposite to that of the vehicle body so as to detect in advance the presence of an obstacle in the left lane. The camera detects the obstacle when the longitudinal displacement of the vehicle is 2 m. At this time, the distance between the center of the obstacle and the center of the picture is 762 PIXEL. At this time, the camera rotates quickly so that the obstacles are in the center of the picture and the obstacles are tracked. When the longitudinal displacement is 2.57 m, the distance between the center of the obstacle and the center of the picture is −20 PIXEL, and the camera rotates and overshoots. When the longitudinal displacement is 2.83 m, the distance between the center of the obstacle and the center of the picture is 11 PIXEL, the camera starts to track the obstacle. When the longitudinal displacement of the vehicle is 2.83~4.08 m, the distance between the obstacle and the center of the picture changes from 11 PIXEL to 156.5 PIXEL. Since the vehicle yaw angle is basically unchanged at this time and the longitudinal displacement changes more, the distance between the center of the obstacle and the center of the picture fluctuates increasingly more when the camera is tracking the obstacle. At this stage, when the camera is tracking the obstacle, then the obstacle has a tendency to move to the right, so the obstacle is in the right half of the picture and the distance value is positive. As the vehicle’s turning process proceeds, the vehicle’s yaw angle begins to change, so when the longitudinal displacement of the vehicle is 4.08~4.35 m, the distance between the obstacle and the center of the picture changes from 156.5 PIXEL to 60 PIXEL. When the longitudinal displacement of the vehicle is 4.35~5.55 m, the distance between the obstacle and the center of the picture changes from 60 PIXEL to 313 PIXEL. Since at this time the vehicle yaw angle change is continuously increasing and the longitudinal displacement change is diminishing, but the magnitude of the vehicle yaw angle change is still smaller than the magnitude of the longitudinal displacement change, the distance of the obstacle center from the center of the picture is positive. When the longitudinal displacement of the vehicle is 5.55~6.07 m, the distance between the obstacle and the center of the picture changes from 313 PIXEL to −110 PIXEL. At this time, the vehicle begins to turn into the lane ahead, the longitudinal displacement of the vehicle is basically unchanged, and the vehicle moves toward the right side of the rotation, so the camera tracking the obstacle will have a tendency to move to the left, so the obstacle is in the left part of the picture, the distance value changes from a positive value to a negative value. When the longitudinal displacement of the vehicle is 6.07~8 m, the distance between the obstacle and the center of the picture changes from −110 PIXEL to −5 PIXEL. At this point, the vehicle has been turning into the lane ahead, the longitudinal displacement of the vehicle is basically unchanged, and the vehicle is turning to the right, so the fluctuation in the distance between the obstacle and the center of the picture diminishes when the camera is tracking the obstacle, until the vehicle completes the turning process.