Mechanical arm control system of electric climbing robot
By designing the robot arm control system of the power climbing robot, using the multi-module obstacle-breaking algorithm and dynamic balance adjustment module, the limitations of the power climbing robot in obstacle-breaking and dynamic balance control are solved, and the limitations of the power climbing robot in obstacle-breaking and dynamic balance control are realized in complex environments. Efficient and safe barrier-breathing capabilities and stability extend application scenarios and reduce maintenance costs.
Patent Information
- Application Number
- CN202411254527.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-09
- Publication Date
- 2024-11-15
AI Technical Summary
The existing power climbing robots have limitations in obstacle crossing capabilities and dynamic balance control, and it is difficult to flexibly cope with variable obstacle types and complex environmental conditions. It lacks high-precision sensors and advanced control algorithms, which affects operational safety. .
A robot arm control system for electric climbing robots was designed, including obstacle detection module, multi-module obstacle resistance algorithm module, dynamic balance adjustment module, robot arm control module, path planning module, data fusion module and remote monitoring and operation module , using sensors such as lidar, ultrasonic sensors, cameras, etc. to detect obstacles in real time, combined with multi-module obstacle avoidance algorithm and dynamic balance adjustment module, automatically identify obstacle types and select suitable obstacle avoidance strategies, monitor and adjust the robot's posture in real time, ensuring that Safety and efficiency of obstacle crossing process.
Through intelligent selection of obstacle-surfing strategy and accurate dynamic balance control, the system improves the robot's obstacle-surfing ability and operation stability in complex environments, expands application scenarios, reduces maintenance costs, and extends the service life of the robot .
Smart Images

Figure CN118952256A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of electric climbing robots, and in particular to a mechanical arm control system of an electric climbing robot. Background Art
[0002] In the power industry, power towers are key facilities for supporting and transmitting electric energy. Their safe and stable operation is crucial to ensuring the safety of the power grid. However, power towers are usually erected in complex and changeable geographical environments, such as mountainous areas, along rivers, or on the edge of cities, which makes the inspection and maintenance of power towers particularly difficult. Traditional manual inspection methods are not only inefficient, but also have high safety risks and are difficult to reach high places and hidden areas.
[0003] In recent years, with the rapid development of robot technology, the application of power climbing robots in power tower inspection and maintenance has gradually attracted attention. This type of robot can autonomously climb power towers to perform inspection, maintenance and other tasks, greatly improving work efficiency and safety. However, in actual applications, the structure of power towers is complex and diverse, including beams of different heights, vertical tower bodies, and various obstacles that may exist (such as wire mesh, cables, ancillary facilities, etc.), which puts extremely high demands on the obstacle-crossing ability and dynamic balance control of power climbing robots.
[0004] Existing electric climbing robots often have limitations in their obstacle-crossing capabilities. They mostly use preset fixed obstacle-crossing strategies, which make it difficult to flexibly cope with changing obstacle types and complex environmental conditions. In addition, in terms of dynamic balance control, many robots lack high-precision sensors and advanced control algorithms, making it difficult to maintain a stable posture during climbing, affecting operational safety. Summary of the invention
[0005] The purpose of this section is to summarize some aspects of embodiments of the present invention and briefly introduce some preferred embodiments. Some simplifications or omissions may be made in this section and the specification abstract and the invention title of this application to avoid blurring the purpose of this section, the specification abstract and the invention title, and such simplifications or omissions cannot be used to limit the scope of the present invention.
[0006] In order to solve the above technical problems, the present invention provides the following technical solutions: a mechanical arm control system of an electric climbing robot, mainly comprising:
[0007] An obstacle detection module, which is used to detect obstacles in the surrounding environment in real time and collect basic information about the obstacles;
[0008] A multi-module obstacle crossing algorithm module, which can automatically identify the type of obstacles and select the most suitable obstacle crossing strategy based on the data provided by the obstacle detection module;
[0009] A dynamic balance adjustment module, which is used to monitor the posture of the electric climbing robot in real time and automatically adjust the posture and torque of the mechanical arm when the robot overcomes an obstacle;
[0010] A robotic arm control module, which controls the movement of the robotic arm according to the instructions of the multi-module obstacle crossing algorithm to ensure smooth passage of obstacles;
[0011] A path planning module, which is used to plan the obstacle crossing path of the electric climbing robot in advance and provide optimal path suggestions;
[0012] A data fusion module, which is used to fuse data from different sensors to improve the accuracy of obstacle detection and identification;
[0013] A remote monitoring and operation module, which allows an operator to remotely intervene and control the electric climbing robot when necessary;
[0014] A power management module, which is responsible for the power supply and management of each module of the electric climbing robot.
[0015] As a preferred solution of the mechanical arm control system of the electric climbing robot of the present invention, wherein: the obstacle detection module includes a laser radar, an ultrasonic sensor, a camera and a data processing unit;
[0016] The laser radar is used to accurately measure the distance and shape of obstacles and generate a high-precision environment map;
[0017] The ultrasonic sensor is used to detect obstacles at close range and provide fast-response obstacle data;
[0018] The camera is used to capture environmental images and assist in identifying the shape and material of obstacles;
[0019] The data processing unit is used to integrate and process the data from various sensors to generate unified obstacle information.
[0020] As a preferred solution of the mechanical arm control system of the electric climbing robot of the present invention, wherein: the multi-module obstacle crossing algorithm module includes an obstacle recognition algorithm, an obstacle crossing strategy library and a real-time data processing unit;
[0021] The obstacle recognition algorithm is used to analyze sensor data and identify the type of obstacle;
[0022] The obstacle crossing strategy library is used to store various obstacle crossing strategies and provide a basis for strategy selection;
[0023] The real-time data processing unit is used to analyze obstacle information in real time and select an appropriate obstacle crossing strategy.
[0024] As a preferred solution of the mechanical arm control system of the electric climbing robot of the present invention, the obstacle recognition algorithm identifies the obstacle type including the following steps:
[0025] S1: Use data fusion algorithm to fuse the data from lidar, ultrasonic sensor and camera to generate a unified environment model;
[0026] S2: Extract key features of obstacles from the fused environment model;
[0027] S3: Based on the point cloud data, the clustering algorithm is used to identify the basic shape of the obstacle, and the size parameters of the obstacle are calculated using the set analysis method;
[0028] S4: Use image processing algorithms to analyze the images captured by the camera, identify the surface material of the obstacle, and then combine the material information with the shape features to preliminarily classify the obstacle type;
[0029] S5: Establish an obstacle type library, use a multi-pattern matching algorithm to match the extracted obstacle features with the type library, and preliminarily determine the obstacle type;
[0030] S6: Selecting an optimal obstacle crossing strategy from the obstacle crossing strategies according to the identified obstacle type.
[0031] As a preferred solution of the mechanical arm control system of the electric climbing robot of the present invention, the optimal obstacle crossing strategy selection formula is as follows:
[0032]
[0033] in:
[0034] P j (T type ,S k ) represents the jth strategy matching algorithm, and the input is the obstacle type and the kth obstacle crossing strategy;
[0035] arg max is a mathematical operator that indicates the parameter that makes the subsequent expression reach the maximum value;
[0036] k is an index variable, representing different obstacle crossing strategies, and the value range of k is the set of all optional obstacle crossing strategies;
[0037] is the weighted sum, which represents the comprehensive score of all strategy matching algorithms;
[0038] k jIt reflects the importance of the j-th strategy matching algorithm;
[0039] P j is the strategy matching function, evaluating the current obstacle type T type With a certain obstacle crossing strategy S k The matching degree
[0040] T type The obstacle type determined by the matching algorithm;
[0041] Value range meaning:
[0042] S optimal The value range of is all possible strategies in the obstacle crossing strategy library;
[0043] T type The value range of is all possible types in the obstacle type library.
[0044] As a preferred solution of the mechanical arm control system of the electric climbing robot of the present invention, the obstacle type matching formula is as follows:
[0045]
[0046] in:
[0047] η i is the weight coefficient, which indicates the contribution of the i-th matching algorithm to the overall matching score;
[0048] M i is the i-th matching algorithm, the input is the combined features of the obstacles and the j-th obstacle type, and the output is the matching score;
[0049] Represents the most likely obstacle type determined by the multi-pattern matching algorithm;
[0050] is the weighted sum, which represents the comprehensive score of the multi-pattern matching algorithm;
[0051] T j Represents the jth obstacle type in the obstacle type library;
[0052] C comb It is a combined feature function of shape and material, which represents the comprehensive features of obstacles and preliminarily classifies obstacle types;
[0053] C comb (x,y,z)=S shape (x,y,z)+M material (r,g,b)
[0054] in:
[0055] M material (r, g, b) is the surface material recognition function, which identifies the material of the obstacle through the image processing algorithm;
[0056] S shape (x, y, z) is a shape feature function, which uses a clustering algorithm to identify the basic shape of the obstacle, represents the shape features of the obstacle in three-dimensional space, and is calculated based on point cloud data;
[0057] Value range meaning:
[0058] C comb The value range of (x, y, z) is the set of all possible combined features;
[0059] S shape The range of (x, y, z) is the set of all possible shape features;
[0060]
[0061] in:
[0062] I i (r, g, b) represents the output of the image processing algorithm for the i-th material;
[0063] ∈ i is the weight coefficient, which expresses the contribution of the i-th image processing algorithm in the overall material recognition;
[0064] is a weighted sum, expressing the combined output of the image processing algorithm;
[0065] Value range meaning:
[0066] M material The value range of (r,g,b) is the set of all possible material features.
[0067] As a preferred solution of the mechanical arm control system of the electric climbing robot of the present invention, the obstacle crossing strategy includes the following obstacle crossing methods:
[0068] Conventional obstacle climbing: the conventional climbing is applicable to situations where there are no obvious obstacles or the obstacles are relatively low in height and regular in shape;
[0069] Crossing over obstacles, which is applicable to obstacles with lower height but larger width;
[0070] Obstacle bypassing: This is applicable to obstacles that are large in height and width and cannot be directly crossed by the robot.
[0071] Climbing over obstacles, which is applicable to vertical or nearly vertical tall obstacles;
[0072] The method of drilling through obstacles is applicable to obstacles with holes or gaps.
[0073] As a preferred solution of the mechanical arm control system of the electric climbing robot of the present invention, wherein: the dynamic balance adjustment module includes a gyroscope, an acceleration sensor, a balance control algorithm and a posture adjustment device;
[0074] The gyroscope is used to detect the rotational angular velocity of the robot in all directions and provide posture change data;
[0075] The acceleration sensor is used to measure the acceleration of the robot in all directions to assist in posture adjustment;
[0076] The balance control algorithm is used to calculate and execute balance adjustment actions based on the data of the gyroscope and the acceleration sensor;
[0077] The posture adjustment device implements specific posture adjustment actions.
[0078] As a preferred solution of the mechanical arm control system of the electric climbing robot described in the present invention, the dynamic balance adjustment module also includes an environmental adaptation unit, and the environmental adaptation unit is used to automatically adjust the parameters of the balance control algorithm according to different characteristics of the environment.
[0079] As a preferred solution of the mechanical arm control system of the electric climbing robot of the present invention, wherein: the mechanical arm control module includes a servo motor, a controller, a force feedback sensor and a motion control algorithm;
[0080] The servo motor is used to drive the movement of each joint of the robotic arm to provide precise positioning and motion control;
[0081] The controller is used to receive instructions from the obstacle crossing algorithm and the balance adjustment module to control the movement of the servo motor;
[0082] The force feedback sensor is used to monitor the gripping force of the robot arm to prevent damage to obstacles or its own parts;
[0083] The motion control algorithm is used to calculate the motion path and posture of the robot arm to ensure the accuracy and stability of the movement.
[0084] Beneficial effects of the present invention:
[0085] 1. The system integrates a multi-module obstacle crossing algorithm module, which can analyze the data provided by the obstacle detection module in real time, automatically identify the type of obstacle, and select the most suitable obstacle crossing strategy. This highly intelligent obstacle crossing strategy selection not only improves the robot's ability to cope with complex environments, but also ensures the safety and efficiency of the obstacle crossing process. Whether facing low walls, tall poles, or complex barbed wire, the system can quickly make judgments and perform corresponding obstacle crossing actions, thereby greatly expanding the application scenarios and operating range of the electric climbing robot.
[0086] 2. The dynamic balance adjustment module of the present invention monitors and adjusts the robot's posture in real time by integrating high-precision sensors such as gyroscopes and accelerometers to ensure stable balance during obstacle crossing. Combined with the balance control algorithm and the posture adjustment device, the system can accurately calculate and execute necessary balance adjustment actions, effectively preventing the robot from overturning or losing control in complex terrain or sudden situations. This precise dynamic balance control not only improves the stability and safety of the robot's operation, but also reduces the risk of mechanical wear and failure caused by unstable conditions, thereby extending the robot's service life and reducing maintenance costs. BRIEF DESCRIPTION OF THE DRAWINGS
[0087] In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the following briefly introduces the drawings required for describing the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative labor. Among them:
[0088] Figure 1 This is a structural block diagram of a mechanical arm control system of an electric climbing robot of the present invention. DETAILED DESCRIPTION
[0089] In order to make the above-mentioned objects, features and advantages of the present invention more obvious and easy to understand, the specific implementation methods of the present invention are described in detail below in conjunction with the accompanying drawings.
[0090] In the following description, many specific details are set forth to facilitate a full understanding of the present invention, but the present invention may also be implemented in other ways different from those described herein, and those skilled in the art may make similar generalizations without violating the connotation of the present invention. Therefore, the present invention is not limited to the specific embodiments disclosed below.
[0091] Secondly, the term "one embodiment" or "embodiment" as used herein refers to a specific feature, structure, or characteristic that may be included in at least one implementation of the present invention. The term "in one embodiment" that appears in different places in this specification does not necessarily refer to the same embodiment, nor does it refer to a separate or selective embodiment that is mutually exclusive with other embodiments.
[0092] Secondly, the present invention is described in detail with reference to the schematic diagram. When describing the embodiments of the present invention in detail, for the sake of convenience, the cross-sectional diagrams showing the device structure will not be partially enlarged according to the general scale, and the schematic diagrams are only examples, which should not limit the scope of protection of the present invention. In addition, in actual production, the three-dimensional dimensions of length, width and depth should be included.
[0093] Example 1
[0094] Reference Figure 1 , which is the first embodiment of the present invention, provides a mechanical arm control system of an electric climbing robot, mainly comprising:
[0095] Obstacle detection module, which uses a variety of sensors (such as lidar, ultrasonic sensors, cameras, etc.) to detect obstacles in the surrounding environment in real time and collect basic information about the obstacles, such as size, shape, material, etc.;
[0096] The obstacle detection module includes a laser radar, an ultrasonic sensor, a camera and a data processing unit;
[0097] The laser radar is used to accurately measure the distance and shape of obstacles and generate a high-precision environment map;
[0098] The ultrasonic sensor is used to detect obstacles at close range and provide fast-response obstacle data;
[0099] The camera is used to capture environmental images and assist in identifying the shape and material of obstacles;
[0100] The data processing unit is used to integrate and process the data from various sensors to generate unified obstacle information.
[0101] Multi-module obstacle crossing algorithm module, which can automatically identify the type of obstacle based on the data provided by the obstacle detection module and select the most suitable obstacle crossing strategy. The algorithm combines machine vision and sensor data to analyze the shape and size of obstacles in real time;
[0102] The multi-module obstacle crossing algorithm module includes an obstacle recognition algorithm, an obstacle crossing strategy library, and a real-time data processing unit;
[0103] The obstacle recognition algorithm is used to analyze sensor data and identify the type of obstacles (such as cylindrical, square, grid structure, etc.);
[0104] The obstacle crossing strategy library is used to store various obstacle crossing strategies and provide a basis for strategy selection;
[0105] The real-time data processing unit is used to analyze obstacle information in real time and select an appropriate obstacle crossing strategy.
[0106] The obstacle identification algorithm identifies the obstacle type including the following steps:
[0107] S1: Use data fusion algorithm to fuse the data from lidar, ultrasonic sensor and camera to generate a unified environment model;
[0108] S2: Extract key features of obstacles from the fused environment model, such as edges, contours, surface materials, colors, etc.
[0109] S3: Based on the point cloud data, use clustering algorithms (such as DBSCAN) to identify the basic shapes of obstacles (such as cylinders, squares, etc.), and use set analysis methods to calculate the size parameters of obstacles (height, width, diameter, etc.);
[0110] S4: Use image processing algorithms to analyze the images captured by the camera, identify the surface material of the obstacle (such as metal, wood, plastic, etc.), and then combine the material information with the shape features to preliminarily classify the obstacle type;
[0111] S5: Establish an obstacle type library, which contains the shape, material and size features of various common obstacles. Use a multi-pattern matching algorithm to match the extracted obstacle features with the type library to preliminarily determine the obstacle type.
[0112] S6: Selecting an optimal obstacle crossing strategy from the obstacle crossing strategies according to the identified obstacle type.
[0113] The obstacle crossing strategy includes the following obstacle crossing methods:
[0114] Ⅰ. Conventional obstacle crossing
[0115] Applicable scenarios: There are no obvious obstacles or the obstacles are low in height and regular in shape.
[0116] Specific content:
[0117] Detection and identification: Use the obstacle detection module to identify the shape, size and material of obstacles.
[0118] Path planning: Use conventional path planning algorithms to determine the obstacle-crossing path.
[0119] Action execution: The robotic arm performs obstacle-crossing actions according to the predetermined path and posture.
[0120] II. Overcoming obstacles
[0121] Applicable scenarios: Obstacles with low height but large width, such as low walls, steps or railings.
[0122] Specific content:
[0123] Detection and identification: Using lidar and ultrasonic sensors, the height and width of obstacles are measured.
[0124] Obstacle crossing strategy: The robot arm grabs the top of the obstacle, raises itself, and crosses the obstacle;
[0125] Grasping position adjustment: adjust the grabbing position of the robot arm according to the width of the obstacle to ensure stable crossing;
[0126] Balance control: The dynamic balance adjustment module adjusts the posture during lifting and crossing to prevent tilting.
[0127] III. Bypass obstacles
[0128] Applicable scenarios: Obstacles that are large in height and width and cannot be directly crossed by the robot, such as high walls and large rocks.
[0129] Specific content:
[0130] Detection and recognition: Using ultrasonic sensors and cameras, measure the width and height of obstacles.
[0131] Obstacle crossing strategy: The robot arm extends to the side of the obstacle and performs a rotational movement to bypass the obstacle.
[0132] Path planning: The 3D environment modeling system generates side detour paths to avoid head-on collisions.
[0133] Balance control: The dynamic balance adjustment module keeps the overall balance of the robot when the robotic arm rotates.
[0134] IV. Climbing over obstacles
[0135] Applicable scenarios: Vertical or nearly vertical tall obstacles, such as electric poles or towers.
[0136] Specific content:
[0137] Detection and identification: Using lidar and cameras, the height and diameter of obstacles can be accurately measured.
[0138] Obstacle crossing strategy: The robotic arm grabs the top of the obstacle and uses the servo motor to drive the robotic arm to gradually climb and pass the obstacle.
[0139] Balance control: The dynamic balance adjustment module monitors and adjusts the posture in real time to prevent the robot from tipping over;
[0140] Gripping force adjustment: Force feedback sensors adjust the gripping force to ensure a secure grip on obstacles while avoiding damage.
[0141] Ⅴ. Drilling through obstacles
[0142] Applicable scenarios: Obstacles with holes or gaps, such as wire mesh or fences.
[0143] Specific content:
[0144] Detection and identification: Using lidar and cameras, the width and length of the gaps between obstacles are measured.
[0145] Obstacle crossing strategy: The robotic arm adjusts its posture to enable the robot to pass through narrow gaps.
[0146] Path planning: Plan the drilling path based on the gap size to ensure the robot passes smoothly.
[0147] Balance control: The dynamic balance adjustment module keeps the robot balanced during the extrusion process to avoid getting stuck or tilting.
[0148] The above obstacle crossing strategy combines the characteristics of different types of obstacles. Through the collaborative work of the multi-mode obstacle crossing algorithm and the dynamic balance adjustment system, it ensures that the electric climbing robot can complete the obstacle crossing task efficiently and safely in a complex environment.
[0149] A dynamic balance adjustment module, which is used to monitor the posture of the electric climbing robot in real time and automatically adjust the posture and torque of the mechanical arm when the robot overcomes an obstacle;
[0150] The dynamic balance adjustment module includes a gyroscope, an acceleration sensor, a balance control algorithm and a posture adjustment device;
[0151] The gyroscope is used to detect the rotational angular velocity of the robot in all directions and provide posture change data;
[0152] The acceleration sensor is used to measure the acceleration of the robot in all directions to assist in posture adjustment;
[0153] The balance control algorithm is used to calculate and execute balance adjustment actions based on the data of the gyroscope and the acceleration sensor;
[0154] The posture adjustment device implements specific posture adjustment actions, such as angle and position adjustment of the robot arm.
[0155] The dynamic balance adjustment module also includes an environment adaptation unit, which is used to automatically adjust the parameters of the balance control algorithm according to different characteristics of the environment to improve the stability and adaptability of the robot in different environments.
[0156] A robotic arm control module, which controls the movement of the robotic arm according to the instructions of the multi-module obstacle crossing algorithm to ensure smooth passage of obstacles;
[0157] The robotic arm control module includes a servo motor, a controller, a force feedback sensor and a motion control algorithm;
[0158] The servo motor is used to drive the movement of each joint of the robotic arm to provide precise positioning and motion control;
[0159] The controller is used to receive instructions from the obstacle crossing algorithm and the balance adjustment module to control the movement of the servo motor;
[0160] The force feedback sensor is used to monitor the gripping force of the robot arm to prevent damage to obstacles or its own parts;
[0161] The motion control algorithm is used to calculate the motion path and posture of the robot arm to ensure the accuracy and stability of the movement.
[0162] A path planning module, which is used to plan the obstacle crossing path of the electric climbing robot in advance and provide optimal path suggestions;
[0163] The path planning module includes a 3D environment modeling system, a path planning algorithm, and a real-time path updating unit;
[0164] The 3D environment modeling system generates a 3D model of the environment based on sensor data, providing the basis for path planning;
[0165] The path planning algorithm calculates the most obstacle-free path, avoiding obstacles and potentially dangerous areas;
[0166] The real-time path updating unit dynamically adjusts and updates the obstacle crossing path according to environmental changes.
[0167] A data fusion module, which is used to fuse data from different sensors to improve the accuracy of obstacle detection and identification;
[0168] A remote monitoring and operation module allows an operator to remotely intervene and control the electric climbing robot when necessary to help the robot overcome obstacles.
[0169] The power management module is responsible for the power supply and management of each module of the electric climbing robot to ensure the stable operation of the system during operation.
[0170] Specifically, the optimal obstacle crossing strategy selection formula is as follows:
[0171]
[0172] in:
[0173] P j (T type ,S k ) represents the jth strategy matching algorithm, and the input is the obstacle type and the kth obstacle crossing strategy;
[0174] argmax is a mathematical operator that represents the parameter that makes the subsequent expression reach the maximum value;
[0175] k is an index variable, representing different obstacle crossing strategies, and the value range of k is the set of all optional obstacle crossing strategies;
[0176] is the weighted sum, which represents the comprehensive score of all strategy matching algorithms;
[0177] k j It reflects the importance of the j-th strategy matching algorithm;
[0178] P j is the strategy matching function, evaluating the current obstacle type T type With a certain obstacle crossing strategy S k The matching degree
[0179] T type The obstacle type determined by the matching algorithm;
[0180] Value range meaning:
[0181] S optimal The value range of is all possible strategies in the obstacle crossing strategy library;
[0182] T type The value range of is all possible types in the obstacle type library.
[0183] As a preferred solution of the mechanical arm control system of the electric climbing robot of the present invention, the obstacle type matching formula is as follows:
[0184]
[0185] in:
[0186] η i is the weight coefficient, which indicates the contribution of the i-th matching algorithm to the overall matching score;
[0187] M iis the i-th matching algorithm, the input is the combined features of the obstacles and the j-th obstacle type, and the output is the matching score;
[0188] Represents the most likely obstacle type determined by the multi-pattern matching algorithm;
[0189] is the weighted sum, which represents the comprehensive score of the multi-pattern matching algorithm;
[0190] T j Represents the jth obstacle type in the obstacle type library;
[0191] C comb It is a combined feature function of shape and material, which represents the comprehensive features of obstacles and preliminarily classifies obstacle types;
[0192] C comb (x,y,z)=S shape (x,y,z)+M material (r,g,b)
[0193] in:
[0194] M material (r, g, b) is the surface material recognition function, which identifies the material of the obstacle through the image processing algorithm;
[0195] S shape (x, y, z) is a shape feature function, which uses a clustering algorithm to identify the basic shape of the obstacle, represents the shape features of the obstacle in three-dimensional space, and is calculated based on point cloud data;
[0196] Value range meaning:
[0197] C comb The value range of (x, y, z) is the set of all possible combined features;
[0198] S shape The range of (x, y, z) is the set of all possible shape features;
[0199]
[0200] in:
[0201] I i (r, g, b) represents the output of the image processing algorithm for the i-th material;
[0202] ∈ i is the weight coefficient, which expresses the contribution of the i-th image processing algorithm in the overall material recognition;
[0203] is a weighted sum, expressing the combined output of the image processing algorithm;
[0204] Value range meaning:
[0205] M material The value range of (r,g,b) is the set of all possible material features.
[0206] Through the above formula, intelligent selection of obstacle crossing strategy can be achieved.
[0207] In summary, the system can analyze the data provided by the obstacle detection module in real time, automatically identify the type of obstacles, and select the most suitable obstacle crossing strategy by integrating a multi-module obstacle crossing algorithm module. This highly intelligent obstacle crossing strategy selection not only improves the robot's ability to cope with complex environments, but also ensures the safety and efficiency of the obstacle crossing process. Whether facing low walls, tall poles, or complex barbed wire, the system can quickly make judgments and perform corresponding obstacle crossing actions, thereby greatly expanding the application scenarios and operating range of the electric climbing robot. In the present invention, the dynamic balance adjustment module monitors and adjusts the robot's posture in real time by integrating high-precision sensors such as gyroscopes and accelerometers to ensure stable balance during the obstacle crossing process. Combined with the balance control algorithm and the posture adjustment device, the system can accurately calculate and perform the necessary balance adjustment actions, effectively preventing the robot from overturning or losing control in complex terrain or sudden situations. This precise dynamic balance control not only improves the stability and safety of the robot's operation, but also reduces the risk of mechanical wear and failure caused by unstable conditions, thereby extending the service life of the robot and reducing maintenance costs.
[0208] It should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention rather than to limit it. Although the present invention has been described in detail with reference to the preferred embodiments, those skilled in the art should understand that the technical solutions of the present invention may be modified or replaced by equivalents without departing from the spirit and scope of the technical solutions of the present invention, which should all be included in the scope of the claims of the present invention.
Claims
1. A mechanical arm control system for an electric climbing robot, It is characterized in that include: An obstacle detection module, which is used to detect obstacles in the surrounding environment in real time and collect basic information about the obstacles; A multi-module obstacle crossing algorithm module, which can automatically identify the type of obstacles and select the most suitable obstacle crossing strategy based on the data provided by the obstacle detection module; A dynamic balance adjustment module, which is used to monitor the posture of the electric climbing robot in real time and automatically adjust the posture and torque of the mechanical arm when the robot overcomes an obstacle; A robotic arm control module, which controls the movement of the robotic arm according to the instructions of the multi-module obstacle crossing algorithm to ensure smooth passage of obstacles; A path planning module, which is used to plan the obstacle crossing path of the electric climbing robot in advance and provide optimal path suggestions; A data fusion module, which is used to fuse data from different sensors to improve the accuracy of obstacle detection and identification; A remote monitoring and operation module, which allows an operator to remotely intervene and control the electric climbing robot when necessary; A power management module, which is responsible for the power supply and management of each module of the electric climbing robot.
2. The mechanical arm control system of the electric climbing robot according to claim 1, Features: The obstacle detection module includes a laser radar, an ultrasonic sensor, a camera and a data processing unit; The laser radar is used to accurately measure the distance and shape of obstacles and generate a high-precision environment map; The ultrasonic sensor is used to detect obstacles at close range and provide fast-response obstacle data; The camera is used to capture environmental images and assist in identifying the shape and material of obstacles; The data processing unit is used to integrate and process the data from various sensors to generate unified obstacle information.
3. The mechanical arm control system of the electric climbing robot according to claim 1, Features: The multi-module obstacle crossing algorithm module includes an obstacle recognition algorithm, an obstacle crossing strategy library, and a real-time data processing unit; The obstacle recognition algorithm is used to analyze sensor data and identify the type of obstacle; The obstacle crossing strategy library is used to store various obstacle crossing strategies and provide a basis for strategy selection; The real-time data processing unit is used to analyze obstacle information in real time and select an appropriate obstacle crossing strategy.
4. The mechanical arm control system of the electric climbing robot as claimed in claim 3, Features: The obstacle identification algorithm identifies the obstacle type including the following steps: S1: Use data fusion algorithm to fuse the data from lidar, ultrasonic sensor and camera to generate a unified environment model; S2: Extract key features of obstacles from the fused environment model; S3: Based on the point cloud data, the clustering algorithm is used to identify the basic shape of the obstacle, and the size parameters of the obstacle are calculated using the set analysis method; S4: Use image processing algorithms to analyze the images captured by the camera, identify the surface material of the obstacle, and then combine the material information with the shape features to preliminarily classify the obstacle type; S5: Establish an obstacle type library, use a multi-pattern matching algorithm to match the extracted obstacle features with the type library, and preliminarily determine the obstacle type; S6: Selecting an optimal obstacle crossing strategy from the obstacle crossing strategies according to the identified obstacle type.
5. The mechanical arm control system of the electric climbing robot as claimed in claim 4, Features: The optimal obstacle crossing strategy selection formula is as follows: in: P j (T type ,S k ) represents the jth strategy matching algorithm, and the input is the obstacle type and the kth obstacle crossing strategy; argmax is a mathematical operator that represents the parameter that makes the subsequent expression reach the maximum value; k is an index variable, representing different obstacle crossing strategies, and the value range of k is the set of all optional obstacle crossing strategies; is the weighted sum, which represents the comprehensive score of all strategy matching algorithms; k j It reflects the importance of the j-th strategy matching algorithm; P j is the strategy matching function, evaluating the current obstacle type T type With a certain obstacle crossing strategy S k The matching degree T type The obstacle type determined by the matching algorithm; Value range meaning: S optimal The value range of is all possible strategies in the obstacle crossing strategy library; T type The value range of is all possible types in the obstacle type library.
6. The mechanical arm control system of the electric climbing robot as claimed in claim 5, Features: The obstacle type matching formula is as follows: in: η i is the weight coefficient, which indicates the contribution of the i-th matching algorithm to the overall matching score; M i is the i-th matching algorithm, the input is the combined features of the obstacles and the j-th obstacle type, and the output is the matching score; Represents the most likely obstacle type determined by the multi-pattern matching algorithm; is the weighted sum, which represents the comprehensive score of the multi-pattern matching algorithm; T j Represents the jth obstacle type in the obstacle type library; C comb It is a combined feature function of shape and material, which represents the comprehensive features of obstacles and preliminarily classifies obstacle types; C comb (x,y,z)=S shape (x,y,z)+M material (r,g,b) in: M material (r, g, b) is the surface material recognition function, which identifies the material of the obstacle through the image processing algorithm; S shape (x, y, z) is a shape feature function, which uses a clustering algorithm to identify the basic shape of the obstacle, represents the shape features of the obstacle in three-dimensional space, and is calculated based on point cloud data; Value range meaning: C comb The value range of (x, y, z) is the set of all possible combined features; S shape The range of (x, y, z) is the set of all possible shape features; in: I i (r, g, b) represents the output of the image processing algorithm for the i-th material; ∈ i is the weight coefficient, which expresses the contribution of the i-th image processing algorithm in the overall material recognition; is a weighted sum, expressing the combined output of the image processing algorithm; Value range meaning: M material The value range of (r,g,b) is the set of all possible material features.
7. The mechanical arm control system of the electric climbing robot according to claim 1, Features: The obstacle crossing strategy includes the following obstacle crossing methods: Conventional obstacle climbing: the conventional climbing is applicable to situations where there are no obvious obstacles or the obstacles are relatively low in height and regular in shape; Crossing over obstacles, which is applicable to obstacles with lower height but larger width; Obstacle bypassing: This is applicable to obstacles that are large in height and width and cannot be directly crossed by the robot. Climbing over obstacles, which is applicable to vertical or nearly vertical tall obstacles; The method of drilling through obstacles is applicable to obstacles with holes or gaps.
8. The mechanical arm control system of the electric climbing robot according to claim 1, Features: The dynamic balance adjustment module includes a gyroscope, an acceleration sensor, a balance control algorithm and a posture adjustment device; The gyroscope is used to detect the rotational angular velocity of the robot in all directions and provide posture change data; The acceleration sensor is used to measure the acceleration of the robot in all directions to assist in posture adjustment; The balance control algorithm is used to calculate and execute balance adjustment actions based on the data of the gyroscope and the acceleration sensor; The posture adjustment device implements specific posture adjustment actions.
9. The mechanical arm control system of the electric climbing robot as claimed in claim 8, Features: The dynamic balance adjustment module further includes an environment adaptation unit, which is used to automatically adjust the parameters of the balance control algorithm according to different characteristics of the environment.
10. The mechanical arm control system of the electric climbing robot according to claim 1, Features: The robotic arm control module includes a servo motor, a controller, a force feedback sensor and a motion control algorithm; The servo motor is used to drive the movement of each joint of the robotic arm to provide precise positioning and motion control; The controller is used to receive instructions from the obstacle crossing algorithm and the balance adjustment module to control the movement of the servo motor; The force feedback sensor is used to monitor the gripping force of the robot arm to prevent damage to obstacles or its own parts; The motion control algorithm is used to calculate the motion path and posture of the robot arm to ensure the accuracy and stability of the movement.
Citation Information
Cited By
Mechanical arm obstacle avoidance method and system based on vision
CN121492024A
Obstacle-crossing climbing robot and using method thereof
CN121871694A
Method and system for controlling automatic climbing of steel-transmission-tower climbing robot
WO2026137615A1
Robot escape and obstacle crossing method and apparatus
WO2026189322A1
