This application claims priority to Chinese Patent Application No. 201810672885.8, filed on Jun. 26, 2018, which is hereby incorporated by reference in its entirety.
The present application relates to an unmanned driving technology, and in particular, to a method and an apparatus for acquiring a control amount for a performance test of an unmanned vehicle.
An unmanned vehicle test process includes a stage for testing special and extreme road conditions. In this stage, a tester constructs a complex test scenario, i.e. constructs the test scenario of the unmanned vehicle by setting a trajectory of an obstacle vehicle and setting dynamic attributes of the obstacle vehicle at multiple key points on its trajectory (the dynamic attributes include but are not limited to a magnitude of the speed and a direction of the speed), and obtains coordinates and dynamic attributes of the obstacle vehicle corresponding to multiple running lengths when the obstacle vehicle is running according to a set running trajectory under the test scenario, to be used as input data of the performance of the unmanned vehicle, that is, a control amount for the performance test of the unmanned vehicle.
In prior art, the obstacle vehicle is in accordance with the set running trajectory and the dynamic attributes of the set obstacle vehicle at a plurality of key points on its running trajectory, thus when the obstacle vehicle runs according to the set running trajectory, the dynamic attributes of the obstacle vehicle change discontinuously, for example, a sudden change in the magnitude of the speed and the direction of the speed, especially at key points, the discontinuous change of the dynamic attributes of the obstacle vehicle will result in false judgment on the perception and control of the unmanned vehicle during the performance test of the unmanned vehicle, as well as a low reliability in the performance test of the unmanned vehicle.
Embodiments of the present application provide a method and an apparatus for acquiring a control amount for a performance test of an unmanned vehicle, so as to overcome the technical problem that the reliability of the performance test of the unmanned vehicle in the prior art is low.
In a first aspect, embodiments of the present application provide a method for acquiring a control amount for a performance test of an unmanned vehicle, including:
acquiring coordinates of m key points on the trajectory of the simulated obstacle vehicle and speeds at the m key points, where m2;
acquiring trajectory equations of the obstacle vehicle between every two adjacent key points according to the coordinates of the m key points, where the trajectory equation is an nth degree polynomial equation, n2;
acquiring accelerations of the obstacle vehicle between every two adjacent key points according to the speeds at the m key points and the trajectory curves corresponding to the trajectory equations, if the speeds of the obstacle vehicle at two adjacent key points are not the same, the acceleration of the obstacle vehicle between the two adjacent key points is a constant that is not 0, if the speeds of the obstacle vehicle at the two adjacent key points are the same, the acceleration of the obstacle vehicle between the two adjacent key points is 0;
for each running duration, according to the accelerations, acquiring a dynamic attribute and a coordinate when the obstacle vehicle has run for the running duration according to trajectories corresponding to the trajectory equations.
In a possible design, where the acquiring trajectory equations of the obstacle vehicle between every two adjacent key points according to the coordinates of the m key points includes:
acquiring a first coordinate of a first shadow point of a first key point among the m key points, and a second coordinate of a second shadow point of a last key point among the m key points;
acquiring the trajectory equations of the obstacle vehicle between every two adjacent key points according to the coordinates of the m key points, the first coordinate and the second coordinate.
In a possible design, where the acquiring accelerations of the obstacle vehicle between every two adjacent key points according to the speeds at the m key points and trajectory curves corresponding to the trajectory equations includes:
acquiring lengths of the trajectory curves corresponding to the trajectory equations;
acquiring running durations of the obstacle vehicle between every two adjacent key points according to the speeds of the obstacle vehicle at the m key points and the lengths of the trajectory curves;
acquiring accelerations of the obstacle vehicle between every two adjacent key points according to the running durations and the speeds of the obstacle vehicle at the m key points.
In a possible design, if the dynamic attribute includes a speed, where the for each running duration, according to the accelerations, acquiring a dynamic attribute when the obstacle vehicle has run for the running duration according to trajectories corresponding to the trajectory equations includes:
for each running duration, determining that, when the obstacle vehicle has run for the running duration, the obstacle vehicle is between a first key point and a second key point and is running according to a target trajectory corresponding to a target trajectory equation between the first key point and the second key point, where the first key point and the second key point are two adjacent points among the m key points;
determining a target duration for which the obstacle vehicle has run according to the target trajectory;
acquiring a speed of the obstacle vehicle when the obstacle vehicle has run for the running duration according to the speed of the obstacle vehicle at the first key point, the acceleration between the first key point and the second key point, and the target duration.
In a possible design, where the for each running duration, according to the accelerations, acquiring a coordinates when the obstacle vehicle has run for the running duration according to trajectories corresponding to the trajectory equations includes:
obtaining, according to the speed of the obstacle vehicle at the first key point and the target duration, a target distance that the obstacle vehicle has run according to the target trajectory;
acquiring a ratio of the target distance to a length of a target trajectory curve, where the length of the target trajectory curve is a length of a trajectory curve corresponding to the target trajectory equation;
acquiring, according to the ratio and the target trajectory equation, the coordinate of the obstacle vehicle when the obstacle vehicle has run for the running duration.
In a possible design, the trajectory equation between an i-th key point and an (i+1)-th key point is:
Traji(r)=c0i+c1ir+c2ir2+c3ir3
where, r represents a running ratio, and the running ratio is the ratio of the distance that the obstacle vehicle has run according to the trajectory between the i-th key point and the (i+1)-th key point to a length of the trajectory curve corresponding to the trajectory of the obstacle vehicle between the i-th key point and the (i+1)-th key point, the i-th key point is adjacent to the (i+1)-th key point; c0i=, Pi is a coordinate of the i-th key point, c1i=−δ×Pi−1+δ×Pi+1, Pi−1 is the coordinate of the i−1 key point, Pi+1 is a coordinate of the (i+1)-th key point, c2i=2δ×Pi−1−(3−δ)×Pi+(3−2δ)×Pi+1−δ×Pi+2, Pi+2 is a coordinate of the (i+2)-th key point, and δ is a tension coefficient, 0<δ<1; P0 is the first coordinate, Pm+1 is the second coordinate, i=1, 2 . . . , m−1.
In a possible design, where the acquiring lengths of the trajectory curves corresponding to the trajectory equations includes:
for every two adjacent key points: determining h sampling points on the trajectory curve corresponding to the trajectory equation between the two adjacent key points;
acquiring straight line distances between adjacent sampling points;
obtaining a length of the trajectory curve corresponding to the trajectory equation between the two adjacent key points according to a sum of the straight line distances.
In a possible design, where the acquiring running durations of the obstacle vehicle between every two adjacent key points according to the speeds of the obstacle vehicle at the m key points and the lengths of the trajectory curves includes:
acquiring the running durations of the obstacle vehicle between every two adjacent key points from the following formula:
T
i=(2×Si)/(ui+ui+1)
where Ti is the running duration of the obstacle vehicle between the i-th key point and the (i+1)-th key point, the i-th key point is adjacent to the (i+1)-th key point; Si is the length of the trajectory curve corresponding to the trajectory equation between the i-th key point and the (i+1)-th key point, ui is the speed of the obstacle vehicle at the i-th key point, and ui+1 is the speed of the obstacle vehicle at the (i+1)-th key point, i=1, 2, . . . m−1.
In a possible design, where the acquiring accelerations of the obstacle vehicle between the every adjacent key points according to the running durations and the speeds of the obstacle vehicle at the m key points includes:
acquiring the accelerations of the obstacle vehicle between every two adjacent key points from the following formula:
a
i=(ui+1−ui)/Ti
where ai is the acceleration of the obstacle vehicle between the i-th key point and the (i+1)-th key point, the i-th key point is adjacent to the (i+1)-th key point, and Ti is the running duration of the obstacle vehicle between the i-th key point and the (i+1)-th key point, ui+1 is the speed of the obstacle vehicle at the (i+1)-th key point, and ui, is the speed of the obstacle vehicle at the i-th key point, i=1, 2, . . . m−1.
In a possible design, where the acquiring a first coordinate of a first shadow point of a first key point among the m key points includes:
obtaining the first coordinate according to a coordinate of the first key point and a coordinate of the second key point;
where the acquiring the second coordinate of the second shadow point of the last key point among the m key points, includes:
obtaining the second coordinate according to a coordinate of the last key point and a coordinate of a second to last key point.
In a second aspect, embodiments of the present application provide an apparatus for acquiring a control amount for a performance test of an unmanned vehicle, including:
a key point acquiring module, configured to acquire coordinates of m key points on the trajectory of the simulated obstacle vehicle and speeds at the m key points, where m2;
a trajectory equation acquiring module, configured to acquire trajectory equations of the obstacle vehicle between every two adjacent key points according to the coordinates of the m key points, wherein the trajectory equation is an nth degree polynomial equation, n2;
an acceleration acquiring module, configured to acquire accelerations of the obstacle vehicle between every two adjacent key points according to the speeds at the m key points and the trajectory curves corresponding to the trajectory equations, if the speeds of the obstacle vehicle at two adjacent key points are not the same, the acceleration of the obstacle vehicle between the two adjacent key points is a constant that is not 0, if the speeds of the obstacle vehicle at the two adjacent key points are the same, the acceleration of the obstacle vehicle between the two adjacent key points is 0;
a control amount acquiring module, configured to, for each running duration, according to the accelerations, acquire a dynamic attribute and a coordinate when the obstacle vehicle has run for the running duration according to trajectories corresponding to the trajectory equations.
In a possible design, the trajectory equation acquiring module is specifically configured to:
acquire a first coordinate of a first shadow point of a first key point among the m key points, and a second coordinate of a second shadow point of a last key point among the m key points;
acquire the trajectory equations of the obstacle vehicle between every two adjacent key points according to the coordinates of the m key points, the first coordinate and the second coordinate.
In a possible design, the acceleration acquiring module is specifically configured to:
acquire lengths of the trajectory curves corresponding to the trajectory equations;
acquire running durations of the obstacle vehicle between every two adjacent key points according to the speeds of the obstacle vehicle at the m key points and the lengths of the trajectory curves;
acquire accelerations of the obstacle vehicle between every two adjacent key points according to the running durations and the speeds of the obstacle vehicle at the m key points.
In a possible design, if the dynamic attribute includes a speed, the control amount acquiring module is specifically configured to:
for each running duration, determine that, when the obstacle vehicle has run for the running duration, the obstacle vehicle is between a first key point and a second key point and is running according to a target trajectory corresponding to a target trajectory equation between the first key point and the second key point, wherein the first key point and the second key point are two adjacent points among the m key points;
determine a target duration for which the obstacle vehicle has run according to the target trajectory;
acquire a speed of the obstacle vehicle when the obstacle vehicle has run for the running duration according to the speed of the obstacle vehicle at the first key point, the acceleration between the first key point and the second key point, and the target duration.
In a possible design, the control amount acquiring module is further specifically configured to:
obtain, according to the speed of the obstacle vehicle at the first key point and the target duration, a target distance that the obstacle vehicle has run according to the target trajectory;
acquire a ratio of the target distance to a length of a target trajectory curve, where the length of the target trajectory curve is a length of a trajectory curve corresponding to the target trajectory equation;
acquire, according to the ratio and the target trajectory equation, the coordinate of the obstacle vehicle when the obstacle vehicle has run for the running duration.
In a possible design, the trajectory equation between an i-th key point and an (i+1)-th key point is:
Traji(r)=c0i+c1ir+c2ir2+c3ir3
where, r represents a running ratio, and the running ratio is the ratio of the distance that the obstacle vehicle has run according to the trajectory between the i-th key point and the (i+1)-th key point to a length of the trajectory curve corresponding to the trajectory of the obstacle vehicle between the i-th key point and the (i+1)-th key point, the i-th key point is adjacent to the (i+1)-th key point; c0i=Pi, Pi is a coordinate of the i-th key point, c1i=−δ×Pi−1+δ×Pi+1, Pi−1 is the coordinate of the i−1 key point, Pi+1 is a coordinate of the (i+1)-th key point, c2i=2δ×Pi−1−(3−δ)×Pi+(3−2δ)×Pi+1−δ×Pi+2, Pi+2 is a coordinate of the (i+2)-th, and δ is a tension coefficient, 0<δ<1; P0 is the first coordinate, Pm+1 is the second coordinate, i=1, 2 . . . , m−1.
In a possible design, the acceleration acquiring module is specifically configured to: for every two adjacent key points: determine h sampling points on the trajectory curve corresponding to the trajectory equation between the two adjacent key points;
acquire straight line distances between adjacent sampling points;
obtain the length of the trajectory curve corresponding to the trajectory equation between the two adjacent key points according to a sum of the straight line distances.
In a possible design, the acceleration acquiring module is specifically configured to:
acquire the running durations of the obstacle vehicle between every two adjacent key points from the following formula:
T
i=(2×Si)/(ui+ui+1)
where Ti is the running duration of the obstacle vehicle between the i-th key point and the (i+1)-th key point, the i-th key point is adjacent to the (i+1)-th key point; Si is the length of the trajectory curve corresponding to the trajectory equation between the i-th key point and the (i+1)-th key point, ui, is the speed of the obstacle vehicle at the i-th key point, and ui+1 is the speed of the obstacle vehicle at the (i+1)-th key point, i=1, 2, . . . m−1.
In a possible design, the acceleration acquiring module is specifically configured to:
acquire the accelerations of the obstacle vehicle between every two adjacent key points from the following formula:
a
i=(ui+1−ui)/Ti
where ai is the acceleration of the obstacle vehicle between the i-th key point and the (i+1)-th key point, the i-th key point is adjacent to the (i+1)-th key point, and Ti is the running duration of the obstacle vehicle between the i-th key point and the (i+1)-th key point, ui+1 is the speed of the obstacle vehicle at the (i+1)-th key point, and ui, is the speed of the obstacle vehicle at the i-th key point, i=1, 2, . . . m−1.
In a possible design, the trajectory equation acquiring module includes:
obtaining the first coordinate according to a coordinate of the first key point and a coordinate of the second key point;
where the acquiring the second coordinate of the second shadow point of the last key point among the m key points, includes:
obtaining the second coordinate according to a coordinate of the last key point and a coordinate of a second to last key point.
In a third aspect, embodiments of the present application provide a non-volatile computer readable storage medium, where a computer program is stored in the non-volatile computer readable storage medium, and the computer program is executed by a processor to perform the method according to the first aspect and any possible design of the first aspect of the claims.
In a fourth aspect, embodiments of the present application provide an apparatus for acquiring a control amount for a performance test of an unmanned vehicle, including a processor and a memory, where
the memory, configured to store a program;
the processor, configured to execute the program stored in the memory, the processor is configured to perform the method according to the first aspect and any possible design of the first aspect when the program is executed.
In the present application, by constructing an nth polynomial trajectory equation, n2, the direction of the speed of the obstacle vehicle during running can be continuously changed, and if the speeds of the obstacle vehicle at two adjacent key points are not the same, the acceleration of the obstacle vehicle between the two adjacent key points is a constant that is not 0, if the speeds of the obstacle vehicle at the two adjacent key points are the same, the acceleration of the obstacle vehicle between the two adjacent key points is 0, so that the magnitude of the speed of the obstacle vehicle can be continuously changed during the running, thus the dynamic attribute of the obstacle vehicle continuously changes, which is in accordance with the dynamic characteristics of the vehicle. The continuously changing dynamic attribute are used as the control amount in the performance test of the unmanned vehicle, therefore, false judgment on the perception and control of the unmanned vehicle rarely happens, and the reliability of the result of the performance test of the unmanned vehicle is improved.
In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the drawings used in the embodiments or the prior art description will be briefly described below. Obviously, the drawings in the following description are some embodiments of the present application, and other drawings can be obtained according to the drawings without any creative labor for those skilled in the art.
In order to make the objective, technical scheme and advantage of the present application more clear, the technical solutions in the embodiments of the present application will be clearly and completely described in the following with reference to the accompanying drawings in the embodiments of the present application. It is obvious that the described embodiments are only a part of embodiments of the present application, not all embodiments of the present application. Based on the embodiments of the present application, all the other embodiments obtained by those of ordinary skill without any creative works are within the protection scope of the present application.
step S101: acquiring coordinates of m key points on the trajectory of the simulated obstacle vehicle and speeds at the m key points, where n2;
step S102: acquiring trajectory equations of the obstacle vehicle between every two adjacent key points according to the coordinates of the m key points, where the trajectory equation is an nth degree polynomial equation, n2;
step S103: acquiring accelerations of the obstacle vehicle between every two adjacent key points according to the speeds at the m key points and the trajectory curves corresponding to the trajectory equations, if the speeds of the obstacle vehicle at two adjacent key points are not the same, the acceleration of the obstacle vehicle between the two adjacent key points is a constant that is not 0, if the speeds of the obstacle vehicle at the two adjacent key points are the same, the acceleration of the obstacle vehicle between the two adjacent key points is 0;
step S104: for each running duration, according to the accelerations, acquiring a dynamic attribute and a coordinate when the obstacle vehicle has run for the running duration according to trajectories corresponding to the trajectory equations.
Specifically, the execution subject of this embodiment may be a terminal device.
For step S101: acquiring coordinates of m key points on the trajectory of the simulated obstacle vehicle and speeds at the m key points.
Specifically, the m key points are points which are set in the performance test scenario of the unmanned vehicle and by which the obstacle vehicle will pass, and the coordinates of the m key points and the speeds of the obstacle vehicle at the m key points are determined according to the performance of the unmanned vehicles that need to be tested. The coordinates of the m key points in this embodiment are three-dimensional coordinates.
Where the m key points can be expressed as [Y0, Y1, . . . , Ym−1], Y0 represents a first key point, Y1 represents a second key point, Ym represents an m-th key point, an i-th key point and an (i+1)-th key point are adjacent key points, i=1, 2 . . . , m−1.
For example, it is necessary to test the performance of the unmanned vehicle in response to the sudden braking of the obstacle vehicle after overtaking. The setting plan of some key points among the m key points can be as shown in
That is to say, acquiring coordinates of the m key points on the trajectory of the simulated obstacle vehicle and the speeds at the m key points is acquiring the coordinates of the m key points and the speeds of the obstacle vehicle at the m key points determined according to the performance of the unmanned vehicle that need to be tested.
For step S102, acquiring trajectory equations of the obstacle vehicle between every two adjacent key points according to the coordinates of the m key points, where the trajectory equation is an nth degree polynomial equation, n2.
Specifically, two adjacent key points are two key points that the obstacle vehicle passes in turn during running, for example, the obstacle vehicle passes Key Point 1 at Time t1, passes Key Point 2 at Time t2, passes Key Point 3 at Time t3, and passes no other key point between Time t1 and Time t2, and passes no other key points between Time t2 and Time t3, then Key Point 1 and Key Point 2 are adjacent key points. Key Point 2 and Key Point 3 are adjacent key points.
The specific process of “acquiring trajectory equations of the obstacle vehicle between every two adjacent key points according to the coordinates of the m key points” is as follows:
a: modeling trajectories between adjacent key points, the trajectory model of every two adjacent key points can be as follows:
Traj(r)=c0+c1r+c2r2+c3r3
where, r represents a running ratio, the running ratio is a ratio of a distance that the obstacle vehicle has run according to the trajectory corresponding to the trajectory equation between the adjacent key points to a length of the trajectory curve corresponding to the trajectory equation between the adjacent key points; c0, c1, c2 and c3 are coefficients;
b: acquiring trajectory equations of the obstacle vehicle between every two adjacent key points according to the coordinates of the m key points, that is, solving the coefficients c0, c1, c2 and c3.
where the trajectory equation between the i-th key point and the (i+1)-th key point can be expressed as:
Traji(r)=c0i+c1ir+c2ir2+c3ir3
where, r represents a running ratio, and the running ratio is the ratio of the distance that the obstacle vehicle has run according to the trajectory between the i-th key point and the (i+1)-th key point to the length of the trajectory curve corresponding to the trajectory of the obstacle vehicle between the i-th key point and the (i+1)-th key point, the i-th key point is adjacent to the (i+1)-th key point, i=1, 2 . . . , m−1.
It can be understood that for every two adjacent key points, it is necessary to solve the corresponding coefficients, c0i, c1i, c2i, c3i, when solving, introduce boundary conditions: Traji(O)=Pi (1), Traji(1)=Pi+1 (2), Traj′i(O)=tan genti (3), Traj′i(1)=tan genti+1 (4), where, tan genti represents a cut vector of the i-th key point, tan genti=δ(Pi+1−Pi−1).
The above boundary condition is substituted into the trajectory equation between the i-th key point and the (i+1)-th key point, and the following solution is obtained:
c
0
i
=P
i;
c
1
i
=−δ×P
i−1
+δ×P
i+1;
c
2
i=2δ×Pi−1−(3−δ)×Pi+(3−2δ)×Pi+1−δ×Pi+2;
c
3
i
=−δ×P
i−1+(2−δ)×Pi−(2−δ)×Pi+1δ×Pi+2;
Where Pi−1 is a coordinate of the (i−1)-th key point, Pi is a coordinate of the i-th key point, Pi+1 is a coordinate of the (i+1)-th key point, and Pi+2 is a coordinate of the (i+2)-th.
When i=1, the coefficients of the trajectory equation between the first key point and the second key point are:
c
0
1
=P
1;
c
1
1
=−δ×P
0
+δ×P
2;
c
2
1=2δ×P0−(3−δ)×P1+(3−2δ)×P2−δ×P3;
c
3
1
=−δ×P
0+(2−δ)×P1−(2−δ)×P2+δ×P3;
Here, P0 appears, according to the above definition, P0 should be a coordinate of the 0-th key point, but the 0-th key point does not exist, in this case, a first shadow point of the first key point can be obtained, the first shadow point is called the 0-th key point, and a first coordinate P0 of the first shadow point can be P0=2×P1−P2, that is, the first coordinate is acquired according to the coordinate of the first key point and the coordinate of the second key point.
When i=m−1, the coefficients of the trajectory equation between the (m−1)-th key point and the m-th key point are:
c
0
m−1
=P
m−1;
c
1
m−1
=−δ×P
m−2
+δ×P
m;
c
2
m−1=2δ×Pm−2−(3−δ)×Pm−1+(3−2δ)×Pm−δ×Pm+1;
c
3
m−1
=−δ×P
m−2+(2−δ)×Pm−1−(2−δ)×Pm+δ×Pm+1;
Here, Pm+1 appears, according to the above definition, Pm+1 should be a coordinate of the (m+1)-th key point, but the (m+1)-th key point does not exist, in this case, a second shadow point of a last key point can be obtained, the second shadow point is called the (m+1)-th key point, and a second coordinate Pm+1 of the second shadow point may be Pm+1=2×Pm−Pm−1, that is, the second coordinate is acquired according to the coordinate of the last key point and the coordinate of the second to last key point.
After the coefficients are solved, the trajectory process of the obstacle vehicle between every two adjacent key points is obtained. It can be understood that, in the case where the number of key points is m, m−1 trajectory equations can be obtained, and between every two adjacent key points, the obstacle vehicle runs according to the trajectory corresponding to the trajectory process between the adjacent key points.
Referring to
That is, in this embodiment, the nth degree polynomial trajectory equation is constructed, n2, so that the obstacle vehicle does not suddenly change the direction of the speed at the key points.
For step S103, acquiring accelerations of the obstacle vehicle between every two adjacent key points according to the speeds at the m key points and the trajectory curves corresponding to the trajectory equations, if the speeds of the obstacle vehicle at two adjacent key points are not the same, the acceleration of the obstacle vehicle between the two adjacent key points is a constant that is not 0, if the speeds of the obstacle vehicle at the two adjacent key points are the same, the acceleration of the obstacle vehicle between the two adjacent key points is 0.
Specifically, the step includes:
b1: acquiring lengths of the trajectory curves corresponding to the trajectory equations;
b2: acquiring running durations of the obstacle vehicle between every two adjacent key points according to the speeds of the obstacle vehicle at the m key points and the lengths of the trajectory curves;
b3: acquiring accelerations of the obstacle vehicle between every two adjacent key points according to the running durations and the speeds of the obstacle vehicle at the m key points.
For b1: acquiring lengths of the trajectory curves corresponding to the trajectory equations:
for every two adjacent key points:
determining h sampling points on the trajectory curve corresponding to the trajectory equation between the two adjacent key points;
acquiring straight line distances between adjacent sampling points;
obtaining the length of the trajectory curve corresponding to the trajectory equation between the two adjacent key points according to a sum of the straight line distances.
Specifically, for every two adjacent key points, sampling is performed on a trajectory curve corresponding to a trajectory equation between two adjacent key points, and multiple sampling points are obtained, and the straight line distances between adjacent sampling points are acquired. The straight line distances are added up to obtain the length of the trajectory curve corresponding to the trajectory equation between the two adjacent key points.
It can be understood that the value of h should be as large as possible.
Referring to
For b2: the acquiring running durations of the obstacle vehicle between every two adjacent key points according to the speeds of the obstacle vehicle at the m key points and the lengths of the trajectory curves includes:
acquiring the running durations of the obstacle vehicle between every two adjacent key points from formula I:
T
i=(2×Si)/(ui+ui+1) Formula I
where Ti is the running duration of the obstacle vehicle between the i-th key point and the (i+1)-th key point, the i-th key point is adjacent to the (i+1)-th key point; Si is the length of the trajectory curve corresponding to the trajectory equation between the i-th key point and the (i+1)-th key point, ui is the speed of the obstacle vehicle at the i-th key point, and ui+1 is the speed of the obstacle vehicle at the (i+1)-th key point, i=1, 2, . . . m−1.
For b3: the acquiring accelerations of the obstacle vehicle between the every adjacent key points according to the running durations and the speeds of the obstacle vehicle at the m key points includes:
acquiring the accelerations of the obstacle vehicle between every two adjacent key points from formula II:
a
i=(ui+1−ui)/Ti Formula II
where ai is the acceleration of the obstacle vehicle between the i-th key point and the (i+1)-th key point, the i-th key point is adjacent to the (i+1)-th key point, and Ti is the running duration of the obstacle vehicle between the i-th key point and the (i+1)-th key point, ui+1 is the speed of the obstacle vehicle at the (i+1)-th key point, and ui, is the speed of the obstacle vehicle at the i-th key point, i=1, 2, . . . m−1.
It can be understood that if the speeds of the obstacle vehicle at the two adjacent key points are the same, the acceleration of the obstacle vehicle between the two adjacent key points is 0.
In this embodiment, if the speeds of the obstacle vehicle at two adjacent key points are not the same, the acceleration of the obstacle vehicle between the two adjacent key points is a constant that is not 0, indicating that the obstacle vehicle is in a uniform acceleration motion or a uniform deceleration motion between the two adjacent key points, so the obstacle vehicle will not suddenly change the speed during running. Similarly, if the speed of the obstacle vehicle is the same at two adjacent key points, the acceleration of the obstacle vehicle between the two adjacent key points is 0, indicating that the obstacle vehicle is in a uniform motion between the two adjacent key points, so the obstacle vehicle will not suddenly change the speed during running.
For step S104, for each running duration, according to the accelerations, acquiring a dynamic attribute and a coordinate when the obstacle vehicle has run for the running duration according to trajectories corresponding to the trajectory equations.
Specifically, for each running duration:
c1: determining that when the obstacle vehicle has run for the running duration, the obstacle vehicle is between a first key point and a second key point, and is running according to a target trajectory corresponding to a target trajectory equation between the first key point and the second key point, where the first key point and the second key point are two adjacent points among the m key points;
c2: determining a target duration for which the obstacle vehicle has run according to the target trajectory;
c3: acquiring a speed of the obstacle vehicle when the obstacle vehicle has run for the running duration according to the speed of the obstacle vehicle at the first key point, the acceleration of the obstacle vehicle between the first key point and the second key point, and the above target duration;
c4: obtaining, according to the speed of the obstacle vehicle at the first key point and the above target duration, a target distance that the obstacle vehicle has run according to the target trajectory;
c5: acquiring a ratio of the target distance to a length of a target trajectory curve, where the length of the target trajectory curve is a length of a trajectory curve corresponding to the target trajectory equation;
c6: acquiring, according to the above ratio and the target trajectory equation, the coordinate of the obstacle vehicle when the obstacle vehicle has run for the running duration.
Specifically, the interval of multiple running durations may be 0.1 second(s), for example, the running durations may be 0 s, 0.1 s, 0.2 s, 0.3 s, . . . , 1 s, 1.1 s, . . . , T, that is, acquiring dynamic attributes and coordinates of the obstacle vehicle when running 0 s, 0.1 s, 0.2 s, 0.3 s, . . . , 1 s, 1.1 s, . . . , T. Where T is the duration that the obstacle vehicle runs from the first key point to the last key point according to the trajectories corresponding to the trajectory equations.
For c1: if acquiring a dynamic attribute and a coordinate of the obstacle when the running duration of the obstacle vehicle is 1 s, where the running duration between the first key point and the second key point is 0.5 s, the running duration between the second key point and the third key point is 0.3 s, and the running duration between the third key point and the fourth key point is 0.4 s. When the obstacle vehicle has run for 1 s, the obstacle vehicle is between the third key point and the fourth key point, and is currently running according to the trajectory between the third key point and the fourth key point, and the trajectory between the third key point and the fourth key point is the target trajectory of the obstacle vehicle, the third key point is the first key point, and the fourth key point is the second key point.
For c2: determining the target duration for which the obstacle vehicle has run according to the above target trajectory t=1 s−0.5 s−0.3 s=0.2 s.
For c3: If the speed of the third key point is v1, the acceleration of the obstacle vehicle between the third key point and the fourth key point is a1, then when the obstacle vehicle has run for 1 s, the speed of the obstacle vehicle v=v1+a1×t.
For c4: the target distance that the obstacle vehicle has run according to the above target trajectory is s=v1×t+0.5×a1×t2.
For c5: if the length of the target trajectory curve corresponding to the trajectory equation between the third key point and the fourth key point is L (i.e., S3), then the ratio of the target distance to the length of the target trajectory curve is taken as r1=s/L.
For c6: substituting r1 into the trajectory equation between the third key point and the fourth key point Traj3(r)=c03+c13+c23r2+c33r3, when the obstacle vehicle has run for 1 s, the coordinate of the obstacle vehicle P=c03+c13r1+c23(r1)2+c33(r1)3.
Further, the dynamic attribute may further include a track. If the obstacle vehicle has run for a duration of T1 (running duration), the coordinate of the obstacle vehicle is P1, and when the obstacle vehicle has run for a duration of T2 (running duration), the coordinate of the obstacle vehicle is P2, then between the running duration T1 and T2, the track of the obstacle vehicle during the time is P2−P1.
The dynamic attributes and coordinates of the obstacle vehicle can be obtained in the same manner as described above when the obstacle vehicle has run for other running durations.
According to the method for acquiring the track as described above, the track of the obstruction during the time between every two adjacent running durations can be acquired, where the above 0 s, 0.1 s are two adjacent running durations, 0.1 s, 0.2 s are two adjacent running durations, 0.2 s, 0.3 s are two adjacent running durations, and so on.
According to the above method, the dynamic attributes and coordinates of the obstacle vehicle when the obstacle vehicle has run according to the trajectories corresponding to the trajectory equations for different running durations are obtained, the dynamic attributes and coordinates of the obstacle vehicle when the obstacle vehicle has run for different running durations are the input data when performing the performance test of the unmanned vehicle, or the dynamic attributes and coordinates of the obstacle vehicle are the control amounts for the performance test of the unmanned vehicle when the obstacle vehicle has rung for different running durations.
In this implementation, by constructing an nth polynomial trajectory equation, n>2, the direction of the speed of the obstacle vehicle during running can be continuously changed, and if the speeds of the obstacle vehicle at two adjacent key points are not the same, the acceleration of the obstacle vehicle between the two adjacent key points is a constant that is not 0, if the speeds of the obstacle vehicle at the two adjacent key points are the same, the acceleration of the obstacle vehicle between the two adjacent key points is 0, so that the magnitude of the speed of the obstacle vehicle can be continuously changed during the running, thus the dynamic attribute of the obstacle vehicle continuously changes, which is in accordance with the dynamic characteristics of the vehicle. The continuously changing dynamic attribute are used as the control amount in the performance test of the unmanned vehicle, therefore, false judgment on the perception and control of the unmanned vehicle rarely happens, and the reliability of the result of the performance test of the unmanned vehicle is improved.
the key point acquiring module 51, configured to acquire coordinates of m key points on the trajectory of the simulated obstacle vehicle and speeds at the m key points, where m≥2;
the trajectory equation acquiring module 52, configured to acquire trajectory equations of the obstacle vehicle between every two adjacent key points according to the coordinates of the m key points, where the trajectory equation is an nth degree polynomial equation, ng;
the acceleration acquiring module 53, configured to acquire accelerations of the obstacle vehicle between every two adjacent key points according to the speeds at the m key points and the trajectory curves corresponding to the trajectory equations, if the speeds of the obstacle vehicle at two adjacent key points are not the same, the acceleration of the obstacle vehicle between the two adjacent key points is a constant that is not 0, if the speeds of the obstacle vehicle at the two adjacent key points are the same, the acceleration of the obstacle vehicle between the two adjacent key points is 0;
the control amount acquiring module 54, configured to, for each running duration, according to the accelerations, acquire a dynamic attribute and a coordinate when the obstacle vehicle has run for the running duration according to trajectories corresponding to the trajectory equations.
The apparatus in this embodiment may be used to implement the technical solution of the foregoing method embodiments, the implementation principle and the technical effect are similar, and details are not described herein again.
In a possible design, the trajectory equation acquiring module is specifically configured to:
acquire a first coordinate of a first shadow point of a first key point among the m key points, and a second coordinate of a second shadow point of a last key point among the m key points;
acquire the trajectory equations of the obstacle vehicle between every two adjacent key points according to the coordinates of the m key points, the first coordinate and the second coordinate.
In a possible design, the acceleration acquiring module is specifically configured to:
acquire lengths of the trajectory curves corresponding to the trajectory equations;
acquire running durations of the obstacle vehicle between every two adjacent key points according to the speeds of the obstacle vehicle at the m key points and the lengths of the trajectory curves;
acquire accelerations of the obstacle vehicle between every two adjacent key points according to the running durations and the speeds of the obstacle vehicle at the m key points.
In a possible design, if the dynamic attribute includes a speed, the control amount acquiring module is specifically configured to:
for each running duration, determine that when the obstacle vehicle has run for the running duration, the obstacle vehicle is between a first key point and a second key point, and is running according to a target trajectory corresponding to a target trajectory equation between the first key point and the second key point, where the first key point and the second key point are two adjacent points among the m key points;
determine a target duration for which the obstacle vehicle has run according to the target trajectory;
acquire a speed of the obstacle vehicle when the obstacle vehicle has run for the running duration according to the speed of the obstacle vehicle at the first key point, the acceleration between the first key point and the second key point, and the target duration.
In a possible design, the control amount acquiring module is further specifically configured to:
obtain, according to the speed of the obstacle vehicle at the first key point and the target duration, a target distance that the obstacle vehicle has run according to the target trajectory;
acquire a ratio of the target distance to a length of a target trajectory curve, where the length of the target trajectory curve is a length of a trajectory curve corresponding to the target trajectory equation;
acquire, according to the ratio and the target trajectory equation, the coordinate of the obstacle vehicle when the obstacle vehicle has run for the running duration.
In a possible design, the trajectory equation between the i-th key point and the (i+1)-th key point is:
Traji(r)=c0i+c1ir+c2ir2+c3ir3
where, r represents a running ratio, and the running ratio is the ratio of the distance that the obstacle vehicle has run according to the trajectory between the i-th key point and the (i+1)-th key point to a length of the trajectory curve corresponding to the trajectory of the obstacle vehicle between the i-th key point and the (i+1)-th key point, the i-th key point is adjacent to the (i+1)-th key point; c0i=Pi, Pi is a coordinate of the i-th key point, c1i=−δ×Pi−1+δ×Pi+1, Pi−1 is the coordinate of the i−1 key point, Pi+1 is a coordinate of the (i+1)-th key point, c2i=2δ×Pi−1−(3−δ)×Pi+(3−2δ)×Pi+1−δ×Pi+2, Pi+2 is a coordinate of the (i+2)-th, and δ is a tension coefficient, 0<δ<1; P0 is the first coordinate, Pm+1 is the second coordinate, i=1, 2 . . . , m−1.
In a possible design, the acceleration acquiring module 53 is specifically configured to: for every two adjacent key points: determine h sampling points on the trajectory curve corresponding to the trajectory equation between the two adjacent key points;
acquire straight line distances between adjacent sampling points;
obtain the length of the trajectory curve corresponding to the trajectory equation between the two adjacent key points according to a sum of the straight line distances.
In a possible design, the acceleration acquiring module 53 is specifically configured to:
acquire the running durations of the obstacle vehicle between every two adjacent key points from the following formula:
T
i=(2×Si)/(ui+ui+1)
where Ti is the running duration of the obstacle vehicle between the i-th key point and the (i+1)-th key point, the i-th key point is adjacent to the (i+1)-th key point; Si is the length of the trajectory curve corresponding to the trajectory equation between the i-th key point and the (i+1)-th key point, ui, is the speed of the obstacle vehicle at the i-th key point, and ui+1 is the speed of the obstacle vehicle at the (i+1)-th key point, i=1, 2, . . . m−1.
In a possible design, the acceleration acquiring module 53 is specifically configured to:
acquire the accelerations of the obstacle vehicle between every two adjacent key points from the following formula:
a
i=(ui+1−ui)/Ti
where ai is the acceleration of the obstacle vehicle between the i-th key point and the (i+1)-th key point, the i-th key point is adjacent to the (i+1)-th key point, and Ti is the running duration of the obstacle vehicle between the i-th key point and the (i+1)-th key point, ui+1 is the speed of the obstacle vehicle at the (i+1)-th key point, and ui, is the speed of the obstacle vehicle at the i-th key point, i=1, 2, . . . m−1.
In a possible design, the trajectory equation acquiring module 52 includes:
obtaining the first coordinate according to a coordinate of the first key point and a coordinate of the second key point;
where the acquiring the second coordinate of the second shadow point of the last key point among the m key points includes:
obtaining the second coordinate according to a coordinate of the last key point and a coordinate of a second to last key point.
The apparatus in this embodiment may be used to implement the technical solution of the foregoing method embodiments, the implementation principle and the technical effect are similar, and details are not described herein again.
The embodiments of the present application further provide a non-volatile computer readable storage medium, where a computer program is stored in the non-volatile computer readable storage medium, and the computer program is executed by a processor to perform the method according to the foregoing method embodiments.
the memory 61, configured to store a program;
the processor 62, configured to execute the program stored in the memory, the processor is configured to perform the method in the foregoing method embodiment when the program is executed.
It will be understood by those skilled in the art that all or part of the steps of implementing the above method embodiments may be performed by hardware related to the program instructions. The aforementioned program can be stored in a non-volatile computer readable storage medium. The program, when executed, performs the steps including the foregoing method embodiments; and the foregoing storage medium includes: various media that can store program codes, such as a ROM, a RAM, a magnetic disk, or an optical disk.
It should be noted that the above embodiments are only used to explain the technical solution of the present application and shall not be construed as limitation; although the present application has been described in detail with reference to the foregoing embodiments, those skilled in the art will understand that the technical solutions described in the foregoing embodiments may be modified, or some or all of the technical features may be equivalently replaced; and the modifications or substitutions do not deviate from the scope of the technical solutions of the embodiments of the present application.
Number | Date | Country | Kind |
---|---|---|---|
201810672885.8 | Jun 2018 | CN | national |