RISK CONTROL METHOD AND DEVICE FOR DEMOLITION ROBOTS

DE602024004855T2Active Publication Date: 2026-05-13JIANGSU XCMG CONSTRUCTION MACHINERY RESEARCH INSTITUTE LTD
View PDF 0 Cites 0 Cited by

Patent Information

Authority / Receiving Office
DE · DE
Patent Type
Patents
Current Assignee / Owner
JIANGSU XCMG CONSTRUCTION MACHINERY RESEARCH INSTITUTE LTD
Filing Date
2024-09-26
Publication Date
2026-05-13

AI Technical Summary

Technical Problem

Demolition robots face risks of tipping and walking path issues in complex environments, which existing technologies have not adequately addressed.

Method used

A risk control method and apparatus for demolition robots that utilize real-time posture determination, neural networks for risk assessment, and adaptive path and posture adjustments to mitigate tipping and walking path risks, including re-planning paths and adjusting postures based on environmental and tipping line information.

Benefits of technology

Significantly improves the stability and safety of demolition robots in complex environments by reducing tipping and walking path risks through real-time risk assessment and adaptive control.

✦ Generated by Eureka AI based on patent content.
Patent Text Reader
Need to check novelty before this filing date? Find Prior Art

Description

TECHNICAL FIELD

[0001] The invention relates to a risk control method and apparatus for demolition robots, and belongs to the field of mechanical engineering.BACKGROUND

[0002] With the development of industrial automation and robotic technology, the use of unmanned three-arm demolition robots in complex environments is growing rapidly, particularly in situations that demand high-precision positioning, minimal energy consumption, efficiency in multi-task operations, and obstacle avoidance. In operation, the three-arm demolition robot is rarely at risk of tipping over thanks to its support legs. However, it may face tipping and walking path risks in complex environments (such as being obstructed by obstacles or falling into pits). US9475193B2 discloses systems and methods for providing a robotic vehicle with tip over prevention. The methods involve: determining a stability footprint, attitude and orientation of the robotic vehicle; computing a center of gravity of the robotic vehicle; projecting the center of gravity onto the stability footprint; determining whether the center of gravity is within an acceptable region of the stability footprint; calculating a new desired configuration for a movable component of the robotic vehicle when a determination is made that the center of gravity is within the acceptable region of the stability footprint; and commanding the movable component to the new desired configuration. CA3049695C discloses a multi-terrain inspection robotic device and methods for configuring and guiding the same. MEGHDARI ET AL ("Neural-network-based observer for real-time tipover estimation", MECHATRONICS, PERGAMON PRESS, OXFORD, GB, vol. 15, no. 8, 1 October 2005, pages 989-1004) disclose a neural-network-based algorithm that enables autonomous mobile manipulator to detect its instable situations. LUPOY MARK LAWRENCE D ET AL ("Design and implementation of an intelligent monitoring system for real-time tip-over assessment of mobile manipulator", 2022 IEEE 14TH INTERNATIONAL CONFERENCE ON HUMANOID, NANOTECHNOLOGY, INFORMATION TECHNOLOGY, COMMUNICATION AND CONTROL, ENVIRONMENT, AND MANAGEMENT (HNICEM), IEEE, 1 December 2022, pages 1-6) discloses a real-time tip-over monitoring system that can be applied to avoid a mobile manipulator tip-over.SUMMARY

[0003] The invention provides a risk control method and apparatus for demolition robots, solving the problems disclosed in the background art.

[0004] According to one aspect of the disclosure, a risk control method for demolition robots is provided, comprising a first method implemented in real time during a walking process of a demolition robot, wherein the first method comprises: determining a posture of the demolition robot and corresponding posture parameters according to posture information of the demolition robot; according to the posture parameters, the posture information and environmental information of the demolition robot, using a trained neural network to determine a risk category associated with the demolition robot; in response to the risk category comprising solely walking path risks, re-planning a walking path according to the environmental information of the demolition robot, and controlling the demolition robot according to the re-planned walking path; in response to the risk category being comprising tipping risks, determining a tipping direction of the demolition robot according to the posture information of the demolition robot and a tipping line, and adjusting the posture of the demolition robot according to the tipping direction; and in response to the risk category comprising tipping risks and walking path risks, determining a tipping direction of the demolition robot according to the posture information of the demolition robot and a tipping line, adjusting the posture of the demolition robot according to the tipping direction, re-planning a walking path according to the environmental information of the demolition robot after the tipping risks are removed, and controlling the demolition robot according to the re-planned walking path.

[0005] In some embodiments of the disclosure, the risk control method for demolition robots further comprises a second method implemented in real time in operation of the demolition robot, wherein the second method comprises: determining a posture of the demolition robot according to posture information of the demolition robot; determining whether the demolition robot has tipping risks according to the posture of the demolition robot, the posture information of the demolition robot and the tipping line; and in response to the presence of tipping risks, determining the tipping direction of the demolition robot according to the posture information of the demolition robot and the tipping line, and adjusting the posture of the demolition robot according to the tipping direction.

[0006] In some embodiments of the disclosure, determining the tipping direction of the demolition robot according to the posture information of the demolition robot and the tipping line comprises: according to tipping angles on tipping lines in the posture information, calculating the probability that each tipping angle exceeds a corresponding angle threshold; and according to a tipping line corresponding to a maximum probability, determining the tipping direction of the demolition robot.

[0007] In some embodiments of the disclosure, the risk control method for demolition robots further comprises a third method for implementing an emergency stop in operation or during the walking process of the demolition robot, wherein the third method comprises: determining a posture of the demolition robot according to posture information of the demolition robot; determining whether the demolition robot has tipping risks according to the posture of the demolition robot, the posture information of the demolition robot during the emergency stop and the tipping line; and in response to the presence of tipping risks, determining the tipping direction of the demolition robot according to the posture information of the demolition robot during the emergency stop, and adjusting the posture of the demolition robot according to the tipping direction.

[0008] In some embodiments of the disclosure, determining whether the demolition robot has tipping risks comprises: calculating a stability coefficient of the demolition robot according to a moment arm length between a center of mass of components of the demolition robot in the posture information and a corresponding tipping line, the stability coefficient of the demolition robot being a ratio of a stabilizing moment of the demolition robot to a tipping moment, and the corresponding tipping line being a tipping line corresponding to the posture of the demolition robot; and in response to the stability coefficient of the demolition robot being less than a stability threshold, determining that the demolition robot has tipping risks.

[0009] In some embodiments of the disclosure, a formula for calculating the stability coefficient of the demolition robot is: K = M 1 / M 0 ; M 1 = G 7 × L 7 + G 6 × L 6 + G 5 × L 5 + G 3 × L 3 + G 2 × L 2 + G 1 × L 1 ; M 0 = G 4 × L 4 ; where K is the stability coefficient of the demolition robot, M1 is the stabilizing moment of the demolition robot, M0 is the tipping moment of the demolition robot, G7-G1 represent gravitational forces of a cabin, a mechanical arm, a hydraulic system, an electrical system, a power system, a rotary platform and a tracked chassis of the demolition robot respectively, and L7-L1 represent a distance between a center of mass of the cabin and the corresponding tipping line, a distance between a center of mass of the mechanical arm and the corresponding tipping line, a distance between a center of mass of the hydraulic system and the corresponding tipping line, a distance between a center of mass of the electrical system and the corresponding tipping line, a distance between a center of mass of the power system and the corresponding tipping line, a distance between a center of mass of the rotary platform and the corresponding tipping line, and a distance between a center of mass of the tracked chassis and the corresponding tipping line respectively.

[0010] In some embodiments of the disclosure, determining the posture of the demolition robot and the corresponding posture parameters according to the posture information of the demolition robot comprises: calculating front and rear height differences of tracks on two sides at the same moment in the posture information; in response to the front and rear height differences of the tracks on two sides being both greater than 0 and greater than a first height difference threshold, determining that the demolition robot is in an uphill posture, the front and rear height differences of the tracks on two sides being parameters for the uphill posture; in response to the front and rear height differences of the tracks on two sides being both less than 0 and less than a negative value of the first height difference threshold, determining that the demolition robot is in a downhill posture, the front and rear height differences of the tracks on two sides being parameters for the downhill posture; calculating a height difference between a left track and a right track at the same moment in the posture information; in response to the height difference between the left track and the right track being greater than a second height difference threshold, determining that the demolition robot is in a tilted posture, the height difference between the left track and the right track being a parameter for the tilted posture; and in response to the front and rear height differences of the tracks on two sides being within the range of the first threshold and the negative value of the first threshold, and the height difference between the left track and the right track being not greater than the second height difference threshold, determining that the demolition robot is in a horizontal posture, a parameter for the horizontal posture being 0.

[0011] According to another aspect of the disclosure, a risk control apparatus for demolition robots is provided, comprising a first apparatus configured to work in real time during a walking process of a demolition robot, wherein the first apparatus comprises: a working condition module configured to determine a posture of the demolition robot and corresponding posture parameters according to posture information of the demolition robot; a risk category module configured to, according to the posture parameters, the posture information and environmental information of the demolition robot, use a trained neural network to determine a risk category associated with the demolition robot; a path planning module configured to, in response to the risk category comprising solely walking path risks, re-plan a walking path according to the environmental information of the demolition robot, and control the demolition robot according to the re-planned walking path; a stability control module configured to, in response to the risk category comprising solely tipping risks, determine a tipping direction of the demolition robot according to the posture information of the demolition robot and a tipping line, and adjust the posture of the demolition robot according to the tipping direction; and a sequential control module configured to, in response to the risk category comprising tipping risks and walking path risks, determine a tipping direction of the demolition robot according to the posture information of the demolition robot and a tipping line, adjust the posture of the demolition robot according to the tipping direction, re-plan a walking path according to the environmental information of the demolition robot after the tipping risks are removed, and control the demolition robot according to the re-planned walking path.

[0012] According to another aspect of the disclosure, a computer-readable storage medium is provided, wherein the computer-readable storage medium stores one or more programs, and the one or more programs comprise instructions which, when executed by a computing device, cause the computing device to implement the risk control method for demolition robots.

[0013] According to another aspect of the disclosure, a computer device is provided, comprising one or more processors and one or more memories, wherein one or more programs are stored in the one or more memories and configured to be executed by the one or more processors, and the one or more programs comprise instructions for implementing the risk control method for demolition robots.

[0014] Beneficial effects: During the walking process of a demolition robot, working conditions are determined according to posture information of the demolition robot. A neural network is employed to assess risk categories. When only walking path risks are present, a walking path is re-planned. If only tipping risks are identified, a tipping direction of the demolition robot is determined, and a posture of the demolition robot is adjusted according to the tipping direction. In cases where both walking path risks and tipping risks exist, priority is given to address the tipping risks, followed by the walking path risks. This approach reduces the tipping and walking path risks faced by the demolition robot walking in complex environments, thereby significantly improving the stability and safety of the demolition robot in complex environments.BRIEF DESCRIPTION OF THE DRAWINGS

[0015] Fig. 1 is a flowchart of a first method in a risk control method for demolition robots; Fig. 2 is a schematic diagram of a tipping line; Fig. 3 is a flowchart of a second method in a risk control method for demolition robots; Fig. 4 is a schematic diagram of moments in a horizontal posture; and Fig. 5 is a flowchart of a third method in a risk control method for demolition robots. DETAILED DESCRIPTION OF THE EMBODIMENTS

[0016] The technical schemes in the embodiments of the disclosure are clearly and completely described in the following with reference to the drawings in the embodiments of the disclosure. It is obvious that the described embodiments are only illustrative ones and are not all possible ones of the disclosure. The description of at least one exemplary embodiment below is only illustrative, and in no way should it be taken as any limitation on the disclosure, its application or uses. Based on the embodiments of the disclosure, all other embodiments obtained by those of ordinary skill in the art without creative labor also fall within the scope of the disclosure.

[0017] The relative arrangement, numerical expressions and numerical values of components and steps set forth in these embodiments do not limit the scope of the disclosure unless otherwise specified.

[0018] Meanwhile, it should be understood that for convenience of description, the dimensions of various parts shown in the drawings are not drawn according to the actual proportional relationship.

[0019] Techniques, methods and devices known to those skilled in the relevant fields may not be discussed in detail, but they should be regarded as part of the specification under appropriate circumstances.

[0020] In all examples shown and discussed herein, any specific values should be interpreted as illustrative only and not as a limitation. Therefore, other examples of exemplary embodiments may have different values.

[0021] It should be noted that similar reference numerals and letters indicate similar items in the following figures, so once an item is defined in one figure, it will not be further discussed in the following figures.

[0022] To address the risk issues associated with demolition robots in a complex environment, the disclosure proposes a risk control method for demolition robots, which specifically comprises a first method implemented in real time during the walking process of a demolition robot, a second method implemented in real time in operation of the demolition robot, and a third method for implementing an emergency stop in operation or during the walking process of the demolition robot.

[0023] Fig. 1 is a schematic diagram of an embodiment of the first method of the disclosure, which can be executed by an on-board controller of the demolition robot, and the method is implemented in real time during the walking process of the demolition robot.

[0024] As shown in Fig. 1, step 1 of the embodiment involves determining a posture of the demolition robot according to posture information of the demolition robot.

[0025] It should be noted that the posture information is used to reflect the posture of the demolition robot, which may include a height of tracks, a tipping angle on a tipping line, a moment arm length from the center of mass of components to a corresponding tipping line, etc. Here, height information may be collected by a laser radar installed on a rotary platform connected with a track chassis, and the height of tracks can be obtained according to a collected height and calibrated heights of the track chassis and the rotary platform; the tipping angle is collected by tipping sensors, which are respectively installed in the oblique, lateral and longitudinal directions of the track chassis; and the moment arm length can also be collected by a rotatable laser radar, which measures a distance from the center of mass to a designated point on the tipping line, and then calculates the moment arm length according to a rotation angle of the laser radar.

[0026] It should be noted that in the scenario, the posture of the demolition robot mainly includes uphill, downhill, tilted, and horizontal positions. Since the risks and control associated with different postures vary, in order to ensure accurate control, the process of determining the posture of the demolition robot can be as follows in some embodiments: (1) calculating front and rear height differences of tracks on two sides at the same moment in the posture information, which can be expressed as: Δh = h 1 − h 2 ; where △h is the front and rear height difference of the same track, and h1 and h2 are the heights of the front and rear of the same track respectively; (2) in response to the front and rear height differences of the tracks on two sides being both greater than 0 and greater than a first height difference threshold, determining that the demolition robot is in an uphill posture, the front and rear height differences of the tracks on two sides being parameters for the uphill posture; uphill posture = Yes Δh > 0 , Δh > first height difference threshold No otherwise ; where the first height difference threshold may be 60 cm, and the front and rear height differences of the tracks on two sides may be used as parameters for the uphill posture; in response to the front and rear height differences of the tracks on two sides being both less than 0 and less than a negative value of the first height difference threshold, determining that the demolition robot is in a downhill posture, the front and rear height differences of the tracks on two sides being parameters for the downhill posture; (3) calculating a height difference between a left track and a right track at the same moment in the posture information, which can be expressed as: ΔH = H 1 − H 2 ; where △H is the height difference between the left track and the right track, and H1 and H2 are the height of the left track and the height of the right track respectively; (4) in response to the height difference between the left track and the right track being greater than a second height difference threshold, determining that the demolition robot is in a tilted posture, which can be expressed as: tilted posture = Yes ΔH > second height difference threshold No otherwise ; where the second height difference threshold may be 40 cm, and the height difference between the left track and the right track may be used as a parameter for the tilted posture; (5) in response to the front and rear height differences of the tracks on two sides being within the range of the first threshold and the negative value of the first threshold, and the height difference between the left track and the right track being not greater than the second height difference threshold, determining that the demolition robot is in a horizontal posture, a parameter for the horizontal posture being 0.

[0027] Returning to Fig. 1, step 2 of the embodiment involves, according to posture parameters, posture information and environmental information of the demolition robot, using a trained neural network to determine risk categories associated with the demolition robot.

[0028] It should be noted that the neural network here may utilize a ResNet50 deep learning model. Before inputting parameters and information into the model, the posture parameters and posture information first undergo filtering and normalization. The environmental information, primarily consisting of captured video images, is first denoised and resized to a standard dimension of 224x224 pixels. The preprocessed data are then input into the model to obtain the risk categories associated with the demolition robot. For instance, the trend of changes in the posture of the demolition robot can be obtained according to the posture parameters and posture information, allowing for the assessment of potential tipping risks. Additionally, key visual information, such as surrounding terrain and obstacles, can be derived from the video images to determine the presence of walking path risks.

[0029] Returning to Fig. 1, step 3 of the embodiment involves, in response to a risk category being solely walking path risks, re-planning a walking path according to the environmental information of the demolition robot, and controlling the demolition robot according to the re-planned walking path.

[0030] It should be noted that the environmental information (i.e. video images) often includes terrain, obstacle position, slope information, etc. In response to the presence of walking path risks, path planning can be carried out again according to the information.

[0031] Path planning is a multi-objective optimization problem, and an objective function can be defined, which comprehensively considers multiple goals during the walking process of the demolition robot, including high-precision positioning, minimal energy consumption and safe obstacle avoidance. By defining a function for the multi-objective optimization problem, which is expressed through a mathematical model, and employing a multi-objective optimization algorithm, optimal or near-optimal solutions can be found.

[0032] Let the objective function be F(x), where x represents decision variables related to the walking of the demolition robot, including path planning parameters, speed control parameters, and so on. Using the multi-objective optimization algorithm, a solution set can be found to minimize the value of the objective function (cost function) while satisfying the constraints of the objective function. This solution set may contain multiple solutions, each representing a potential walking strategy for the demolition robot. By analyzing the solution set, the optimal or near-optimal solution can be identified, providing support and guidance for path planning.

[0033] For example, F(x)=f1(x)+ f2(x)+f3(x); where f1(x)=k1× (actual accuracy-target accuracy) 2< , f2(x)=k2× energy consumption, f3(x)=k3× (obstacle avoidance safety distance-safety distance threshold), k1-k3 are weight coefficients used to adjust the priority of different goals, f1(x) represents an accuracy cost, and f2(x) denotes an energy consumption cost; the energy consumption cost specifically depends on the driving method of the demolition robot; if it is electrically driven, the energy consumption cost is the product of electric energy consumption and electric energy cost, and if it is fuel-driven, the energy consumption cost is the product of fuel consumption and fuel cost; and f3(x) represents an obstacle avoidance cost, indicating the safety loss of the demolition robot in the obstacle avoidance process. Here, the safe distance threshold is generally 70 cm.

[0034] Returning to Fig. 1, step 4 of the embodiment involves, in response to a risk category being solely tipping risks, determining a tipping direction of the demolition robot according to the posture information of the demolition robot and a tipping line, and adjusting the posture of the demolition robot according to the tipping direction.

[0035] It should be noted that the demolition robot tips over along a certain tipping line, which refers to the axis around which the entire vehicle rotates during a tipping situation.

[0036] According to existing knowledge, the tipping lines primarily include longitudinal tipping lines, lateral tipping lines, and oblique tipping lines. The longitudinal tipping lines include an intersection of a vertical plane where centers of front walking wheels on both sides of the track chassis are located with the ground, as well as an intersection of a vertical plane where centers of rear walking wheels on both sides with the ground. The lateral tipping lines include an intersection of a vertical plane where walking wheels on one side of the track chassis are located with the ground, and an intersection of a vertical plane where walking wheels on the other side of the track chassis are located with the ground. The oblique tipping lines are intersections of vertical planes where intersection points parallel to a diagonal are located with the ground, the diagonal is defined by a quadrilateral formed by all the longitudinal and lateral tipping lines, and the intersection points are where the longitudinal and lateral tipping lines cross. The arrangement of the tipping lines can be seen in Fig. 2, which shows two longitudinal tipping lines, two lateral tipping lines, and four oblique tipping lines.

[0037] It should be noted that determining the tipping direction means determining a tipping line with the maximum probability of tipping over for the demolition robot, so in some embodiments, the specific process of determining the tipping direction of the demolition robot may comprise: (41) according to tipping angles on tipping lines in the posture information, calculating the probability that each tipping angle exceeds a corresponding angle threshold; it should be noted that assuming there are a total of N tipping lines, where N=8, the tipping angles on each tipping line are represented as θ 1 -θ N , the corresponding angle thresholds for each tipping line are denoted as [θ 1 ]-[θ N ] (the angle threshold is generally 30°), and the probability distribution of the tipping angles on each tipping line may be expressed as P(θ i ), where i = 1, 2, ..., N; the tipping line with the maximum probability of occurrence and the greatest risk is determined by comparing the probabilities of each tipping line exceeding the angle threshold; let the maximum probability of exceeding the angle threshold be P max , expressed as: P max = max P θ 1 > θ 1 , P θ 2 > θ 2 , … , P θ N > θ N ; the tipping line corresponding to P max is the most dangerous tipping line, meaning that the demolition robot is very likely to tip over along this line; (42) according to a tipping line corresponding to a maximum probability, determining the tipping direction of the demolition robot.

[0038] It should be noted that after the most dangerous tipping line is determined, the tipping direction with the maximum probability will be known.

[0039] To prevent tipping, the posture of the demolition robot can be adjusted according to the tipping direction, specifically by controlling a mechanical arm. For example, if the demolition robot is likely to tip over along longitudinal tipping line 1, the mechanical arm should be retracted; if the demolition robot is likely to tip over along longitudinal tipping line 2, the mechanical arm should be extended forward. Adjustments are primarily made through the movement of the mechanical arm to modify the moment. For instance, in a three-segment mechanical arm structure, the connections between a vehicle body and a first segment, the first segment and a second segment, the second segment and a third segment, as well as the third segment and an end effector, are all realized through cylinders. The extension and retraction of the cylinders lead to changes in posture and further adjustments of the moments. This is an ongoing adjustment process (a relatively standard procedure, which will not be described in detail here) until the demolition robot is free from tipping risks.

[0040] Returning to Fig. 1, step 5 of the embodiment involves, in response to a risk categories comprising tipping risks and walking path risks, determining a tipping direction of the demolition robot according to the posture information of the demolition robot and a tipping line, adjusting the posture of the demolition robot according to the tipping direction, re-planning a walking path according to the environmental information of the demolition robot after the tipping risks are removed, and controlling the demolition robot according to the re-planned walking path.

[0041] According to the above method, during the walking process of a demolition robot, a posture of the demolition robot is determined according to posture information of the demolition robot. A neural network is employed to assess risk categories. When only walking path risks are present, a walking path is re-planned. If only tipping risks are identified, a tipping direction of the demolition robot is determined, and a posture of the demolition robot is adjusted according to the tipping direction. In cases where both walking path risks and tipping risks exist, priority is given to address the tipping risks, followed by the walking path risks. This approach reduces the tipping and walking path risks faced by the demolition robot walking in complex environments, thereby significantly improving the stability and safety of the demolition robot in complex environments.

[0042] It should be noted that apart from walking, the demolition robot will also carry out operations in the scenario, mainly including demolition operations, stone turning operations, and excavation tasks. During these operations, the demolition robot extends its surrounding support legs to ensure stability throughout the process.

[0043] However, if a particular support leg consistently bears a significant load during prolonged operations, it will greatly reduce the lifespan of the support leg. Therefore, the disclosure also introduces a second method implemented in real time in operation of the demolition robot.

[0044] Fig. 3 is a schematic diagram of an embodiment of the second method of the disclosure, which can be executed by an on-board controller of the demolition robot.

[0045] As shown in Fig. 3, S1 of the embodiment involves determining a posture of the demolition robot according to posture information of the demolition robot.

[0046] It should be noted that the posture determination process is the same as that in the first method, which will not be repeated here.

[0047] Returning to Fig. 3, S2 of the embodiment involves determining whether the demolition robot has tipping risks according to the posture of the demolition robot, the posture information of the demolition robot and the tipping line.

[0048] It should be noted that the tipping risk here refers to the tendency to tip over to one side of the demolition robot, indicating that the support leg on that side is under significant stress and needs adjustment.

[0049] Since the support legs support the demolition robot, the assessment can be directly based on moments, and the specific process may be as follows: (S21) calculating a stability coefficient of the demolition robot according to a moment arm length between a center of mass of components of the demolition robot in the posture information and a corresponding tipping line, the corresponding tipping line being a tipping line corresponding to the posture of the demolition robot; the center of mass of components of the demolition robot can be seen in Figs. 4 and 5, from which it can be seen that the corresponding tipping lines are different in different postures; Fig. 4 shows a horizontal posture, so the corresponding tipping line is longitudinal tipping line 1; the tipping line corresponding to the uphill posture is longitudinal tipping line 2; other postures correspond to different tipping lines; for example, the downhill posture corresponds to longitudinal tipping line 1, and tipping to one side corresponds to a lateral tipping line; the stability coefficient of the demolition robot may be a ratio of a stabilizing moment of the demolition robot to a tipping moment, which can be as follows: K = M 1 / M 0 ; M 1 = G 7 × L 7 + G 6 × L 6 + G 5 × L 5 + G 3 × L 3 + G 2 × L 2 + G 1 × L 1 ; M 0 = G 4 × L 4 ; where K is the stability coefficient of the demolition robot, M1 is the stabilizing moment of the demolition robot, M0 is the tipping moment of the demolition robot, G7-G1 represent gravitational forces of a cabin, a mechanical arm, a hydraulic system, an electrical system, a power system, a rotary platform and a track chassis of the demolition robot respectively, and L7-L1 represent a distance between a center of mass of the cabin and the corresponding tipping line, a distance between a center of mass of the mechanical arm and the corresponding tipping line, a distance between a center of mass of the hydraulic system and the corresponding tipping line, a distance between a center of mass of the electrical system and the corresponding tipping line, a distance between a center of mass of the power system and the corresponding tipping line, a distance between a center of mass of the rotary platform and the corresponding tipping line, and a distance between a center of mass of the track chassis and the corresponding tipping line respectively; (S22) in response to the stability coefficient of the demolition robot being less than a stability threshold (generally 1.15), determining that the demolition robot has tipping risks.

[0050] Returning to Fig. 3, S3 of the embodiment involves, in response to the presence of tipping risks, determining the tipping direction of the demolition robot according to the posture information of the demolition robot and the tipping line, and adjusting the posture of the demolition robot according to the tipping direction.

[0051] It should be noted that the method for determining the tipping direction of the demolition robot and the adjustment method are consistent with those in the first method, which will not be repeated here.

[0052] According to the above method, in operation of a demolition robot, a posture of the demolition robot is determined according to posture information of the demolition robot. The presence of tipping risks is assessed based on the stabilizing moment and tipping moment, and the tipping direction of the demolition robot is determined when tipping risks are present. The posture of the demolition robot is then adjusted according to the tipping direction, thereby regulating the force on the support legs and reducing the risk of damage. This significantly improves the stability and safety of the demolition robot in complex environments.

[0053] It should be noted that during the walking and operation processes, the demolition robot may encounter emergencies, such as component failures, oil leaks, or low battery levels. In such cases, a remote control will issue an emergency stop command. At this point, the demolition robot may face a tipping risk due to inertia; for instance, if it suddenly stops while moving forward, it may tip forward. Therefore, the disclosure also introduces a third method for implementing an emergency stop in operation or during the walking process of the demolition robot.

[0054] Fig. 5 is a schematic diagram of an embodiment of the third method of the disclosure, which can be executed by an on-board controller of the demolition robot.

[0055] As shown in Fig. 5, A1 of the embodiment involves determining a posture of the demolition robot according to posture information of the demolition robot.

[0056] It should be noted that the posture determination process is the same as that in the first method, which will not be repeated here.

[0057] Returning to Fig. 5, A2 of the embodiment involves determining whether the demolition robot has tipping risks according to the posture of the demolition robot, the posture information of the demolition robot during the emergency stop and the tipping line.

[0058] It should be noted that the specific process of this step is the same as that in the second method, which will not be repeated here.

[0059] Returning to Fig. 5, A3 of the embodiment involves, in response to the presence of tipping risks, determining the tipping direction of the demolition robot according to the posture information of the demolition robot during the emergency stop, and adjusting the posture of the demolition robot according to the tipping direction.

[0060] It should be noted that tipping may occur due to inertia during an emergency stop. Therefore, it is only necessary to know the posture at the time of the emergency stop to determine the corresponding tipping line and direction. Taking the example of an emergency stop while moving forward, the tipping direction would be forward, with the corresponding tipping line being longitudinal tipping line 1.

[0061] It should be noted that the adjustment methods are consistent with those in the first method, which will not be repeated here.

[0062] According to the above method, during an emergency stop of a demolition robot, a posture of the demolition robot is determined according to posture information of the demolition robot. The presence of tipping risks is assessed based on the stabilizing moment and tipping moment, and the tipping direction of the demolition robot is determined when tipping risks are present. The posture of the demolition robot is then adjusted according to the tipping direction, thereby ensuring stability during an emergency stop. This significantly improves the stability and safety of the demolition robot in complex environments.

[0063] The disclosure also provides a virtual apparatus corresponding to the above method, namely a risk control apparatus for demolition robots, which can be loaded and executed by an on-board controller of the demolition robot, and specifically comprises a first apparatus working in real time during the walking process of a demolition robot, a second apparatus working in real time in operation of the demolition robot and a third apparatus for implementing an emergency stop in operation or during the walking process of the demolition robot.

[0064] The first apparatus comprises a working condition module, a risk category module, a path planning module and a stability control module.

[0065] The working condition module in this embodiment is configured to determine a posture of the demolition robot according to posture information of the demolition robot.

[0066] The risk category module in this embodiment is configured to, according to posture parameters, posture information and environmental information of the demolition robot, use a trained neural network to determine risk categories associated with the demolition robot.

[0067] The path planning module in this embodiment is configured to, in response to a risk category being solely walking path risks, re-plan a walking path according to the environmental information of the demolition robot, and control the demolition robot according to the re-planned walking path.

[0068] The stability control module in this embodiment is configured to, in response to a risk category being solely tipping risks, determine a tipping direction of the demolition robot according to the posture information of the demolition robot and a tipping line, and adjust the posture of the demolition robot according to the tipping direction.

[0069] The second apparatus comprises a working condition module, a risk assessment module and a first posture adjustment module.

[0070] The working condition module in this embodiment is configured to determine a posture of the demolition robot according to posture information of the demolition robot.

[0071] The risk assessment module in this embodiment is configured to determine whether the demolition robot has tipping risks according to the posture of the demolition robot, the posture information of the demolition robot and the tipping line.

[0072] The first posture adjustment module in this embodiment is configured to, in response to the presence of tipping risks, determine the tipping direction of the demolition robot according to the posture information of the demolition robot and the tipping line, and adjust the posture of the demolition robot according to the tipping direction.

[0073] The third apparatus comprises a working condition module, a risk assessment module and a second posture adjustment module.

[0074] The working condition module in this embodiment is configured to determine a posture of the demolition robot according to posture information of the demolition robot.

[0075] The risk assessment module in this embodiment is configured to determine whether the demolition robot has tipping risks according to the posture of the demolition robot, the posture information of the demolition robot during the emergency stop and the tipping line.

[0076] The second posture adjustment module in this embodiment is configured to, in response to the presence of tipping risks, determine the tipping direction of the demolition robot according to the posture information of the demolition robot during the emergency stop, and adjust the posture of the demolition robot according to the tipping direction.

[0077] The above apparatus ensures the stability of the demolition robot during walking, operation, and emergency stops, effectively improving the stability and safety of the demolition robot in complex environments.

[0078] Based on the same technical scheme, the disclosure also relates to a computer-readable storage medium, the computer-readable storage medium stores one or more programs, and the one or more programs comprise instructions which, when executed by a computing device, cause the computing device to implement the risk control method for demolition robots.

[0079] Based on the same technical scheme, the disclosure also relates to a computer device, comprising one or more processors and one or more memories, wherein one or more programs are stored in the one or more memories and configured to be executed by the one or more processors, and the one or more programs comprise instructions for implementing the risk control method for demolition robots.

[0080] It should be understood by those skilled in the art that the embodiments of the invention can be provided as methods, systems, or computer program products. Therefore, the invention may take the form of an entirely hardware embodiment, an entirely software embodiment, or an embodiment combining software and hardware aspects. Furthermore, the invention may take the form of a computer program product implemented on one or more computer usable storage media (including but not limited to magnetic disk memory, CD-ROM, optical memory, etc.) having computer usable program code embodied therein.

[0081] The invention is described with reference to flowcharts / or block diagrams of the method, device (system), and computer program product according to the embodiments of the invention. It should be understood that each flow and / or block in the flowcharts and / or block diagrams, and combinations of flows and / or blocks in the flowcharts and / or block diagrams, may be implemented by computer program instructions. These computer program instructions may be provided to a processor of a general purpose computer, special purpose computer, embedded processor, or other programmable data processing apparatus to produce a machine, such that the instructions executed by the processor of the computer or other programmable data processing apparatus produce a device for implementing the functions specified in one or more flows in the flowcharts and / or one or more blocks in the block diagrams.

[0082] These computer program instructions may also be stored in a computer-readable memory which can direct a computer or other programmable data processing apparatus to function in a particular manner, such that the instructions stored in the computer-readable memory produce an article of manufacture including an instruction device which implements the functions specified in one or more flows in the flowcharts and / or one or more blocks in the block diagrams.

[0083] These computer program instructions may also be loaded onto a computer or other programmable data processing apparatus such that a series of operational steps are performed on the computer or other programmable apparatus to produce a computer implemented process, and the instructions executed on the computer or other programmable apparatus provide steps for implementing the functions specified in one or more flows in the flowcharts / or one or more blocks in the block diagrams.

Claims

1. A risk control method for demolition robots, comprising a first method implemented in real time during a walking process of a demolition robot, wherein the first method comprises: determining a posture of the demolition robot and corresponding posture parameters according to posture information of the demolition robot; characterized in that the first method further comprises: according to the posture parameters, the posture information and environmental information of the demolition robot, using a trained neural network to determine a risk category associated with the demolition robot; in response to the risk category comprising solely walking path risks, re-planning a walking path according to the environmental information of the demolition robot, and controlling the demolition robot according to the re-planned walking path; in response to the risk category comprising solely tipping risks, determining a tipping direction of the demolition robot according to the posture information of the demolition robot and a tipping line, and adjusting the posture of the demolition robot according to the tipping direction; and in response to the risk category comprising tipping risks and walking path risks, determining a tipping direction of the demolition robot according to the posture information of the demolition robot and a tipping line, adjusting the posture of the demolition robot according to the tipping direction, re-planning a walking path according to the environmental information of the demolition robot after the tipping risks are removed, and controlling the demolition robot according to the re-planned walking path.

2. The risk control method for demolition robots according to claim 1, further comprising a second method implemented in real time in operation of the demolition robot, wherein the second method comprises: determining the posture of the demolition robot according to the posture information of the demolition robot; determining whether the demolition robot has tipping risks according to the posture of the demolition robot, the posture information of the demolition robot and the tipping line; and in response to the presence of tipping risks, determining the tipping direction of the demolition robot according to the posture information of the demolition robot and the tipping line, and adjusting the posture of the demolition robot according to the tipping direction.

3. The risk control method for demolition robots according to claim 1 or 2, wherein determining the tipping direction of the demolition robot according to the posture information of the demolition robot and the tipping line comprises: according to tipping angles on tipping lines in the posture information, calculating the probability that each tipping angle exceeds a corresponding angle threshold; and according to a tipping line corresponding to a maximum probability, determining the tipping direction of the demolition robot.

4. The risk control method for demolition robots according to claim 1, further comprising a third method for implementing an emergency stop in operation or during the walking process of the demolition robot, wherein the third method comprises: determining the posture of the demolition robot according to the posture information of the demolition robot; determining whether the demolition robot has tipping risks according to the posture of the demolition robot, the posture information of the demolition robot during the emergency stop and the tipping line; and in response to the presence of tipping risks, determining the tipping direction of the demolition robot according to the posture information of the demolition robot during the emergency stop, and adjusting the posture of the demolition robot according to the tipping direction.

5. The risk control method for demolition robots according to claim 2 or 4, wherein determining whether the demolition robot has tipping risks comprises: calculating a stability coefficient of the demolition robot according to a moment arm length between a center of mass of components of the demolition robot in the posture information and a corresponding tipping line, the stability coefficient of the demolition robot being a ratio of a stabilizing moment of the demolition robot to a tipping moment, and the corresponding tipping line being a tipping line corresponding to the posture of the demolition robot; and in response to the stability coefficient of the demolition robot being less than a stability threshold, determining that the demolition robot has tipping risks.

6. The risk control method for demolition robots according to claim 5, wherein a formula for calculating the stability coefficient of the demolition robot is: K = M 1 / M 0 ; M 1 = G 7 × L 7 + G 6 × L 6 + G 5 × L 5 + G 3 × L 3 + G 2 × L 2 + G 1 × L 1 ; M 0 = G 4 × L 4 ; where K is the stability coefficient of the demolition robot, M1 is the stabilizing moment of the demolition robot, M0 is the tipping moment of the demolition robot, G7-G1 represent gravitational forces of a cabin, a mechanical arm, a hydraulic system, an electrical system, a power system, a rotary platform and a track chassis of the demolition robot respectively, and L7-L1 represent a distance between a center of mass of the cabin and the corresponding tipping line, a distance between a center of mass of the mechanical arm and the corresponding tipping line, a distance between a center of mass of the hydraulic system and the corresponding tipping line, a distance between a center of mass of the electrical system and the corresponding tipping line, a distance between a center of mass of the power system and the corresponding tipping line, a distance between a center of mass of the rotary platform and the corresponding tipping line, and a distance between a center of mass of the track chassis and the corresponding tipping line respectively.

7. The risk control method for demolition robots according to claim 1, 2 or 4, wherein determining the posture of the demolition robot and the corresponding posture parameters according to the posture information of the demolition robot comprises: calculating front and rear height differences of tracks on two sides at the same moment in the posture information; in response to the front and rear height differences of the tracks on two sides being both greater than 0 and greater than a first height difference threshold, determining that the demolition robot is in an uphill posture, the front and rear height differences of the tracks on two sides being parameters for the uphill posture; in response to the front and rear height differences of the tracks on two sides being both less than 0 and less than a negative value of the first height difference threshold, determining that the demolition robot is in a downhill posture, the front and rear height differences of the tracks on two sides being parameters for the downhill posture; calculating a height difference between a left track and a right track at the same moment in the posture information; in response to the height difference between the left track and the right track being greater than a second height difference threshold, determining that the demolition robot is in a tilted posture, the height difference between the left track and the right track being a parameter for the tilted posture; and in response to the front and rear height differences of the tracks on two sides being within the range of the first threshold and the negative value of the first threshold, and the height difference between the left track and the right track being not greater than the second height difference threshold, determining that the demolition robot is in a horizontal posture, a parameter for the horizontal posture being 0.

8. A risk control apparatus for demolition robots, comprising a first apparatus configured to work in real time during a walking process of a demolition robot, wherein the first apparatus comprises: a working condition module configured to determine a posture of the demolition robot and corresponding posture parameters according to posture information of the demolition robot; characterized in that the first apparatus further comprises: a risk category module configured to, according to the posture parameters, the posture information and environmental information of the demolition robot, use a trained neural network to determine a risk category associated with the demolition robot; a path planning module configured to, in response to the risk category comprising solely walking path risks, re-plan a walking path according to the environmental information of the demolition robot, and control the demolition robot according to the re-planned walking path; a stability control module configured to, in response to the risk category comprising solely tipping risks, determine a tipping direction of the demolition robot according to the posture information of the demolition robot and a tipping line, and adjust the posture of the demolition robot according to the tipping direction; and a sequential control module configured to, in response to the risk category comprising tipping risks and walking path risks, determine a tipping direction of the demolition robot according to the posture information of the demolition robot and a tipping line, adjust the posture of the demolition robot according to the tipping direction, re-plan a walking path according to the environmental information of the demolition robot after the tipping risks are removed, and control the demolition robot according to the re-planned walking path.

9. A computer-readable storage medium, wherein the computer-readable storage medium stores one or more programs, and the one or more programs comprise instructions which, when executed by a computing device, cause the computing device to implement the method according to any one of claims 1-7.

10. A computer device, comprising: one or more processors and one or more memories, wherein one or more programs are stored in the one or more memories and configured to be executed by the one or more processors, and the one or more programs comprise instructions for implementing the method according to any one of claims 1-7.