Full-automatic control method and system for press-in type mechanical open caisson equipment
Through fully automatic control system and virtual cylinder technology, the problems of manual operation of ground press-in mechanized caisson equipment and complex motion control of underwater robots are solved, and the efficiency, safe sinking and stable attitude of caisson equipment are achieved.
Patent Information
- Application Number
- CN202411360025.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-27
- Publication Date
- 2024-11-22
AI Technical Summary
In the existing caisson construction technology, manual operation is difficult during the multi-system collaborative control of ground press-in mechanized caisson equipment, low operating efficiency, and complex motion control of underwater robots, which poses safety risks.
A fully automatic control method and system was designed, including soil extraction robot, propulsion equipment and synchronous grouting system. Through the central control center, the soil extraction control subsystem, propulsion control subsystem and grouting control subsystem are coordinated to realize the pipe sheet ring The automatic sinking and synchronous grouting are used to adjust the extension speed of the propulsion equipment by using a virtual oil cylinder, and collision detection is carried out during the work of the soil extraction robot to ensure safety.
The full automatic control of caisson equipment is realized, which reduces the difficulty of manual intervention, improves operating efficiency, ensures the stability and safety of the caisson structure attitude, and avoids the risks brought by manual operation.
Smart Images

Figure CN118997201A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of caisson construction, and in particular to a fully automatic control method and system for press-in mechanized caisson equipment. Background Art
[0002] In recent years, various parts of the country have accelerated the construction of livelihood projects such as sponge cities and underground smart garages, and there are more and more ultra-large diameter and ultra-deep shaft projects. The traditional method is to cast the entire caisson steel concrete structure on the ground, and dig the soil in the well to make the caisson gradually sink under its own weight. During construction, quicksand is prone to occur, causing the caisson to tilt or sink. Difficulty. Therefore, the research and development of new ground-pressed mechanized caisson construction equipment (such as the applicant’s prior patent application number: 202310058717.0, the name of the invention is: Active Controlled Assembled Mechanized Caisson System) has great practical significance. However, the actual construction of this equipment must be completed by the coordination of multiple systems, and manual operation is extremely difficult, especially the motion control of underwater robots. Summary of the invention
[0003] The purpose of the present invention is to overcome the defects of the prior art and provide a fully automatic control method and system for a press-in mechanized caisson equipment to solve the problems that the existing caisson equipment is extremely difficult to operate manually and the motion control of underwater robots is difficult.
[0004] The technical solution to achieve the above purpose is:
[0005] The present invention provides a fully automatic control method for a press-in mechanized caisson equipment, wherein the caisson equipment comprises a soil taking robot, a propulsion device and a synchronous grouting system, and the fully automatic control method comprises the following steps:
[0006] S11, segment rings are assembled in place;
[0007] S12, controlling the soil-collecting robot to start soil-collecting work;
[0008] S13, after the soil-excavating robot excavates and extracts soil to a set depth, controlling the propulsion device to press down the segment ring to a corresponding position;
[0009] S14, during the process of pressing down the segment ring, obtaining the target grouting amount of each grouting point, and controlling the synchronous grouting system to perform synchronous grouting according to the target grouting amount of each grouting point;
[0010] S15, controlling the soil-extracting robot to continue digging and extracting soil downwards;
[0011] S16, looping step S13 to step S15 until the current segment ring completes the sinking work;
[0012] S17, turning on the propulsion device, assembling the next segment ring above the current segment ring, and turning off the propulsion device;
[0013] S18, looping steps S12 to S17 until the sinking of all segment rings is completed.
[0014] A further improvement of the fully automatic control method of the press-in mechanized caisson equipment of the present invention is that when controlling the soil-taking robot to perform soil-taking work, the soil-taking work area is divided into four quadrants according to the cross beam for installing the soil-taking robot, and each quadrant is further divided into an inner circle area and an outer circle area;
[0015] The soil-excavating robot is made to first excavate the inner circle areas of the four quadrants, and then to excavate the outer circle areas of the four quadrants. When excavating the four quadrants, a symmetrical excavation method is used for sequential excavation.
[0016] The further improvement of the fully automatic control method of the push-in mechanized caisson equipment of the present invention is that after the soil excavation of the four quadrants is completed, the caisson posture is collected and it is determined whether correction is required. When correction is determined to be required, correction work is performed:
[0017] The next step of soil excavation is carried out in the inner circle area of the quadrant where the caisson is tilted in the opposite direction. If the caisson returns to its original position, the correction is completed.
[0018] If the caisson posture has not returned, the next soil excavation will be carried out in the outer circle area of the current quadrant. If the caisson posture returns, the correction is completed;
[0019] If the caisson does not return to its original position, the next step of soil excavation will be carried out in the inner circle area below the cross beam. If the caisson returns to its original position, the deviation correction is completed.
[0020] If the caisson does not return to its original position, the next step of soil excavation will be carried out in the outer circle area below the cross beam. If the caisson returns to its original position, the deviation correction is completed.
[0021] If the caisson posture has not returned, the soil below the steel blade foot ring in the current quadrant is excavated until the caisson posture returns.
[0022] A further improvement of the fully automatic control method of the push-in mechanized caisson equipment of the present invention is that, when controlling the propulsion device to press down the segment ring, a virtual oil cylinder is set, and the extension speed and total extension stroke of the virtual oil cylinder are set, and the set total extension stroke of the virtual oil cylinder is the set depth of the soil excavation robot for excavating soil;
[0023] Control the propulsion cylinder of the propulsion equipment and the set virtual cylinder to start, so that the set virtual cylinder is extended at a set extension speed, and the stroke sensor of each propulsion cylinder collects its current stroke in real time;
[0024] The current stroke of each propulsion cylinder is compared with the extension stroke of the virtual cylinder to calculate the difference, and the difference is transmitted to the stroke controller of each propulsion cylinder. The stroke controller calculates the target opening degree of the proportional flow valve of the corresponding propulsion cylinder, and then controls the proportional flow valve to execute the corresponding opening degree, so as to dynamically adjust the extension speed of each propulsion cylinder, so that each propulsion cylinder can be extended synchronously with the virtual cylinder until it is extended to the set depth of the soil-excavating robot for excavation.
[0025] A further improvement of the fully automatic control method of the press-in mechanized caisson equipment of the present invention is that, during the operation of the soil-collecting robot, it also includes collision detection of the robot:
[0026] Digitally model the soil-extracting robot, steel blade foot ring and cross beam to determine the zero-position posture of the soil-extracting robot;
[0027] The digital modeling of the soil-excavating robot, the steel blade foot ring and the cross beam is meshed to form a corresponding number of unit bodies;
[0028] During the operation of the soil-extracting robot, the sensor data of each joint of the soil-extracting robot is obtained, and the digital model of the soil-extracting robot is driven by data mapping to present the spatial state of the soil-extracting robot in the global coordinate system in real time;
[0029] Obtain and store the spatial coordinates of the center of each unit body of the soil-taking robot, steel blade foot ring and cross beam in the global coordinate system at the current calculation moment, which are denoted as P i , Q j and G k ;
[0030] Calculate all P i and Q j Distance m i-j And all P i and G k The distance n i-k , and obtain the minimum value min{m i-j ,n i-k};
[0031] If the minimum value obtained is greater than 10 cm, the soil-collecting robot is judged to be in a safe working state;
[0032] If the minimum value obtained is greater than 5 cm and less than or equal to 10 cm, the working state of the soil-extracting robot is judged to be a warning, and the soil-extracting robot is controlled to slow down;
[0033] If the obtained minimum value is greater than 0 cm and less than or equal to 5 cm, the working state of the soil-extracting robot is judged to be dangerous, and the soil-extracting robot is controlled to stop working.
[0034] The present invention also provides a fully automatic control system for a press-in mechanized caisson equipment, the caisson equipment comprising a soil taking robot, a propulsion device and a synchronous grouting system, the fully automatic control system comprising a central control center, a soil taking control subsystem connected to the central control center, a propulsion control subsystem connected to the central control center, and a grouting control subsystem connected to both the central control center and the propulsion control subsystem;
[0035] The central control center is used to send a work instruction to the soil extraction control subsystem after the segment ring is assembled in place, so that the soil extraction control subsystem starts and controls the soil extraction robot to start soil extraction work, and after the soil extraction robot excavates and extracts soil to a set depth, sends a completion instruction to the central control center;
[0036] After receiving the completion instruction sent by the soil excavation control subsystem, the central control center sends a work instruction to the propulsion control subsystem and the grouting control subsystem, so that the propulsion control subsystem controls the propulsion equipment to press the segment ring to the corresponding position, and the grouting control subsystem obtains the target grouting amount of each grouting point during the pressing process of the segment ring, and controls the synchronous grouting system to perform synchronous grouting according to the target grouting amount of each grouting point. When completed, the propulsion control subsystem and the grouting control subsystem send a completion instruction to the central control center;
[0037] The central control center sends a work instruction of the next set depth to the soil extraction control subsystem to repeat the soil extraction work, and then repeats the actions of pressing down the segment ring and synchronous grouting according to the above process until the current segment ring completes the sinking work;
[0038] The central control center sends an opening command to the propulsion control subsystem to control the propulsion equipment to open. After assembling the next segment ring above the current segment ring, the propulsion equipment is controlled to close. The central control center repeats the above-mentioned segment ring sinking action until the sinking of all segment rings is completed.
[0039] A further improvement of the fully automatic control system of the press-in mechanized caisson equipment of the present invention is that the soil taking control subsystem includes a soil taking area division module and a soil taking action control module;
[0040] The soil-excavating area division module is used to divide the soil-excavating working area into four quadrants according to the cross beam used to install the soil-excavating robot, and then divide each quadrant into an inner circle area and an outer circle area;
[0041] The soil-excavating action control module is connected to the soil-excavating area division module, and is used to control the soil-excavating robot to first excavate the inner circle area of the four quadrants, and then excavate the outer circle area of the four quadrants. When excavating the four quadrants, sequential excavation is performed in a symmetrical excavation manner.
[0042] A further improvement of the fully automatic control system of the press-in mechanized caisson equipment of the present invention is that the soil taking control subsystem further includes a deviation correction execution module;
[0043] The fully automatic control system also includes an automatic measurement subsystem connected to the central control center, and the automatic measurement subsystem is used to collect caisson posture data and send it to the central control center after the soil excavation in the four quadrants is completed;
[0044] The central control center determines whether deviation correction is required based on the received caisson posture data, and sends a deviation correction instruction to the soil excavation control subsystem when deviation correction is required;
[0045] After receiving the deviation correction instruction, the soil extraction control subsystem starts the deviation correction execution module;
[0046] The deviation correction execution module is used to control the soil-excavating robot to excavate the next soil depth in the inner circle area of the quadrant where the caisson is tilted in the opposite direction. If the caisson returns to its original position, the deviation correction is completed.
[0047] If the caisson posture has not returned, the next soil excavation will be carried out in the outer circle area of the current quadrant. If the caisson posture returns, the correction is completed;
[0048] If the caisson does not return to its original position, the next step of soil excavation will be carried out in the inner circle area below the cross beam. If the caisson returns to its original position, the deviation correction is completed.
[0049] If the caisson does not return to its original position, the next step of soil excavation will be carried out in the outer circle area below the cross beam. If the caisson returns to its original position, the deviation correction is completed.
[0050] If the caisson posture has not returned, the soil below the steel blade foot ring in the current quadrant is excavated until the caisson posture returns.
[0051] A further improvement of the fully automatic control system of the push-in mechanized caisson equipment of the present invention is that the propulsion control subsystem is used to set a virtual cylinder when controlling the propulsion equipment to press down the pipe segment ring, and set the extension speed and total extension stroke of the virtual cylinder, and the set total extension stroke of the virtual cylinder is the set depth of the soil excavation robot for excavating and taking soil;
[0052] The propulsion control subsystem is also used to control the propulsion cylinder of the propulsion equipment and the set virtual cylinder to open, so that the set virtual cylinder is extended at a set extension speed, and the stroke sensor of each propulsion cylinder collects its current stroke in real time;
[0053] The propulsion control subsystem obtains the current stroke collected by the stroke sensor of each propulsion cylinder, compares the current stroke of each propulsion cylinder with the extension stroke of the virtual cylinder to obtain the difference, and transmits the difference to the stroke controller of each propulsion cylinder, and the stroke controller calculates the target opening degree of the proportional flow valve of the corresponding propulsion cylinder;
[0054] The propulsion control subsystem receives the target opening degree of the proportional flow valve of the corresponding propulsion cylinder calculated by the stroke controller, and then controls the proportional flow valve to execute the corresponding opening degree, so as to dynamically adjust the extension speed of each propulsion cylinder, so that each propulsion cylinder can be extended synchronously with the virtual cylinder until it is extended to the set depth of excavation by the soil-excavating robot.
[0055] A further improvement of the fully automatic control system of the press-in mechanized caisson equipment of the present invention is that it also includes a robot collision detection subsystem connected to the central control center and the soil extraction control subsystem;
[0056] The robot collision subsystem includes a modeling module, a division module, a mapping module, an acquisition module, a calculation module and a judgment module;
[0057] The modeling module is used to digitally model the soil-extracting robot, the steel blade foot ring and the cross beam to determine the zero-position posture of the soil-extracting robot;
[0058] The division module is connected to the modeling module and is used to perform grid division on the digital modeling of the soil-excavating robot, the steel blade foot ring and the cross beam to form a corresponding number of unit bodies;
[0059] The mapping module is connected to the modeling module and is used to obtain the sensor data of each joint of the soil-extracting robot during the operation of the soil-extracting robot, drive the digital model of the soil-extracting robot through data mapping, and present the spatial state of the soil-extracting robot in the global coordinate system in real time;
[0060] The acquisition module is connected with the modeling module, the division module and the mapping module, and is used to acquire and store the position spatial coordinates of the center of each unit body of the soil-taking robot, the steel blade foot ring and the cross beam in the global coordinate system at the current calculation moment, which are respectively denoted as P i , Q j and G k ;
[0061] The calculation module is connected with the modeling module, the partitioning module, the mapping module and the acquisition module, and is used to calculate all P i and Q j Distance m i-j And all P i and G kThe distance ni-k is obtained, and the minimum value min{m i-j ,n i-k};
[0062] The judgment module is connected to the calculation module, and is used for judging that the working state of the soil-excavating robot is safe and sending a safety signal to the central control center when the minimum value is greater than 10cm; judging that the working state of the soil-excavating robot is warning and sending a warning signal to the central control center when the minimum value is greater than 5cm and less than or equal to 10cm, and the central control center sends a speed reduction instruction to the soil-excavating control subsystem based on the warning signal to control the soil-excavating robot to slow down; and judging that the working state of the soil-excavating robot is dangerous and sending a danger signal to the central control center when the minimum value is greater than 0cm and less than or equal to 5cm, and the central control center sends a shutdown instruction to the soil-excavating control subsystem based on the danger signal to control the soil-excavating robot to stop working.
[0063] The beneficial effects of the fully automatic control method and system of the press-in mechanized caisson equipment of the present invention are:
[0064] The fully automatic control method and system of the present invention realizes fully automatic control of caisson equipment without manual intervention, and effectively solves the problems of difficult manual operation, low operating efficiency, high safety risks, etc. in the process of multi-system coordinated control of ground-pressed mechanized caisson equipment.
[0065] The fully automatic control method and system of the present invention control the soil-excavating robot (i.e., underwater robot) to perform soil-excavating work in a symmetrical manner of first digging inside and then outside, and use a step-by-step method to dig downward to a set depth each time, which can effectively ensure the smooth progress of the excavation work and can also help ensure the stability of the posture of the caisson structure.
[0066] The fully automatic control method and system of the present invention also provides a correction model. After the soil-excavating robot excavates the soil in the four quadrants, it judges the posture of the caisson structure and performs correction work in time if deviation occurs, ensuring that the caisson posture is within the construction requirements.
[0067] The fully automatic control method and system of the present invention uses the parameters of the propulsion cylinder of the propulsion equipment as a reference according to the set virtual cylinder, and can then quickly calculate the control parameters of each propulsion cylinder, that is, the target opening degree of the proportional flow valve, through the difference, so as to achieve the effect of synchronous propulsion of each propulsion cylinder according to the virtual cylinder.
[0068] The fully automatic control method and system of the present invention also have a robot collision detection function. According to the established digital modeling, it obtains the minimum distance between the soil-excavating robot and the corresponding structure including the steel blade foot ring and the cross beam in real time, and reduces the speed or stops the robot when the minimum distance falls within the corresponding range, thereby ensuring the working safety of the soil-excavating robot. BRIEF DESCRIPTION OF THE DRAWINGS
[0069] Figure 1 This is the overall architecture diagram of the fully automatic control system of the push-in mechanized caisson equipment of the present invention.
[0070] Figure 2 This is a structural schematic diagram of the full-automatic control method and system of the push-in mechanized caisson equipment of the present invention in which the preparation work for the first segment ring is completed.
[0071] Figure 3 It is a schematic diagram of the motion path of the soil-collecting robot in the fully automatic control method of the push-in mechanized caisson equipment and the system of the present invention.
[0072] Figure 4 This is a fully automatic control method for a press-in mechanized caisson equipment and a flow chart of the excavation control of a soil-collecting robot in the system.
[0073] Figure 5 It is a schematic diagram of the fully automatic control method of the push-in mechanized caisson equipment and the synchronous control of the propulsion cylinder in the system of the present invention.
[0074] Figure 6 It is a schematic diagram of the liquid level measurement in the fully automatic control method and system of the push-in mechanized caisson equipment of the present invention.
[0075] Figure 7 The present invention is a fully automatic control method for the press-in mechanized caisson equipment and a schematic diagram of the system collision detection. DETAILED DESCRIPTION
[0076] The present invention will be further described below in conjunction with the accompanying drawings and specific embodiments.
[0077] See also Figure 1 The present invention provides a fully automatic control method and system for a push-in mechanized caisson equipment, which realizes the fully automatic control of the caisson equipment without manual intervention, and effectively solves the problems of difficult manual operation, low operating efficiency, and high safety risks in the multi-system coordinated control process of ground push-in mechanized caisson equipment. The fully automatic control method and system for the push-in mechanized caisson equipment of the present invention are described below in conjunction with the accompanying drawings.
[0078] See also Figure 1 , shows the overall architecture of the fully automatic control system of the push-in mechanized caisson equipment of the present invention. Figure 1, the fully automatic control system of the push-in mechanized caisson equipment of the present invention is explained.
[0079] like Figure 1 As shown, the fully automatic control system of the push-in mechanized caisson equipment provided by the present invention is used to realize the fully automatic control of the push-in mechanized caisson equipment, combined with Figure 2 As shown, the caisson equipment includes an earth-excavating robot 11, a propulsion device 13 and a synchronous grouting system. The fully automatic control system includes a central control center 21, an earth-excavating control subsystem 22 connected to the central control center 21, a propulsion control subsystem 23 connected to the central control center 21, and a grouting control subsystem 24 connected to both the central control center 21 and the propulsion control subsystem 23; further, the earth-excavating control subsystem 22, the propulsion control subsystem 23 and the grouting control subsystem 24 interact with the central control center 21 in a two-way manner to realize data reception and transmission.
[0080] The central control center 21 is used to send a work instruction to the soil extraction control subsystem 22 after the segment ring 12 is assembled in place, so that the soil extraction control subsystem 22 starts and controls the soil extraction robot 11 to start soil extraction. After the soil extraction robot 11 reaches the set depth, it sends a completion instruction to the central control center 21;
[0081] After receiving the completion instruction sent by the soil excavation control subsystem 22, the central control center 21 sends a work instruction to the propulsion control subsystem 23 and the grouting control subsystem 24, so that the propulsion control subsystem 23 controls the propulsion device 13 to press the segment ring 12 to the corresponding position, and the grouting control subsystem 24 obtains the target grouting amount of each grouting point during the pressing process of the segment ring 12, and controls the synchronous grouting system to perform synchronous grouting according to the target grouting amount of each grouting point. When completed, the propulsion control subsystem 23 and the grouting control subsystem 24 send a completion instruction to the central control center 21;
[0082] The central control center 21 sends a work instruction of the next set depth to the soil extraction control subsystem 22 to repeat the soil extraction work, and then repeats the actions of pressing down the segment ring and synchronous grouting according to the above process until the current segment ring completes the sinking work;
[0083] The central control center 21 sends an opening command to the propulsion control subsystem 23 to control the propulsion device 13 to open. After assembling the next segment ring above the current segment ring 12, the propulsion device 13 is controlled to close. The central control center 21 repeats the above-mentioned segment ring sinking action until the sinking of all the segment rings is completed.
[0084] In a specific embodiment of the present invention, Figure 2As shown, the preparation work for the first segment ring 12 is as follows: first put the steel blade foot ring 14 in place, install the soil-excavating robot 11 to the center of the cross beam of the steel blade foot ring 14, install the propulsion device 13 and keep it in an open state, assemble the first segment ring 12 above the steel blade foot ring 14, close the loop propulsion device 13, the propulsion device 13 includes multiple propulsion cylinders, after the propulsion cylinders extend out and contact the top surface of the first segment ring 12, the propulsion cylinders stop extending, water is injected into the caisson structure, and after the liquid level is consistent with the external ground, the sinking preparation work of the first segment ring 12 is completed.
[0085] After the first segment ring 12 is lowered, the preparation work for the second segment ring includes: retracting the propulsion cylinder, assembling the second segment ring above the first segment ring 12, extending the propulsion cylinder, making the propulsion cylinder contact the top surface of the second segment ring, and stopping the extension of the propulsion cylinder, thus completing the preparation work for the second segment ring. Similarly, the preparation work for the subsequent segment rings can be carried out with reference to the preparation work for the second segment ring. The opening and closing of the propulsion equipment (i.e., the propulsion cylinder) during the segment ring preparation work is realized by the central control center 21 sending instructions to the propulsion control subsystem 23.
[0086] In a specific embodiment of the present invention, Figure 2 and Figure 3 As shown, the soil taking control subsystem 22 includes a soil taking area division module and a soil taking action control module; the soil taking area division module is used to divide the soil taking work area into four quadrants according to the cross beam 13 for installing the soil taking robot, and then divide each quadrant into an inner circle area and an outer circle area;
[0087] The soil excavation action control module is connected to the soil excavation area division module, and is used to control the soil excavation robot to first excavate the inner circle area of the four quadrants, and then excavate the outer circle area of the four quadrants. When excavating the four quadrants, a symmetrical excavation method is used for sequential excavation.
[0088] Specifically, the soil taking action control module of the soil taking control subsystem controls the soil taking robot 11 to enter the normal soil taking working mode, adopting a scheme of first inside and then outside, symmetrical digging, and digging a set depth (or footage) each time in a step-by-step manner, such as Figure 3 The digital markings shown indicate that after the inner circle areas 1 to 4 are excavated to a set depth in a rotating manner, the outer circle areas 5 to 8 are excavated to a set depth.
[0089] Furthermore, in order to ensure the efficiency of excavation and soil extraction and the safety of equipment, the digging depth should be set no more than the radius of the robot's suction head each time. If the digging depth is set too large, the suction head may be easily "covered".
[0090] Furthermore, if Figure 1As shown, the soil extraction control subsystem 22 also includes a deviation correction execution module;
[0091] The fully automatic control system also includes an automatic measurement subsystem 25 connected to the central control center 21. The automatic measurement subsystem 25 is used to collect the caisson posture data and send it to the central control center 21 after the soil excavation in the four quadrants is completed;
[0092] The central control center 21 determines whether correction is needed based on the received caisson posture data, and sends a correction instruction to the soil excavation control subsystem when correction is needed; when the caisson posture data meets the construction requirements, the next step is entered, that is, the central control center 21 sends a work instruction to the propulsion control subsystem 23 and the grouting control subsystem 24.
[0093] After receiving the deviation correction instruction, the soil extraction control subsystem 22 starts the deviation correction execution module and enters the deviation correction mode;
[0094] Combination Figure 4 As shown, the deviation correction execution module is used to control the soil-excavating robot to excavate the next soil depth in the inner circle area of the quadrant where the caisson is tilted in the opposite direction. If the caisson posture returns, the deviation correction is completed; at this time, the judgment of whether the caisson posture returns is collected by the automatic measurement subsystem 25 and sent to the central control center 21 for judgment. After the central control center 21 obtains the judgment result, it decides whether it is necessary to continue the deviation correction;
[0095] If the caisson posture has not returned, the soil-excavating robot is controlled to excavate the next soil depth in the outer circle area of the current quadrant. If the caisson posture returns, the deviation correction is completed;
[0096] If the caisson posture does not return, the soil robot is controlled to move to the inner circle area below the cross beam (such as Figure 3 The next soil excavation is carried out in the area A to D shown in the figure. If the caisson returns to its original position, the deviation correction is completed.
[0097] If the caisson posture does not return, the soil robot is controlled to move to the outer circle area below the cross beam (such as Figure 3 The next soil excavation is carried out in the area E to H shown in the figure. If the caisson returns to its original position, the deviation correction is completed.
[0098] If the caisson posture has not returned, the soil-excavating robot is controlled to excavate the soil below the steel blade foot ring in the current quadrant until the caisson posture returns.
[0099] The control method of the soil-extracting robot of the present invention comprises:
[0100] In the three-dimensional model space, the initial state of the soil-excavating robot in the global coordinate system is clarified; in the three-dimensional model, the coordinate set of the motion path of the suction head is drawn according to the above-given mode types; according to the inverse kinematics method (refer to the Chinese patent: Mechanized caisson excavation robot kinematics forward and inverse solution analytical method, patent application number: 202311241447.3), the target motion of each joint of the robot is calculated; the soil-excavating control subsystem executes the target motion of each joint in a closed loop, and drives the suction head to cut the soil according to the set path. The set paths of each quadrant are as follows: Figure 3 As shown, the circle with the intersection center of the cross beam as the center and the set length as the radius is the set path of the suction head of the soil-excavating robot, and the moving directions of two adjacent circles are opposite.
[0101] In a specific embodiment of the present invention, Figure 5 As shown, the propulsion control subsystem is used to set a virtual cylinder, set the extension speed and total extension stroke of the virtual cylinder when controlling the propulsion equipment to press down the segment ring. The set total extension stroke of the virtual cylinder is the set depth of the soil-excavating robot for excavating soil.
[0102] The propulsion control subsystem is also used to control the propulsion cylinder of the propulsion equipment and the opening of the set virtual cylinder, so that the set virtual cylinder is extended at a set extension speed, and the stroke sensor of each propulsion cylinder collects its current stroke in real time;
[0103] The propulsion control subsystem obtains the current stroke collected by the stroke sensor of each propulsion cylinder, compares the current stroke of each propulsion cylinder with the extension stroke of the virtual cylinder to obtain the difference, and transmits the difference to the stroke controller of each propulsion cylinder, and the stroke controller calculates the target opening degree of the proportional flow valve of the corresponding propulsion cylinder;
[0104] The propulsion control subsystem receives the target opening degree of the proportional flow valve of the corresponding propulsion cylinder calculated by the stroke controller, and then controls the proportional flow valve to execute the corresponding opening degree to dynamically adjust the extension speed of each propulsion cylinder, so that each propulsion cylinder can be extended synchronously with the virtual cylinder until it is extended to the set depth of excavation by the earth-moving robot.
[0105] Specifically, (1) a virtual cylinder is set, and its extension speed and total extension stroke (first footage) are set; (2) the propulsion control subsystem is started, the virtual cylinder is extended at a uniform speed, and the stroke sensor of each propulsion cylinder collects and feeds back its current stroke every 0.1 seconds; (3) the actual stroke of each propulsion cylinder is compared with the stroke of the virtual cylinder to obtain the difference (ΔLA~ΔLD); (4) the difference is entered into the stroke control PID controller of each propulsion cylinder to calculate the target opening degree of each proportional flow valve; (5) the propulsion control subsystem executes the target opening degree to dynamically adjust the extension speed of each cylinder, and realize the synchronous extension of each propulsion cylinder and the virtual cylinder until the extension reaches the target stroke. After completion, the propulsion control subsystem sends a completion command to the central control center.
[0106] In a specific embodiment of the present invention, the grouting control subsystem 24 reads the extension speed V (unit: m / s) of the propulsion cylinder every 0.1s. The outer diameter of the caisson structure is R1 (unit: m), and the thickness of the mud filling behind the wall is d (unit: m). Then the cumulative target grouting volume Q of each grouting point is target It can be calculated according to the following formula:
[0107]
[0108] According to the theoretical cumulative grouting volume Q target and the actual cumulative grouting volume Q actual The difference ΔQ is input into the synchronous grouting PID controller, and the target opening degree of the proportional flow valve is output. The grouting control subsystem executes the target opening degree until the first advance (first set depth) is completed. The grouting control subsystem sends a completion command to the central control center.
[0109] In a specific embodiment of the present invention, Figure 1 and Figure 7 As shown, it also includes a robot collision detection subsystem 26 connected to the central control center 21 and the soil extraction control subsystem 22;
[0110] The robot collision subsystem 26 is in operation from the time the first ring of segments is sunk until the entire caisson is sunk.
[0111] The robot collision subsystem 26 includes a modeling module, a division module, a mapping module, an acquisition module, a calculation module and a judgment module;
[0112] The modeling module is used to digitally model the soil-extracting robot, the steel blade foot ring and the cross beam to determine the zero-position posture of the soil-extracting robot;
[0113] The division module is connected to the modeling module and is used to mesh the digital modeling of the soil-extracting robot, the steel blade foot ring and the cross beam to form a corresponding number of unit bodies; the total number of unit bodies of the soil-extracting robot, the steel blade foot ring and the cross beam is N respectively. a 、N b and N c indivual;
[0114] The mapping module is connected to the modeling module, and is used to obtain the sensor data of each joint of the soil-extracting robot during its operation, drive the digital model of the soil-extracting robot through data mapping, and present the spatial state of the soil-extracting robot in the global coordinate system in real time;
[0115] The acquisition module is connected with the modeling module, the partitioning module and the mapping module, and is used to acquire and store the spatial coordinates of the center of each unit body of the soil-taking robot, the steel blade foot ring and the cross beam in the global coordinate system at the current calculation moment, which are denoted as P i , Q j and G k ;
[0116] The calculation module is connected with the modeling module, the partitioning module, the mapping module and the acquisition module to calculate all P i and Q j Distance m i-j (The number is N a ×N b ) and all P i and G k The distance ni-k (the number is Na×Nc), and the minimum value min{m i-j ,n i-k};
[0117] The judgment module is connected to the calculation module, and is used to judge that the working state of the soil-excavating robot is safe and send a safety signal to the central control center when the minimum value is greater than 10cm; to judge that the working state of the soil-excavating robot is warning and send a warning signal to the central control center when the minimum value is greater than 5cm and less than or equal to 10cm, and the central control center sends a speed reduction instruction to the soil-excavating control subsystem based on the warning signal to control the soil-excavating robot to slow down; and to judge that the working state of the soil-excavating robot is dangerous and send a danger signal to the central control center when the minimum value is greater than 0cm and less than or equal to 5cm, and the central control center sends a shutdown instruction to the soil-excavating control subsystem based on the danger signal to control the soil-excavating robot to stop working.
[0118] In a specific embodiment of the present invention, Figure 1 and Figure 6As shown, it also includes a well liquid level control subsystem 27 connected to the central control center 21. The well liquid level control subsystem 27 is in working state from the sinking of the first ring segment to the completion of the sinking of the entire caisson. Its working principle is as follows:
[0119] By installing an ultrasonic ranging sensor, the distance D to the liquid level in the well is monitored in real time. actual , if the distance is set to D target , the difference ΔD between the two is used as the input value to the well liquid level PID controller every 0.1 seconds, and the target opening degree of the proportional flow valve is dynamically output. The system executes the target opening degree to achieve the stability of the well liquid level.
[0120] The present invention also provides a fully automatic control method for a press-in mechanized caisson equipment, wherein the caisson equipment includes a soil taking robot, a propulsion device, and a synchronous grouting system, and the fully automatic control method includes the following steps:
[0121] S11, segment rings are assembled in place;
[0122] S12, controlling the soil-collecting robot to start soil-collecting work;
[0123] S13, after the soil-excavating robot reaches a set depth, controlling the propulsion device to press down the segment ring to a corresponding position;
[0124] S14, during the process of pressing down the segment ring, obtaining the target grouting amount of each grouting point, and controlling the synchronous grouting system to perform synchronous grouting according to the target grouting amount of each grouting point;
[0125] S15, controlling the soil-extracting robot to continue digging and extracting soil downwards;
[0126] S16, looping step S13 to step S15 until the current segment ring completes the sinking work;
[0127] S17, turning on the propulsion device, assembling the next segment ring above the current segment ring, and turning off the propulsion device;
[0128] S18, looping steps S12 to S17 until the sinking of all segment rings is completed.
[0129] In a specific embodiment of the present invention, the caisson equipment mainly includes a soil-excavating robot, a propulsion device, a synchronous grouting system and a liquid level balance system.
[0130] The soil-extracting robot mainly includes mechanical arms, slewing tables, slewing bearings, cutter suction pumps, variable-length cylinders, telescopic cylinders, joint cylinders, swing cylinders, clamping cylinders, etc. The soil-extracting robot is fastened to the center of the cross beam of the steel blade foot ring of the caisson through four gripping claws at the bottom.
[0131] The propulsion equipment includes four propulsion cylinders, which apply force through the contact between the end of the piston rod and the top surface of the segment ring to achieve the sinking control of the caisson structure, and can be opened during the segment assembly stage to provide sufficient operating space.
[0132] The synchronous grouting system includes n grouting points located at the top of the blade foot ring. Each grouting point is equipped with a separate pipeline and flow sensor. The slurry flow is independently controlled by a proportional flow valve, which can feedback the cumulative grouting volume.
[0133] The liquid level balance system monitors the liquid level in real time through ultrasonic sensors, and controls the mud flow rate through liquid level feedback and variable frequency speed regulation of the mud pump. The liquid level fluctuation error must be controlled within the range of ±5cm.
[0134] The fully automatic control method of the present invention can realize automatic control through the above-mentioned fully automatic control system, which includes a center and six subsystems, namely, a central control center 21, a soil taking control subsystem 22, a propulsion control subsystem 23, a grouting control subsystem 24, a well liquid level control subsystem 27, an automatic measurement subsystem 25, and a robot collision detection subsystem 26. Except for the automatic measurement subsystem 25 and the robot collision detection subsystem 26, the other four subsystems can interact with the central control center 21 in a two-way manner. The robot collision detection subsystem 26 reads the sensor data of each joint of the soil taking robot from the soil taking control subsystem, and judges the spatial distance between the soil taking robot and the steel blade foot ring and the cross beam, and gives a safety warning or an emergency stop signal to the central control center 21. The automatic measurement subsystem collects multi-source data such as equipment, caisson, and environment, and inputs measurement data to the central control center 21 in a unidirectional manner. The collected data can be realized by deploying corresponding sensors. During the operation of the propulsion equipment, the grouting control subsystem must read the propulsion speed to realize its own automatic control.
[0135] The first step, such as Figure 2 As shown, after the steel blade foot ring is placed in place, the soil-excavating robot is installed at the center of the cross beam of the steel blade foot ring; the propulsion equipment is installed and kept in an open state, and after the first ring of segments is assembled above the steel blade foot ring, the ground propulsion equipment is closed; the propulsion cylinder is extended, and after contacting the top surface of the first ring of segments, the propulsion cylinder stops extending; water is injected into the well to keep the liquid level consistent with the external ground, and the sinking preparation work of the first ring of segments is completed.
[0136] The second step is to control the soil-excavating robot to enter normal working mode.
[0137] In the normal working mode (i.e. the soil-taking robot performs soil-taking work), the soil-taking work area is divided into four quadrants according to the cross beam used to install the soil-taking robot, and each quadrant is further divided into an inner circle area and an outer circle area;
[0138] The soil-excavating robot is made to first excavate the inner circle areas of the four quadrants, and then to excavate the outer circle areas of the four quadrants. When excavating the four quadrants, a symmetrical excavation method is used for sequential excavation.
[0139] Specifically, Figure 3 As shown in the figure, after the first footage of the inner circle 1 to 4 areas is completed in sequence, the outer circle 5 to 8 areas are excavated. To ensure the efficiency of excavation and soil extraction and the safety of the equipment, the excavation depth is set to not exceed the radius of the robot's suction head each time. If the excavation depth is set too large, the suction head may be easily "covered".
[0140] After the excavation of the soil in the four-quadrant area is completed in normal mode, the caisson posture is collected once and the collected caisson posture data is judged. If it is judged that the caisson posture meets the construction requirements, the third step is entered; if the overall caisson structure is tilted to meet the correction requirements, the correction mode is entered.
[0141] like Figure 4 As shown in the figure, the correction mode is carried out in multiple steps. First, the inner circle excavation and soil excavation of the next footage are carried out in the quadrant opposite to the inclination of the caisson. If the caisson returns to its original position, the correction is completed. If the caisson does not return to its original position after the inner circle soil excavation is completed, the outer circle in the current quadrant will be excavated and soil excavated for the next footage. If the caisson returns to its original position, the correction is completed. Figure 3 As shown in the figure, if the posture return is still insufficient after the outer circle soil is taken, the next depth of soil will be taken at the four positions A to D corresponding to the inner circle under the cross beam. If the posture of the caisson returns, the deviation correction is completed; if the posture return is still insufficient after the inner circle excavation under the beam, the next depth of soil will be taken at the outer circle (E to H) under the beam. If the posture of the caisson returns, the deviation correction is completed. If the posture return is still insufficient after the outer circle soil is taken under the beam, the limit mode is entered, that is, soil taking operations are carried out under the steel blade foot ring of the corresponding quadrant until the caisson returns.
[0142] The soil-excavating robot control method of the present invention includes: clarifying the initial state of the soil-excavating robot in the global coordinate system in the three-dimensional model space; drawing the coordinate set of the motion path of the suction head in the three-dimensional model according to the above-given mode type; calculating the target motion amount of each joint of the robot according to the kinematic inverse solution method (refer to Chinese patent: Mechanized caisson excavation robot kinematic forward and inverse solution analytical method, patent application number: 202311241447.3); the soil-excavating control subsystem executes the target motion amount of each joint in a closed loop, and drives the suction head to cut the soil according to the set path. The set path of each quadrant is as follows: Figure 3 As shown, the circle with the intersection center of the cross beam as the center and the set length as the radius is the set path of the suction head of the soil-excavating robot, and the moving directions of two adjacent circles are opposite.
[0143] The third step is to control the propulsion equipment to press down the segment ring, and the synchronous grouting system to perform synchronous grouting.
[0144] When controlling the propulsion equipment, the overall downward pressure of the caisson structure is automatically controlled according to the digging depth of the earth-excavating robot.
[0145] When controlling the propulsion device to press down the segment ring, a virtual cylinder is set, and the extension speed and total extension stroke of the virtual cylinder are set. The set total extension stroke of the virtual cylinder is the set depth of the soil excavation robot for excavating soil;
[0146] Control the propulsion cylinder of the propulsion equipment and the set virtual cylinder to start, so that the set virtual cylinder is extended at a set extension speed, and the stroke sensor of each propulsion cylinder collects its current stroke in real time; real-time collection can collect the current stroke every 0.1 seconds and provide feedback, for example;
[0147] Compare the current stroke of each propulsion cylinder with the extension stroke of the virtual cylinder to obtain the difference (ΔL A ~ΔL D ), and transmit the difference to the stroke controller of each propulsion cylinder. The stroke controller calculates the target opening degree of the proportional flow valve of the corresponding propulsion cylinder, and then controls the proportional flow valve to execute the corresponding opening degree, so as to dynamically adjust the extension speed of each propulsion cylinder, so that each propulsion cylinder can be extended synchronously with the virtual cylinder until it is extended to the set depth of the soil-excavating robot.
[0148] Furthermore, the control of the synchronous grouting system includes:
[0149] The extension speed V (unit: m / s) of the ground propulsion cylinder is read every 0.1s. The outer diameter of the caisson structure is R1 (unit: m), and the thickness of the mud filling behind the wall is d (unit: m). The cumulative target grouting volume Q for each grouting point is target It can be calculated according to the following formula:
[0150]
[0151] According to the theoretical cumulative grouting volume Q target and the actual cumulative grouting volume Q actual The difference ΔQ is input into the synchronous grouting PID controller, and the target opening degree of the proportional flow valve is output. The system executes the target opening degree until the first advance is completed. The synchronous grouting control system sends a completion command to the central control center.
[0152] Step 4: Send a second advance work instruction to the soil-excavating robot, and repeat steps 2 to 4 to complete the sinking control of the caisson structure with a segment width.
[0153] Step 5: After sending an opening command to the propulsion device, the propulsion device opens, and after assembling the second ring of segments above the first ring of segments, the propulsion device is closed, and the preparations for sinking the second ring of segments are completed.
[0154] Step 6: Repeat steps 2 to 5 until the entire caisson structure completes the sinking work.
[0155] In a specific embodiment of the present invention, during the operation of the soil-extracting robot, the robot is also subjected to collision detection:
[0156] Digitally model the soil-extracting robot, steel blade foot ring and cross beam to determine the zero-position posture of the soil-extracting robot;
[0157] The digital modeling of the soil-extracting robot, the steel blade foot ring and the cross beam is meshed to form a corresponding number of unit bodies; the total number of unit bodies of the soil-extracting robot, the steel blade foot ring and the cross beam is N a 、N b and N c indivual;
[0158] During the operation of the soil-extracting robot, the sensor data of each joint of the soil-extracting robot is obtained, and the digital model of the soil-extracting robot is driven by data mapping to present the spatial state of the soil-extracting robot in the global coordinate system in real time;
[0159] Obtain and store the spatial coordinates of the center of each unit body of the soil-taking robot, steel blade foot ring and cross beam in the global coordinate system at the current calculation moment, which are denoted as P i , Q j and G k ;
[0160] Calculate all P i and Q j Distance m i-j (The number is N a ×N b ) and all P i and G k The distance ni-k (the number is Na×Nc), and the minimum value min{m i-j ,n i-k};
[0161] If the minimum value obtained is greater than 10 cm, the soil-collecting robot is judged to be in a safe working state;
[0162] If the minimum value obtained is greater than 5 cm and less than or equal to 10 cm, the working state of the soil-extracting robot is judged to be a warning, and the soil-extracting robot is controlled to slow down;
[0163] If the obtained minimum value is greater than 0 cm and less than or equal to 5 cm, the working state of the soil-extracting robot is judged to be dangerous, and the soil-extracting robot is controlled to stop working.
[0164] In a specific embodiment of the present invention, the liquid level in the well is fully controlled, including:
[0165] By installing an ultrasonic ranging sensor, the distance D to the liquid level in the well is monitored in real time. actual , if the distance is set to D target , the difference ΔD between the two is used as the input value to the well liquid level PID controller every 0.1 seconds, and the target opening degree of the proportional flow valve is dynamically output. The system executes the target opening degree to achieve the stability of the well liquid level.
[0166] The present invention is described in detail above in conjunction with the embodiments of the accompanying drawings. A person skilled in the art can make various variations of the present invention according to the above description. Therefore, certain details in the embodiments should not be construed as limiting the present invention, and the scope of protection of the present invention shall be the scope defined by the attached claims.
Claims
1. A fully automatic control method for a press-in mechanized caisson equipment, wherein the caisson equipment comprises a soil-taking robot, a propulsion device and a synchronous grouting system, characterized in that: The fully automatic control method comprises the following steps: S11, segment rings are assembled in place; S12, controlling the soil-collecting robot to start soil-collecting work; S13, after the soil-excavating robot reaches a set depth, controlling the propulsion device to press down the segment ring to a corresponding position; S14, during the process of pressing down the segment ring, obtaining the target grouting amount of each grouting point, and controlling the synchronous grouting system to perform synchronous grouting according to the target grouting amount of each grouting point; S15, controlling the soil-extracting robot to continue digging and extracting soil downwards; S16, looping step S13 to step S15 until the current segment ring completes the sinking work; S17, turning on the propulsion device, assembling the next segment ring above the current segment ring, and turning off the propulsion device; S18, looping steps S12 to S17 until the sinking of all segment rings is completed.
2. The fully automatic control method for the push-in mechanized caisson equipment according to claim 1 is characterized in that: When controlling the soil-taking robot to perform soil-taking work, the soil-taking work area is divided into four quadrants according to the cross beam used to install the soil-taking robot, and each quadrant is further divided into an inner circle area and an outer circle area; The soil-excavating robot is made to first excavate the inner circle area of the four quadrants, and then to excavate the outer circle area of the four quadrants. When excavating the four quadrants, a symmetrical excavation method is used for sequential excavation.
3. The fully automatic control method for the push-in mechanized caisson equipment according to claim 2 is characterized in that: After the soil excavation in the four quadrants is completed, collect the caisson posture and determine whether it needs to be corrected. If it is determined that correction is needed, perform the correction work: The next step of soil excavation is carried out in the inner circle area of the quadrant where the caisson is tilted in the opposite direction. If the caisson returns to its original position, the deviation correction is completed. If the caisson posture has not returned, the next soil excavation will be carried out in the outer circle area of the current quadrant. If the caisson posture returns, the correction is completed; If the caisson does not return to its original position, the next step of soil excavation will be carried out in the inner circle area below the cross beam. If the caisson returns to its original position, the deviation correction is completed. If the caisson does not return to its original position, the next step of soil excavation will be carried out in the outer circle area below the cross beam. If the caisson returns to its original position, the deviation correction is completed. If the caisson posture has not returned, the soil below the steel blade foot ring in the current quadrant is excavated until the caisson posture returns.
4. The fully automatic control method for the push-in mechanized caisson equipment according to claim 1 is characterized in that: When controlling the propulsion device to press down the segment ring, a virtual oil cylinder is set, and the extension speed and total extension stroke of the virtual oil cylinder are set. The set total extension stroke of the virtual oil cylinder is the set depth of the soil excavation robot for excavating soil; Control the propulsion cylinder of the propulsion equipment and the set virtual cylinder to start, so that the set virtual cylinder is extended at a set extension speed, and the stroke sensor of each propulsion cylinder collects its current stroke in real time; The current stroke of each propulsion cylinder is compared with the extension stroke of the virtual cylinder to calculate the difference, and the difference is transmitted to the stroke controller of each propulsion cylinder. The stroke controller calculates the target opening degree of the proportional flow valve of the corresponding propulsion cylinder, and then controls the proportional flow valve to execute the corresponding opening degree, so as to dynamically adjust the extension speed of each propulsion cylinder, so that each propulsion cylinder can be extended synchronously with the virtual cylinder until it is extended to the set depth of the soil-excavating robot for excavation.
5. The fully automatic control method for the push-in mechanized caisson equipment according to claim 1 is characterized in that: During the operation of the soil-collecting robot, collision detection is also performed on the robot: Digitally model the soil-extracting robot, steel blade foot ring and cross beam to determine the zero-position posture of the soil-extracting robot; The digital modeling of the soil-excavating robot, the steel blade foot ring and the cross beam is meshed to form a corresponding number of unit bodies; During the operation of the soil-extracting robot, the sensor data of each joint of the soil-extracting robot is obtained, and the digital model of the soil-extracting robot is driven by data mapping to present the spatial state of the soil-extracting robot in the global coordinate system in real time; Obtain and store the spatial coordinates of the center of each unit body of the soil-taking robot, steel blade foot ring and cross beam in the global coordinate system at the current calculation moment, which are denoted as P i , Q j and G k ; Calculate all P i and Q j Distance m i-j And all P i and G k The distance n i-k , and obtain the minimum value min{m i-j ,n i-k }; If the minimum value obtained is greater than 10 cm, the soil-collecting robot is judged to be in a safe working state; If the minimum value obtained is greater than 5 cm and less than or equal to 10 cm, the working state of the soil-extracting robot is judged to be a warning, and the soil-extracting robot is controlled to slow down; If the obtained minimum value is greater than 0 cm and less than or equal to 5 cm, the working state of the soil-extracting robot is judged to be dangerous, and the soil-extracting robot is controlled to stop working.
6. A fully automatic control system for a press-in mechanized caisson equipment, the caisson equipment comprising a soil-taking robot, a propulsion device and a synchronous grouting system, characterized in that: The fully automatic control system includes a central control center, a soil excavation control subsystem connected to the central control center, a propulsion control subsystem connected to the central control center, and a grouting control subsystem connected to both the central control center and the propulsion control subsystem; The central control center is used to send a work instruction to the soil extraction control subsystem after the segment ring is assembled in place, so that the soil extraction control subsystem starts and controls the soil extraction robot to start soil extraction work, and after the soil extraction robot excavates and extracts soil to a set depth, sends a completion instruction to the central control center; After receiving the completion instruction sent by the soil excavation control subsystem, the central control center sends a work instruction to the propulsion control subsystem and the grouting control subsystem, so that the propulsion control subsystem controls the propulsion equipment to press the segment ring to the corresponding position, and the grouting control subsystem obtains the target grouting amount of each grouting point during the pressing process of the segment ring, and controls the synchronous grouting system to perform synchronous grouting according to the target grouting amount of each grouting point. When completed, the propulsion control subsystem and the grouting control subsystem send a completion instruction to the central control center; The central control center sends a work instruction of the next set depth to the soil extraction control subsystem to repeat the soil extraction work, and then repeats the actions of pressing down the segment ring and synchronous grouting according to the above process until the current segment ring completes the sinking work; The central control center sends an opening command to the propulsion control subsystem to control the propulsion equipment to open. After assembling the next segment ring above the current segment ring, the propulsion equipment is controlled to close. The central control center repeats the above-mentioned segment ring sinking action until the sinking of all segment rings is completed.
7. The fully automatic control system for the push-in mechanized caisson equipment according to claim 6 is characterized in that: The soil excavation control subsystem includes a soil excavation area division module and a soil excavation action control module; The soil-excavating area division module is used to divide the soil-excavating working area into four quadrants according to the cross beam used to install the soil-excavating robot, and then divide each quadrant into an inner circle area and an outer circle area; The soil-excavating action control module is connected to the soil-excavating area division module, and is used to control the soil-excavating robot to first excavate the inner circle area of the four quadrants, and then excavate the outer circle area of the four quadrants. When excavating the four quadrants, sequential excavation is performed in a symmetrical excavation manner.
8. The fully automatic control system for the push-in mechanized caisson equipment according to claim 7 is characterized in that: The soil extraction control subsystem also includes a deviation correction execution module; The fully automatic control system also includes an automatic measurement subsystem connected to the central control center, and the automatic measurement subsystem is used to collect caisson posture data and send it to the central control center after the soil excavation in the four quadrants is completed; The central control center determines whether deviation correction is required based on the received caisson posture data, and sends a deviation correction instruction to the soil excavation control subsystem when deviation correction is required; After receiving the deviation correction instruction, the soil extraction control subsystem starts the deviation correction execution module; The deviation correction execution module is used to control the soil-excavating robot to excavate the next soil depth in the inner circle area of the quadrant where the caisson is tilted in the opposite direction. If the caisson returns to its original position, the deviation correction is completed. If the caisson posture has not returned, the next soil excavation will be carried out in the outer circle area of the current quadrant. If the caisson posture returns, the correction is completed; If the caisson does not return to its original position, the next step of soil excavation will be carried out in the inner circle area below the cross beam. If the caisson returns to its original position, the deviation correction is completed. If the caisson does not return to its original position, the next step of soil excavation will be carried out in the outer circle area below the cross beam. If the caisson returns to its original position, the deviation correction is completed. If the caisson posture has not returned, the soil below the steel blade foot ring in the current quadrant is excavated until the caisson posture returns.
9. The fully automatic control system for the push-in mechanized caisson equipment according to claim 6, characterized in that: The propulsion control subsystem is used to set a virtual cylinder when controlling the propulsion device to press down the segment ring, set the extension speed and total extension stroke of the virtual cylinder, and the set total extension stroke of the virtual cylinder is the set depth of the soil excavation robot; The propulsion control subsystem is also used to control the propulsion cylinder of the propulsion equipment and the set virtual cylinder to open, so that the set virtual cylinder is extended at a set extension speed, and the stroke sensor of each propulsion cylinder collects its current stroke in real time; The propulsion control subsystem obtains the current stroke collected by the stroke sensor of each propulsion cylinder, compares the current stroke of each propulsion cylinder with the extension stroke of the virtual cylinder to obtain the difference, and transmits the difference to the stroke controller of each propulsion cylinder, and the stroke controller calculates the target opening degree of the proportional flow valve of the corresponding propulsion cylinder; The propulsion control subsystem receives the target opening degree of the proportional flow valve of the corresponding propulsion cylinder calculated by the stroke controller, and then controls the proportional flow valve to execute the corresponding opening degree, so as to dynamically adjust the extension speed of each propulsion cylinder, so that each propulsion cylinder can be extended synchronously with the virtual cylinder until it is extended to the set depth of excavation by the soil-excavating robot.
10. The fully automatic control system for the push-in mechanized caisson equipment according to claim 6, characterized in that: It also includes a robot collision detection subsystem connected to the central control center and the soil extraction control subsystem; The robot collision subsystem includes a modeling module, a division module, a mapping module, an acquisition module, a calculation module and a judgment module; The modeling module is used to digitally model the soil-extracting robot, the steel blade foot ring and the cross beam to determine the zero-position posture of the soil-extracting robot; The division module is connected to the modeling module and is used to perform grid division on the digital modeling of the soil-excavating robot, the steel blade foot ring and the cross beam to form a corresponding number of unit bodies; The mapping module is connected to the modeling module and is used to obtain the sensor data of each joint of the soil-extracting robot during the operation of the soil-extracting robot, drive the digital model of the soil-extracting robot through data mapping, and present the spatial state of the soil-extracting robot in the global coordinate system in real time; The acquisition module is connected with the modeling module, the division module and the mapping module, and is used to acquire and store the position spatial coordinates of the center of each unit body of the soil-taking robot, the steel blade foot ring and the cross beam in the global coordinate system at the current calculation moment, which are respectively denoted as P i , Q j and G k ; The calculation module is connected with the modeling module, the partitioning module, the mapping module and the acquisition module, and is used to calculate all P i and Q j Distance m i-j And all P i and G k The distance ni-k is obtained, and the minimum value min{m i-j ,n i-k }; The judgment module is connected to the calculation module, and is used to judge that the working state of the soil-excavating robot is safe and send a safety signal to the central control center when the minimum value is greater than 10cm; to judge that the working state of the soil-excavating robot is warning and send a warning signal to the central control center when the minimum value is greater than 5cm and less than or equal to 10cm, and the central control center sends a speed reduction instruction to the soil-excavating control subsystem based on the warning signal to control the soil-excavating robot to slow down; and to judge that the working state of the soil-excavating robot is dangerous and send a danger signal to the central control center when the minimum value is greater than 0cm and less than or equal to 5cm, and the central control center sends a shutdown instruction to the soil-excavating control subsystem based on the danger signal to control the soil-excavating robot to stop working.
