5.2.1. The Method of Cooperative Control for Dummy Target Traction System and ADR
Figure 7a depicts the overall design of the cooperative control between the dummy target traction system and the ADR.
Figure 7b shows key components of the control system such as navigation positioning receiver, positioning data link (PDL), ECU, move power supply, antenna, etc. The dummy target traction system is tested, working synergistically with the ADR, INS/GPS navigation, and positioning module to send real-time position and velocity information to the control system of dummy target traction system wirelessly. The main controller in dummy target traction system triggers the dummy target to start moving when the calculated distance between the VUT and the dummy target traction system is equal to the pre-set value, depending on the requirements of the test scenario for the VUT driving speed, dummy target moving speed, and collision position. Therefore, the main controller has the function to ensure the dummy target arrives at the predetermined position (i.e., impact or collision location).
As mentioned earlier, the VUT is equipped with ADR, INS, and GPS positioning equipment. The inertial navigator can collect the test speed, acceleration and heading angle of the VUT in real time. The differential global positioning system (DGPS) consists of the VUT positioning, RTK base station positioning and dummy driving system positioning. The DGPS can obtain centimeter-level positioning accuracy, thus achieving high-precision positioning of both the VUT and dummy target motion [
42]. ADR can control the VUT according to the vehicle trajectory set in the intended test scenario. The real-time VUT’s position and velocity are measured by an integrated navigation system of RTK-DGPS/INS installed in the VUT and transmitted to the controller of the dummy traction system (see
Figure 8) via 2.4 GHz wireless communication channel.
Differential precise positioning information is communicated via 915 MHz wireless communication channel, while the information of vehicle distance and velocity is communicated through the 2.4 GHz wireless communication channel (NRF24L01 chip developed by Nordic Corporation). The controller of dummy traction system monitors the VUT whether or not traveling to the predefined location. The coordinates of the predefined location are calculated by the controller of dummy target driving system depending on the currently undertaken test scenario (the requirements of the test scenario for the driving speed of the VUT, the moving speed of the dummy target and the collision position of the VUT). When the VUT arrives at the predefined position, the controller immediately starts the dummy target to move and controls the velocity of dummy target motion to follow the S-shaped path to be described in
Section 5.2.2. Finally, the contact between the VUT and the dummy target at the pre-determined collision point is realized.
5.2.2. Control Algorithm for Dummy’s Motion
During the testing process, the dummy target needs to move from the original starting position to the targeted one, thus requiring to start, accelerate, move steadily, and then slow down until stopping at the targeted location. In order to keep steady motion of the driving motor and dummy target in this process, the motion control method of S-shaped curve of acceleration and deceleration is adapted in this study. The shape of the velocity curve is S-shaped in the acceleration and deceleration stages, with both acceleration and velocity curves being continuous, and the derivative of acceleration (i.e., jerk = da/dt) being constant. By controlling the jerk value, the impact on the dummy target motion can be minimized, thus leading to realization of the steady motion of the dummy target, and achieving the flexible acceleration and deceleration control. This control strategy provides advantages of good stability, small jerk force, and high positioning accuracy to the dummy target motion. In addition, this control strategy also has extremely high practical application merits, especially use of the velocity control method incorporating a very important technology capable of dealing with modern high-speed and high-precision machine [
43].
Generally, the acceleration and deceleration motion of the S-shaped curve, including seven or five stages of motion control, is described as follows [
44]:
(1) When the maximum acceleration of the control system cannot reach the required speed, a uniform acceleration stage is needed. Should this occur, the movement process of the S-shaped acceleration and deceleration curve is then divided into seven stages: increasing acceleration stage, uniform acceleration stage, decreasing acceleration stage, uniform velocity stage, increasing deceleration stage, uniform acceleration stage, and decreasing deceleration stage, as shown in
Figure 9a.
(2) When the maximum acceleration of the control system is able to reach the required speed, there is no need to have a uniform acceleration stage, namely,
T2 =
T6 = 0 in
Figure 9a. Hence, in this case, there are only five stages in the S-shaped velocity curve to accommodate with acceleration and deceleration motion, namely, increasing acceleration, decreasing acceleration, uniform speed, increasing deceleration, and decreasing deceleration, as shown in
Figure 9b. Let
tk (
k = 0, 1,…, 5) represent the starting time of each stage, then
Tk =
tk −
tk−1 (
k = 0, 1,…, 5) represents the running time of each stage.
In this study, a five-stage S-shaped acceleration and deceleration control method is selected because of its simple control algorithm, since the dummy target’s velocity is not high, and the driving motors can easily reach this target velocity. In practice, the dummy target’s starting and ending velocities are zero. In the acceleration and deceleration stages, the absolute value of
j is taken to be a fixed value, so that the acceleration curve becomes a triangle in the starting and the stopping stages. In order to make the acceleration and deceleration process symmetrical, the time of increasing acceleration stage is equal to that of decreasing acceleration stage, and the time of increasing deceleration stage is equal to that of decreasing deceleration stage, namely
T1 =
T2 and
T4 =
T5. Since
T1 =
T5 and
T2 =
T4, and letting
T1 =
T2 =
T4 =
T5 =
T (see
Figure 9b), then, as long as
T1 and
T3 are determined, the formulas for calculating acceleration
a and velocity
v of the dummy target can be derived accordingly.
In the acceleration and deceleration stages, jerk is the first derivative of acceleration, and the relationship between jerk and acceleration is expressed in Equation (1), and the relationship between velocity and acceleration is given in Equation (2).
Due to the movement speeds of the dummy target in different test scenarios are specified in C-NCAP (2018), then let one assume that the targeted velocity of the dummy target is
vt. The absolute value of jerk is set to be a constant value
j, and the jerks at time
t0,
t2 and
t5 (see
Figure 9b) are set to be zero, then the acceleration of the dummy target reaches its maximum value at time
t1 in the five-stage S-shaped curve model, the maximum acceleration
amax, and velocity at time
t1 are expressed as Equations (3) and (4).
In the five-stage S-shaped curve model,
T1 =
T2 =
T4 =
T5 =
T, and
v(
t0) =
v(
t5) = 0 (see
Figure 9b), the targeted velocity
vt is expressed as:
The duration from time
t0 to time
t1 is
T1 (see
Figure 9b), and
T1 =
T2 =
T4 =
T5 =
T, then the duration
Ti (
i = 1, 2, 4, 5. Please note that 3 is not included here) is calculated according to Equation (6).
According to the above theoretical mathematical models, the acceleration, velocity, and displacement of each stage in the S-shaped curve can be calculated as long as the targeted velocity vt and duration T are determined.
After calculating the running time of five stages in the S-curve acceleration and deceleration process, the flexible acceleration and deceleration control algorithm can be easily implemented into the motion controller based on STM32F103 to improve the motion performance of the dummy target and the function of the whole system. The flow chart of the program of increasing velocity stage in the S-shaped velocity curve is shown in
Figure 10. In this flow chart,
vt is the required velocity of dummy target;
T is the time of increasing acceleration for motor;
n is the number of samples per cycle;
α is the step angle of motor;
fk is the pulse frequency. The section of speed reduction is opposite to that of a speed increase [
45].
Initial and final velocities of the dummy target are zero. According to kinematics principles, the expressions of acceleration
a(
t), velocity
v(
t), and displacement
S(
t) of the dummy target in each stage are shown in
Table 1.
The required movement speed of dummy target is 6.5 km/h (1.80 m/s) in CVFA-50 test scenario specified in C-NCAP (2018), and
T is assigned a value of 1 s. Using the expressions
and
, then
j is found to be 1.80 m/s
3 and
am = 1.80 m/s
2. The expressions of acceleration, velocity, and displacement for each stage in
Table 1 are simulated using MATLAB/Simulink that yields the simulation results as shown in
Figure 11.
From the simulation results shown in
Figure 11, the motion state curves (velocity, acceleration, and jerk) of the dummy target are obtained using the expressions given in
Table 1, which are in accord with the intended characteristics of the S-shaped acceleration and deceleration curve exhibiting that the curves of velocity and acceleration are continuous, and the absolute value of jerk is a constant value. Therefore, the dummy target’s motion will be reliably controlled to be smooth without “jerk” during movement by the S-shaped velocity curve method using acceleration and deceleration control algorithm. At the same time, the expressions given in
Table 1 are verified to be correct. The detailed data of the simulation results of the S-shaped velocity curve are shown in
Table 2.