Leveling control method of operation equipment, operation equipment and storage medium
The slant distance and angle are determined through the laser ranging sensor, the compensation control amount is calculated, and the leveling of the six-degree of freedom stabilized platform is solved, which solves the problem of poor stability of construction equipment in high altitude operations, and improves construction accuracy and efficiency.
Patent Information
- Application Number
- CN202411057641.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-02
- Publication Date
- 2024-11-26
AI Technical Summary
During high-altitude operations, existing construction equipment has poor stability due to factors such as wind disturbance and ground vibration, and low construction accuracy and efficiency. It is difficult for existing leveling technology to effectively solve the lifting platform clearance, slide rail clearance and working platform movement of equipment with large loads. Error caused.
The slant distance and angle of the platform are determined through the laser ranging sensor, the compensation control amount is calculated, the position of the stable platform is adjusted, and the leveling is performed using the six-degree of freedom stable platform to ensure that the construction equipment works in a stable state.
It improves the construction accuracy and efficiency of construction equipment, effectively solves the problem of poor stability of equipment with large loads in high altitude operations, and enhances the immunity of construction equipment.
Smart Images

Figure CN119024886A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of mechanical control technology, and in particular to a leveling control method for an operating device, an operating device, and a storage medium. Background Art
[0002] In order to protect personal safety, more and more automated equipment is being put into use to improve the existing construction environment. However, due to the influence of strong winds, ground vibrations, and disturbances caused by automated process equipment during aerial work, the aerial work platform has poor stability, which affects the construction accuracy and efficiency of the construction equipment on the work platform. Therefore, in order to ensure the construction accuracy and efficiency of aerial work, the stability enhancement and anti-disturbance performance of the work platform has received more and more attention.
[0003] In the related leveling technical scheme, by predetermining the preset position of the working platform when it is stable, the supporting structure of the base is automatically adjusted when the base shakes so that the working platform can always maintain its preset position. However, for construction equipment with a large load, the above scheme still cannot solve the errors caused by the gap between the lifting platform, the gap between the slide rails, and the reciprocating movement of the working platform. The poor positioning accuracy leads to low construction accuracy and construction efficiency of the construction equipment.
[0004] The above contents are only used to assist in understanding the technical solution of the present invention and do not constitute an admission that the above contents are prior art. Summary of the invention
[0005] The embodiments of the present application aim to solve the technical problems of low construction accuracy and construction efficiency of construction equipment by providing a leveling control method, equipment and computer-readable storage medium for working equipment.
[0006] To achieve the above object, an embodiment of the present invention provides a leveling control method for an operating device, the leveling control method for the operating device comprising the following steps:
[0007] Determine the swing distance of the lower platform according to the offset between the light spot position and the center position of the lower platform of the stable platform, wherein the light spot corresponding to the light spot position is generated by the laser emitted by the laser ranging sensor hitting the lower platform, and the laser ranging sensor is located at the lower side of the center position;
[0008] Obtaining the deflection angle of the lower platform of the stable platform;
[0009] Determining a compensation control amount corresponding to the upper platform of the stable platform according to the deflection distance and the deflection angle;
[0010] The posture of the upper platform of the stabilizing platform is adjusted according to the compensation control amount so that the construction equipment is in a stable state.
[0011] Optionally, the operation leveling control method includes:
[0012] Acquire a structural image of the working equipment, and create a dynamic model of the construction equipment and the stable platform according to the structural image;
[0013] Determining the operating reaction force and moment of the construction equipment on the stable platform according to the dynamic model;
[0014] Determining a compensation control amount corresponding to the stable platform according to the operating reaction force and torque;
[0015] The position and posture of the upper platform of the stable platform is adjusted according to the compensation control amount.
[0016] Optionally, the operating equipment includes a movable base, and the bottom end of the movable base is connected to a support structure with an adjustable height; after the step of determining the compensation control amount corresponding to the upper platform of the stable platform according to the swing distance and the swing angle, the method further includes:
[0017] When the compensation control amount is less than a preset compensation control amount, performing the step of adjusting the posture of the upper platform of the stabilizing platform according to the compensation control amount;
[0018] When the compensation control amount is greater than the preset compensation control amount, obtaining a current base seat posture and an original base seat posture of the movable base;
[0019] Determining a target support height of the support structure according to the current base seat posture and the original base seat posture;
[0020] The support height of the support structure is adjusted to the target support height so that the construction equipment is in a stable state.
[0021] Optionally, the method further comprises:
[0022] Acquire the current base seat posture and the original base seat posture of the movable base;
[0023] When the current base seat posture and the original base seat posture are not equal, determining a target support height of the support structure according to the current base seat posture and the original base seat posture;
[0024] The support height of the support structure is adjusted to the target support height so that the construction equipment is in a stable state.
[0025] Optionally, the bottom end of the lower platform is connected to a camera via a bracket, and the step of determining the swing distance of the lower platform according to the light spot position of the lower platform of the stabilizing platform and the center position of the lower platform comprises:
[0026] Acquire a planar image of the lower platform captured by the camera, identify the light spot in the planar image, and acquire the light spot position of the light spot and the center position of the lower platform;
[0027] Determine the eccentric distance of the lower platform according to the light spot position and the center position;
[0028] The swing distance of the lower platform is determined according to the eccentric distance.
[0029] Optionally, the step of determining a compensation control amount corresponding to the upper platform of the stable platform according to the yaw distance and the yaw angle includes:
[0030] Preprocessing the swing distance and the swing angle to obtain a target swing distance and a target swing angle;
[0031] Determining a compensation control amount corresponding to the upper platform of the stable platform according to the target swing distance and the target swing angle;
[0032] The posture of the upper platform of the stabilizing platform is adjusted according to the compensation control amount so that the construction equipment is in a stable state.
[0033] Optionally, before the step of determining the swing distance of the lower platform according to the light spot position of the lower platform of the stabilizing platform and the center position of the lower platform, the step includes:
[0034] Obtaining the working height of the construction equipment and the construction direction posture of the construction equipment;
[0035] Determining an adjustment height of the working platform according to the working height, and moving the working platform to the adjustment height;
[0036] Control the construction equipment to move in the construction direction to perform the construction task.
[0037] Optionally, the step of adjusting the posture of the upper platform of the stabilizing platform according to the compensation control amount so that the construction equipment is in a stable state includes:
[0038] Determining a target posture of the upper platform according to the compensation control amount;
[0039] The posture of the upper platform is adjusted to the target posture so that the construction equipment is in a stable state.
[0040] In addition, to achieve the above-mentioned purpose, the present invention also provides an operating equipment, which includes: a memory, a processor, and a leveling control program of the operating equipment stored in the memory and executable on the processor, and the leveling control program of the operating equipment implements the steps of the leveling control method of the operating equipment as described above when executed by the processor.
[0041] In addition, to achieve the above-mentioned purpose, the present invention also provides a computer-readable storage medium, on which a leveling control program for an operating equipment is stored. When the leveling control program for the operating equipment is executed by a processor, the steps of the leveling control method for the operating equipment as described above are implemented.
[0042] An embodiment of the present invention proposes a leveling control method for working equipment, working equipment and computer-readable storage medium, which determines the swing distance of the lower platform according to the offset between the light spot position and the center position of the lower platform of the stable platform, wherein the light spot corresponding to the light spot position is generated by the laser emitted by the laser ranging sensor hitting the lower platform, and the laser ranging sensor is located below the center position, and obtains the swing angle of the lower platform of the stable platform, and determines the compensation control amount corresponding to the upper platform of the stable platform according to the swing distance and the swing angle, and then adjusts the posture of the upper platform of the stable platform according to the compensation control amount, so that the construction equipment is in a stable state. By installing a six-degree-of-freedom stable platform between the construction equipment and the working platform, the stable platform is used for leveling, so that the construction equipment is in a stable state, and the construction accuracy and efficiency are improved. BRIEF DESCRIPTION OF THE DRAWINGS
[0043] Figure 1 It is a structural schematic diagram of the operating equipment involved in the present invention;
[0044] Figure 2 It is a schematic diagram of the lower platform of the six-degree-of-freedom stable platform involved in the present invention;
[0045] Figure 3 A schematic flow chart of an embodiment of a leveling control method for operating equipment of the present invention;
[0046] Figure 4 It is a schematic diagram of the reaction force of the construction equipment according to the present invention on the stable platform;
[0047] Figure 5 It is a detailed flow chart of step S30 in the second embodiment of the leveling control method of the working equipment of the present invention;
[0048] Figure 6 Another detailed flow chart of step S30 in the third embodiment of the leveling control method of the working equipment of the present invention;
[0049] Figure 7A schematic diagram of the system structure of the leveling control method according to the present invention;
[0050] Figure 8 It is a schematic diagram of the terminal structure of the hardware operating environment involved in the embodiment of the present invention.
[0051] The realization of the purpose, functional features and advantages of the present invention will be further explained in conjunction with embodiments and with reference to the accompanying drawings. DETAILED DESCRIPTION
[0052] It should be understood that the specific embodiments described herein are only used to explain the present invention, and are not used to limit the present invention.
[0053] In the related leveling technical solution, the preset position of the working platform when it is stable is pre-determined, and the supporting structure of the base is automatically adjusted when the base shakes so that the working platform can always maintain its preset position. However, for construction equipment with a large load, the above solution still cannot solve the technical problems of the errors caused by the gap between the lifting platform, the gap between the slide rails, and the reciprocating movement of the working platform, and the poor positioning accuracy leads to low construction accuracy and construction efficiency of the construction equipment.
[0054] In order to solve the above defects in the related art, the present invention proposes a leveling control method for working equipment, and its main solution steps include the following:
[0055] The deflection distance of the lower platform is determined by the offset between the light spot position and the center position of the lower platform of the stable platform, wherein the light spot corresponding to the light spot position is generated by the laser emitted by the laser ranging sensor hitting the lower platform, and the laser ranging sensor is located below the center position to obtain the deflection angle of the lower platform of the stable platform, and the compensation control amount corresponding to the upper platform of the stable platform is determined according to the deflection distance and deflection angle, and then the posture of the upper platform of the stable platform is adjusted according to the compensation control amount to keep the construction equipment in a stable state. A six-degree-of-freedom stable platform is installed between the construction equipment and the working platform, and the stable platform is used for leveling to keep the construction equipment in a stable state, thereby improving construction accuracy and efficiency.
[0056] In order to better understand the above technical solution, exemplary embodiments of the present application will be described in more detail below with reference to the accompanying drawings. Although exemplary embodiments of the present application are shown in the accompanying drawings, it should be understood that the present application can be implemented in various forms and should not be limited by the embodiments described herein. On the contrary, these embodiments are provided to enable a more thorough understanding of the present application and to fully convey the scope of the present application to those skilled in the art.
[0057] Reference Figure 1 , Figure 1It is a structural schematic diagram of the working equipment involved in the present invention. The working equipment includes a movable base 1, a working platform 2 and a six-degree-of-freedom stable platform 3. The movable base 1 includes a four-axle wheel drive 4 and an adjustable height support structure 5, the four-axle wheel drive 4 is used to move the working equipment, and the support structure is used to adjust the base posture of the movable base so that the construction equipment is in a stable state, thereby improving the construction accuracy and construction efficiency of the construction equipment; it can be understood that the six-degree-of-freedom stable platform 3 includes an upper platform 6 and a lower platform 7 and six electric cylinders 8, wherein the upper platform 6 is connected to the construction equipment 9, the lower platform 6 is connected to the working platform 2, and the electric cylinder 8 is used to drive the upper platform 6 to move in the six degrees of freedom. Refer to Figure 2 , Figure 2 The present invention is a schematic diagram of the lower platform of the six-degree-of-freedom stable platform. A nine-axis IMU (Inertial Measurement Unit, sensor) is arranged at the bottom of the lower platform, which is used to obtain the yaw angle of the lower platform, wherein the yaw angle includes the pitch angle (angle of rotation around the X-axis), the roll angle (angle of rotation around the Y-axis), and the yaw angle (angle of rotation around the Z-axis); a bracket is arranged on one side of the edge of the lower platform, and a camera is connected to the end of the bracket, and the camera is used to obtain a planar image of the bottom of the lower platform; a laser ranging sensor is arranged on the lower side of the center position of the lower platform, which is used to emit laser to the lower platform to form a light spot on the lower platform.
[0058] It should be noted that the construction equipment is not limited to the shape structure shown in the construction equipment 9 of the present invention, but can also be construction equipment of other shapes and structures used for construction. The construction equipment 9 is only used to reflect the position and connection relationship between the various platforms between the working equipment.
[0059] Reference Figure 3 In one embodiment of the leveling control method of the working equipment of the present invention, the leveling control method of the working equipment comprises the following steps:
[0060] Step S10: determining the deflection distance of the lower platform according to the offset between the light spot position and the center position of the lower platform of the stable platform, wherein the light spot corresponding to the light spot position is generated by the laser emitted by the laser ranging sensor hitting the lower platform, and the laser ranging sensor is located below the center position;
[0061] In this embodiment, a laser distance measuring sensor is pre-arranged on the lower side of the center position of the lower platform, and a laser is emitted to the center position by the laser distance measuring sensor to form a light spot on the lower platform. At this time, the light spot position of the light spot is consistent with the center position of the lower platform. It can be understood that when the light spot position is inconsistent with the center position of the lower platform, it can be determined that the construction equipment is disturbed, causing the lower platform to tilt. Optionally, the lower platform is connected to the working platform, and a laser distance measuring sensor can be set at the bottom or top of the working platform; or the laser distance measuring sensor is connected to the edge of the lower platform by setting a bracket, and the laser distance measuring sensor is aimed at the center position of the lower platform. The embodiment of the present invention does not make specific limitations on this.
[0062] Optionally, the plane image of the lower platform is collected by a camera, the light spot is identified according to the collected plane image, and the light spot position of the light spot and the center position of the lower platform are obtained, and the swing distance of the lower platform is determined according to the offset between the light spot position and the center position. It can be understood that when the offset between the light spot position and the center position is within the standard range, it indicates that the lower platform has not tilted, the construction equipment is in a stable state, and there is no need to level the construction equipment. When the offset between the light spot position and the center position does not exceed the standard range, it indicates that the lower platform has tilted, and the construction equipment is in an unstable state at this time, and the construction equipment needs to be leveled. Experiments can be conducted according to different types of construction equipment to determine the standard range intervals of the offsets corresponding to different types of construction equipment. It can be understood that the offset within the standard range interval will not affect the construction of the construction equipment, so the offset within the standard range interval indicates that the lower platform has not tilted and the construction equipment is in a stable state.
[0063] Step S20: obtaining the deflection angle of the lower platform of the stabilizing platform;
[0064] In this embodiment, the yaw angle of the lower platform is obtained by a nine-axis IMU pre-set on the lower platform. It can be understood that the yaw angle includes a pitch angle, a roll angle, and a yaw angle. It can be understood that the pitch angle is the angle of rotation around the X-axis, the roll angle is the angle of rotation around the Y-axis, and the yaw angle is the angle of rotation around the Z-axis.
[0065] Step S30: determining a compensation control amount corresponding to the upper platform of the stable platform according to the deflection distance and the deflection angle;
[0066] Step S40: adjusting the posture of the upper platform of the stabilizing platform according to the compensation control amount so that the construction equipment is in a stable state.
[0067] In this embodiment, after determining the compensation control amount corresponding to the upper platform, the target posture of the upper platform is determined according to the compensation control amount, and the posture of the upper platform is adjusted to the target posture according to the compensation control amount to keep the construction equipment in a stable state.
[0068] Optionally, in another optional embodiment, referring to Figure 4 , Figure 4 The present invention is a schematic diagram of the operating force reaction force of the construction equipment on the stable platform. The structural image of the operating equipment can be obtained through a camera, and a dynamic model of the construction equipment and the stable platform can be created based on the structural image; the operating reaction force and torque of the construction equipment on the stable platform can be determined based on the dynamic model; the compensation control amount corresponding to the stable platform can be determined based on the operating reaction force and torque; and the posture of the upper platform of the stable platform can be adjusted based on the compensation control amount.
[0069] In this embodiment, the operating force reaction force is the main source of interference during construction operations. Whether it is wind load or the operating force of the construction equipment that causes the construction equipment to be unstable, the operating force reaction force of the construction equipment will increase. Therefore, the structural images of the operating equipment in various directions can be taken in advance by a camera to create a dynamic model of the construction equipment on the stable platform, and perform force analysis to obtain the operating force reaction force and torque of the construction equipment on the stable platform. The compensation control amount is determined based on the operating force reaction force and torque. This embodiment does not make specific restrictions on this. The dynamic model of the operating equipment can be created through a simulation system. It only needs to input the structural image and the weight parameters of each platform on the operating equipment into the simulation system. The simulation system can automatically perform force analysis and output the operating force reaction force and torque of the construction equipment on the stable platform. The simulation system can use Flac3D (three-dimensional simulation software), Simerics PumpLinx (CFD simulation software) or other simulation system software for dynamic analysis. This embodiment does not make specific restrictions on this.
[0070] In the technical solution provided in this embodiment, the deflection distance of the lower platform is determined according to the offset between the light spot position and the center position of the lower platform of the stable platform, wherein the light spot corresponding to the light spot position is generated by the laser emitted by the laser ranging sensor hitting the lower platform, and the laser ranging sensor is located below the center position to obtain the deflection angle of the lower platform of the stable platform, and the compensation control amount corresponding to the upper platform of the stable platform is determined according to the deflection distance and the deflection angle, and then the posture of the upper platform of the stable platform is adjusted according to the compensation control amount to stabilize the construction equipment. A six-degree-of-freedom stable platform is installed between the construction equipment and the working platform, and the stable platform is used for leveling to stabilize the construction equipment, thereby improving the construction accuracy and efficiency.
[0071] Reference Figure 5In the second embodiment, based on the first embodiment, after step S30, the following steps are included:
[0072] Step S50: When the compensation control amount is less than a preset compensation control amount, performing the step of adjusting the posture of the upper platform of the stabilizing platform according to the compensation control amount;
[0073] Step S60: when the compensation control amount is greater than the preset compensation control amount, obtaining the current base seat posture and the original base seat posture of the movable base;
[0074] Step S70: determining a target support height of the support structure according to the current base seat posture and the original base seat posture;
[0075] Step S80: adjusting the support height of the support structure to the target support height so that the construction equipment is in a stable state.
[0076] In this embodiment, different methods are used for leveling according to different degrees of interference. Since the amplitude of each adjustment of the support structure of the movable base is larger than the amplitude of each adjustment of the stable platform, the low-frequency and large-amplitude interference of the present invention is leveled by the movable base, and the medium-high frequency and low-amplitude interference is leveled by the stable platform with six degrees of freedom. It can be understood that the low-frequency and large-amplitude interference can improve the leveling rate by leveling the movable base, while the medium-high frequency and low-amplitude interference can improve the leveling accuracy by leveling the stable platform with six degrees of freedom. Therefore, when the compensation control amount of the upper platform is greater than the preset compensation control amount, it indicates that the current interference is low-frequency and large-amplitude interference, so that the construction equipment is in a stable state by adjusting the support structure of the movable base. When the compensation control amount is less than the preset compensation control amount, it indicates that the interference is medium-high frequency and low-amplitude interference. In order to improve the accuracy of the adjustment, the upper platform is adjusted by mobilizing the electric cylinder of the stable platform to make the construction equipment in a stable state.
[0077] Optionally, in another optional implementation, the base posture of the movable base and the posture of the lower platform of the six-degree-of-freedom stable platform can be detected in real time, and whether the leveling conditions of the movable base are met is determined according to the base posture. If so, the movable base is used for leveling to stabilize the construction equipment, and whether the leveling conditions of the six-degree-of-freedom stable platform are met is determined according to the posture of the lower platform. If so, the stable platform is used for leveling to stabilize the construction equipment. It should be noted that the leveling of the movable base and the leveling of the stable platform can refer to the technical solutions mentioned above in the present invention, which will not be repeated here.
[0078] Optionally, before the step of determining the swing distance of the lower platform according to the light spot position of the lower platform of the stable platform and the center position of the lower platform, the step includes: acquiring the working height of the construction equipment and the construction direction posture of the construction equipment, and then determining the adjustment height of the working platform according to the working height, and moving the working platform to the adjustment height, controlling the construction equipment to move in the construction direction posture, and performing the construction task.
[0079] In the technical solution provided in this embodiment, when the compensation control amount is less than the preset compensation control amount, the step of adjusting the posture of the upper platform of the stable platform according to the compensation control amount is performed, and when the compensation control amount is greater than the preset compensation control amount, the current base seat posture and the original base seat posture of the movable base are obtained, and then the target support height of the support structure is determined according to the current base seat posture and the original base seat posture, and the support height of the support structure is adjusted to the target support height, so that the construction equipment is in a stable state. By adding two leveling methods to the operating equipment of the present invention, low-frequency and large-amplitude interference is leveled through the movable base, and medium and high-frequency interference is leveled through the six-degree-of-freedom stable platform, thereby improving the leveling accuracy of the construction equipment, and achieving the improvement of the construction accuracy and construction efficiency of the construction equipment.
[0080] Reference Figure 6 In a third embodiment, based on any of the above embodiments, step S30 includes:
[0081] Step S31: pre-processing the swing distance and the swing angle to obtain a target swing distance and a target swing angle;
[0082] In this embodiment, the preprocessing is filtering, aligning, interpolating, and fusing the yaw distance and yaw angle. It can be understood that the above yaw distance and yaw angle are determined by data acquired by the sensor, and the sensor collects multiple data. Preprocessing is used to eliminate erroneous data, select the optimal data output, and improve positioning accuracy.
[0083] Step S32: determining a compensation control amount corresponding to the upper platform of the stable platform according to the target swing distance and the target swing angle;
[0084] Step S40: adjusting the posture of the upper platform of the stabilizing platform according to the compensation control amount so that the construction equipment is in a stable state.
[0085] In this embodiment, since the target swing distance and the target swing angle are preprocessed, the compensation control amount determined according to the target swing distance and the target swing angle is more accurate. Therefore, after the position of the upper platform of the stable platform is subsequently adjusted according to the compensation control amount, the construction equipment is in a stable state, thereby improving the construction accuracy and efficiency of the construction equipment.
[0086] Optionally, in another optional embodiment, the leveling control method of the working equipment further includes: obtaining the current base seat posture and the original base seat posture of the movable base; when the current base seat posture and the original base seat posture are not equal, determining the target support height of the support structure according to the current base seat posture and the original base seat posture; adjusting the support height of the support structure to the target support height so that the construction equipment is in a stable state.
[0087] In this embodiment, when the current base posture of the movable base is not equal to the original base posture, the posture of the movable base is directly adjusted. It can be understood that after adjusting the support height of the support structure to the target support height, the current base posture of the movable base is equal to the original base posture.
[0088] It should be noted that the present invention performs posture detection on the movable base and the six-degree-of-freedom stable platform in real time, and when the current base posture of the movable base is not equal to the original base posture, the base posture of the movable base is adjusted to keep the construction equipment in a stable state; when the swing distance of the six-degree-of-freedom stable platform exceeds the standard swing distance range, the posture of the upper platform of the six-degree-of-freedom stable platform is adjusted to keep the construction equipment in a stable state.
[0089] Further, see Figure 7 , Figure 7 The system structure diagram of the leveling control method involved in the present invention. A base posture sensing system and a platform posture sensing system can be set. Both the base posture sensing system and the platform posture sensing system are connected to the controller. When the posture changes, the posture is adjusted by the controller to keep the construction equipment in a stable state. It can be understood that the platform posture sensing system is composed of a camera, a nine-axis IMU and a laser ranging sensor. Optionally, the platform posture sensing system can also determine the platform posture through VLAM (Vertical Line Array Measurement), or through visual beacon observation or optical flow and other technologies. The observation amount can effectively correct the long-term drift error of the inertial sensor, and this embodiment does not make specific limitations on this.
[0090] In the technical solution provided in this embodiment, after determining the swing distance and the swing angle, the swing distance and the swing angle are preprocessed to obtain the target swing distance and the target swing angle, and then the compensation control amount corresponding to the upper platform of the stable platform is determined according to the target swing distance and the target swing angle, and then the posture of the upper platform is adjusted according to the compensation control amount to make the construction equipment in a stable state. By preprocessing the swing distance and the swing angle, and then determining the compensation control amount, the accuracy of the compensation control amount is improved, so that when the posture of the upper platform is adjusted according to the compensation control amount, the leveling accuracy of the construction equipment can be improved, thereby further improving the construction accuracy and construction efficiency of the construction equipment.
[0091] Reference Figure 8 , Figure 8 The figure is a schematic diagram of the terminal structure of the hardware operating environment involved in the embodiment of the present invention.
[0092] The terminal in the embodiment of the present invention may be an operating device.
[0093] like Figure 8 As shown, the terminal may include: a processor 1001, such as a CPU, a network interface 1004, a user interface 1003, a memory 1005, and a communication bus 1002. Among them, the communication bus 1002 is used to realize the connection and communication between these components. The user interface 1003 may include a display screen (Display), etc., and the optional user interface 1003 may also include a standard wired interface and a wireless interface. The network interface 1004 may optionally include a standard wired interface and a wireless interface (such as a WI-FI interface). The memory 1005 may be a high-speed RAM memory, or a stable memory (non-volatile memory), such as a disk memory. The memory 1005 may also be a storage device independent of the aforementioned processor 1001.
[0094] Those skilled in the art will understand that Figure 8 The terminal structure shown in the figure does not constitute a limitation on the terminal, and may include more or less components than shown in the figure, or combine certain components, or arrange the components differently.
[0095] like Figure 8 As shown, the memory 1005 as a computer storage medium may include an operating system, a network communication module, a user interface module, and a leveling control program for the operating equipment.
[0096] exist Figure 8 In the terminal shown, the network interface 1004 is mainly used to connect to the background server and perform data communication with the background server; the processor 1001 can be used to call the leveling control program of the operating equipment stored in the memory 1005 and perform the following operations:
[0097] Determine the swing distance of the lower platform according to the offset between the light spot position and the center position of the lower platform of the stable platform, wherein the light spot corresponding to the light spot position is generated by the laser emitted by the laser ranging sensor hitting the lower platform, and the laser ranging sensor is located at the lower side of the center position;
[0098] Obtaining the deflection angle of the lower platform of the stable platform;
[0099] Determining a compensation control amount corresponding to the upper platform of the stable platform according to the deflection distance and the deflection angle;
[0100] The posture of the upper platform of the stabilizing platform is adjusted according to the compensation control amount so that the construction equipment is in a stable state.
[0101] Furthermore, the processor 1001 may call the leveling control program of the working equipment stored in the memory 1005, and further perform the following operations:
[0102] Acquire a structural image of the working equipment, and create a dynamic model of the construction equipment and the stable platform according to the structural image;
[0103] Determining the operating reaction force and moment of the construction equipment on the stable platform according to the dynamic model;
[0104] Determining a compensation control amount corresponding to the stable platform according to the operating reaction force and torque;
[0105] The position and posture of the upper platform of the stable platform is adjusted according to the compensation control amount.
[0106] Furthermore, the processor 1001 may call the leveling control program of the working equipment stored in the memory 1005, and further perform the following operations:
[0107] When the compensation control amount is less than a preset compensation control amount, performing the step of adjusting the posture of the upper platform of the stabilizing platform according to the compensation control amount;
[0108] When the compensation control amount is greater than the preset compensation control amount, obtaining a current base seat posture and an original base seat posture of the movable base;
[0109] Determining a target support height of the support structure according to the current base seat posture and the original base seat posture;
[0110] The support height of the support structure is adjusted to the target support height so that the construction equipment is in a stable state.
[0111] Furthermore, the processor 1001 may call the leveling control program of the working equipment stored in the memory 1005, and further perform the following operations:
[0112] Acquire the current base seat posture and the original base seat posture of the movable base;
[0113] When the current base seat posture and the original base seat posture are not equal, determining a target support height of the support structure according to the current base seat posture and the original base seat posture;
[0114] The support height of the support structure is adjusted to the target support height so that the construction equipment is in a stable state.
[0115] Furthermore, the processor 1001 may call the leveling control program of the working equipment stored in the memory 1005, and further perform the following operations:
[0116] Acquire a planar image of the lower platform captured by the camera, identify the light spot in the planar image, and acquire the light spot position of the light spot and the center position of the lower platform;
[0117] Determine the eccentric distance of the lower platform according to the light spot position and the center position;
[0118] The swing distance of the lower platform is determined according to the eccentric distance.
[0119] Furthermore, the processor 1001 may call the leveling control program of the working equipment stored in the memory 1005, and further perform the following operations:
[0120] Preprocessing the swing distance and the swing angle to obtain a target swing distance and a target swing angle;
[0121] Determining a compensation control amount corresponding to the upper platform of the stable platform according to the target swing distance and the target swing angle;
[0122] The posture of the upper platform of the stabilizing platform is adjusted according to the compensation control amount so that the construction equipment is in a stable state.
[0123] Furthermore, the processor 1001 may call the leveling control program of the working equipment stored in the memory 1005, and further perform the following operations:
[0124] Obtaining the working height of the construction equipment and the construction direction posture of the construction equipment;
[0125] Determining an adjustment height of the working platform according to the working height, and moving the working platform to the adjustment height;
[0126] Control the construction equipment to move in the construction direction to perform the construction task.
[0127] Furthermore, the processor 1001 may call the leveling control program of the working equipment stored in the memory 1005, and further perform the following operations:
[0128] Determining a target posture of the upper platform according to the compensation control amount;
[0129] The posture of the upper platform is adjusted to the target posture so that the construction equipment is in a stable state.
[0130] In addition, to achieve the above-mentioned purpose, the present invention also provides an operating equipment, which includes: a memory, a processor, and a leveling control program of the operating equipment stored in the memory and executable on the processor, and the leveling control program of the operating equipment implements the steps of the leveling control method of the operating equipment as described above when executed by the processor.
[0131] In addition, to achieve the above-mentioned purpose, the present invention also provides a computer-readable storage medium, on which a leveling control program for an operating equipment is stored. When the leveling control program for the operating equipment is executed by a processor, the steps of the leveling control method for the operating equipment as described above are implemented.
[0132] It should be noted that, in this article, the terms "include", "comprises" or any other variations thereof are intended to cover non-exclusive inclusion, so that a process, method, article or system including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or system. In the absence of further restrictions, an element defined by the sentence "comprises a ..." does not exclude the existence of other identical elements in the process, method, article or system including the element.
[0133] The serial numbers of the above embodiments of the present invention are only for description and do not represent the advantages or disadvantages of the embodiments.
[0134] Through the description of the above implementation methods, those skilled in the art can clearly understand that the above-mentioned embodiment methods can be implemented by means of software plus a necessary general hardware platform, and of course by hardware, but in many cases the former is a better implementation method. Based on such an understanding, the technical solution of the present invention is essentially or the part that contributes to the prior art can be embodied in the form of a software product, which is stored in a storage medium (such as ROM / RAM. Disk. CD) as described above, and includes a number of instructions for enabling a terminal device (which can be an aerial work device) to execute the methods described in each embodiment of the present invention.
[0135] The above are only preferred embodiments of the present invention, and are not intended to limit the patent scope of the present invention. Any equivalent structure or equivalent process transformation made using the contents of the present invention specification and drawings, or directly or indirectly applied in other related technical fields, are also included in the patent protection scope of the present invention.
Claims
1. A leveling control method for operating equipment, characterized in that: Used to control the working equipment, the working equipment includes a working platform with adjustable height; a six-degree-of-freedom stabilizing platform is installed on the upper side of the working platform, and the stabilizing platform is connected to the construction equipment and the working platform; the leveling control method of the working equipment includes: Determine the swing distance of the lower platform according to the offset between the light spot position and the center position of the lower platform of the stable platform, wherein the light spot corresponding to the light spot position is generated by the laser emitted by the laser ranging sensor hitting the lower platform, and the laser ranging sensor is located at the lower side of the center position; Obtaining the deflection angle of the lower platform of the stable platform; Determining a compensation control amount corresponding to the upper platform of the stable platform according to the deflection distance and the deflection angle; The posture of the upper platform of the stabilizing platform is adjusted according to the compensation control amount so that the construction equipment is in a stable state.
2. The leveling control method of the working equipment according to claim 1, characterized in that: The operation leveling control method comprises: Acquire a structural image of the working equipment, and create a dynamic model of the construction equipment and the stable platform according to the structural image; Determining the operating reaction force and moment of the construction equipment on the stable platform according to the dynamic model; Determining a compensation control amount corresponding to the stable platform according to the operating reaction force and torque; The position and posture of the upper platform of the stable platform is adjusted according to the compensation control amount.
3. The leveling control method of the working equipment according to claim 1, characterized in that: The working equipment includes a movable base, and the bottom end of the movable base is connected to a support structure with adjustable height; after the step of determining the compensation control amount corresponding to the upper platform of the stable platform according to the swing distance and the swing angle, it includes: When the compensation control amount is less than a preset compensation control amount, performing the step of adjusting the posture of the upper platform of the stabilizing platform according to the compensation control amount; When the compensation control amount is greater than the preset compensation control amount, obtaining a current base seat posture and an original base seat posture of the movable base; Determining a target support height of the support structure according to the current base seat posture and the original base seat posture; The support height of the support structure is adjusted to the target support height so that the construction equipment is in a stable state.
4. The leveling control method of the working equipment according to claim 3, characterized in that: The method further comprises: Acquire the current base seat posture and the original base seat posture of the movable base; When the current base seat posture and the original base seat posture are not equal, determining a target support height of the support structure according to the current base seat posture and the original base seat posture; The support height of the support structure is adjusted to the target support height so that the construction equipment is in a stable state.
5. The leveling control method of the working equipment according to claim 1, characterized in that: The bottom end of the lower platform is connected to a camera via a bracket, and the step of determining the swing distance of the lower platform according to the light spot position of the lower platform of the stabilizing platform and the center position of the lower platform comprises: Acquire a planar image of the lower platform captured by the camera, identify the light spot in the planar image, and acquire the light spot position of the light spot and the center position of the lower platform; Determine the eccentric distance of the lower platform according to the light spot position and the center position; The swing distance of the lower platform is determined according to the eccentric distance.
6. The leveling control method of the working equipment according to claim 1, characterized in that: The step of determining the compensation control amount corresponding to the upper platform of the stable platform according to the swing distance and the swing angle comprises: Preprocessing the swing distance and the swing angle to obtain a target swing distance and a target swing angle; Determining a compensation control amount corresponding to the upper platform of the stable platform according to the target swing distance and the target swing angle; The posture of the upper platform of the stabilizing platform is adjusted according to the compensation control amount so that the construction equipment is in a stable state.
7. The leveling control method of the working equipment according to claim 1, characterized in that: Before the step of determining the deflection distance of the lower platform according to the light spot position of the lower platform of the stabilizing platform and the center position of the lower platform, the method includes: Obtaining the working height of the construction equipment and the construction direction posture of the construction equipment; Determining an adjustment height of the working platform according to the working height, and moving the working platform to the adjustment height; Control the construction equipment to move in the construction direction to perform the construction task.
8. The leveling control method of the working equipment according to claim 1, characterized in that: The step of adjusting the posture of the upper platform of the stabilizing platform according to the compensation control amount so that the construction equipment is in a stable state comprises: Determining a target posture of the upper platform according to the compensation control amount; The posture of the upper platform is adjusted to the target posture so that the construction equipment is in a stable state.
9. An operating device, characterized in that: The working equipment includes: a memory, a processor, and a leveling control program of the working equipment stored in the memory and executable on the processor. When the leveling control program of the working equipment is executed by the processor, the steps of the leveling control method of the working equipment as described in any one of claims 1 to 8 are implemented.
10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a leveling control program for the working equipment, and when the leveling control program for the working equipment is executed by the processor, the steps of the leveling control method for the working equipment according to any one of claims 1 to 8 are implemented.
