Method, system and equipment for planning operation track in closed cabin and medium

By using the cabin corner map and initial vehicle position on the rake machine to divide the operating areas, identify the rake drop points and build the rake push route, the problem of low accuracy of manual driving the rake down rake machine in the cabin environment is solved, and automation is achieved Pushing and rake operations improve efficiency.

CN118915738APending Publication Date: 2024-11-08GUANGDONG ELECTRIC POWER SCI RES INST ENERGY TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410964443.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-18
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

The existing rake trajectory determined by manual driving is easily affected by the cabin environment and cannot accurately drive to the target operating area, resulting in low working efficiency.

Method used

By obtaining the cabin corner map of the closed cabin and the initial vehicle position of the preset rake pusher, dividing the operating areas, identifying the rake drop points, and building a target rake push route to achieve fully automatic rake pushing operations to avoid environmental interference.

Benefits of technology

It improves the accuracy and efficiency of pushing rake operations, realizes automated operations in harsh cabin environments, and improves work efficiency.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118915738A_ABST
    Figure CN118915738A_ABST
Patent Text Reader

Abstract

The invention discloses a method, a system, equipment and a medium for planning an operation trajectory in a closed cabin, and relates to the technical field of trajectory planning. A target operation area set is generated by performing area division on a cabin angular point map. And taking the target operation area corresponding to the minimum value of the serial number in the target operation area set as an operation execution area. And carrying out rake falling point identification based on the initial vehicle body pose and the operation execution area, and determining a rake falling point set corresponding to the operation execution area. And performing operation track construction based on the rake falling point set and the operation angle corresponding to the operation execution area, generating a target rake pushing route, and counting the number of iterations. And when the number of iterations is a preset iteration threshold value, constructing a bulldozing operation track corresponding to the closed cabin by adopting all the target bulldozing routes according to a corresponding execution sequence. And by determining the optimal rake falling point, a rake pushing operation track is constructed. The preset bulldozing machine achieves full-automatic bulldozing operation according to the bulldozing operation track, is not affected by the cabin environment, and is high in working efficiency.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of trajectory planning, and in particular to a method, system, equipment and medium for planning an operation trajectory in a closed cabin. Background Art

[0002] The coal for many thermal power plants is transported to the port by large ships. When the large ships are docked at the dock, vertical excavators are generally used to grab the coal in the cabin. Due to the limitation of the cabin top baffle and the working range of the vertical excavator, the vertical excavator can only grab the coal pile in the middle area of ​​the cabin. The remaining coal pile is often piled under the cabin top baffle and attached to the two walls of the cabin. At this time, it is necessary to use a crane to put the pusher into the cabin, manually drive the pusher to gather the coal pile to the middle of the cabin, and then use the grab of the vertical excavator to grab the remaining coal pile.

[0003] At present, the operation of the pusher rake machine is basically manually driven. The operator needs to go deep into the bottom of the cabin and drive the pusher rake machine to gather the coal piles around the cabin to the middle area of ​​the cabin, and then grab them with a vertical excavator. The working environment in the cabin is harsh, the air quality is poor, the working environment is noisy, the cabin is filled with dust, and the visible field of view is poor. The driver cannot accurately drive to the target working area, and the work efficiency is greatly reduced. Therefore, the operating trajectory of the existing pusher rake machine determined by manual driving is easily affected by the cabin environment, and it cannot accurately drive to the target working area, resulting in low work efficiency. Summary of the invention

[0004] The present invention provides a method, system, medium and product for planning an operation trajectory in a closed cabin, which solves the technical problem that the operation trajectory of an existing push-rake machine determined by manual driving is easily affected by the cabin environment and cannot accurately drive to a target operation area, resulting in low work efficiency.

[0005] The present invention provides a method for planning an operation trajectory in a closed cabin, which is applied to a preset pusher and rake machine. The method comprises:

[0006] Acquire a cabin corner point map of a closed cabin and an initial body posture of the preset pusher and rake, divide the cabin corner point map into regions, and generate a target operation area set;

[0007] The target operation area corresponding to the minimum sequence number in the target operation area set is used as the operation execution area;

[0008] Performing rake point recognition based on the initial vehicle body posture and the work execution area, and determining a rake point set corresponding to the work execution area;

[0009] Based on the set of harrowing points and the operation angle corresponding to the operation execution area, an operation trajectory is constructed, a target harrowing route corresponding to the operation execution area is generated, and the number of iterations is counted;

[0010] The target operation area with a sequence number equal to the number of iterations in the target operation area set is used as a new operation execution area, and the step of performing rake point identification based on the initial vehicle body posture and the operation execution area to determine the rake point set corresponding to the operation execution area is skipped and executed;

[0011] When the number of iterations reaches a preset iteration threshold, all the target raking routes are adopted in a corresponding execution order to construct a raking operation trajectory corresponding to the closed cabin.

[0012] Optionally, the step of dividing the cabin corner point map into regions to generate a set of target operating areas includes:

[0013] Divide the cabin corner map into regions according to preset division rules to generate an initial operation area set;

[0014] The initial operation areas in the initial operation area set are sequentially sorted according to a preset direction to generate an intermediate operation area set;

[0015] The operating angles of the intermediate operating areas are updated according to the connection angles between each intermediate operating area in the intermediate operating area set and the preset center, so as to generate a target operating area set.

[0016] Optionally, the step of identifying a target point based on the initial vehicle body posture and the operation execution area to determine a target point set corresponding to the operation execution area includes:

[0017] The laser frame coordinates corresponding to the cabin corner point map are converted into global coordinates using the initial vehicle body posture to generate a point cloud map corresponding to the closed cabin;

[0018] The rake point is identified based on the point cloud map and the operation execution area, and a rake point set corresponding to the operation execution area is determined.

[0019] Optionally, the step of identifying the landing points based on the point cloud map and the job execution area and determining the landing point set corresponding to the job execution area includes:

[0020] Dividing the point cloud map according to the regional corner points corresponding to the job execution area to generate a point cloud map corresponding to the job execution area;

[0021] Selecting point clouds that meet a first preset screening criterion in the point cloud image to generate a plurality of initial point clouds;

[0022] Selecting an initial point cloud that meets a second preset screening criterion to generate a plurality of target point clouds;

[0023] Based on the operation angle corresponding to the operation execution area and the distance between the target point cloud and the center of the cabin body of the closed cabin, a set of rake points corresponding to the operation execution area is determined.

[0024] Optionally, the step of determining a set of rake points corresponding to the operation execution area based on the operation angle corresponding to the operation execution area and the distance between the target point cloud and the center of the cabin of the closed cabin comprises:

[0025] Arrange the target point clouds from low to high according to the distance between the target point clouds and the center of the cabin of the closed cabin to generate a first point cloud sequence;

[0026] rasterizing the first point clouds in the first point cloud sequence respectively to generate a second point cloud sequence;

[0027] Constructing a contour point sequence according to the order of the second point cloud sequence and the operation angle corresponding to the operation execution area;

[0028] The contour points in the contour point sequence that meet the third preset screening standard are used as rake points to generate a rake point set corresponding to the job execution area.

[0029] Optionally, the step of constructing a work trajectory based on the set of harrow points and the work angle corresponding to the work execution area, generating a target harrowing route corresponding to the work execution area and counting the number of iterations includes:

[0030] The rake point corresponding to the minimum sequence number in the rake point set is used as the target rake point;

[0031] The preset curve is constructed by using the working angle corresponding to the working execution area, the initial vehicle body posture and the target harrow landing point, the initial harrowing route and the target vehicle body posture corresponding to the target harrow landing point are generated, and the number of executions is counted;

[0032] The target vehicle body posture is used as a new initial vehicle body posture, the harrow point with a sequence number equal to the execution number in the harrow drop set is used as a new target harrow drop point, and the step of constructing a preset curve using the operation angle corresponding to the operation execution area, the initial vehicle body posture and the target harrow drop point, generating an initial harrowing route and target vehicle body posture corresponding to the target harrow drop point, and counting the execution number is executed;

[0033] When the execution number reaches a preset execution threshold, all the initial raking routes are sequentially connected according to the execution order corresponding to the initial raking routes, a target raking route corresponding to the operation execution area is constructed, and the iteration number is counted.

[0034] The present invention also provides an operation trajectory planning system in a closed cabin, which is applied to a preset pusher and rake machine, and the system comprises:

[0035] A target operation area set generation module is used to obtain a cabin corner point map of a closed cabin and an initial vehicle body posture of the preset pusher and rake, divide the cabin corner point map into regions, and generate a target operation area set;

[0036] A job execution area determination module, used to take the target job area corresponding to the minimum serial number in the target job area set as the job execution area;

[0037] A rake point set determination module, used for performing rake point identification based on the initial vehicle body posture and the operation execution area, and determining a rake point set corresponding to the operation execution area;

[0038] A target raking data and iteration number generation module is used to construct a work trajectory based on the set of raking points and the work angle corresponding to the work execution area, generate a target raking route corresponding to the work execution area and count the iteration number;

[0039] A first jump execution module, configured to take the target operation area in the target operation area set whose sequence number is equal to the iteration number as the operation execution area, and jump to execute the step of performing rake point recognition based on the initial vehicle body posture and the operation execution area, and determining the rake point set corresponding to the operation execution area;

[0040] The push-and-hake operation trajectory data construction module is used to construct the push-and-hake operation trajectory corresponding to the closed cabin by adopting all the target push-and-hake routes in a corresponding execution order when the number of iterations reaches a preset iteration threshold.

[0041] Optionally, the target operation area set generation module includes:

[0042] An initial operation area set generation module is used to divide the cabin corner point map into regions according to a preset division rule to generate an initial operation area set;

[0043] An intermediate operation area set generation module, used to sort the initial operation areas in the initial operation area set in sequence according to a preset direction to generate an intermediate operation area set;

[0044] The target operation area set generation submodule is used to update the operation angle of the intermediate operation area according to the connection angle between each intermediate operation area in the intermediate operation area set and the preset center, so as to generate a target operation area set.

[0045] The present invention also provides an electronic device, including a memory and a processor, wherein the memory stores a computer program, and when the computer program is executed by the processor, the processor executes the steps of implementing any of the above-mentioned methods for planning an operation trajectory in a closed cabin.

[0046] The present invention also provides a computer-readable storage medium having a computer program stored thereon, and when the computer program is executed, the method for planning an operation trajectory in a closed cabin as described above is implemented.

[0047] It can be seen from the above technical solutions that the present invention has the following advantages:

[0048] The present invention obtains a cabin corner map of a closed cabin and an initial body posture of a preset pusher and rake machine, divides the cabin corner map into regions, and generates a target operation area set. The target operation area corresponding to the minimum sequence number in the target operation area set is used as the operation execution area. The rake point is identified based on the initial body posture and the operation execution area, and the rake point set corresponding to the operation execution area is determined. The operation trajectory is constructed based on the rake point set and the operation angle corresponding to the operation execution area, and the target pusher and rake route corresponding to the operation execution area is generated and the number of iterations is counted. The target operation area with a sequence number equal to the number of iterations in the target operation area set is used as a new operation execution area, and the step of identifying the rake point based on the initial body posture and the operation execution area and determining the rake point set corresponding to the operation execution area is jumped. When the number of iterations is a preset iteration threshold, all target pusher and rake routes are used in the corresponding execution order to construct the pusher and rake operation trajectory corresponding to the closed cabin. The present invention solves the technical problem that the operation trajectory of the existing pusher and rake machine determined by manual driving is easily affected by the cabin environment, cannot accurately drive to the target operation area, and leads to low work efficiency. The cabin corner map of the closed cabin and the initial body posture of the preset pusher and rake are used to divide the working area, determine the best raking point in each area, and construct the most ideal pusher and rake operation trajectory. The preset pusher and rake can realize fully automatic pusher and rake operation according to the pusher and rake operation trajectory, which is not affected by the cabin environment and has high working efficiency. BRIEF DESCRIPTION OF THE DRAWINGS

[0049] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative labor.

[0050] Figure 1 A flowchart of a method for planning an operation trajectory in a closed cabin provided in Embodiment 1 of the present invention;

[0051] Figure 2 A flowchart of a method for planning an operation trajectory in a closed cabin provided in Embodiment 2 of the present invention;

[0052] Figure 3 A distribution diagram of a target operation area set provided in the second embodiment of the present invention;

[0053] Figure 4 A flowchart of a method for planning an operation trajectory in a closed cabin provided in Embodiment 2 of the present invention;

[0054] Figure 5 This is a structural block diagram of a closed cabin operation trajectory planning system provided in Example 3 of the present invention. DETAILED DESCRIPTION

[0055] The embodiments of the present invention provide a method, system, medium and product for planning an operation trajectory in a closed cabin, which are used to solve the technical problem that the operation trajectory of the existing bulldozer determined by manual driving is easily affected by the cabin environment and cannot accurately drive to the target operation area, resulting in low work efficiency.

[0056] In order to make the purpose, features and advantages of the present invention more obvious and easy to understand, the technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the embodiments described below are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0057] Embodiment 1

[0058] See also Figure 1 , Figure 1 A flowchart of the steps of a method for planning an operation trajectory in a closed cabin provided in Example 1 of the present invention.

[0059] A method for planning an operation trajectory in a closed cabin provided in Example 1 of the present invention is applied to a preset pusher and rake machine, which is a pusher and rake machine in which two 3D laser radars with more than 32 lines and a field of view of more than 270 degrees are installed at the front and rear (center left and right) positions of the pusher and rake machine respectively. Among them, the front laser is used to identify the position of the coal pile, and the front and rear lasers are used together for global positioning calculation of the vehicle body. The preset pusher and rake machine is also provided with a control module for controlling the pusher and rake machine to automatically perform the pusher and rake task according to the pusher and rake operation trajectory and a positioning program for realizing automatic positioning, which can provide the contour corner points of the cabin and the real-time vehicle body positioning posture of the pusher and rake machine.

[0060] The method includes:

[0061] Step 101: obtain a cabin corner point map of a closed cabin and an initial body posture of a preset pusher and rake, divide the cabin corner point map into regions, and generate a target operation area set.

[0062] In an embodiment of the present invention, the present invention is designed based on the positioning program of the preset pusher and rake. The positioning program provides the contour corner points of the closed cabin, the closed cabin is rectangular in shape, and provides real-time vehicle body positioning posture (x, y, theta). After obtaining the cabin corner point map of the closed cabin and the initial vehicle body posture of the preset pusher and rake, the cabin corner point map is divided into regions according to the preset division rules to generate an initial operation area set. The initial operation areas in the initial operation area set are sorted in sequence according to the preset direction to generate an intermediate operation area set. The operation angles of the intermediate operation areas are updated according to the connection angles of each intermediate operation area in the intermediate operation area set with the preset center to generate a target operation area set.

[0063] Step 102: The target operation area corresponding to the minimum sequence number in the target operation area set is used as the operation execution area.

[0064] In an embodiment of the present invention, the work areas in the target work area set have been marked with corresponding serial numbers according to the work order. Therefore, the target work area corresponding to the minimum serial number in the target work area set is first selected as the work execution area to perform the corresponding pushing and raking task.

[0065] Step 103: perform rake point identification based on the initial vehicle body posture and the work execution area, and determine a rake point set corresponding to the work execution area.

[0066] In the embodiment of the present invention, the laser frame coordinates corresponding to the cabin corner map are converted into global coordinates using the initial vehicle body posture to generate a point cloud map corresponding to the closed cabin. The harrow point is identified based on the point cloud map and the operation execution area to determine the harrow point set corresponding to the operation execution area.

[0067] Step 104: construct an operation trajectory based on the set of harrowing points and the operation angle corresponding to the operation execution area, generate a target harrowing route corresponding to the operation execution area and count the number of iterations.

[0068] In an embodiment of the present invention, the landing point corresponding to the minimum sequence number in the landing point set is used as the target landing point. The working angle, initial vehicle body posture and target landing point corresponding to the operation execution area are used to construct a preset curve, and the initial pushing and rake route and target vehicle body posture corresponding to the target landing point are generated, and the number of executions are counted. Preferably, the preset curve can be a Bezier curve, or a Bezier curve or a Bezier curve. The target vehicle body posture is used as the new initial vehicle body posture, and the landing point with the same sequence number as the number of executions in the landing point set is used as the new target landing point, and the operation angle, initial vehicle body posture and target landing point corresponding to the operation execution area are used to construct a preset curve, and the initial pushing and rake route and target vehicle body posture corresponding to the target landing point are generated, and the number of executions is counted. When the number of executions is the preset execution threshold, all the initial pushing and rake routes are connected in sequence according to the execution order corresponding to the initial pushing and rake routes, and the target pushing and rake route corresponding to the operation execution area is constructed, and the number of iterations is counted.

[0069] Step 105: The target operating area with the same sequence number and iteration number in the target operating area set is taken as the operating execution area, and the process jumps to the step of identifying the landing point based on the initial vehicle posture and the operating execution area, and determining the landing point set corresponding to the operating execution area.

[0070] In an embodiment of the present invention, after obtaining the target push-and-hake route corresponding to the working area, continue to construct the target push-and-hake route of the next target working area corresponding to it and count the number of iterations. Specifically, the target working area with a sequence number equal to the number of iterations in the target working area set is used as the working execution area, and then jumps to perform the step of identifying the landing point based on the initial vehicle body posture and the working execution area, and determining the landing point set corresponding to the working execution area. Among them, the initial value of the number of iterations is equal to the minimum value of the sequence number corresponding to the target working area set.

[0071] Step 106: When the number of iterations reaches a preset iteration threshold, all target raking routes are used in a corresponding execution order to construct a raking operation trajectory corresponding to the closed cabin.

[0072] The preset iteration threshold refers to the number of target operation areas in the target operation area set.

[0073] In the embodiment of the present invention, when the number of iterations reaches the preset iteration threshold, that is, when the target raking routes corresponding to all target operation areas are constructed, the target raking routes are connected together according to the sequence numbers corresponding to the target operation areas, thereby obtaining the raking operation trajectory corresponding to the closed cabin. The raking operation trajectory is input into the control module of the preset raking machine, and the preset raking machine is controlled to automatically perform the raking task according to the raking operation trajectory, without manual driving, and will not be affected by the cabin environment, so that the raking task of the closed cabin can be quickly completed.

[0074] In an embodiment of the present invention, by obtaining a cabin corner map of a closed cabin and an initial body posture of a preset pusher and rake machine, the cabin corner map is divided into regions to generate a target operation area set. The target operation area corresponding to the minimum sequence number in the target operation area set is used as the operation execution area. The rake point is identified based on the initial body posture and the operation execution area, and the rake point set corresponding to the operation execution area is determined. The operation trajectory is constructed based on the rake point set and the operation angle corresponding to the operation execution area, and the target pusher and rake route corresponding to the operation execution area is generated and the number of iterations is counted. The target operation area with a sequence number equal to the number of iterations in the target operation area set is used as a new operation execution area, and the step of identifying the rake point based on the initial body posture and the operation execution area and determining the rake point set corresponding to the operation execution area is jumped. When the number of iterations is a preset iteration threshold, all target pusher and rake routes are used in the corresponding execution order to construct the pusher and rake operation trajectory corresponding to the closed cabin. The technical problem that the operation trajectory of the existing pusher and rake machine determined by manual driving is easily affected by the cabin environment and cannot accurately drive to the target operation area, resulting in low work efficiency, is solved. The cabin corner map of the closed cabin and the preset initial body posture of the pusher and rake are used to automatically divide the working area, determine the best landing point in the area, and construct the pushing and rake operation trajectory. The preset pusher and rake can realize fully automatic pushing and rake operation according to the pushing and rake operation trajectory, which is not affected by the cabin environment and has high working efficiency.

[0075] Embodiment 2

[0076] See also Figure 2 , Figure 2 A flowchart of the steps of a method for planning an operation trajectory in a closed cabin provided in Embodiment 2 of the present invention.

[0077] Another method for planning an operation trajectory in a closed cabin provided by Example 2 of the present invention is used for presetting a pusher and rake machine, and the method comprises:

[0078] Step 201: obtain a cabin corner point map of a closed cabin and an initial body posture of a preset pusher and rake, divide the cabin corner point map into regions, and generate a target operation area set.

[0079] Further, step 201 may include the following sub-steps S11-S13:

[0080] S11. Divide the cabin corner map into regions according to preset division rules to generate an initial operation area set.

[0081] S12. Sort the initial operation areas in the initial operation area set in sequence according to a preset direction to generate an intermediate operation area set.

[0082] S13, updating the operating angle of the intermediate operating area according to the connection angle between each intermediate operating area in the intermediate operating area set and the preset center, and generating a target operating area set.

[0083] The default division rule is to divide the map into 12 small areas except the central area (approximately 10*10m).

[0084] The preset direction means that the initial operation area in the initial operation area is arranged in a clockwise direction.

[0085] In the embodiment of the present invention, a cabin corner map provided by a positioning algorithm of a preset pusher is obtained, and a complete rectangle of the outline map is drawn. Figure 3 As shown, the part of the cabin corner map except the central hoisting area (approximately 10*10m) is divided into 12 small areas to obtain an initial operation area set. The serial numbers of the initial operation areas are arranged in a certain direction, and in the embodiment of the present invention, they are arranged clockwise to obtain an intermediate operation area set. The angle of operation in the area is basically set according to the angle formed by the area and the center line, so that the planned route can be the shortest and the operation efficiency can be the highest. Therefore, the operation angle of the intermediate operation area is updated according to the connection angle between each intermediate operation area and the preset center in the intermediate operation area set, thereby obtaining a target operation area set.

[0086] Step 202: The target operation area corresponding to the minimum sequence number in the target operation area set is used as the operation execution area.

[0087] In the embodiment of the present invention, the specific implementation process of step 202 is similar to step 102 and will not be repeated here.

[0088] Step 203: The laser frame coordinates corresponding to the cabin corner point map are converted into global coordinates using the initial vehicle body posture, so as to generate a point cloud map corresponding to the closed cabin.

[0089] In an embodiment of the present invention, the current laser frame corresponding to the preset pusher is obtained through the point cloud recognition program, and the body posture 6dof of the positioning program is obtained, so that the laser frame coordinates and the body posture corresponding to the cabin corner map are substituted into the conversion formula for global coordinate system conversion to obtain the point cloud map corresponding to the closed cabin. The body posture 6dof is (x1, y1, z1, roll, pitch, yaw). The positioning program can calculate the coordinates and angles of the preset pusher body in real time through the laser frames of the front laser and the rear laser combination, through the steps of composition and contour extraction. The conversion formula used is:

[0090]

[0091] R=Rz1*Ry1*Rx1;

[0092] P2 = R * P1 + T;

[0093] Among them, R, Rz, Ry, and Rx are all 3*3 matrices; T, P1, and P2 are 3*1 vectors; R is the rotation matrix of the point cloud transformation; Rz, Ry, and Rx are the intermediate matrices for rotation around the z, y, and x axes respectively; T is the translation vector of the point cloud transformation; P1 is the coordinate of a point cloud in the laser coordinate system; P2 is the coordinate of the point cloud in the global coordinate system; x1 is the position of the vehicle body in the x-axis direction; y1 is the position of the vehicle body in the y-axis direction; z1 is the position of the vehicle body in the z-axis direction; roll is the roll angle of the vehicle body; pitch is the launch angle of the vehicle body; yaw is the yaw angle of the vehicle body.

[0094] Step 204: perform rake point identification based on the point cloud map and the job execution area, and determine a rake point set corresponding to the job execution area.

[0095] Further, step 204 may include the following sub-steps S21-S24:

[0096] S21. Divide the point cloud map according to the regional corner points corresponding to the job execution area to generate a point cloud map corresponding to the job execution area.

[0097] S22, selecting point clouds that meet a first preset screening criterion in the point cloud image, and generating a plurality of initial point clouds.

[0098] S23, selecting an initial point cloud that meets a second preset screening criterion, and generating a plurality of target point clouds.

[0099] S24. Determine a set of rake points corresponding to the operation execution area based on the operation angle corresponding to the operation execution area and the distance between the target point cloud and the center of the cabin of the closed cabin.

[0100] The first preset screening criterion is to select the point cloud corresponding to the stockpile whose height in the point cloud image is higher than the first threshold value e1.

[0101] The second preset screening criterion is to remove point clouds within a radius of 0.5 m whose number of point clouds is less than a second threshold value e2.

[0102] In the embodiment of the present invention, the coordinates of the four corner points of each operation execution area are calculated to obtain the regional corner points. The point cloud map is divided according to the regional corner points corresponding to the operation execution area to generate a point cloud map corresponding to the operation execution area. It is detected whether there is a pile of materials higher than the threshold value e1 in the operation execution area, that is, the point clouds corresponding to the piles of materials with a height higher than the first threshold value in the point cloud map are screened out to obtain multiple initial point clouds. Figure 3 As shown, for the No. 1 operation area, the coordinates of its four corner points, the value of the first threshold e1, and the operation angle theta (45 degrees) of the vehicle body can be provided as input parameters to the point cloud recognition program, so as to select the point cloud corresponding to the stockpile with a height higher than the first threshold in the operation area. Remove the isolated points in the initial point cloud, that is, remove the initial point cloud with a radius of 0.5m and the number of point clouds less than the second threshold e2, so as to obtain multiple target point clouds. Finally, the set of rake points corresponding to the operation execution area is constructed by the operation angle corresponding to the operation execution area and the distance between the target point cloud and the center of the cabin of the closed cabin.

[0103] Further, step S24 may include the following sub-steps S241-S244:

[0104] S241. Arrange the target point cloud from low to high according to the distance between the target point cloud and the center of the closed cabin to generate a first point cloud sequence.

[0105] S242 , rasterizing the first point clouds in the first point cloud sequence respectively to generate a second point cloud sequence.

[0106] S243: Construct a contour point sequence according to the order of the second point cloud sequence and the working angle corresponding to the working execution area.

[0107] S244: Use the contour points in the contour point sequence that meet the third preset screening standard as rake points, and generate a rake point set corresponding to the job execution area.

[0108] The third preset screening criterion is to select contour points that do not interfere with the cabin bulkhead when performing the push and rake task.

[0109] In the embodiment of the present invention, the target point cloud is arranged in ascending order according to the distance between the target point cloud and the center of the cabin of the closed cabin to obtain a first point cloud sequence. A certain rasterization is performed, and the grid side length used is 0.1m to improve the calculation efficiency. That is, the first point cloud in the first point cloud sequence is rasterized according to the size of the grid side length of 0.1m to obtain a second point cloud sequence.

[0110] Calculate according to the point cloud sequence in the second point cloud sequence, assuming that the point is moved forward by the third threshold e3 at the angle theta' as the harrow operation point, and calculate the contour point of the vehicle body. The contour point calculation method is:

[0111] Assume that the global coordinates of the harrow drop point are (x', y', theta'), the total length of the vehicle body (including the harrow pusher mechanism) is length, and the width is width. p1 is the coordinate of the upper left corner of the vehicle body contour relative to the vehicle body coordinate system; p1' is the coordinate of the upper left corner relative to the global coordinate system, then we can get:

[0112]

[0113] Rotation Matrix

[0114] Frequency Shift Matrix

[0115] p′1=R*p1+T;

[0116] The remaining three corner points can be obtained in the same way.

[0117] If the vehicle body contour point does not interfere with the bulkhead, the point is confirmed as a point where the push-raking task can be performed, and the vehicle body coordinates are calculated back based on the rake point (keeping the vehicle body angle theta'). The return is have_coal.

[0118] The formula for back-calculating the vehicle coordinates based on the harrow point is as follows:

[0119] Assume the position of the landing point is (x a ,y a , theta a ), then the coordinates of the vehicle body relative to the harrow landing point are:

[0120] Initial global coordinates of the vehicle body

[0121] The rotation matrix of the vehicle body relative to the landing point

[0122] Frequency shift matrix of vehicle body relative to the target point

[0123] The global coordinates of the vehicle body are v'=R a *v+T a .

[0124] If interference occurs at this point, the following points will be calculated in sequence. If all points do not meet the requirements, the result will be returned as empty, indicating that there is no rake point with a suitable theta angle in this area. All contour points that do not interfere with the cabin bulkhead will be used to construct the rake point set corresponding to the operation execution area.

[0125] Step 205: construct an operation trajectory based on the set of harrowing points and the operation angle corresponding to the operation execution area, generate a target harrowing route corresponding to the operation execution area and count the number of iterations.

[0126] Further, step 205 may include the following sub-steps S31-S34:

[0127] S31, taking the landing point corresponding to the minimum sequence number in the landing point set as the target landing point.

[0128] S32, using the working angle, initial vehicle posture and target harrow drop point corresponding to the working execution area to construct a preset curve, generate an initial harrowing route and target vehicle posture corresponding to the target harrow drop point, and count the number of executions.

[0129] S33, taking the target vehicle body posture as the new initial vehicle body posture, taking the harrow point with the same sequence number as the number of executions in the harrow set as the new target harrow point, and jumping to execute the step of constructing a preset curve using the working angle, initial vehicle body posture and target harrow point corresponding to the working execution area, generating the initial harrow route and target vehicle body posture corresponding to the target harrow point and counting the number of executions.

[0130] S34. When the execution times reach the preset execution threshold, all the initial pushing and raking routes are sequentially connected according to the execution order corresponding to the initial pushing and raking routes, a target pushing and raking route corresponding to the operation execution area is constructed, and the number of iterations is counted.

[0131] In an embodiment of the present invention, the landing points in the landing point set have been sorted in ascending order. The landing point corresponding to the minimum sequence number in the landing point set is used as the target landing point, and then the operating angle, initial vehicle posture and target landing point corresponding to the operation execution area are used to generate a Bezier curve from the current point to the target landing point, and the obtained Bezier curve is used as the initial push-and-hake route corresponding to the target landing point, and the vehicle posture corresponding to the target landing point is used as the target vehicle posture and the number of executions is counted. Then the target vehicle posture is used as the new initial vehicle posture, and the landing point with the same sequence number and execution number in the landing point set is used as the new target landing point, and the step of jumping to execute the operation angle, initial vehicle posture and target landing point corresponding to the operation execution area to construct a preset curve, generate the initial push-and-hake route and target vehicle posture corresponding to the target landing point and count the number of executions. The initial target push-and-hake routes corresponding to other landing points are constructed in sequence and the number of iterations is counted. When the number of executions reaches the preset execution threshold, that is, after the initial pushing and raking routes corresponding to all the harrow drop points are constructed, the initial pushing and raking routes are connected in sequence according to the execution order corresponding to the initial pushing and raking routes to obtain the target pushing and raking routes corresponding to the work execution area and count the number of iterations.

[0132] Step 206: The target operating area with the same sequence number and iteration number in the target operating area set is taken as a new operating execution area, and the process jumps to the step of identifying the landing point based on the initial vehicle posture and the operating execution area, and determining the landing point set corresponding to the operating execution area.

[0133] In the embodiment of the present invention, the specific implementation process of step 206 is similar to step 105 and will not be repeated here.

[0134] Step 207: When the number of iterations reaches a preset iteration threshold, all target raking routes are used in a corresponding execution order to construct a raking operation trajectory corresponding to the closed cabin.

[0135] In the embodiment of the present invention, the specific implementation process of step 207 is similar to step 106 and will not be repeated here.

[0136] In the embodiment of the present invention, Figure 3 and Figure 4 As shown, the push-and-rake operation trajectory corresponding to the closed cabin is constructed by simulation. By reading the cabin corner point map, the operation area is divided to obtain the target operation area set. The four corner points of a certain operation area, the desired posture of the vehicle body, and the height threshold of the material pile are obtained. The laser point cloud frame and the current posture of the vehicle body are obtained, and the global coordinates of the point cloud are calculated. Then, based on the input information such as the four corner points obtained, the point closest to the center and not interfering with the cabin bulkhead is obtained, that is, the rake point is identified based on the initial vehicle body posture and the operation execution area, and the rake point set corresponding to the operation execution area is determined. Navigation sets this point as the target point, generates a Bezier curve from the current point to the target point, navigates to this place for push-and-rake operation, and takes 0, 0, theta as the target point, navigates to this place, pushes and rakes the coal pile to the center point, and ends this navigation. When the material piles in area 1 are all pushed to the central lifting area, the recognition program will return to empty, and the push-and-rake recognition of area 2 will be executed. The corner points and body angles (0 degrees) of area 2 will be sent to the recognition program, and the operation trajectory will be constructed based on the set of rake points and the operation angles corresponding to the operation execution area. The target push-and-rake route corresponding to the operation execution area will be generated and the number of iterations will be counted. When the material piles in areas 1-12 are all pushed to the central lifting area, a complete push-and-rake operation is completed, that is, all areas are empty, and the recognition and navigation are ended. The simulated push-and-rake operation routes corresponding to areas 1-12 are used as the push-and-rake operation trajectory corresponding to the closed cabin. The push-and-rake operation trajectory is input into the control module of the preset push-and-rake machine, and the preset push-and-rake machine is controlled to automatically operate in the closed cabin according to the push-and-rake operation trajectory to quickly complete the push-and-rake task.

[0137] Embodiment 3

[0138] See also Figure 5 , Figure 5This is a structural block diagram of a closed cabin operation trajectory planning system provided in Example 3 of the present invention.

[0139] Example 3 of the present invention provides a closed cabin operation trajectory planning system, which is applied to a preset pusher and rake machine, and the system includes:

[0140] The target operation area set generation module 501 is used to obtain the cabin corner point map of the closed cabin and the initial vehicle body posture of the preset pusher and rake, divide the cabin corner point map into regions, and generate a target operation area set.

[0141] The job execution area determination module 502 is used to select the target job area corresponding to the minimum sequence number in the target job area set as the job execution area.

[0142] The target point set determination module 503 is used to identify the target point based on the initial vehicle posture and the work execution area, and determine the target point set corresponding to the work execution area.

[0143] The target raking data and iteration number generation module 504 is used to construct a work trajectory based on the raking point set and the work angle corresponding to the work execution area, generate a target raking route corresponding to the work execution area and count the iteration number.

[0144] The first jump execution module 505 is used to take the target operation area with the same sequence number and iteration number in the target operation area set as the operation execution area, and jump to execute the step of performing the landing point recognition based on the initial vehicle body posture and the operation execution area to determine the landing point set corresponding to the operation execution area.

[0145] The raking operation trajectory data construction module 506 is used to construct the raking operation trajectory corresponding to the closed cabin by using all target raking routes in a corresponding execution order when the number of iterations reaches a preset iteration threshold.

[0146] Optionally, the target operation area set generation module 501 includes:

[0147] The initial operation area set generation module is used to divide the cabin corner point map into areas according to preset division rules to generate an initial operation area set.

[0148] The intermediate operation area set generation module is used to sort the initial operation areas in the initial operation area set in sequence according to a preset direction to generate an intermediate operation area set.

[0149] The target operation area set generation submodule is used to update the operation angle of the intermediate operation area according to the connection angle between each intermediate operation area in the intermediate operation area set and the preset center, so as to generate the target operation area set.

[0150] Optionally, the target point set determination module 503 includes:

[0151] The point cloud map generation module is used to convert the laser frame coordinates corresponding to the cabin corner point map into global coordinates using the initial vehicle body posture, and generate a point cloud map corresponding to the closed cabin.

[0152] The rake point set determination submodule is used to identify the rake points based on the point cloud map and the job execution area, and determine the rake point set corresponding to the job execution area.

[0153] Optionally, the target point set determination submodule may perform the following steps:

[0154] Divide the point cloud map according to the regional corner points corresponding to the job execution area to generate a point cloud map corresponding to the job execution area;

[0155] Selecting point clouds that meet a first preset screening criterion in the point cloud image to generate a plurality of initial point clouds;

[0156] Selecting an initial point cloud that meets a second preset screening criterion to generate a plurality of target point clouds;

[0157] Based on the operation angle corresponding to the operation execution area and the distance between the target point cloud and the center of the cabin of the closed cabin, a set of rake points corresponding to the operation execution area is determined.

[0158] Optionally, the target point set determination submodule may further perform the following steps:

[0159] Arrange the target point cloud from low to high according to the distance between the target point cloud and the center of the closed cabin to generate a first point cloud sequence;

[0160] rasterizing the first point clouds in the first point cloud sequence respectively to generate a second point cloud sequence;

[0161] Constructing a contour point sequence according to the order of the second point cloud sequence and the operation angle corresponding to the operation execution area;

[0162] The contour points in the contour point sequence that meet the third preset screening standard are used as rake points to generate a rake point set corresponding to the job execution area.

[0163] Optionally, the target raking data and iteration number generating module 504 includes:

[0164] The target landing point determination module is used to take the landing point corresponding to the minimum sequence number in the landing point set as the target landing point.

[0165] The module for generating the initial harrowing route and the number of executions is used to construct a preset curve using the working angle, initial vehicle posture and target harrowing point corresponding to the working execution area, generate the initial harrowing route and target vehicle posture corresponding to the target harrowing point and count the number of executions.

[0166] The second jump execution module is used to take the target vehicle body posture as the new initial vehicle body posture, take the harrow point with the same sequence number as the execution number in the harrow set as the new target harrow point, and jump to execute the steps of constructing a preset curve using the working angle, initial vehicle body posture and target harrow point corresponding to the working execution area, generating an initial pushing harrow route and target vehicle body posture corresponding to the target harrow point and counting the execution number.

[0167] The target raking data and iteration number generation submodule is used to connect all the initial raking routes in the execution order corresponding to the initial raking routes when the execution number reaches the preset execution threshold, construct the target raking route corresponding to the job execution area and count the iteration number.

[0168] An embodiment of the present invention further provides an electronic device, comprising: a memory and a processor, wherein a computer program is stored in the memory; when the computer program is executed by the processor, the processor executes a method for planning an operation trajectory in a closed cabin as described in any of the above embodiments.

[0169] The memory can be an electronic memory such as a flash memory, an EEPROM (electrically erasable programmable read-only memory), an EPROM, a hard disk or a ROM. The memory has a storage space for a program code for executing any method step in the above method. For example, the storage space for the program code can include individual program codes for implementing the various steps in the above method respectively. These program codes can be read from or written to one or more computer program products. These computer program products include program code carriers such as a hard disk, a compact disk (CD), a memory card or a floppy disk. The program code can be compressed, for example, in an appropriate form. When these codes are run by a computing and processing device, the computing and processing device is caused to execute the various steps in the above-described method for operating trajectory planning in a closed cabin.

[0170] An embodiment of the present invention further provides a computer-readable storage medium having a computer program stored thereon. When the computer program is executed by a processor, the method for planning an operation trajectory in a closed cabin as described in any of the above embodiments is implemented.

[0171] Those skilled in the art can clearly understand that, for the convenience and brevity of description, the specific working processes of the systems, devices and units described above can refer to the corresponding processes in the aforementioned method embodiments and will not be repeated here.

[0172] In the several embodiments provided in the present application, it should be understood that the disclosed systems, devices and methods can be implemented in other ways. For example, the device embodiments described above are only schematic. For example, the division of units is only a logical function division. There may be other division methods in actual implementation. For example, multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be an indirect coupling or communication connection through some interfaces, devices or units, which can be electrical, mechanical or other forms.

[0173] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.

[0174] In addition, each functional unit in each embodiment of the present invention may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit. The above-mentioned integrated unit may be implemented in the form of hardware or in the form of software functional units.

[0175] If the integrated unit is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention, in essence, or the part that contributes to the prior art, or all or part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium, including a number of instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the methods of each embodiment of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), disk or optical disk and other media that can store program codes.

[0176] The above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit the same. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that the technical solutions described in the aforementioned embodiments may still be modified, or some of the technical features may be replaced by equivalents. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present invention.

Claims

1. A method for planning an operation trajectory in a closed cabin, characterized in that: Applied to a preset push rake, the method comprises: Acquire a cabin corner point map of a closed cabin and an initial body posture of the preset pusher and rake, divide the cabin corner point map into regions, and generate a target operation area set; The target operation area corresponding to the minimum sequence number in the target operation area set is used as the operation execution area; Performing rake point recognition based on the initial vehicle body posture and the work execution area, and determining a rake point set corresponding to the work execution area; Based on the set of harrowing points and the operation angle corresponding to the operation execution area, an operation trajectory is constructed, a target harrowing route corresponding to the operation execution area is generated, and the number of iterations is counted; The target operation area with a sequence number equal to the number of iterations in the target operation area set is used as a new operation execution area, and the step of performing rake point identification based on the initial vehicle body posture and the operation execution area to determine the rake point set corresponding to the operation execution area is skipped and executed; When the number of iterations reaches a preset iteration threshold, all the target raking routes are adopted in a corresponding execution order to construct a raking operation trajectory corresponding to the closed cabin.

2. The method for planning trajectory of operations in a closed cabin according to claim 1, characterized in that: The step of dividing the cabin corner point map into regions to generate a target operation area set includes: Divide the cabin corner map into regions according to preset division rules to generate an initial operation area set; The initial operation areas in the initial operation area set are sequentially sorted according to a preset direction to generate an intermediate operation area set; The operating angles of the intermediate operating areas are updated according to the connection angles between each intermediate operating area in the intermediate operating area set and the preset center, so as to generate a target operating area set.

3. The method for planning trajectory of operations in a closed cabin according to claim 1, characterized in that: The step of identifying the landing point based on the initial vehicle body posture and the operation execution area and determining the landing point set corresponding to the operation execution area includes: The laser frame coordinates corresponding to the cabin corner point map are converted into global coordinates using the initial vehicle body posture to generate a point cloud map corresponding to the closed cabin; The rake point is identified based on the point cloud map and the operation execution area, and a rake point set corresponding to the operation execution area is determined.

4. The method for planning trajectory of operations in a closed cabin according to claim 3, characterized in that: The step of identifying the landing points based on the point cloud map and the operation execution area and determining the landing point set corresponding to the operation execution area includes: Dividing the point cloud map according to the regional corner points corresponding to the job execution area to generate a point cloud map corresponding to the job execution area; Selecting point clouds that meet a first preset screening criterion in the point cloud image to generate a plurality of initial point clouds; Selecting an initial point cloud that meets a second preset screening criterion to generate a plurality of target point clouds; Based on the operation angle corresponding to the operation execution area and the distance between the target point cloud and the center of the cabin body of the closed cabin, a set of rake points corresponding to the operation execution area is determined.

5. The method for planning trajectory for operations in a closed cabin according to claim 4, characterized in that: The step of determining a set of rake points corresponding to the operation execution area based on the operation angle corresponding to the operation execution area and the distance between the target point cloud and the center of the cabin of the closed cabin comprises: Arrange the target point clouds from low to high according to the distance between the target point clouds and the center of the cabin of the closed cabin to generate a first point cloud sequence; rasterizing the first point clouds in the first point cloud sequence respectively to generate a second point cloud sequence; Constructing a contour point sequence according to the order of the second point cloud sequence and the operation angle corresponding to the operation execution area; The contour points in the contour point sequence that meet the third preset screening standard are used as rake points to generate a rake point set corresponding to the job execution area.

6. The method for planning trajectory for operations in a closed cabin according to claim 1, characterized in that: The step of constructing a work trajectory based on the set of harrow points and the work angle corresponding to the work execution area, generating a target harrowing route corresponding to the work execution area and counting the number of iterations includes: The rake point corresponding to the minimum sequence number in the rake point set is used as the target rake point; The preset curve is constructed by using the working angle corresponding to the working execution area, the initial vehicle body posture and the target harrow landing point, the initial harrowing route and the target vehicle body posture corresponding to the target harrow landing point are generated, and the number of executions is counted; The target vehicle body posture is used as a new initial vehicle body posture, and the harrow point with a sequence number equal to the execution number in the harrow drop set is used as a new target harrow drop point, and the step of constructing a preset curve using the operation angle corresponding to the operation execution area, the initial vehicle body posture and the target harrow drop point, generating an initial harrowing route and target vehicle body posture corresponding to the target harrow drop point, and counting the execution number is executed; When the execution number reaches a preset execution threshold, all the initial raking routes are sequentially connected according to the execution order corresponding to the initial raking routes, a target raking route corresponding to the operation execution area is constructed, and the iteration number is counted.

7. A closed cabin operation trajectory planning system, characterized in that: Applied to a preset push rake, the system comprises: A target operation area set generation module is used to obtain a cabin corner point map of a closed cabin and an initial vehicle body posture of the preset pusher and rake, divide the cabin corner point map into regions, and generate a target operation area set; A job execution area determination module, used to take the target job area corresponding to the minimum serial number in the target job area set as the job execution area; A rake point set determination module, used for performing rake point identification based on the initial vehicle body posture and the operation execution area, and determining a rake point set corresponding to the operation execution area; A target raking data and iteration number generation module is used to construct a work trajectory based on the set of raking points and the work angle corresponding to the work execution area, generate a target raking route corresponding to the work execution area and count the iteration number; A first jump execution module, configured to take the target operation area in the target operation area set whose sequence number is equal to the iteration number as the operation execution area, and jump to execute the step of performing rake point recognition based on the initial vehicle body posture and the operation execution area, and determining the rake point set corresponding to the operation execution area; The push-and-hake operation trajectory data construction module is used to construct the push-and-hake operation trajectory corresponding to the closed cabin by adopting all the target push-and-hake routes in a corresponding execution order when the number of iterations reaches a preset iteration threshold.

8. The closed cabin operation trajectory planning system according to claim 7, characterized in that: The target operation area set generation module includes: An initial operation area set generation module is used to divide the cabin corner point map into regions according to a preset division rule to generate an initial operation area set; An intermediate operation area set generation module, used to sort the initial operation areas in the initial operation area set in sequence according to a preset direction to generate an intermediate operation area set; The target operation area set generation submodule is used to update the operation angle of the intermediate operation area according to the connection angle between each intermediate operation area in the intermediate operation area set and the preset center, so as to generate a target operation area set.

9. An electronic device, characterized in that: It comprises a memory and a processor, wherein the memory stores a computer program, and when the computer program is executed by the processor, the processor executes the steps of the method for planning an operation trajectory in a closed cabin as described in any one of claims 1 to 6.

10. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed, the method for planning the trajectory of operations in a closed cabin as described in any one of claims 1 to 6 is implemented.