A balance control method for a soft waist platform of a power inspection robot
By comprehensively evaluating the multi-dimensional balance parameters of the power inspection robot, calculating the inspection balance index, and formulating airbag adjustment commands, the problem of imbalance in existing power inspection robots is solved, and the stability of inspection is improved.
Patent Information
- Application Number
- CN202411806115.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-12-10
- Publication Date
- 2025-10-21
- Estimated Expiration
- 2044-12-10
AI Technical Summary
The existing balance control method for power inspection robots uses single-dimensional data analysis, resulting in insufficient evaluation accuracy and an inability to formulate targeted balance control measures. This causes the power inspection robot to lose balance when encountering obstacles, reducing the stability of the inspection.
By acquiring the comprehensive balance parameters of the power inspection robot, calculating the inspection balance index, and combining multi-dimensional data analysis to judge the balance status, formulating balance control commands, and using airbags to adjust the height of the soft waist platform to maintain balance, a comprehensive evaluation of height difference, platform tilt, vibration rise value, and pressure stability is conducted.
It enables multi-dimensional and accurate assessment and timely adjustment of the balance state of the power inspection robot, avoiding violent shaking caused by obstacles and improving the stability of power inspection.
Smart Images

Figure CN119748432B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robotics, and more particularly to a balance control method for a soft waist platform of an electric power inspection robot. Background Art
[0002] Power inspection robots are often used for operations in substations. When inspecting narrow indoor aisles, they can perform inspection tasks of screen cabinets such as ground wire cabinets through video imaging instruments installed on the soft waist platform. Due to the complex indoor environment of the substation, when the cables of various electrical equipment are crossed and gathered on the indoor floor, and the power inspection robot touches the cables, it will cause the power inspection robot to shake and become unbalanced, which will cause fluctuations in video image data. Therefore, it is necessary to balance the soft waist platform to ensure that the power inspection robot maintains a balanced state, thereby providing stability for the power inspection robot.
[0003] Patent application with reference publication number CN111805506A discloses a balance control method for an electric inspection robot and a soft waist platform. The balance control method for the soft waist platform flexibly drives a fluid medium to adjust the fluid pressure required for each soft driver in the assigned drive unit of each soft driver group in each layer based on the state information of motion inertia and the state information of fluid pressure. This method facilitates the drive units and sensing units in each layer to jointly provide a motion opposite to the motion inertia, and balances the spatial posture of the top plate in the soft waist platform by means of motion compensation, further enhancing the flexibility and stability of the robot arm during operation, and has high application value.
[0004] The existing technology has the following deficiencies:
[0005] The existing robot balance control method determines whether the power inspection robot is unbalanced by collecting changes in single-dimensional vibration data or height data during the inspection process, which leads to limitations in the evaluation and analysis of the balance state of the power inspection robot. The lack of analysis and calculation process of multi-dimensional data such as pressure data and vibration data reduces the accuracy of the balance state assessment, resulting in the power inspection robot being unable to formulate reasonable balance control measures to change the posture of the soft waist platform according to the actual balance state, thereby causing the power inspection robot to be unbalanced and reducing the stability of the power inspection.
[0006] In view of this, the present invention proposes a balance control method for a soft waist platform of an electric power inspection robot to solve the above-mentioned problem. Summary of the Invention
[0007] In order to overcome the above-mentioned defects of the prior art and achieve the above-mentioned objectives, the present invention provides the following technical solutions: a balance control method for a soft waist platform of a power inspection robot, applied to a balance controller, comprising:
[0008] S1: Obtain the comprehensive balance parameters of the power inspection robot and calculate the inspection balance index based on the comprehensive balance parameters. The comprehensive balance parameters include height drop value, platform inclination, vibration climbing value and pressure stability;
[0009] S2: Compare the inspection balance index with the preset inspection balance threshold to generate a balance difference, and determine whether to issue a balance warning prompt; if a balance warning prompt is issued, execute S3; if no balance warning prompt is issued, repeat S1-S2;
[0010] S3: Based on the balance difference, the balance risk level is divided and balance control instructions are formulated. The balance control instructions include the instructions for raising or lowering the height of the soft waist platform on one side and the instructions for raising or lowering the height of the soft waist platform on both sides.
[0011] S4: Mark the first target airbag and control the first target airbag to execute the height increase or decrease command of the control software waist platform until the balance warning prompt is no longer issued;
[0012] S5: Mark the second target airbag and control the second target airbag to execute the height increase or decrease command of the waist platform on both sides of the control software until the balance warning prompt is no longer issued.
[0013] Furthermore, the method for obtaining the height difference value includes:
[0014] The laser sensor is used to measure the distance between the left side and the right side of the top of the soft waist platform and the inspection ground to obtain a first height value and a second height value;
[0015] The height difference value is obtained by taking the absolute value of the difference between the first height value and the second height value;
[0016] The expression of the height difference is:
[0017] ;
[0018] Where, is the height difference value, is the first height value, The second height value.
[0019] Furthermore, the method for obtaining the platform inclination includes:
[0020] Measure the height difference of the soft waist platform at time T1, which is recorded as the first difference;
[0021] Check the length of the soft waist platform in the technical parameter table and record it as the platform length value;
[0022] After comparing the first difference value with the platform length value, a first inclination is generated;
[0023] The expression of the first inclination is:
[0024] ;
[0025] Where, is the first inclination, is the first difference, is the platform length value;
[0026] Measure the height difference of the soft waist platform at time T2, and record it as the second difference;
[0027] After comparing the second difference with the platform length value, a second inclination is generated;
[0028] The expression of the second inclination is:
[0029] ;
[0030] Where, is the second inclination, is the second difference;
[0031] The first inclination and the second inclination are added and averaged to obtain the platform inclination;
[0032] The expression of platform inclination is:
[0033] ;
[0034] Where, is the platform inclination.
[0035] Furthermore, the method for obtaining the vibration rise value includes:
[0036] The vibration sensor is used to detect the vibration amplitude of the power inspection robot in real time to obtain the real-time amplitude value;
[0037] The moment when the real-time amplitude value reaches the standard amplitude value for the first time is recorded as the starting moment, and the period from the starting moment to the current moment is recorded as the vibration period;
[0038] The corresponding moments when the real-time amplitude value is greater than the standard amplitude value during the vibration period are counted sequentially to obtain a vibration moment;
[0039] Measure the interval duration between two adjacent vibration moments one by one, and record the minimum interval duration value as the standard interval value;
[0040] The duration corresponding to one third of the standard interval value is the vibration unit duration. Taking the vibration moment as the base point, we extend forward and backward by one vibration unit time to obtain The starting time and an ending moment;
[0041] The first Starting time to The period between the end times is recorded as a sub-period, and the sub-periods;
[0042] Count the software waist platform in sequence The number of vibrations in a sub-period and The number of vibrations in each sub-period is compared with the duration of the sub-period in turn to obtain Vibration frequency;
[0043] The expression of vibration frequency is:
[0044] ;
[0045] Where, For the Vibration frequency, For the The number of vibrations in a sub-period, is the duration corresponding to the sub-period;
[0046] The first The vibration frequency and After subtracting the vibration frequencies, we get Height climbing value;
[0047] The expression of sub-climb value is:
[0048] ;
[0049] Where, For the The height increase value, For the Vibration frequency;
[0050] After removing the maximum and minimum values of the sub-climb value, the remaining The individual climbing values are accumulated and averaged to obtain the vibration climbing value;
[0051] The expression of vibration rise value is:
[0052] ;
[0053] Where, is the vibration rise value, For the The height increase value.
[0054] Furthermore, the method for obtaining pressure stability includes:
[0055] The impact force received by the power inspection robot during the vibration period is detected in real time by the pressure sensor, recorded as the real-time pressure value, and the number of real-time pressure values is counted;
[0056] Record the real-time pressure value that is less than the safety pressure value as the effective pressure value, and obtain k effective pressure values;
[0057] Sort the k valid pressure values in chronological order, and mark the detection moments corresponding to the k valid pressure values to obtain k detection moments;
[0058] The two valid pressure values corresponding to the time between two adjacent detection moments being less than the preset impact period are recorded as target pressure values, and the number of target pressure values is counted;
[0059] Comparing the number of target pressure values with the number of real-time pressure values to obtain pressure stability;
[0060] The expression of pressure stability is:
[0061] :
[0062] Where, is the pressure stability, is the number of target pressure values, is the number of real-time pressure values.
[0063] Furthermore, the expression of the inspection balance index is:
[0064] ;
[0065] Where, is the inspection balance index, 、 、 、 is the weight coefficient, and 、 、 、 All greater than 0;
[0066] Methods for determining whether to issue a balance warning prompt include:
[0067] Subtract the inspection balance index from the preset inspection balance threshold to obtain the balance difference;
[0068] The expression of the balance difference is:
[0069] ;
[0070] Where, is the balance difference, It is the preset inspection balance threshold;
[0071] when When it is less than or equal to 0, it is determined that no balance warning prompt will be issued;
[0072] when When it is greater than 0, a balance warning prompt is issued.
[0073] Furthermore, the balanced risk level includes a medium risk level and a high risk level;
[0074] The classification methods for medium and high risk levels include:
[0075] Balance the difference Balance difference threshold with the preset value Compare;
[0076] when Less than or equal to When the risk is too high, it is classified as medium risk level;
[0077] when Greater than When the risk is high, it is classified as a high-risk level;
[0078] The method for formulating the command for controlling the height increase or decrease of one side of the soft waist platform and the command for controlling the height increase or decrease of both sides of the soft waist platform includes:
[0079] When the balance risk level is medium, formulate an instruction to control the height increase or decrease of one side of the waist platform of the software;
[0080] When the balance risk level is high, instructions are issued to control the height increase or decrease of both sides of the waist platform of the software.
[0081] Furthermore, the marking method of the first target airbag includes:
[0082] When the power inspection robot is in a static and balanced state, measure the height of the soft waist platform from the ground to obtain the standard height value;
[0083] Differences are taken between the first height value and the second height value and the standard height value, and then absolute values are obtained to obtain a first standard deviation value and a second standard deviation value;
[0084] The expression for the first standard deviation is:
[0085] ;
[0086] Where, is the first standard deviation value, is the standard height value;
[0087] The expression for the second standard deviation is:
[0088] ;
[0089] Where, is the second standard deviation value;
[0090] When the first standard deviation value is greater than the second standard deviation value, the height of the left side of the soft waist platform is higher, and the airbag on the left side of the soft waist platform is recorded as the first target airbag;
[0091] When the first standard deviation value is smaller than the second standard deviation value, the height of the right side of the soft waist platform is higher, and the airbag on the right side of the soft waist platform is recorded as the first target airbag.
[0092] Furthermore, the control method for executing the command to increase or decrease the height of one side of the waist platform of the control software includes:
[0093] If the first target airbag is the airbag on the left side of the soft waist platform, and when the first height value is lower than the standard height value, the air pump will introduce air to the airbag on the left side of the soft waist platform through the air pipe, forcing the left side of the soft waist platform to rise in height until the balance warning prompt is no longer issued, and then the air introduction will be stopped;
[0094] When the first height value is greater than the standard height value, the air pump extracts gas from the air bag on the left side of the soft waist platform through the gas pipeline, forcing the left side of the soft waist platform to lower its height until the balance warning prompt is no longer issued, and then stops extracting gas;
[0095] If the first target airbag is the airbag on the right side of the soft waist platform, and when the second height value is less than the standard height value, the air pump will introduce gas to the airbag on the right side of the soft waist platform through the gas pipeline, forcing the right side of the soft waist platform to rise in height until the balance warning prompt is no longer issued, and then stop introducing gas;
[0096] When the second height value is greater than the standard height value, the air pump extracts gas from the air bag on the right side of the soft waist platform through the gas pipeline, forcing the height of the right side of the soft waist platform to decrease until the balance warning prompt is no longer issued, and then stops extracting gas.
[0097] Furthermore, the second target airbag includes an airbag on the left side of the soft waist platform and an airbag on the right side of the soft waist platform;
[0098] The control method for executing the control software's command to raise or lower the height of the waist platform on both sides includes:
[0099] When the power inspection robot is in a static and balanced state, measure the height of the soft waist platform from the ground to obtain the standard height value;
[0100] If both the first height value and the second height value are lower than the standard height value, and when the first height value is higher than the second height value, the air pump introduces gas into the airbag on the left side of the soft waist platform through the gas pipeline at a rate lower than the rate of gas introduction into the airbag on the right side of the soft waist platform, forcing the increase in the height of the left side of the soft waist platform to be lower than the increase in the height of the right side of the soft waist platform, until the balance warning prompt is no longer issued, and then the gas introduction is stopped;
[0101] When the first height value is lower than the second height value, the air pump introduces gas into the airbag on the left side of the soft waist platform through the gas pipeline at a rate greater than the rate of gas introduction into the airbag on the right side of the soft waist platform, forcing the left side of the soft waist platform to increase in height more than the right side of the soft waist platform, until the balance warning prompt is no longer issued, and then the gas introduction is stopped;
[0102] If both the first height value and the second height value are greater than the standard height value, and when the first height value is greater than the second height value, the air pump extracts gas from the air bag on the left side of the soft waist platform through the gas pipeline at a rate greater than the rate of gas extraction from the air bag on the right side of the soft waist platform, forcing the height of the left side of the soft waist platform to decrease by a greater margin than the height of the right side of the soft waist platform, until the balance warning prompt is no longer issued, and then the gas introduction is stopped;
[0103] When the first height value is lower than the second height value, the rate at which the air pump extracts gas from the airbag on the left side of the soft waist platform through the gas pipeline is lower than the rate at which the air pump extracts gas from the airbag on the right side of the soft waist platform, forcing the height of the left side of the soft waist platform to decrease less than the height of the right side of the soft waist platform, until the balance warning prompt is no longer issued, and then the gas extraction stops.
[0104] The technical effects and advantages of the balance control method of the soft waist platform of the power inspection robot of the present invention are as follows:
[0105] The present invention obtains the comprehensive balance parameters of the power inspection robot, and calculates the inspection balance index based on the comprehensive balance parameters, compares the inspection balance index with a preset inspection balance threshold, generates a balance difference, and determines whether to issue a balance warning prompt. Based on the balance difference, the balance danger level is divided, and a balance control instruction is formulated. The first target airbag is marked, and the first target airbag is controlled to execute the height increase or decrease instruction of the control software waist platform until the balance warning prompt is no longer issued. The second target airbag is marked, and the second target airbag is controlled to execute the height increase or decrease instruction of the control software waist platform on both sides until the balance warning prompt is no longer issued. Compared with the prior art, the present invention obtains the comprehensive balance parameters of the power inspection robot, and calculates the inspection balance index based on the preset inspection balance threshold, generates a balance difference, and determines whether to issue a balance warning prompt. Based on the balance difference, the balance danger level is divided, and a balance control instruction is formulated. By taking the comprehensive balance parameters, we can accurately collect data that affects the balance state of the power inspection robot in multiple dimensions, realize the accurate analysis of the degree of influence of multi-dimensional balance influencing data on the balance state, and combine it with the inspection balance index for judgment and comparison. It can accurately evaluate the current imbalance degree of the power inspection robot, and formulate targeted balance control instructions according to the actual imbalance degree, so as to timely and accurately control the soft waist platform to execute the corresponding balance control instructions, actively optimize and improve the balance posture of the soft waist platform, and thus avoid the power inspection robot from shaking violently when encountering bumpy terrain, further improving the stability of the power inspection robot during power inspection. BRIEF DESCRIPTION OF THE DRAWINGS
[0106] Figure 1 A schematic flow chart of a method for balancing the soft waist platform of a power inspection robot provided in Example 1 of the present invention;
[0107] Figure 2 A schematic diagram of the structure of the power inspection robot provided in Example 1 of the present invention;
[0108] Figure 3 This is a schematic diagram of a balance control system for the soft waist platform of a power inspection robot provided in Example 2 of the present invention. DETAILED DESCRIPTION
[0109] The following will clearly and completely describe the technical solutions in the embodiments of the present invention in conjunction with the accompanying drawings. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without making creative efforts are within the scope of protection of the present invention.
[0110] Example 1: Please refer to Figure 1 and Figure 2 As shown, the balance control method of the soft waist platform of the power inspection robot described in this embodiment is applied to the balance controller, including:
[0111] S1: Obtain comprehensive balance parameters of the power inspection robot, and calculate the inspection balance index based on the comprehensive balance parameters;
[0112] The comprehensive balance parameter refers to the data that can represent the changes in the balance posture of the power inspection robot due to the influence of external obstacles during the inspection of power equipment. By obtaining the comprehensive balance parameter, a data basis can be provided for the calculation of the subsequent inspection balance index, so as to facilitate the precise balance control of the power inspection robot's soft waist platform;
[0113] Comprehensive balance parameters include height difference, platform inclination, vibration climbing value and pressure stability;
[0114] The height difference value refers to the height difference between the left and right sides of the soft waist platform of the power inspection robot during the power inspection process. When the power inspection robot touches a raised obstacle or a sunken terrain during the power inspection process, the impact force during the touch will cause the power inspection robot to become unbalanced, making the heights of the left and right sides of the soft waist platform inconsistent. When the height difference value is larger, it means that the height difference between the left and right sides of the soft waist platform is larger, the balance state of the power inspection robot is worse, and the inspection balance index is larger;
[0115] Methods for obtaining height difference values include:
[0116] The laser sensor is used to measure the distance between the left side and the right side of the top of the soft waist platform and the inspection ground to obtain a first height value and a second height value;
[0117] The height difference value is obtained by taking the absolute value of the difference between the first height value and the second height value;
[0118] The expression of the height difference is:
[0119] ;
[0120] Where, is the height difference value, is the first height value, The second height value.
[0121] The platform inclination refers to the degree of inclination of the power inspection robot's soft waist platform relative to the horizontal plane during the power inspection process. When the power inspection robot touches a raised obstacle or a concave terrain during the power inspection process, the levelness of the soft waist platform will change. The greater the platform inclination, the greater the degree of inclination of the soft waist platform relative to the horizontal plane, the worse the balance state of the power inspection robot, and the greater the inspection balance index;
[0122] Methods for obtaining platform inclination include:
[0123] Measure the height difference of the soft waist platform at time T1, which is recorded as the first difference;
[0124] Check the length of the soft waist platform in the technical parameter table and record it as the platform length value;
[0125] After comparing the first difference value with the platform length value, a first inclination is generated;
[0126] The expression of the first inclination is:
[0127] ;
[0128] Where, is the first inclination, is the first difference, is the platform length value;
[0129] Measure the height difference of the soft waist platform at time T2, which is recorded as the second difference; time T2 is the next moment after time T1, and the time between time T2 and time T1 is long enough for the height difference of the soft waist platform to change, so as to ensure that the height difference values collected at time T2 and time T1 are different;
[0130] After comparing the second difference with the platform length value, a second inclination is generated;
[0131] The expression of the second inclination is:
[0132] ;
[0133] Where, is the second inclination, is the second difference;
[0134] The first inclination and the second inclination are added and averaged to obtain the platform inclination;
[0135] The expression of platform inclination is:
[0136] ;
[0137] Where, is the platform inclination.
[0138] The vibration rise value refers to the increase in the vibration frequency of the power inspection robot per unit time from the moment when the real-time vibration amplitude exceeds the standard vibration amplitude to the detection moment. When the power inspection robot touches a raised obstacle or a sunken terrain during the power inspection process, the vibration frequency of the power inspection robot will change. The larger the vibration rise value, the greater the increase in the vibration frequency of the power inspection robot, the worse the balance state of the power inspection robot, and the larger the inspection balance index;
[0139] Methods for obtaining vibration rise values include:
[0140] The vibration sensor is used to detect the vibration amplitude of the power inspection robot in real time to obtain the real-time amplitude value;
[0141] The moment when the real-time amplitude value reaches the standard amplitude value for the first time is recorded as the starting moment, and the period from the starting moment to the current moment is recorded as the vibration period; the standard amplitude value refers to the minimum vibration amplitude that can negatively affect the balance state of the power inspection robot, so that the size of the vibration amplitude corresponding to the vibration frequency can be limited, avoiding the burden of collecting a large amount of low-amplitude vibration data and reducing the subsequent calculation amount; the standard amplitude value is obtained by collecting a large number of historical minimum vibration amplitudes that can negatively affect the balance state of the power inspection robot and calculating their average value;
[0142] The corresponding moments when the real-time amplitude value is greater than the standard amplitude value during the vibration period are counted sequentially to obtain a vibration moment;
[0143] Measure the interval duration between two adjacent vibration moments one by one, and record the minimum interval duration value as the standard interval value;
[0144] The duration corresponding to one third of the standard interval value is the vibration unit duration. Taking the vibration moment as the base point, we extend forward and backward by one vibration unit time to obtain The starting time and End time; by setting the vibration unit duration, you can extend the vibration time forward and backward by a certain length of time, so as to expand the time when the real-time amplitude value is greater than the standard amplitude value, and give the time period near when the real-time amplitude value is greater than the standard amplitude value, thereby improving the effectiveness of the vibration number collection time length;
[0145] The first Starting time to The period between the end times is recorded as a sub-period, and the sub-periods;
[0146] Count the software waist platform in sequence The number of vibrations in a sub-period and The number of vibrations in each sub-period is compared with the duration of the sub-period in turn to obtain Vibration frequency;
[0147] The expression of vibration frequency is:
[0148] ;
[0149] Where, For the Vibration frequency, For the The number of vibrations in a sub-period, is the duration corresponding to the sub-period;
[0150] The first The vibration frequency and After subtracting the vibration frequencies, we get Height climbing value;
[0151] The expression of sub-climb value is:
[0152] ;
[0153] Where, For the The height increase value, For the Vibration frequency;
[0154] After removing the maximum and minimum values of the sub-climb value, the remaining The individual climbing values are accumulated and averaged to obtain the vibration climbing value;
[0155] The expression of vibration rise value is:
[0156] ;
[0157] Where, is the vibration rise value, For the The height increase value.
[0158] Pressure stability refers to the stability of the power inspection robot when it is subjected to impact forces during the power inspection process. When the power inspection robot touches raised obstacles or sunken terrain during the power inspection process, the impact forces on the power inspection robot vary in size. The greater the pressure stability, the more stable the power inspection robot is when subjected to impact forces, the better the balance of the power inspection robot, and the smaller the inspection balance index.
[0159] Methods for obtaining pressure stability include:
[0160] The impact force received by the power inspection robot during the vibration period is detected in real time by the pressure sensor, recorded as the real-time pressure value, and the number of real-time pressure values is counted;
[0161] The real-time pressure value that is less than the safety pressure value is recorded as the effective pressure value, and k effective pressure values are obtained; the safety pressure value refers to the minimum pressure value that can have a negative impact on the balance state of the power inspection robot, which can effectively distinguish the size of the real-time pressure value; the safety pressure value is obtained by collecting a large number of historical minimum pressure values that can have a negative impact on the balance state of the power inspection robot and calculating their average value;
[0162] Sort the k valid pressure values in chronological order, and mark the detection moments corresponding to the k valid pressure values to obtain k detection moments;
[0163] The two valid pressure values corresponding to the time interval between two adjacent detection moments that is less than the preset impact period are recorded as target pressure values, and the number of target pressure values is counted; the preset impact period is the minimum interval between two adjacent target pressure values, which can accurately limit the span of the target pressure value occurrence time and obtain a sufficient number of target pressure values;
[0164] Comparing the number of target pressure values with the number of real-time pressure values to obtain pressure stability;
[0165] The expression of pressure stability is:
[0166] :
[0167] Where, is the pressure stability, is the number of target pressure values, is the number of real-time pressure values.
[0168] The inspection balance index is used to numerically represent the balance state of the power inspection robot. It can quantify the specific balance value of the power inspection robot and serve as the numerical basis for subsequent balance control analysis and processing of the soft waist platform.
[0169] The expression of inspection balance index is:
[0170] ;
[0171] Where, is the inspection balance index, 、 、 、 is the weight coefficient, and 、 、 、 All greater than 0;
[0172] in, , exemplary, is 0.32, is 0.22, is 0.26, is 0.20.
[0173] S2: Compare the inspection balance index with the preset inspection balance threshold to generate a balance difference, and determine whether to issue a balance warning prompt;
[0174] After obtaining the inspection balance index, the balance state of the power inspection robot can be specifically expressed in numerical value. According to the size of the inspection balance index, it is judged whether the balance state of the power inspection robot is abnormal. When the balance state is abnormal, a balance warning prompt is issued in time, thereby achieving the effect of imbalance warning of the power inspection robot.
[0175] Methods for determining whether to issue a balance warning prompt include:
[0176] The inspection balance index is subtracted from the preset inspection balance threshold to obtain a balance difference. The preset inspection balance threshold refers to the maximum value of the inspection balance index when the power inspection robot does not issue a balance warning prompt. This can be used to distinguish the balance state of the power inspection robot and thus determine the size of the inspection balance index. The preset inspection balance threshold is obtained by collecting a large number of historical maximum values of the inspection balance index when no balance warning prompt is issued and calculating their average value.
[0177] The expression of the balance difference is:
[0178] ;
[0179] Where, is the balance difference, It is the preset inspection balance threshold;
[0180] when When it is less than or equal to 0, it means that the inspection balance index is less than or equal to the preset inspection balance threshold. At this time, the inspection balance index does not exceed the corresponding maximum value under which no balance warning prompt is issued, and it is determined that no balance warning prompt is issued;
[0181] when When it is greater than 0, it means that the inspection balance index is greater than the preset inspection balance threshold. At this time, the inspection balance index exceeds the corresponding maximum value without issuing a balance warning prompt, and it is determined that a balance warning prompt is issued.
[0182] S3: Based on the balance difference, the balance risk level is divided and balance control instructions are formulated;
[0183] When a balance warning prompt is issued, the balance difference at this time is greater than 0, and the danger level corresponding to the current balance state of the power inspection robot needs to be indicated according to the specific size of the balance difference. The balance danger level can specifically indicate the danger level corresponding to the current balance state of the power inspection robot;
[0184] The balance risk level includes a medium risk level and a high risk level. The medium risk level corresponds to a current balance state of the power inspection robot with a medium risk, and the high risk level corresponds to a current balance state of the power inspection robot with a high risk.
[0185] The classification methods for medium and high risk levels include:
[0186] Balance the difference Balance difference threshold with the preset value Comparison; The preset balance difference threshold refers to the critical value of the balance difference corresponding to the division of the power inspection robot into medium and high danger levels, which can distinguish the size of the balance difference to achieve the effect of distinguishing different danger levels; The preset balance difference threshold is obtained by collecting a large number of critical values of the balance difference corresponding to the medium and high danger levels in history and calculating their average value;
[0187] when Less than or equal to When , it indicates that the current balance state of the power inspection robot is of medium risk. At this time, the imbalance degree of the power inspection robot is medium, and it is classified as medium risk level.
[0188] when Greater than When , it indicates that the current balance state of the power inspection robot is highly dangerous. At this time, the imbalance degree of the power inspection robot is serious and it is classified as a high-risk level.
[0189] After the balance danger level is generated, corresponding balance control instructions need to be formulated for the different danger levels of the power inspection robot. In this way, when the balance state of the power inspection robot changes to different degrees of danger, balance control countermeasures can be given according to the degree of danger change of the actual balance state, which will serve as the instructions for the subsequent power inspection robot to perform balance control on the soft waist platform, ensuring that the soft waist platform can perform reasonable balance control, preventing the power inspection robot from shaking and losing balance during the inspection operation, and improving the stability of the power inspection.
[0190] The balance control instructions include instructions for controlling the height increase or decrease of one side of the soft waist platform and instructions for controlling the height increase or decrease of both sides of the soft waist platform;
[0191] The method for formulating the command for controlling the height increase or decrease of one side of the soft waist platform and the command for controlling the height increase or decrease of both sides of the soft waist platform includes:
[0192] When the balance risk level is medium, the balance control measures corresponding to the soft waist platform are relatively simple, and an instruction to control the height increase or decrease of one side of the soft waist platform is formulated;
[0193] When the balance risk level is a high risk level, the balance control measures corresponding to the soft waist platform are relatively complex, and instructions for controlling the height increase or decrease of both sides of the soft waist platform are formulated.
[0194] S4: Mark the first target airbag and control the first target airbag to execute the command until the balance warning prompt is no longer issued;
[0195] After the balance control instruction is formulated, the balance controller on the power inspection robot needs to send the balance control instruction to the corresponding execution airbag, so that the execution airbag can execute the corresponding balance control instruction, prompting the balance posture of the soft waist platform to change, thereby ensuring that the power inspection robot is in a balanced state;
[0196] The first target airbag refers to an airbag that can perform balancing measures to execute the height increase or decrease command of the waist platform of the control software, and enables the first target airbag to efficiently and accurately execute the height increase or decrease command of the waist platform of the control software under the control of the balance controller, so as to achieve the balance control effect of the power inspection robot;
[0197] The marking method of the first target airbag includes:
[0198] When the power inspection robot is in a static and balanced state, measure the height of the soft waist platform from the ground to obtain the standard height value;
[0199] Differences are taken between the first height value and the second height value and the standard height value, and then absolute values are obtained to obtain a first standard deviation value and a second standard deviation value;
[0200] The expression for the first standard deviation is:
[0201] ;
[0202] Where, is the first standard deviation value, is the standard height value;
[0203] The expression for the second standard deviation is:
[0204] ;
[0205] Where, is the second standard deviation value;
[0206] When the first standard deviation value is greater than the second standard deviation value, the height of the left side of the soft waist platform is higher, and the airbag on the left side of the soft waist platform is recorded as the first target airbag;
[0207] When the first standard deviation value is smaller than the second standard deviation value, the height of the right side of the soft waist platform is higher, and the airbag on the right side of the soft waist platform is recorded as the first target airbag.
[0208] The control method for executing the command of raising or lowering the height of one side of the waist platform of the control software includes:
[0209] If the first target airbag is the airbag on the left side of the soft waist platform, the first height value is compared with the standard height value;
[0210] When the first height value is less than the standard height value, it means that the height of the left side of the soft waist platform is lower than the height in the static equilibrium state. At this time, the balance controller sends a working instruction to the air pump and the solenoid valve, controlling the air pump and the solenoid valve to be in the open state, and the solenoid valve conducts the gas pipeline connected to the air bag on the left side of the soft waist platform;
[0211] The air pump introduces gas to the air bag on the left side of the soft waist platform through the gas pipeline, forcing the left side of the soft waist platform to rise until the balance warning prompt is no longer issued, and then the gas introduction is stopped;
[0212] When the first height value is greater than the standard height value, it means that the height of the left side of the soft waist platform is higher than the height in the static equilibrium state. At this time, the balance controller sends a working instruction to the air pump and the solenoid valve, controlling the air pump and the solenoid valve to be in the open state, and the solenoid valve conducts the gas pipeline connected to the air bag on the left side of the soft waist platform;
[0213] The air pump extracts gas from the air bag on the left side of the soft waist platform through the gas pipeline, forcing the left side of the soft waist platform to lower in height until the balance warning prompt is no longer issued, and then stops extracting gas;
[0214] If the first target airbag is the airbag on the right side of the soft waist platform, the second height value is compared with the standard height value;
[0215] When the second height value is less than the standard height value, it means that the height of the right side of the soft waist platform is lower than the height in the static equilibrium state. At this time, the balance controller sends a working instruction to the air pump and the solenoid valve, controlling the air pump and the solenoid valve to be in the open state, and the solenoid valve conducts the gas pipeline connected to the air bag on the right side of the soft waist platform;
[0216] The air pump introduces gas to the air bag on the right side of the soft waist platform through the gas pipeline, forcing the right side of the soft waist platform to rise in height until the balance warning prompt is no longer issued, and then the gas introduction is stopped;
[0217] When the second height value is greater than the standard height value, it means that the height of the right side of the soft waist platform is higher than the height in the static equilibrium state. At this time, the balance controller sends a working instruction to the air pump and the solenoid valve, controlling the air pump and the solenoid valve to be in the open state, and the solenoid valve conducts the gas pipeline connected to the air bag on the right side of the soft waist platform;
[0218] The air pump extracts gas from the air bag on the right side of the soft waist platform through the gas pipeline, forcing the height of the right side of the soft waist platform to decrease until the balance warning prompt is no longer issued, and then stops extracting gas.
[0219] Please participate in the structure of the power inspection robot Figure 2 As shown in the figure, A is the air pump, B is the air bag on the left side of the soft waist platform, C is the air bag on the right side of the soft waist platform, D is the gas pipeline, E is the solenoid valve, F is the support plate, and B, C, and F constitute the soft waist platform.
[0220] S5: Mark the second target airbag and control the second target airbag to execute the command until the balance warning prompt is no longer issued;
[0221] The second target airbag refers to an airbag that can perform balancing measures to execute the height increase or decrease instructions on both sides of the waist platform of the control software, and enables the second target airbag to efficiently and accurately execute the height increase or decrease instructions on both sides of the waist platform of the control software under the control of the balance controller, so as to achieve the balance control effect of the power inspection robot;
[0222] When an instruction is issued to control the height of both sides of the soft waist platform to increase or decrease, it indicates that the balance state is at a high risk level. At this time, corresponding measures need to be taken on both the left and right airbags of the soft waist platform to achieve the balance control effect of the combined soft waist platform.
[0223] The second target airbag includes an airbag on the left side of the soft waist platform and an airbag on the right side of the soft waist platform.
[0224] The control method for executing the control software's command to raise or lower the height of the waist platform on both sides includes:
[0225] When the power inspection robot is in a static and balanced state, measure the height of the soft waist platform from the ground to obtain the standard height value;
[0226] Comparing the first height value and the second height value with the standard height value respectively;
[0227] If the first height value and the second height value are both lower than the standard height value, it means that the heights of the left and right sides of the soft waist platform are lower than the heights in the static equilibrium state. At this time, the balance controller sends a working instruction to the air pump and the solenoid valve, and the solenoid valve connects the air pipes connected to the airbags on the left and right sides of the soft waist platform;
[0228] When the first height value is greater than the second height value, it means that the height of the left side of the soft waist platform is higher than the height of the right side of the soft waist platform. At this time, the air pump introduces gas into the airbag on the left side of the soft waist platform through the gas pipeline at a rate lower than the rate of gas introduction into the airbag on the right side of the soft waist platform, forcing the increase in the height of the left side of the soft waist platform to be smaller than the increase in the height of the right side of the soft waist platform. When the balance warning prompt is no longer issued, the gas introduction is stopped;
[0229] When the first height value is less than the second height value, it means that the height of the left side of the soft waist platform is lower than the height of the right side of the soft waist platform. At this time, the air pump introduces gas into the airbag on the left side of the soft waist platform through the gas pipeline at a rate greater than the rate of gas introduction into the airbag on the right side of the soft waist platform, forcing the height of the left side of the soft waist platform to increase by a greater margin than the height of the right side of the soft waist platform. When the balance warning prompt is no longer issued, the gas introduction is stopped.
[0230] If both the first height value and the second height value are greater than the standard height value, it means that the heights of the left and right sides of the measuring soft waist platform are higher than the heights in the static equilibrium state. At this time, the balance controller sends a working instruction to the air pump and the solenoid valve, and the solenoid valve connects the air pipes connected to the airbags on the left and right sides of the soft waist platform;
[0231] When the first height value is greater than the second height value, it means that the height of the left side of the soft waist platform is higher than the height of the right side of the soft waist platform. At this time, the air pump extracts gas from the air bag on the left side of the soft waist platform through the gas pipeline at a rate greater than the rate of gas extraction from the air bag on the right side of the soft waist platform, forcing the height of the left side of the soft waist platform to decrease by a greater margin than the height of the right side of the soft waist platform. When the balance warning prompt is no longer issued, the gas introduction is stopped.
[0232] When the first height value is less than the second height value, it means that the height of the left side of the soft waist platform is lower than the height of the right side of the soft waist platform. At this time, the rate at which the air pump extracts gas from the airbag on the left side of the soft waist platform through the gas pipeline is lower than the rate at which the air pump extracts gas from the airbag on the right side of the soft waist platform, forcing the height of the left side of the soft waist platform to decrease less than the height of the right side of the soft waist platform, until the balance warning prompt is no longer issued, and then the gas extraction is stopped.
[0233] In this embodiment, by obtaining the comprehensive balance parameters of the power inspection robot, and based on the comprehensive balance parameters, calculating the inspection balance index, the inspection balance index is compared with the preset inspection balance threshold, generating a balance difference, and determining whether to issue a balance warning prompt, based on the balance difference, dividing the balance danger level, and formulating a balance control instruction, marking the first target airbag, and controlling the first target airbag to execute the height increase or decrease instruction of the control software waist platform until no balance warning prompt is issued, marking the second target airbag, and controlling the second target airbag to execute the height increase or decrease instruction of the control software waist platform on both sides until no balance warning prompt is issued; Compared with the prior art, by Obtaining comprehensive balance parameters can accurately collect data that affects the balance state of the power inspection robot in multiple dimensions, realize accurate analysis of the degree of influence of multi-dimensional balance influencing data on the balance state, and combine with the inspection balance index for judgment and comparison, to accurately evaluate the current imbalance degree of the power inspection robot, and formulate targeted balance control instructions according to the actual imbalance degree, so as to timely and accurately control the soft waist platform to execute the corresponding balance control instructions, actively optimize and improve the balance posture of the soft waist platform, thereby avoiding the power inspection robot from shaking violently when encountering bumpy terrain, and further improving the stability of the power inspection robot during power inspection.
[0234] Example 2: Please refer to Figure 3 As shown, for the parts not described in detail in this embodiment, please refer to the description of Example 1. A balance control system for a soft waist platform of an electric power inspection robot is provided, which is applied to a balance controller and is used to implement a balance control method for the soft waist platform of an electric power inspection robot. The method includes a data acquisition and calculation module, a balance early warning prompt module, a control instruction formulation module, a first execution module, and a second execution module, wherein the modules are connected via a wired or wireless network.
[0235] The data acquisition and calculation module is used to obtain the comprehensive balance parameters of the power inspection robot and calculate the inspection balance index based on the comprehensive balance parameters. The comprehensive balance parameters include height difference value, platform inclination, vibration climbing value and pressure stability;
[0236] The balance warning prompt module is used to compare the inspection balance index with the preset inspection balance threshold, generate a balance difference, and determine whether to issue a balance warning prompt;
[0237] A control instruction formulation module is used to classify the balance risk level based on the balance difference and formulate balance control instructions; the balance control instructions include instructions for raising or lowering the height of one side of the soft waist platform and instructions for raising or lowering the height of both sides of the soft waist platform;
[0238] The first execution module is used to mark the first target airbag and control the first target airbag to execute the height increase or decrease instruction of the control software waist platform until the balance warning prompt is no longer issued;
[0239] The second execution module is used to mark the second target airbag and control the second target airbag to execute the height increase or decrease instruction of the two sides of the waist platform of the control software until the balance warning prompt is no longer issued.
[0240] The above description is only a specific embodiment of the present invention, but the scope of protection of the present invention is not limited thereto. Any technician familiar with this technical field can easily think of changes or replacements within the technical scope disclosed by the present invention, which should be covered by the scope of protection of the present invention.
Claims
1. A balance control method for a soft waist platform of an electric power inspection robot, applied to a balance controller, characterized in that: include: S1: Obtain the comprehensive balance parameters of the power inspection robot and calculate the inspection balance index based on the comprehensive balance parameters. The comprehensive balance parameters include height drop value, platform inclination, vibration climbing value and pressure stability; The height difference value refers to the height difference between the left and right sides of the soft waist platform of the power inspection robot during the power inspection process; The platform inclination refers to the degree of inclination of the soft waist platform of the power inspection robot relative to the horizontal plane during the power inspection process; The vibration rise value refers to the increase in the vibration frequency of the power inspection robot per unit time from the moment when the real-time vibration amplitude exceeds the standard vibration amplitude to the detection moment; Pressure stability refers to the stability of the power inspection robot when it is subjected to impact force during the power inspection process; S2: Compare the inspection balance index with the preset inspection balance threshold to generate a balance difference, and determine whether to issue a balance warning prompt; if a balance warning prompt is issued, execute S3; if no balance warning prompt is issued, repeat S1-S2; S3: Based on the balance difference, the balance risk level is divided and balance control instructions are formulated. The balance control instructions include the instructions for raising or lowering the height of the soft waist platform on one side and the instructions for raising or lowering the height of the soft waist platform on both sides. S4: Use a laser sensor to measure the distance between the top left and top right of the soft waist platform and the inspection ground, respectively, to obtain a first height value and a second height value; when the power inspection robot is in a static balance state, measure the height value of the soft waist platform from the ground to obtain a standard height value; take the absolute value of the difference between the first height value and the second height value and the standard height value, respectively, to obtain a first standard difference value and a second standard difference value; when the first standard difference value is greater than the second standard difference value, the height of the left side of the soft waist platform is higher, and the airbag on the left side of the soft waist platform is recorded as the first target airbag; when the first standard difference value is less than the second standard difference value, the height of the right side of the soft waist platform is higher, and the airbag on the right side of the soft waist platform is recorded as the first target airbag; and based on the relationship between the first height value and the second height value and the standard height value, control the first target airbag to execute the command to control the height of one side of the soft waist platform to increase or decrease until no balance warning prompt is issued; S5: Mark the second target airbag, which includes the airbag on the left side of the soft waist platform and the airbag on the right side of the soft waist platform. Based on the size relationship between the first height value, the second height value and the standard height value, control the second target airbag to execute the height increase or decrease command of the two sides of the soft waist platform until no balance warning prompt is issued.
2. The balance control method of the soft waist platform of a power inspection robot according to claim 1, characterized in that: The method for obtaining the height difference value includes: The height difference value is obtained by taking the absolute value of the difference between the first height value and the second height value; The expression of the height difference is: ; Where, is the height difference value, is the first height value, The second height value.
3. The balance control method of the soft waist platform of the power inspection robot according to claim 2 is characterized in that: The method for obtaining the platform inclination includes: Measure the height difference of the soft waist platform at time T1, which is recorded as the first difference; Check the length of the soft waist platform in the technical parameter table and record it as the platform length value; After comparing the first difference value with the platform length value, a first inclination is generated; The expression of the first inclination is: ; Where, is the first inclination, is the first difference, is the platform length value; Measure the height difference of the soft waist platform at time T2, and record it as the second difference; After comparing the second difference with the platform length value, a second inclination is generated; The expression of the second inclination is: ; Where, is the second inclination, is the second difference; The first inclination and the second inclination are added and averaged to obtain the platform inclination; The expression of platform inclination is: ; Where, is the platform inclination.
4. The balance control method of the soft waist platform of the power inspection robot according to claim 3 is characterized in that: The method for obtaining the vibration rise value includes: The vibration sensor is used to detect the vibration amplitude of the power inspection robot in real time to obtain the real-time amplitude value; The moment when the real-time amplitude value reaches the standard amplitude value for the first time is recorded as the starting moment, and the period from the starting moment to the current moment is recorded as the vibration period; The corresponding moments when the real-time amplitude value is greater than the standard amplitude value during the vibration period are counted sequentially to obtain a vibration moment; Measure the interval duration between two adjacent vibration moments one by one, and record the minimum interval duration value as the standard interval value; The duration corresponding to one third of the standard interval value is the vibration unit duration. Taking the vibration moment as the base point, we extend forward and backward by one vibration unit time to obtain The starting time and an ending moment; The first Starting time to The period between the end times is recorded as a sub-period, and the sub-periods; Count the software waist platform in sequence The number of vibrations in a sub-period and The number of vibrations in each sub-period is compared with the duration of the sub-period in turn to obtain Vibration frequency; The expression of vibration frequency is: ; Where, For the Vibration frequency, For the The number of vibrations in a sub-period, is the duration corresponding to the sub-period; The first The vibration frequency and After subtracting the vibration frequencies, we get Height climbing value; The expression of sub-climb value is: ; Where, For the The height increase value, For the Vibration frequency; After removing the maximum and minimum values of the sub-climb value, the remaining The individual climbing values are accumulated and averaged to obtain the vibration climbing value; The expression of vibration rise value is: ; Where, is the vibration rise value, For the The height increase value.
5. The balance control method of the soft waist platform of the power inspection robot according to claim 4 is characterized in that: The method for obtaining the pressure stability includes: The impact force received by the power inspection robot during the vibration period is detected in real time by the pressure sensor, recorded as the real-time pressure value, and the number of real-time pressure values is counted; Record the real-time pressure value that is less than the safety pressure value as the effective pressure value, and obtain k effective pressure values; Sort the k valid pressure values in chronological order, and mark the detection moments corresponding to the k valid pressure values to obtain k detection moments; The two valid pressure values corresponding to the time between two adjacent detection moments being less than the preset impact period are recorded as target pressure values, and the number of target pressure values is counted; Comparing the number of target pressure values with the number of real-time pressure values to obtain pressure stability; The expression of pressure stability is: : Where, is the pressure stability, is the number of target pressure values, is the number of real-time pressure values.
6. The balance control method of the soft waist platform of the power inspection robot according to claim 5, characterized in that: The expression of the inspection balance index is: ; Where, is the inspection balance index, 、 、 、 is the weight coefficient, and 、 、 、 All greater than 0; Methods for determining whether to issue a balance warning prompt include: Subtract the inspection balance index from the preset inspection balance threshold to obtain the balance difference; The expression of the balance difference is: ; Where, is the balance difference, It is the preset inspection balance threshold; when When it is less than or equal to 0, it is determined that no balance warning prompt will be issued; when When it is greater than 0, a balance warning prompt is issued.
7. The balance control method of the soft waist platform of the power inspection robot according to claim 6, characterized in that: The balance risk level includes a medium risk level and a high risk level; The classification methods for medium and high risk levels include: Balance the difference Balance difference threshold with the preset value Compare; when Less than or equal to When the risk is too high, it is classified as medium risk level; when Greater than When the risk is high, it is classified as a high-risk level; The method for formulating the command for controlling the height increase or decrease of one side of the soft waist platform and the command for controlling the height increase or decrease of both sides of the soft waist platform includes: When the balance risk level is medium, formulate an instruction to control the height increase or decrease of one side of the waist platform of the software; When the balance risk level is high, instructions are issued to control the height increase or decrease of both sides of the waist platform of the software.
8. The balance control method of the soft waist platform of the power inspection robot according to claim 7, characterized in that: The expression of the first standard deviation value is: ; Where, is the first standard deviation value, is the standard height value; The expression for the second standard deviation is: ; Where, is the second standard deviation value.
9. The balance control method of the soft waist platform of the power inspection robot according to claim 8, characterized in that: The control method for executing the instruction to increase or decrease the height of one side of the waist platform of the control software includes: If the first target airbag is the airbag on the left side of the soft waist platform, and when the first height value is lower than the standard height value, the air pump will introduce air to the airbag on the left side of the soft waist platform through the air pipe, forcing the left side of the soft waist platform to rise in height until the balance warning prompt is no longer issued, and then the air introduction will be stopped; When the first height value is greater than the standard height value, the air pump extracts gas from the air bag on the left side of the soft waist platform through the gas pipeline, forcing the left side of the soft waist platform to lower its height until the balance warning prompt is no longer issued, and then stops extracting gas; If the first target airbag is the airbag on the right side of the soft waist platform, and when the second height value is less than the standard height value, the air pump will introduce gas to the airbag on the right side of the soft waist platform through the gas pipeline, forcing the right side of the soft waist platform to rise in height until the balance warning prompt is no longer issued, and then stop introducing gas; When the second height value is greater than the standard height value, the air pump extracts gas from the air bag on the right side of the soft waist platform through the gas pipeline, forcing the height of the right side of the soft waist platform to decrease until the balance warning prompt is no longer issued, and then stops extracting gas.
10. The balance control method of the soft waist platform of the power inspection robot according to claim 9, characterized in that: The control method for executing the control software's command to raise or lower the height of the waist platform on both sides includes: When the power inspection robot is in a static and balanced state, measure the height of the soft waist platform from the ground to obtain the standard height value; If both the first height value and the second height value are lower than the standard height value, and when the first height value is higher than the second height value, the air pump introduces gas into the airbag on the left side of the soft waist platform through the gas pipeline at a rate lower than the rate of gas introduction into the airbag on the right side of the soft waist platform, forcing the increase in the height of the left side of the soft waist platform to be lower than the increase in the height of the right side of the soft waist platform, until the balance warning prompt is no longer issued, and then the gas introduction is stopped; When the first height value is lower than the second height value, the air pump introduces gas into the airbag on the left side of the soft waist platform through the gas pipeline at a rate greater than the rate of gas introduction into the airbag on the right side of the soft waist platform, forcing the left side of the soft waist platform to increase in height more than the right side of the soft waist platform, until the balance warning prompt is no longer issued, and then the gas introduction is stopped; If both the first height value and the second height value are greater than the standard height value, and when the first height value is greater than the second height value, the air pump extracts gas from the air bag on the left side of the soft waist platform through the gas pipeline at a rate greater than the rate of gas extraction from the air bag on the right side of the soft waist platform, forcing the height of the left side of the soft waist platform to decrease by a greater margin than the height of the right side of the soft waist platform, until the balance warning prompt is no longer issued, and then the gas introduction is stopped; When the first height value is lower than the second height value, the rate at which the air pump extracts gas from the airbag on the left side of the soft waist platform through the gas pipeline is lower than the rate at which the air pump extracts gas from the airbag on the right side of the soft waist platform, forcing the height of the left side of the soft waist platform to decrease less than the height of the right side of the soft waist platform, until the balance warning prompt is no longer issued, and then the gas extraction stops.
Citation Information
Patent Citations
Electric power inspection robot, and balance control method of soft body waist platform
CN111805506A
Monitoring device for electric power inspection robot
CN111815797A
Infrared detection traveling robot for wind power generator cabin
CN111911362A