阅读说明：本技术 用于地面无人平台的室内测试方法、系统及计算机设备 (Indoor testing method and system for ground unmanned platform and computer equipment ) 是由 余彪 陈志磊 梁华为 王少平 李碧春 于 2020-06-29 设计创作，主要内容包括：本发明公开了一种用于地面无人平台的室内测试方法、系统及计算机设备,其利用模拟平台在室内的测试结果判断地面无人平台的规划控制能力,所述室内测试方法包括以下步骤：构建包含障碍物的室内测试场景,所述障碍物包括静态障碍物；将室内测试场景内的障碍物信息和终点位置发送至模拟平台,模拟平台生成包含规划轨迹的运行规划,且在室内测试场景中躲避障碍物并沿规划轨迹从初始位置运动至终点位置；在模拟平台从初始位置运动至终点位置的过程中,实时采集模拟平台的实际轨迹；根据模拟平台运行过程中的轨迹风险、模拟平台实际运行情况与运行规划的偏差,以及轨迹规划用时、规划轨迹长度计算地面无人平台的规划控制能力得分。(The invention discloses an indoor test method, a system and computer equipment for a ground unmanned platform, which judge the planning control capability of the ground unmanned platform by using the indoor test result of a simulation platform, wherein the indoor test method comprises the following steps: constructing an indoor test scenario containing obstacles, including static obstacles; the method comprises the steps that barrier information and a terminal position in an indoor test scene are sent to a simulation platform, the simulation platform generates an operation plan containing a planned track, and avoids barriers in the indoor test scene and moves from an initial position to the terminal position along the planned track; acquiring an actual track of a simulation platform in real time in the process that the simulation platform moves from an initial position to a terminal position; and calculating the planning control capability score of the ground unmanned platform according to the track risk in the operation process of the simulation platform, the deviation between the actual operation condition of the simulation platform and the operation plan, the planning track length during the track planning and the planning track length.)

1. An indoor test method for a ground unmanned platform, which judges the planning control capability of the ground unmanned platform by using the indoor test result of a simulation platform, comprises the following steps:

the method comprises the following steps: constructing an indoor test scenario containing obstacles, including static obstacles;

step two: the method comprises the steps that barrier information and a terminal position in an indoor test scene are sent to a simulation platform, the simulation platform generates an operation plan containing a planned track, and avoids barriers in the indoor test scene and moves from an initial position to the terminal position along the planned track;

step three: acquiring an actual track of a simulation platform in real time in the process that the simulation platform moves from an initial position to a terminal position; and calculating the planning control capability score of the ground unmanned platform according to the track risk in the operation process of the simulation platform, the deviation between the actual operation condition of the simulation platform and the operation plan, the planning track length during the track planning and the planning track length.

2. The indoor testing method for the ground unmanned platform as claimed in claim 1, wherein the time for planning the trajectory is from the time when the simulation platform receives the obstacle information and the end position to the time when the planned trajectory is generated, and the score S for planning the trajectory is determined according to the length of the time for planning the trajectory_t(ii) a Acquiring actual coordinate points of the simulation platform once every fixed period, wherein the actual coordinate points are A in sequence in the motion process of the simulation platform₁(x₁，y₁)，A₂(x₂，y₂)，...，A_N(x_N，y_N) Connecting the coordinate points by straight line segments in sequence to form the actual track, and regarding each actual coordinate point A_i(x_i，y_i) Finding and A on the planned trajectory_iCorresponding point A'_i(x′_i，y′_i) (ii) a Length of the planned trajectoryThen track length score

Wherein L is_maxSetting a maximum track length value under the indoor test scene; the track risk is used for measuring the collision risk between the simulation platform and the obstacles, calculating the minimum distance from each obstacle to the actual track, and selecting the minimum value d in the minimum distances_minThen score the track risk

Wherein D is a safe distance; in the third step, the deviation between the actual operation condition of the simulation platform and the operation plan comprises a transverse deviation and a longitudinal deviation, the transverse deviation is the distance deviation between the actual operation condition of the simulation platform and the operation plan, and the shortest distance d between each actual coordinate point and the planning track is calculated_iAnd calculate the average of all shortest distances:

Longitudinal deviation score

Wherein d is_maxIs the distance deviation threshold, v_maxIs the speed deviation threshold; the planning control capability score of the ground unmanned platform is equal to S ═ w_tS_t+w_LS_L+w_RS_R+w_latS_lat+w_lngS_lngWherein w is_t、w_L、w_R、w_lat、w_lngRespectively, the weight of the track planning time score, the weight of the track length score, the weight of the track risk score, the weight of the transverse deviation score and the weight of the longitudinal deviation score.

3. The indoor testing method for the ground unmanned platform as claimed in claim 1, wherein in the first step, the obstacle further comprises a dynamic obstacle whose position changes during the motion of the simulation platform.

4. The indoor testing method for a ground-based unmanned platform of claim 3, wherein the trajectory planning time is a time from when the simulation platform receives the obstacle information and the end position to when the operation plan is generated,determining the score S of the track planning time according to the length of the track planning time_t(ii) a Acquiring actual coordinate points of the simulation platform once every fixed period, wherein the actual coordinate points are A in sequence in the motion process of the simulation platform₁(x₁，y₁)，A₂(x₂，y₂)，...，A_N(x_N，y_N) Connecting the coordinate points by straight line segments in sequence to form the actual track, and regarding each actual coordinate point A_i(x_i，y_i) Finding and A on the planned trajectory_iCorresponding point A'_i(x′_i，y′_i) (ii) a Length of the planned trajectoryThen track length score

Wherein L is_maxSetting a maximum track length value under the indoor test scene; the track risk is used for measuring the collision risk between the simulation platform and the obstacles, calculating the minimum distance from each obstacle to the actual track, and selecting the minimum value d in the minimum distances_minThen score the track risk

Wherein D is a safe distance; in the third step, the deviation between the actual operation condition of the simulation platform and the operation plan comprises longitudinal deviation and dynamic planning response, the longitudinal deviation is the speed deviation between the actual operation condition of the simulation platform and the operation plan, and the actual speed v of the simulation platform at each actual coordinate point is collected_iCalculating a difference in velocity

Wherein d is_maxIs the distance deviation threshold, v_maxIs the speed deviation threshold; the dynamic planning response is a process of adjusting and generating a new planning track on the basis of the initial planning track when the simulation platform detects the dynamic barrier, and the dynamic planning response is carried out according to the sum of the minimum distances between each dynamic barrier and the new planning track

5. Indoor test method for ground unmanned platforms, according to claim 2 or 4, characterized by the fact that the calculationBefore planning the track length, track validity verification is required to be carried out; if for any i e [2, N]In presence of y_i＞y_i-1If so, the planning track is considered to be effective; otherwise, the planning track is invalid, and the test is stopped.

6. The indoor testing method for the ground unmanned platform as claimed in claim 1, wherein in the first step, the static obstacles comprise negative static obstacles lower than a reference plane and positive static obstacles higher than the reference plane; when an indoor test scene is built, a ground coordinate system and a basic terrain system need to be built, wherein the ground coordinate system is a UWB indoor positioning system built in an equidistant grid mode, the basic terrain system comprises a plurality of basic unit modules, the basic unit modules are tiled in the indoor test scene, individual basic unit modules are removed according to needs to form negative static obstacles, and other basic unit modules are stacked on the individual basic unit modules to form positive static obstacles.

7. An indoor test system for a ground unmanned platform, characterized in that: the method comprises the following steps:

a scene construction module that constructs an indoor test scene containing obstacles, including static obstacles;

the system comprises a track generation module, a simulation platform and a data processing module, wherein the track generation module sends barrier information and a terminal position in an indoor test scene to the simulation platform, and the simulation platform generates an operation plan containing a planned track, avoids barriers in the indoor test scene and moves from an initial position to the terminal position along the planned track;

an evaluation module: acquiring an actual track of a simulation platform in real time in the process that the simulation platform moves from an initial position to a terminal position; and calculating the planning control capability score of the ground unmanned platform according to the track risk in the operation process of the simulation platform, the deviation between the actual operation condition of the simulation platform and the operation plan, the planning track length during the track planning and the planning track length.

8. Computer arrangement, characterized in that it comprises a memory and a processor, in which memory a computer program is stored, which computer program, when being executed by the processor, performs the steps of the room testing method according to any of the claims 1-6.

Technical Field

The invention relates to the field of ground unmanned platforms, in particular to an indoor testing method and system for a ground unmanned platform and computer equipment.

Background

The ground unmanned platform can assist soldiers and firefighters in scouting, fire extinguishing, material transportation, medical service and other works, and can replace the human beings to perform monotonous, boring and dirty tasks.

Disclosure of Invention

In order to solve the technical problems, the invention provides an indoor testing method and system for a ground unmanned platform and computer equipment.

In order to solve the technical problems, the invention adopts the following technical scheme:

an indoor test method for a ground unmanned platform, which judges the planning control capability of the ground unmanned platform by using the indoor test result of a simulation platform, comprises the following steps:

the method comprises the following steps: constructing an indoor test scenario containing obstacles, including static obstacles;

step two: the method comprises the steps that barrier information and a terminal position in an indoor test scene are sent to a simulation platform, the simulation platform generates an operation plan containing a planned track, and avoids barriers in the indoor test scene and moves from an initial position to the terminal position along the planned track;

step three: acquiring an actual track of a simulation platform in real time in the process that the simulation platform moves from an initial position to a terminal position; and calculating the planning control capability score of the ground unmanned platform according to the track risk in the operation process of the simulation platform, the deviation between the actual operation condition of the simulation platform and the operation plan, the planning track length during the track planning and the planning track length.

Specifically, the time for planning the track is the time from the receiving of the obstacle information and the end position to the generation of the planned track by the simulation platform, and the score S for planning the track is determined according to the length of the time for planning the track_t(ii) a Acquiring actual coordinate points of the simulation platform once every fixed period, wherein the actual coordinate points are A in sequence in the motion process of the simulation platform₁(x₁,y₁)，A₂(x₂,y₂)，…，A_N(x_N,y_N) Connecting the coordinate points by straight line segments in sequence to form the actual track, and regarding each actual coordinate point A_i(x_i,y_i) Finding and A on the planned trajectory_iCorresponding point A'_i(x′_i,y′_i) (ii) a Length of the planned trajectory

Then track length score

Wherein L is_maxSetting a maximum track length value under the indoor test scene; the track risk is used for measuring the collision risk between the simulation platform and the obstacles, calculating the minimum distance from each obstacle to the actual track, and selecting the minimum value d in the minimum distances_minThen score the track risk

Wherein D is a safe distance; in the third step, the deviation between the actual operation condition of the simulation platform and the operation plan comprises a transverse deviation and a longitudinal deviation, the transverse deviation is the distance deviation between the actual operation condition of the simulation platform and the operation plan, and the distance between each actual coordinate point and the planning track is calculatedThe shortest distance d_iAnd calculate the average of all shortest distances:the longitudinal deviation is the speed deviation between the actual operation condition of the simulation platform and the operation plan, and the actual speed v of the simulation platform at each actual coordinate point is collected_iCalculating a difference in velocityAnd calculating the average of all speed differencesWhereinIs A'_iThe speed of the planning of the points is,is A_iActual velocity v of a point_iIn thatA velocity component in the direction; then the lateral deviation score

Longitudinal deviation score

Wherein d is_maxIs a distance deviation threshold, v_maxIs a speed deviation threshold; the planning control capability score of the ground unmanned platform is equal to S ═ w_tS_t+w_LS_L+w_RS_R+w_latS_lat+w_lngS_lngWherein w is_t、w_L、w_R、w_lat、w_lngRespectively scoring time for trajectory planningThe weight of the track length score, the weight of the track risk score, the weight of the lateral deviation score and the weight of the longitudinal deviation score.

Specifically, in the first step, the obstacle further includes a dynamic obstacle whose position may change during the motion of the simulation platform.

Specifically, the time for planning the track is the time from the receiving of the obstacle information and the end position to the generation of the operation plan by the simulation platform, and the score S for planning the track is determined according to the length of the time for planning the track_t(ii) a Acquiring actual coordinate points of the simulation platform once every fixed period, wherein the actual coordinate points are A in sequence in the motion process of the simulation platform₁(x₁,y₁)，A₂(x₂,y₂)，…，A_N(x_N,y_N) Connecting the coordinate points by straight line segments in sequence to form the actual track, and regarding each actual coordinate point A_i(x_i,y_i) Finding and A on the planned trajectory_iCorresponding point A'_i(x′_i,y′_i) (ii) a Length of the planned trajectory

Then track length score

Wherein L is_maxSetting a maximum track length value under the indoor test scene; the track risk is used for measuring the collision risk between the simulation platform and the obstacles, calculating the minimum distance from each obstacle to the actual track, and selecting the minimum value d in the minimum distances_minThen score the track risk

Wherein D is a safe distance; in step three, the deviation of the actual operation condition of the simulation platform and the operation plan comprises longitudinal deviation and motionAnd (3) responding to the dynamic planning, wherein the longitudinal deviation is the speed deviation between the actual operation condition of the simulation platform and the operation planning, and the actual speed v of the simulation platform at each actual coordinate point is acquired_iCalculating a difference in velocity

And calculating the average of all speed differencesWherein

Is A'_iThe speed of the planning of the points is,is A_iActual velocity v of a point_iIn thatA velocity component in the direction; score for longitudinal deviation

Wherein d is_maxIs a distance deviation threshold, v_maxIs a speed deviation threshold; the dynamic planning response is a process of adjusting and generating a new planning track on the basis of the initial planning track when the simulation platform detects the dynamic barrier, and the dynamic planning response is carried out according to the sum of the minimum distances between each dynamic barrier and the new planning track

Determining a dynamic programming response score S_dl(ii) a The planning control capability score of the ground unmanned platform is equal to S ═ w_tS_t+w_LS_L+w_RS_R+w_dlS_dl+w_lngS_lngWherein w is_t、w_l、w_R、w_dl、w_lngWeights for time-scoring of trajectory planningThe weight of the track length score, the weight of the track risk score, the weight of the dynamic programming response capability score and the weight of the longitudinal deviation score.

Specifically, before calculating the length of the planned track, track validity verification needs to be performed; if for any i e [2, N]In presence of y_i>y_i-1If so, the planning track is considered to be effective; otherwise, the planning track is invalid, and the test is stopped.

Specifically, in the first step, the static obstacles include a negative static obstacle lower than the reference plane and a positive static obstacle higher than the reference plane; when an indoor test scene is built, a ground coordinate system and a basic terrain system need to be built, wherein the ground coordinate system is a UWB indoor positioning system built in an equidistant grid mode, the basic terrain system comprises a plurality of basic unit modules, the basic unit modules are tiled in the indoor test scene, individual basic unit modules are removed according to needs to form negative static obstacles, and other basic unit modules are stacked on the individual basic unit modules to form positive static obstacles.

An indoor testing system for a ground based unmanned platform, comprising:

a scene construction module that constructs an indoor test scene containing obstacles, including static obstacles;

the system comprises a track generation module, a simulation platform and a data processing module, wherein the track generation module sends barrier information and a terminal position in an indoor test scene to the simulation platform, and the simulation platform generates an operation plan containing a planned track, avoids barriers in the indoor test scene and moves from an initial position to the terminal position along the planned track;

an evaluation module: acquiring an actual track of a simulation platform in real time in the process that the simulation platform moves from an initial position to a terminal position; and calculating the planning control capability score of the ground unmanned platform according to the track risk in the operation process of the simulation platform, the deviation between the actual operation condition of the simulation platform and the operation plan, the planning track length during the track planning and the planning track length.

A computer device comprising a memory and a processor, the memory having stored therein a computer program, which computer program, when executed by the processor, performs the steps of the room testing method.

Compared with the prior art, the invention has the beneficial technical effects that:

1. according to the equivalent test principle, the ground unmanned platform is tested by the simulation platform in an indoor simulation environment, the planning control capability of the ground unmanned platform in real operation can be reflected, the planning control capability comprises the planning capability and the control capability, the planning capability is that after the environment is known, the operation route of the unmanned platform can be preliminarily planned, and the control capability is that the unmanned platform can control the operation capability of the unmanned platform according to the planned route; because the simulation platform can be rapidly produced and iterated, and the indoor environment can be rapidly changed, the invention can accelerate the research and development of the ground unmanned platform, and has low cost and high efficiency.

Drawings

FIG. 1 is a schematic flow chart of the testing method of the present invention.

Detailed Description

A preferred embodiment of the present invention will be described in detail below with reference to the accompanying drawings.

The ground unmanned platform can comprehensively reflect the comprehensive performance of the ground unmanned platform when tested outdoors, but an outdoor field meeting the conditions is difficult to build, and the ground unmanned platform belongs to a batch production product, has higher integration level and slower iteration, so the outdoor test progress of the ground unmanned platform is slow, the period is long, the cost is high, and the research and development period of the ground unmanned platform is prolonged.

The equivalent test of the ground unmanned platform is a test method which tests in an indoor scene through a simply built simulation platform and reflects the real operation capability of the ground unmanned platform through an indoor test result.

The simulation platform is a simplified model of the ground unmanned platform, has approximately the same structure and weight as the ground unmanned platform, has the same functions, does not need to consider productization, and can be quickly iterated.

As shown in fig. 1, an indoor testing method for a ground unmanned platform, which determines a planning control capability of the ground unmanned platform by using an indoor testing result of a simulation platform, includes the following steps:

s1: an indoor test scenario is constructed that includes an obstacle, which includes a static obstacle.

The planning control capability of the ground unmanned platform comprises planning capability and control capability, wherein the planning capability is the capability of preliminarily planning the running route of the ground unmanned platform after the ground unmanned platform knows the surrounding environment; the control capability is the operation capability of the ground unmanned platform to control the ground unmanned platform to operate according to the planned route.

In particular, the static obstacles comprise negative static obstacles below the reference plane and positive static obstacles above the reference plane; when an indoor test scene is built, a ground coordinate system and a basic terrain system need to be built, wherein the ground coordinate system is a UWB indoor positioning system built in an equidistant grid mode, the basic terrain system comprises a plurality of basic unit modules, the basic unit modules are tiled in the indoor test scene, individual basic unit modules are removed according to needs to form negative static obstacles, and other basic unit modules are stacked on the individual basic unit modules to form positive static obstacles.

In the indoor environment, GPS signals are difficult to receive, positioning information is needed to support the simulation platform to generate a planned track in the testing process, and the actual track of the simulation platform is collected.

The indoor basic terrain system is convenient to construct, the length and the width of each basic unit module are both 600mm, the height of each basic unit module has three specifications, namely 200mm, 350mm and 600mm, a positioning pin is fixedly arranged at the bottom of each basic unit module, a positioning hole is formed in the top of each basic unit module, the positioning pins can be inserted into the positioning holes for combined installation, multiple layers of basic unit modules with different specifications are laid as required, individual basic unit modules are dug out, a negative static obstacle is formed at the dug-out position, the basic unit modules are stacked on each basic unit module, a positive static obstacle is formed at the stacked position, a reference plane represents outdoor ground, the negative static obstacle represents an underground pit, and the positive static obstacle represents an underground bulge.

Specifically, in the first step, the obstacle further includes a dynamic obstacle whose position may change during the motion of the simulation platform.

Dynamic obstacles, which the ground unmanned platform needs to go around to perform actual tasks, represent objects that can move outdoors, such as animals, humans, etc.

S2: and sending the information of the obstacles and the end point position in the indoor test scene to the simulation platform, generating an operation plan containing a planned track by the simulation platform, avoiding the obstacles in the indoor test scene and moving from the initial position to the end point position along the planned track.

The simulation platform generates an overall operation plan and plans to move to a terminal position along a planning track, and due to deviation between the planning and the actual situation and interference of obstacles, deviation occurs between the actual operation situation and the operation plan, such as speed deviation, distance deviation, deviation of a new planning track after dynamic planning response, and the like.

S3: acquiring an actual track of a simulation platform in real time in the process that the simulation platform moves from an initial position to a terminal position; and calculating the planning control capability score of the ground unmanned platform according to the track risk in the operation process of the simulation platform, the deviation between the actual operation condition of the simulation platform and the operation plan, the planning track length during the track planning and the planning track length.

Specifically, the time for planning the track is the time from the receiving of the obstacle information and the end position to the generation of the planned track by the simulation platform, and the score S for planning the track is determined according to the length of the time for planning the track_t(ii) a Acquiring actual coordinate points of the simulation platform once every fixed period, wherein the actual coordinate points are A in sequence in the motion process of the simulation platform₁(x₁,y₁)，A₂(x₂,y₂)，…，A_N(x_N,y_N) Connecting the coordinate points by straight line segments in sequence to form the actual track, pairAt each actual coordinate point A_i(x_i,y_i) Finding and A on the planned trajectory_iCorresponding point A'_i(x′_i,y′_i) (ii) a Length of the planned trajectory

Then track length score

Wherein L is_maxSetting a maximum track length value under the indoor test scene; the track risk is used for measuring the collision risk between the simulation platform and the obstacles, calculating the minimum distance from each obstacle to the actual track, and selecting the minimum value d in the minimum distances_minThen score the track risk

Wherein D is a safe distance; in the third step, the deviation between the actual operation condition of the simulation platform and the operation plan comprises a transverse deviation and a longitudinal deviation, the transverse deviation is the distance deviation between the actual operation condition of the simulation platform and the operation plan, and the shortest distance d between each actual coordinate point and the planning track is calculated_iAnd calculate the average of all shortest distances:

the longitudinal deviation is the speed deviation between the actual operation condition of the simulation platform and the operation plan, and the actual speed v of the simulation platform at each actual coordinate point is collected_iCalculating a difference in velocity

And calculating the average of all speed differences

Wherein

Is A'_iThe speed of the planning of the points is,is A_iActual velocity v of a point_iIn thatA velocity component in the direction; then the lateral deviation score

Longitudinal deviation score

Wherein d is_maxIs a distance deviation threshold, v_maxIs a speed deviation threshold; the planning control capability score of the ground unmanned platform is equal to S ═ w_tS_t+w_LS_L+w_RS_R+w_latS_lat+w_lngS_lngWherein w is_t、w_L、w_R、w_lat、w_lngRespectively a weight value of a track planning time score, a weight value of a track length score, a weight value of a track risk score, a weight value of a transverse deviation score and a weight value of a longitudinal deviation score; the planning control capability score integrates the planning capability of the simulation platform and the control capability of controlling the simulation platform to operate according to the plan, and can comprehensively reflect the planning control capability of the ground unmanned platform.

Specifically, if the indoor test scene contains dynamic obstacles, different methods are needed for calculating the planning control capability score; the time for planning the track is the time from the receiving of the barrier information and the end position to the generation of the operation plan by the simulation platform, and the score S for planning the track is determined according to the length of the time for planning the track_t(ii) a Acquiring the actual coordinates of the simulation platform once every fixed periodPoints, during the motion process of the simulation platform, the actual coordinate points are A in sequence₁(x₁,y₁)，A₂(x₂,y₂)，…，A_N(x_N,y_N) Connecting the coordinate points by straight line segments in sequence to form the actual track, and regarding each actual coordinate point A_i(x_i,y_i) Finding and A on the planned trajectory_iCorresponding point A'_i(x′_i,y′_i) (ii) a Length of the planned trajectory

Then track length score

Wherein L is_maxSetting a maximum track length value under the indoor test scene; the track risk is used for measuring the collision risk between the simulation platform and the obstacles, calculating the minimum distance from each obstacle to the actual track, and selecting the minimum value d in the minimum distances_minThen score the track risk

Wherein D is a safe distance; in the third step, the deviation between the actual operation condition of the simulation platform and the operation plan comprises longitudinal deviation and dynamic planning response, the longitudinal deviation is the speed deviation between the actual operation condition of the simulation platform and the operation plan, and the actual speed v of the simulation platform at each actual coordinate point is collected_iCalculating a difference in velocity

And calculating the average of all speed differencesWhereinIs A'_iThe speed of the planning of the points is,

is A_iActual velocity v of a point_iIn thatA velocity component in the direction; score for longitudinal deviation

Wherein d is_maxIs a distance deviation threshold, v_maxIs a speed deviation threshold; the dynamic planning response is a process of adjusting and generating a new planning track on the basis of the initial planning track when the simulation platform detects the dynamic barrier, and the dynamic planning response is carried out according to the sum of the minimum distances between each dynamic barrier and the new planning track

Determining a dynamic programming response score S_dl(ii) a The planning control capability score of the ground unmanned platform is equal to S ═ w_tS_t+w_LS_L+w_RS_R+w_dlS_dl+w_lngS_lngWherein w is_t、w_L、w_R、w_dl、w_lngRespectively a weight value of a time score for track planning, a weight value of a track length score, a weight value of a track risk score, a weight value of a dynamic planning response capability score and a weight value of a longitudinal deviation score; the planning control capability score integrates the planning capability of the simulation platform and the control capability of controlling the simulation platform to operate according to the plan, and can comprehensively reflect the planning control capability of the ground unmanned platform.

When the simulation platform encounters an obstacle, a new planned trajectory is generated, the lateral deviation is difficult to calculate, and even if the calculation is possible, the lateral deviation score is not calculated any more because the overall score is distorted by the value of the lateral deviation score.

Wherein the obstacle information includes the size, position, whether the obstacle is a static obstacle, above or below the reference plane.

Determining the score S of the track planning time according to the length of the track planning time_tThe shorter the time for planning the trajectory, the shorter S_tThe higher the value of (A); sum of minimum distances between each dynamic obstacle and new planned trajectory

The smaller the dynamic programming response score S_dlThe larger.

The acquisition period of the actual coordinate point can be set as required, and a millisecond acquisition period is adopted in the embodiment; each actual coordinate point a_i(x_i,y_i) Points A 'corresponding to the planned trajectories exist on the planned trajectory'_i(x′_i,y′_i) Here, the mapping rule is not "A'_iIs on the planned trajectory and A_iThe point closest to the point "is the ith point on the planned track", and in fact, the planned track is generated and simultaneously the planned track point A 'is generated on the planned track'_iAnd the programmed velocity v ″_iPlanning track point A 'from the last at planned speed'_i-1Run to A 'exactly after one acquisition cycle'_iPoint; if a dynamic obstacle is encountered, the simulation platform generates a new planning track, the new planning track generally has a part coinciding with the original planning track and a part not coinciding with the original planning track, if the part not coinciding with the original track has M points, the M points on the part not coinciding with the new planning track are taken at equal intervals, and the M points on the original planning track are replaced by the M points on the new planning track, so that the speed difference of each point can be calculated when the longitudinal deviation is calculated.

Specifically, before calculating the length of the planned track, track validity verification needs to be performed; if for any i e [2, N]In presence of y_i>y_i-1If so, the planning track is considered to be effective; otherwise, the planning track is invalid, and the test is stopped.

An indoor testing system for a ground based unmanned platform, comprising:

a scene construction module that constructs an indoor test scene containing obstacles, including static obstacles;

the system comprises a track generation module, a simulation platform and a data processing module, wherein the track generation module sends barrier information and a terminal position in an indoor test scene to the simulation platform, and the simulation platform generates an operation plan containing a planned track, avoids barriers in the indoor test scene and moves from an initial position to the terminal position along the planned track;

an evaluation module: acquiring an actual track of a simulation platform in real time in the process that the simulation platform moves from an initial position to a terminal position; and calculating the planning control capability score of the ground unmanned platform according to the track risk in the operation process of the simulation platform, the deviation between the actual operation condition of the simulation platform and the operation plan, the planning track length during the track planning and the planning track length.

The evaluation module can be integrated into the simulation platform or can be independently operated in the server.

A computer device comprising a memory and a processor, the memory having stored therein a computer program, which computer program, when executed by the processor, performs the steps of the room testing method.

It will be evident to those skilled in the art that the invention is not limited to the details of the foregoing illustrative embodiments, and that the present invention may be embodied in other specific forms without departing from the spirit or essential attributes thereof. The present embodiments are therefore to be considered in all respects as illustrative and not restrictive, the scope of the invention being indicated by the appended claims rather than by the foregoing description, and all changes which come within the meaning and range of equivalency of the claims are therefore intended to be embraced therein, and any reference signs in the claims are not intended to be construed as limiting the claim concerned.

Furthermore, it should be understood that although the present description refers to embodiments, not every embodiment may contain only a single embodiment, and such description is for clarity only, and those skilled in the art should integrate the description, and the embodiments may be combined as appropriate to form other embodiments understood by those skilled in the art.