Intelligent wet spraying trolley, control method and equipment thereof and medium
Through the intelligent industrial control machine, sensor and three-dimensional lidar technology of wet spray trolley, the automation and precise positioning of wet spray trolley is achieved, solving the problems of low construction efficiency and waste of concrete in manual operations, and improving construction efficiency and spraying accuracy , reducing the rebound rate of concrete.
Patent Information
- Application Number
- CN202410907087.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-08
- Publication Date
- 2024-11-12
AI Technical Summary
During spray concrete construction, manual operation of wet spray trolley has low construction efficiency and difficult to accurately control the spray angle of the end nozzle, resulting in waste of concrete and harsh environment, affecting the health of the operators.
It adopts an intelligent wet spray trolley, equipped with industrial control machines, sensors and three-dimensional lidar, and achieves precise positioning through UWB and inertial navigation, automatic construction of the robotic arm, real-time detection and closed-loop control, and reduces the rebound rate of concrete.
Fully automated construction is realized, construction efficiency is improved, concrete rebound rate is reduced, spray angle accuracy is ensured, and material waste and environmental pollution are reduced.
Smart Images

Figure CN118933860A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of wet spraying trolleys for mine tunnels, and in particular to an intelligent wet spraying trolley and a control method, equipment and medium thereof. Background Art
[0002] In shotcrete construction, rebound rate is a very important issue. The rebound rate of shotcrete is one of the conditions that can ensure the quality of concrete. The rebound rate of the wet spraying trolley refers to the proportion of concrete rebounding and falling to the ground after being sprayed on the surface. Excessive rebound rate will cause material loss and generate a lot of dust. Usually the rebound rate percentage is between 5% and 50%. On the construction site, depending on different types of working conditions, the spraying distance is about 0.8 meters to 1.5 meters from the surface. Excessive deviation will cause great waste. In order to achieve the best homogeneity and the least rebound, the spraying angle must be guaranteed to be 90 degrees. A larger angle deviation means more rebound. The manual operation of the wet spraying trolley construction has low construction efficiency and the spraying angle of the end nozzle is not easy to accurately control, which is easy to cause concrete waste. At the same time, the poor construction environment will also have a certain impact on the health of the operators. Summary of the invention
[0003] In view of this, the present invention provides an intelligent spraying trolley and its control method, equipment and medium, which can realize fully automatic spraying trolley construction, realize automated and intelligent construction of the spraying trolley mechanical arm, improve construction efficiency and reduce concrete rebound rate.
[0004] To achieve the above-mentioned purpose, the present invention proposes an intelligent wetting trolley, including a wetting trolley, an industrial computer is installed on the wetting trolley, and a sensor is installed on the wetting trolley to detect the status information of the wetting trolley in real time; the real-time communication between the industrial computer and the wetting trolley is established on the main controller of the wetting trolley by extending the CAN communication interface; the industrial computer triggers the communication of the vehicle body's own sensors in a directional and real-time manner to obtain the parameter information of the vehicle body itself in real time, and at the same time, the industrial computer sends control instructions to the main controller of the wetting trolley through the CAN communication port to control the movement of the wetting trolley.
[0005] Among them, UWB and inertial navigation are used to realize the positioning of the spraying trolley. A three-dimensional laser radar is installed at the end of the mechanical arm of the spraying trolley. The laser radar is connected to the industrial computer through the network port. The industrial computer obtains the three-dimensional spatial model of the tunnel area to be sprayed through point cloud splicing processing of the point cloud information collected by the three-dimensional laser radar.
[0006] The present invention also proposes a control method for the intelligent spraying trolley of the present invention, comprising the following steps:
[0007] Step 1, obtaining geometric information and features of the area to be sprayed;
[0008] Step 2, determine the spraying posture of the spray head of the spraying trolley;
[0009] Step 3, after obtaining the position and posture of the spray gun end, the spatial posture of the spray trolley robot arm is solved to obtain the posture of the spray trolley robot arm;
[0010] Step 4, control the spraying trolley robot arm as follows:
[0011] According to the results of path planning and inverse solution calculation, the movement of the wet spraying robot is controlled so that it can perform spraying construction according to the predetermined trajectory and posture; the robot is controlled by the industrial computer, which rewrites the robot arm posture information into control instructions and sends them to the main control board of the wet spraying trolley through CAN communication to control the wet spraying trolley robot arm to perform corresponding actions, and detects the angles of each joint and whether the wet spraying robot arm is in place during the spraying process to achieve closed-loop control;
[0012] Step 5, by expanding the CAN communication interface, the parameters of the vehicle body itself are informatized, and the vehicle body's own sensor communication is triggered in a directional and real-time manner to obtain the real-time sprayed concrete volume, quick-setting dosage, wind pressure, concrete volume and quick-setting dosage ratio parameters.
[0013] Among them, in the step 5, the obtained parameters and the current gridded area are synchronously serialized to the Pickle local file; the parameters recorded during the spraying construction process are verified in real time.
[0014] Among them, the intelligent spraying trolley is symmetrically equipped with a three-dimensional laser radar for scanning the area to be sprayed in the tunnel;
[0015] The laser radar is used to obtain the geometric information of the tunnel wall in real time and generate a three-dimensional model. By obtaining the three-dimensional spatial model of the area to be sprayed, the data obtained by the three-dimensional laser radar is processed and analyzed to extract the geometric information and features of the area to be sprayed for subsequent path planning and spraying posture calculation.
[0016] Among them, the specific process of solving the spatial posture of the mechanical arm of the spraying trolley and obtaining the mechanical arm posture of the spraying trolley is as follows:
[0017] The D-H method is used to establish the linkage coordinate system of the wet spraying trolley robot arm, and the base coordinate system of the system is fixed at the center of the base.
[0018] Space transformation matrix: The motion of the concrete spraying trolley robot arm in the workspace is decomposed into the position and posture of each rod in its own coordinate system, and the relative position and posture between two adjacent links are represented by the rotation matrix;
[0019] The position and posture of the nozzle at the end of the spraying trolley robot arm relative to the base coordinate system is obtained, that is, the transformation matrix of the end coordinate system to the base coordinate system.
[0020] The present invention also proposes an electronic device, which includes a processor and a memory for storing executable instructions of the processor; the processor is used to read the executable instructions from the memory and execute the instructions to implement the control method described in the present invention.
[0021] The present invention further provides a computer-readable storage medium, wherein the storage medium stores a computer program, and the computer program is used to execute the control method described in the present invention.
[0022] Beneficial effects:
[0023] 1. The intelligent spraying trolley of the present invention can realize fully automatic spraying trolley construction. Through intelligent perception, spraying mechanical arm posture analysis and modification of the original spraying trolley control system and the addition of control interface technology, the spraying trolley mechanical arm can realize automated and intelligent construction, improve construction efficiency and reduce concrete rebound rate.
[0024] 2. The intelligent spraying trolley of the present invention is to add an industrial computer to the existing spraying trolley, and the real-time communication between the industrial computer and the spraying trolley is established on the main controller of the spraying trolley by expanding the CAN communication interface. The industrial computer triggers the communication of the vehicle body's own sensors in a directional and real-time manner, and can obtain the parameter information of the vehicle body itself in real time. At the same time, the industrial computer can send control instructions to the main controller of the spraying trolley through the CAN communication port to control the movement of the spraying trolley; UWB and inertial navigation technology are used to achieve precise positioning of the spraying trolley. Two three-dimensional laser radars are installed at the end of the mechanical arm of the spraying trolley. The laser radar and the industrial computer are connected through the network port. The industrial computer obtains the three-dimensional spatial model of the tunnel area to be sprayed by splicing the point cloud information collected by the two three-dimensional laser radars; sensors are installed on the spraying trolley to detect the status information of the spraying trolley in real time to ensure that the spraying trolley is accurately constructed and operated according to the planned trajectory.
[0025] 3. In the control method of the present invention, the movement of the wet spraying manipulator is controlled according to the results of path planning and inverse solution calculation, so that the wet spraying manipulator performs spraying construction according to the predetermined trajectory and posture. The manipulator is controlled by an industrial computer, which rewrites the manipulator arm posture information into control instructions and sends them to the main control board of the wet spraying trolley through CAN communication to control the wet spraying trolley manipulator to perform corresponding actions. During the spraying process, the inclination sensor detects the angles of each joint to check whether the wet spraying manipulator arm is in place, thereby realizing closed-loop control.
[0026] 4. In the device of the present invention, the movement of the wet spraying manipulator is controlled according to the results of path planning and inverse solution calculation, so that the spraying construction is carried out according to the predetermined trajectory and posture. The manipulator is controlled by an industrial computer, and the industrial computer rewrites the manipulator arm posture information into control instructions and sends them to the main control board of the wet spraying trolley through CAN communication to control the wet spraying trolley manipulator to perform corresponding actions. During the spraying process, the inclination sensor detects the angles of each joint to check whether the wet spraying manipulator arm is in place, thereby realizing closed-loop control.
[0027] 5. In the medium of the present invention, the movement of the wet spraying manipulator is controlled according to the results of path planning and inverse solution calculation, so that the wet spraying manipulator performs spraying construction according to the predetermined trajectory and posture. The manipulator is controlled by an industrial computer, and the industrial computer rewrites the manipulator arm posture information into a control instruction and sends it to the main control board of the wet spraying trolley through CAN communication to control the wet spraying trolley manipulator to perform corresponding actions. During the spraying process, the inclination sensor detects the angle of each joint to check whether the wet spraying manipulator arm is in place, thereby realizing closed-loop control. BRIEF DESCRIPTION OF THE DRAWINGS
[0028] Figure 1 It is the technical roadmap of the intelligent spraying trolley of the present invention.
[0029] Figure 2 This is a schematic diagram of the overall connection of the intelligent spraying trolley according to an embodiment of the present invention.
[0030] Figure 3 This is a schematic diagram of the construction of a wet spraying trolley according to an embodiment of the present invention.
[0031] Figure 4 It is a schematic diagram of a three-dimensional model of a mechanical arm of a wet spraying trolley according to an embodiment of the present invention.
[0032] Figure 5 Schematic diagram of the connecting rod coordinate system of the mechanical arm of the spray trolley according to an embodiment of the present invention.
[0033] Figure 6 It is a schematic diagram of the operation parameter detection and host computer interface of the wet spraying trolley according to an embodiment of the present invention.
[0034] Figure 7 A schematic diagram of the structure of an electronic device provided by an embodiment of the present invention. DETAILED DESCRIPTION
[0035] The present invention is described in detail below with reference to the accompanying drawings and embodiments.
[0036] The present invention provides an intelligent spraying trolley. Figure 1 It is the technical roadmap of the intelligent spraying trolley of the present invention. Figure 2The figure is a schematic diagram of the overall connection of the intelligent spraying trolley of the embodiment of the present invention. The intelligent spraying trolley of the present invention is to add an industrial computer to the existing spraying trolley, and the real-time communication between the industrial computer and the spraying trolley is established by extending the CAN communication interface on the main controller of the spraying trolley. The industrial computer triggers the communication of the vehicle body's own sensors in a directional and real-time manner, and can obtain the parameter information of the vehicle body itself in real time. At the same time, the industrial computer can send control instructions to the main controller of the spraying trolley through the CAN communication port to control the movement of the spraying trolley; UWB and inertial navigation technology are used to achieve precise positioning of the spraying trolley. Two three-dimensional laser radars are installed at the end of the mechanical arm of the spraying trolley. The laser radar and the industrial computer are connected through the network port. The industrial computer obtains the three-dimensional spatial model of the tunnel area to be sprayed by splicing the point cloud information collected by the two three-dimensional laser radars; sensors are installed on the spraying trolley to detect the status information of the spraying trolley in real time to ensure that the spraying trolley is accurately constructed and operated according to the planned trajectory.
[0037] The present invention also provides a method for controlling the intelligent spraying trolley of the present invention, comprising the following steps:
[0038] Step 1: Two three-dimensional laser radars are symmetrically installed on the intelligent spraying trolley of the present invention to scan the area to be sprayed in the tunnel. The laser radar can obtain the geometric information of the wall surface in the tunnel in real time and generate an accurate three-dimensional model. By obtaining the three-dimensional model of the space of the area to be sprayed, the data obtained by the three-dimensional laser radar is processed and analyzed to extract the geometric information and features of the area to be sprayed, which is used for subsequent path planning and spraying posture calculation.
[0039] Step 2, determine the spraying posture of the spray head of the spraying trolley;
[0040] Specifically, the distance and angle between the spray head of the spray trolley and the surface to be sprayed are the key factors affecting the spraying quality; the spray distance is about 0.8 to 1.5 meters from the surface. Excessive deviation will cause great waste. In order to achieve the best homogeneity and the least rebound, the spray angle must be guaranteed to be 90 degrees. A larger angle deviation means more rebound. According to the above theoretical basis, the best spray position and posture of the spray head are obtained. Figure 3 It is a schematic diagram of the construction of the wet spraying trolley of the present invention.
[0041] Step 3, after obtaining the position and posture of the spray gun end, the spatial posture of the spray trolley robot arm is solved to obtain the robot arm posture of the spray trolley, as follows:
[0042] ① Use the D-H method to establish the wet spraying trolley mechanical arm connecting rod coordinate system, and fix the system's base coordinate system at the center of the base, such as Figure 4 The figure shows the 3D model of the spraying trolley robot arm. Figure 5 This is the coordinate system of the robot arm link of the spraying trolley;
[0043] ② Space transformation matrix: The motion of the concrete wet spraying trolley robot arm in the workspace can be decomposed into the position and posture of each rod in its own coordinate system. The relative position and posture between two adjacent links are represented by the rotation matrix. The transformation matrix of the i-th link relative to the i-1-th link is:
[0044]
[0045] Where i is the link number, d and θ describe the relative geometric relationship between adjacent line segments a(i-1) and a(i), and α represents the relative position between the two axes of rotation;
[0046] The position of the nozzle at the end of the spraying trolley robot arm relative to the base coordinate system, that is, the transformation matrix of the end coordinate system to the base coordinate system can be expressed as:
[0047]
[0048] in, Represents the components of the nozzle coordinate system at the end of the spraying trolley robot arm relative to the base coordinate system, that is, the rotation coordinates; It indicates the position coordinates of the origin of the nozzle coordinate system at the end of the spray trolley robot arm relative to the origin of the base coordinate system.
[0049] Step 4, control the spraying trolley robot arm as follows:
[0050] According to the results of path planning and inverse solution calculation, the movement of the wet spraying manipulator is controlled so that it can perform spraying construction according to the predetermined trajectory and posture. The manipulator is controlled by the industrial computer, which rewrites the manipulator's posture information into control instructions and sends them to the main control board of the wet spraying trolley through CAN communication to control the wet spraying trolley manipulator to perform corresponding actions. During the spraying process, the inclination sensor is used to detect the angles of each joint to check whether the wet spraying manipulator is in place, thereby realizing closed-loop control.
[0051] Step 5: By expanding the CAN communication interface, the parameters of the vehicle body are informatized, and the vehicle body's own sensor communication is triggered in real time to obtain the real-time sprayed concrete volume, quick-setting dosage, wind pressure, concrete volume and quick-setting dosage ratio parameters. At the same time, the obtained parameters are synchronously serialized with the current grid area to the Pickle local file for later data recording, analysis, and query. The parameters recorded during the spraying construction process are verified in real time. Figure 6 Shown is the host computer design interface for the intelligent transformation of the wet spraying trolley.
[0052] The embodiment of the present application also provides an electronic device, Figure 7The structure of the electronic device provided by the embodiment of the present invention is shown. For example, the electronic device 70 may include a processor 71, a memory 72 and a transmission device 73. The processor 71 is used to execute the control method of the intelligent spraying trolley mentioned in the above embodiment, wherein the processor and the memory may be connected by a bus or other means, taking the bus connection as an example. The transmission device may be connected to the processor and the memory by wire or wirelessly. The memory, as a non-transient computer-readable storage medium, may be used to store non-transient software programs, non-transient computer executable programs and modules, such as program instructions / modules corresponding to the control method of the intelligent spraying trolley in the embodiment of the present application. The processor executes various functional applications and data processing of the processor by running the non-transient software programs, instructions and modules stored in the memory, that is, the control method of the intelligent spraying trolley in the above method embodiment is realized. The memory may include a program storage area and a data storage area, wherein the program storage area may store an operating system and an application required by at least one function; the data storage area may store data created by the processor, etc. In addition, the memory may include a high-speed random access memory, and may also include a non-transient memory, such as at least one disk storage device, a flash memory device, or other non-transient solid-state storage device. In some embodiments, the memory may optionally include a memory remotely arranged relative to the processor, and these remote memories may be connected to the processor via a network. Examples of the above network include, but are not limited to, the Internet, an intranet, a local area network, a mobile communication network, and a combination thereof. The one or more modules are stored in the memory, and when executed by the processor, the control method of the intelligent spraying trolley in the embodiment is executed.
[0053] As another aspect, the present application also provides a computer-readable storage medium, which may be the computer-readable storage medium included in the device described in the above embodiment; or it may be a computer-readable storage medium that exists independently and is not assembled into the device. The computer-readable storage medium may be a tangible storage medium, such as a random access memory (RAM), a memory, a read-only memory (ROM), an electrically programmable ROM, an electrically erasable programmable ROM, a register, a floppy disk, a hard disk, a removable storage disk, a CD-ROM, or any other form of storage medium known in the technical field. The computer-readable storage medium stores one or more programs, and the programs are used by one or more processors to execute the control method of the intelligent spraying trolley described in the present application.
[0054] In summary, the above are only preferred embodiments of the present invention and are not intended to limit the protection scope of the present invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention should be included in the protection scope of the present invention.
Claims
1. An intelligent spraying trolley, comprising a spraying trolley, characterized in that: The wetting trolley is equipped with an industrial computer and a sensor to detect the status information of the wetting trolley in real time; the main controller of the wetting trolley establishes real-time communication between the industrial computer and the wetting trolley by extending the CAN communication interface; the industrial computer triggers the communication of the vehicle body's own sensors in a directional and real-time manner to obtain the parameter information of the vehicle body itself in real time, and at the same time, the industrial computer sends control instructions to the main controller of the wetting trolley through the CAN communication port to control the movement of the wetting trolley.
2. The intelligent spraying trolley according to claim 1, characterized in that: UWB and inertial navigation are used to realize the positioning of the spraying trolley. A three-dimensional laser radar is installed at the end of the mechanical arm of the spraying trolley. The laser radar is connected to the industrial computer through the network port. The industrial computer obtains the three-dimensional spatial model of the tunnel area to be sprayed by splicing the point cloud information collected by the three-dimensional laser radar.
3. A method for controlling the intelligent spraying trolley as claimed in claim 1 or 2, characterized in that , including the following steps: Step 1, obtaining geometric information and features of the area to be sprayed; Step 2, determine the spraying position of the spray head of the spraying trolley; Step 3, after obtaining the position and posture of the spray gun end, the spatial posture of the spray trolley robot arm is solved to obtain the posture of the spray trolley robot arm; Step 4, control the spraying trolley robot arm as follows: According to the results of path planning and inverse solution calculation, the movement of the wet spraying robot is controlled so that it can perform spraying construction according to the predetermined trajectory and posture; the robot is controlled by the industrial computer, which rewrites the robot arm posture information into control instructions and sends them to the main control board of the wet spraying trolley through CAN communication to control the wet spraying trolley robot arm to perform corresponding actions, and detects the angles of each joint and whether the wet spraying robot arm is in place during the spraying process to achieve closed-loop control; Step 5, by expanding the CAN communication interface, the parameters of the vehicle body itself are informatized, and the vehicle body's own sensor communication is triggered in a directional and real-time manner to obtain the real-time sprayed concrete volume, quick-setting dosage, wind pressure, concrete volume and quick-setting dosage ratio parameters.
4. The method according to claim 3, characterized in that In the step 5, the obtained parameters are synchronously serialized with the current gridded area to the Pickle local file; the parameters recorded during the injection construction process are verified in real time.
5. The method according to claim 3 or 4, characterized in that The intelligent spraying trolley is symmetrically equipped with a three-dimensional laser radar for scanning the area to be sprayed in the tunnel; The laser radar is used to obtain the geometric information of the tunnel wall in real time and generate a three-dimensional model. By obtaining the three-dimensional spatial model of the area to be sprayed, the data obtained by the three-dimensional laser radar is processed and analyzed to extract the geometric information and features of the area to be sprayed for subsequent path planning and spraying posture calculation.
6. The method according to claim 5, characterized in that The specific process of calculating the spatial posture of the robot arm of the spraying trolley and obtaining the posture of the robot arm of the spraying trolley is as follows: The D-H method is used to establish the linkage coordinate system of the wet spraying trolley robot arm, and the base coordinate system of the system is fixed at the center of the base. Spatial transformation matrix: The motion of the concrete wet spraying trolley robot arm in the workspace is decomposed into the position and posture of each rod in its own coordinate system. The relative posture between two adjacent connecting rods is represented by a rotation matrix; the posture of the end nozzle of the wet spraying trolley robot arm relative to the base coordinate system is obtained, that is, the transformation matrix of the end coordinate system to the base coordinate system.
7. An electronic device, characterized in that: The electronic device includes a processor and a memory for storing executable instructions of the processor; the processor is used to read the executable instructions from the memory and execute the instructions to implement the control method described in any one of claims 3 to 6 above.
8. A computer-readable storage medium, characterized in that: The storage medium stores a computer program, and the computer program is used to execute the control method described in any one of claims 3 to 6.
Citation Information
Cited By
Five-layer man-machine alternating operation method and system for wet spraying mechanical arm
CN120382496A
Method for automatically planning spraying track of tunnel wet spraying trolley
CN120493369A
Man-machine cooperative control system and method for tunnel concrete wet spraying operation
CN120592650A
