Excavator parameter calibration methods, devices, equipment and storage media
By filtering excavator joint data to obtain joint angle torque information, and calibrating hydraulic cylinder friction and gravitational torque, the problems of accuracy and time in excavator parameter calibration are solved, achieving efficient and accurate parameter calibration.
Patent Information
- Application Number
- CN202410688165.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-05-29
- Publication Date
- 2026-11-10
- Estimated Expiration
- 2044-05-29
AI Technical Summary
Existing technologies for excavator parameter calibration have shortcomings in terms of accuracy and calibration time. In particular, in excavator operation scenarios, dynamic model calibration methods are complex and costly, while data fitting methods have large errors and cannot meet the requirements for high precision and rapid calibration.
By filtering excavator joint data based on preset thresholds, joint angle torque information is obtained, hydraulic cylinder friction force and joint gravity torque are determined, and the connecting rod gravity parameters are calibrated using this information. This simplifies data acquisition requirements and improves the accuracy and robustness of calibration.
It reduces calibration complexity, improves calibration accuracy and reliability, reduces data collection volume, adapts to the special characteristics of excavator operation scenarios, and enhances the robustness and reliability of the calibration algorithm.
Smart Images

Figure CN118596189B_ABST
Abstract
Description
Technical Field
[0001] This application relates to the field of information processing technology, and more specifically, to a method, apparatus, device, and storage medium for calibrating excavator parameters. Background Technology
[0002] To achieve precise control of the robotic arm, its dynamic parameters need to be calibrated before it begins operation. Currently, there are two methods for calibrating the dynamic parameters of a robotic arm: dynamic model calibration and data fitting.
[0003] The dynamic model calibration method requires pre-constructing a dynamic model, and then obtaining the optimal estimates of the dynamic parameters through system identification. The data fitting method requires fitting calculations using a large amount of data to obtain the dynamic parameters.
[0004] However, due to the special nature of excavator operation scenarios, the above two calibration methods for robotic arms have problems of poor accuracy and long calibration time when used for excavator parameter calibration. Summary of the Invention
[0005] The purpose of this application is to address the shortcomings of the prior art by providing a method, apparatus, device, and storage medium for calibrating excavator parameters, thereby solving the problems of poor accuracy and long calibration time in the application of the prior art for calibrating excavator parameters.
[0006] To achieve the above objectives, the technical solution adopted in this application is as follows:
[0007] Firstly, this application provides a method for calibrating excavator parameters, the method comprising:
[0008] Based on a preset threshold, the joint data of the excavator to be calibrated is filtered to obtain the joint angle torque information of the excavator to be calibrated. The joint angle torque information is used to characterize the relationship between the joint angle and the driving torque of the excavator to be calibrated.
[0009] Based on the joint angle torque information, determine the hydraulic cylinder friction force and joint gravity torque of the excavator to be calibrated;
[0010] The linkage gravity parameters of the excavator to be calibrated are determined based on the joint data and the joint gravity torque.
[0011] Secondly, this application provides an excavator parameter calibration device, the device comprising:
[0012] The first determining module is used to filter the joint data of the excavator to be calibrated based on a preset threshold to obtain the joint angle torque information of the excavator to be calibrated. The joint angle torque information is used to characterize the relationship between the joint angle and the driving torque of the excavator to be calibrated.
[0013] The second determining module is used to determine the hydraulic cylinder friction force and joint gravity torque of the excavator to be calibrated based on the joint angle torque information.
[0014] The third determining module is used to determine the link gravity parameters of the excavator to be calibrated based on the joint data and the joint gravity torque.
[0015] Thirdly, embodiments of this application also provide an electronic device, including: a processor, a storage medium, and a bus, wherein the storage medium stores machine-readable instructions executable by the processor, and when the electronic device is running, the processor communicates with the storage medium via the bus, and the processor executes the machine-readable instructions to perform the steps of an excavator parameter calibration method as described in any one of the first aspects.
[0016] Fourthly, embodiments of this application also provide a computer-readable storage medium storing a computer program, which, when executed by a processor, performs the steps of an excavator parameter calibration method as described in any one of the first aspects.
[0017] The beneficial effects of this application are as follows: Based on a preset threshold, the joint data of the excavator to be calibrated is filtered to obtain the joint angle and torque information of the excavator. This information characterizes the relationship between the joint angles and driving torque of the excavator. Based on this information, the hydraulic cylinder friction force and joint gravity torque of the excavator are determined. Finally, the linkage gravity parameters of the excavator are determined based on the joint data and joint gravity torque. This application addresses the specific characteristics of excavator operation scenarios by calibrating only the dominant factors, reducing calibration complexity. Furthermore, based on the special structure of the excavator arm, an optimized calibration method for friction and gravity parameters is proposed, improving the accuracy of data calibration, increasing the robustness and reliability of the calibration algorithm, and reducing the amount of data collection required. By filtering the joint data based on a preset threshold, more suitable joint data can be selected, ensuring the traceability and reliability of the joint data and improving the accuracy of subsequent calibration.
[0018] To make the above-mentioned objectives, features and advantages of this application more apparent and understandable, preferred embodiments are described below in detail with reference to the accompanying drawings. Attached Figure Description
[0019] To more clearly illustrate the technical solutions of the embodiments of this application, the accompanying drawings used in the embodiments will be briefly introduced below. It should be understood that the following drawings only show some embodiments of this application and should not be regarded as a limitation of the scope. For those skilled in the art, other related drawings can be obtained based on these drawings without creative effort.
[0020] Figure 1 This illustration shows a structural schematic diagram of an excavator provided in an embodiment of this application;
[0021] Figure 2 A flowchart of an excavator parameter calibration method provided in an embodiment of this application is shown;
[0022] Figure 3 A flowchart illustrating a method for determining joint angle torque information according to an embodiment of this application is shown;
[0023] Figure 4 A flowchart illustrating a method for generating a second curve, as provided in an embodiment of this application, is shown.
[0024] Figure 5 This document illustrates another flowchart for determining joint angle torque information provided in an embodiment of this application.
[0025] Figure 6 This application provides a flowchart illustrating the calibration of frictional force and gravitational torque according to an embodiment of the present application.
[0026] Figure 7 This application provides a flowchart for calibrating gravity parameters according to an embodiment.
[0027] Figure 8 This document illustrates a flowchart of another method for calibrating gravity parameters, as provided in an embodiment of this application.
[0028] Figure 9 This illustration shows a structural schematic diagram of an excavator parameter calibration device provided in an embodiment of this application;
[0029] Figure 10 A schematic diagram of the structure of an electronic device provided in an embodiment of this application is shown. Detailed Implementation
[0030] To make the objectives, technical solutions, and advantages of the embodiments of this application clearer, the technical solutions of the embodiments of this application will be clearly and completely described below with reference to the accompanying drawings. Obviously, the described embodiments are only some embodiments of this application, and not all embodiments. The components of the embodiments of this application described and shown in the accompanying drawings can generally be arranged and designed in various different configurations. Therefore, the following detailed description of the embodiments of this application provided in the accompanying drawings is not intended to limit the scope of the claimed application, but merely represents selected embodiments of this application. All other embodiments obtained by those skilled in the art based on the embodiments of this application without inventive effort are within the scope of protection of this application.
[0031] It should be noted that the term "comprising" will be used in the embodiments of this application to indicate the presence of the features declared thereafter, but does not exclude the addition of other features.
[0032] Force control and end-effector force estimation in excavators are crucial for improving excavation efficiency, environmental awareness, and safety. To achieve excavator arm dynamics control, accurate weight, center of gravity dimensions, and hydraulic cylinder friction parameters of the arm linkages are required. Due to the limitations of the excavator arm's mounting structure, it's generally impossible to directly measure spatial forces using torque sensors. Instead, hydraulic sensors are needed to measure hydraulic cylinder pressure, and the hydraulic cylinders and the robotic arm must be modeled to estimate the force at the excavator arm's end effector from hydraulic pressure. Accurate and rapid calibration of these dynamic parameters significantly impacts the final control effectiveness of the excavator's automatic control system.
[0033] There are two main methods for calibrating the parameters of robotic arms in the current technology. The first is the dynamic model calibration method, which requires the pre-construction of a dynamic model and then obtaining the optimal estimate of the dynamic parameters through system identification. The second is the data fitting method, which requires fitting calculations using a large amount of data to obtain the dynamic parameters.
[0034] The first calibration method, used for excavator parameter calibration, requires precise hydraulic servo valves to control the excitation trajectory during data acquisition. However, precision hydraulic valves are generally unsuitable for the harsh working conditions of actual excavators or significantly increase costs. Even with precision servo valves, excavator modeling is still necessary for better excitation trajectory tracking, but excavator modeling relies on dynamic parameters. Furthermore, the parameters of the dynamic model are overly complex, and the inevitable delays and instabilities of the hydraulic system lead to high data noise, further causing the calibration to easily deviate from the correct parameter range.
[0035] The second calibration method is used when calibrating excavator parameters. Generally, it can only select a fixed excavator position for static measurement. Therefore, when measuring based on the acquired data, there are problems such as large fitting errors and unpredictable results.
[0036] Therefore, when calibrating the dynamic parameters of excavators using existing technologies, there are problems of poor accuracy and long calibration times. How to obtain high-precision calibration results with less calibration time and more calibration data, and improve the accuracy and efficiency of calibration, has become an urgent problem to be solved.
[0037] Based on this, this application proposes a method for calibrating the dynamic parameters of an excavator. Due to the specific working environment of excavators, the dominant factors affecting excavator operation are calibrated. The calibration algorithm employed has higher robustness and reliability. Compared to existing technologies, this application collects less data and uses a simpler data collection method, ensuring the traceability and reliability of the collected data while reducing the amount of data required.
[0038] Figure 1 This application provides a schematic diagram of an excavator structure, taking a hydraulically driven three-link excavator arm as an example. The parts requiring dynamic parameter calibration include the excavator boom, arm, and bucket shown in the diagram. Before the excavator is put into use, its dynamic parameters can be calibrated based on the method described in this application.
[0039] Next, combine Figure 2 The excavator parameter calibration method of this application is described. The execution subject of this method can be an electronic device. After the collected joint data is input into the electronic device, the electronic device can determine the excavator's dynamic parameters based on the method of this application. For example... Figure 2 As shown, the method includes:
[0040] Step 201: Based on a preset threshold, filter the joint data of the excavator to be calibrated to obtain the joint angle torque information of the excavator to be calibrated. The joint angle torque information is used to characterize the relationship between the joint angle and the driving torque of the excavator to be calibrated.
[0041] Optionally, the joint data of the excavator to be calibrated includes the joint data of the boom, the joint data of the forearm, and the joint data of the bucket. Sensors can be installed at the locations of the hydraulic cylinders of each joint to collect joint data.
[0042] Taking the acquisition of boom joint data as an example, the forearm and bucket joints can be fixed in place, and forward and reverse excitation trajectories can be executed. The hydraulic data, joint angle data, and rotation direction of the boom can be recorded by sensors set at the position of the boom hydraulic cylinder as the joint data of the boom.
[0043] After collecting joint data, the joint data can be filtered based on preset thresholds. For example, joint data with slopes or fluctuation amplitudes that meet preset thresholds can be filtered. After filtering the joint data, the joint angle torque information of the excavator to be calibrated can be determined based on the filtered joint data.
[0044] The excitation trajectory can be predefined. As an example, the excitation trajectory can use a simple control signal or control law to allow a single joint to rotate at a low speed with the smallest possible smooth joint velocity. Optional excitation trajectories include constant solenoid valve voltage / current signals and simple PID speed control of the joint. One rotation in the forward direction from the upper limit position to the lower limit position and one rotation in the reverse direction from the lower limit position to the upper limit position are performed respectively.
[0045] The joint data includes time information. After processing the joint data based on the time information, the driving torque of each joint can be calculated separately. The joint angle torque information is determined based on the driving torque and the joint angle in the joint data. The joint angle torque information is used to characterize the relationship between the joint angle and the driving torque of the excavator.
[0046] Reference Figure 1 The joint angles include the angle q0 between the excavator's boom and the vertical direction, the angle q1 between the forearm and the extension line of the boom, and the angle q2 between the bucket and the extension line of the forearm. The driving torque includes the driving torque of the boom, the driving torque of the forearm, and the driving torque of the bucket.
[0047] Step 202: Based on the joint angle torque information, determine the hydraulic cylinder friction force and joint gravity torque of the excavator to be calibrated.
[0048] Reference Figure 1 The hydraulic cylinder friction force of the excavator to be calibrated includes the hydraulic cylinder friction force F of the boom joint. fri_boom The hydraulic cylinder friction force F of the forearm joint fri_arm And the hydraulic cylinder friction F of the bucket joint fri_bucket .
[0049] Figure 1 When the hydraulic cylinders of each joint move back and forth at the same constant speed, the frictional force under the same posture can be approximated as the same magnitude. Therefore, after obtaining the joint angle torque information based on the data of the constant up and down movement of the joint, the hydraulic cylinder friction force and joint gravity torque of each joint can be calibrated according to the joint angle torque information.
[0050] Step 203: Determine the link gravity parameters of the excavator to be calibrated based on the joint data and joint gravity torque.
[0051] Optionally, the link gravity parameters include the weight of the joint and the position of its center of gravity. The link gravity parameters of the excavator to be calibrated include the weight of the boom joint and the position of its center of gravity, the weight of the forearm joint and the position of its center of gravity, and the weight of the bucket joint and the position of its center of gravity.
[0052] It is worth noting that since the operating speed of each joint of the excavator is relatively slow during operation, the influence of centrifugal force and Coriolis force can be basically ignored. Therefore, for this special scenario, the method of this application only calibrates the dominant factors such as friction and gravity parameters, which reduces the complexity of parameter calibration and reduces the amount of data collection required.
[0053] In this embodiment, the joint angle and torque information of the excavator to be calibrated is determined based on the joint data. This information characterizes the relationship between the joint angles and driving torque of the excavator. Based on this information, the hydraulic cylinder friction force and joint gravity torque of the excavator are determined. Finally, the connecting rod gravity parameters are determined based on the joint data and joint gravity torque. This application addresses the specific characteristics of excavator operation scenarios by calibrating only the dominant factors, reducing calibration complexity. Furthermore, based on the unique structure of the excavator arm, an optimized calibration method for friction and gravity parameters is proposed, improving the accuracy of data calibration, increasing the robustness and reliability of the calibration algorithm, and reducing the amount of data collection required.
[0054] The following explains the steps for determining the joint angle and torque information of the excavator to be calibrated based on its joint data. Figure 3 As shown, step 201 above includes:
[0055] Step 301: Determine the torque information of each joint and the first curve of each joint based on the joint data. The first curve is used to characterize the relationship between time and joint velocity.
[0056] After obtaining the joint data, based on the excavator's configuration and joint data, the hydraulic cylinder thrust and driving torque of each joint of the excavator can be calculated first, and the calculated hydraulic cylinder thrust and driving torque can be added to the joint data.
[0057] Optionally, for each segment of the joint motion trajectory described in the joint data, a time-joint velocity curve can be plotted, and the time-joint velocity curve corresponding to the interval with smaller joint acceleration and smaller velocity fluctuation can be used as the first curve.
[0058] Step 302: Generate a second curve based on the first curve, the preset first threshold, and the joint data. The second curve is used to characterize the relationship between the joint angle and the driving torque.
[0059] The second curve can be the joint angle-driving torque curve, which describes how the driving torque changes with the joint angle.
[0060] Optionally, the preset first threshold can characterize the range of slope values and the range of velocity differences. When determining the first curve, the time-joint velocity curves can be filtered based on the preset first threshold, selecting the range with a smaller slope and smaller velocity fluctuations as the first curve. As an example, the filtering can be performed electronically based on the preset threshold, or it can be done manually.
[0061] After obtaining the first curve, the second curve can be generated based on the time information contained in the first curve and the driving torque and joint angle in the joint data.
[0062] Step 303: Determine the joint angle torque information of the excavator to be calibrated based on the second curve.
[0063] In this step, the second curve can be further filtered, for example, the range with smaller curve torque fluctuations can be used as joint angle torque information.
[0064] As one possible implementation, the steps described above for generating a second curve based on the first curve, a preset first threshold, and joint data are as follows: Figure 4 As shown, it includes:
[0065] Step 401: Filter the first curves corresponding to each motion joint according to the first threshold to determine the first sub-curve.
[0066] It is worth noting that the first curve includes multiple sub-curves corresponding to the excitation trajectories. The first curve can be filtered based on a first threshold to obtain each sub-curve that meets the first threshold.
[0067] The first threshold represents the range of slope values and the range of velocity differences. Filtering the first curve based on the first threshold can involve determining the slope of each sub-curve within the first curve, determining the velocity differences between each sub-curve, and identifying the sub-curve whose slope and velocity difference satisfy the first threshold as the first sub-curve. The velocity difference of the sub-curve can be the difference between the maximum and minimum joint velocities of the sub-curve.
[0068] Step 402: Generate the second curve based on the first sub-curve and the joint data.
[0069] After determining the first sub-curve, the second curve can be generated based on the time information of the first sub-curve and the joint angles and driving torques in the joint data corresponding to the time information of the first sub-curve.
[0070] The second curve is used to characterize the change of driving torque with joint angle. After generating multiple sub-curves based on the first curve, the sub-curves can be filtered based on the torque fluctuation of each sub-curve, and the sub-curve with smaller torque fluctuation can be identified as the second curve. The second curve can include multiple sub-curves.
[0071] Specifically, the steps described above for determining the joint angle torque information of the excavator to be calibrated based on the second curve are as follows: Figure 5 As shown, it includes:
[0072] Step 501: Filter the second curve based on the second threshold to obtain at least one second sub-curve.
[0073] The second threshold can characterize the range of the difference in driving torque, which can be the difference between the maximum and minimum driving torque values in the sub-curve.
[0074] The second curve can be filtered based on the second threshold. This can be done by determining the difference in driving torque between the sub-curves of the second curve based on the second threshold, and taking the sub-curve interval with the difference in driving torque less than the second threshold as the second sub-curve.
[0075] Step 502: Use the joint angle and driving torque information corresponding to each second sub-curve as joint angle torque information.
[0076] The second sub-curve represents the relationship between joint angle and driving torque. After determining the second sub-curve, the joint angle and driving torque in the second sub-curve can be used as joint angle torque information.
[0077] It is worth noting that when a hydraulic cylinder moves back and forth at a constant speed, the frictional force at the same joint posture can be approximated as being the same in magnitude but opposite in direction. Taking the constant up-and-down movement of a joint as an example, the frictional force of the hydraulic cylinder can be determined based on the joint angle and driving torque during the up-and-down movement.
[0078] Based on this, this application proposes to determine the frictional force of a joint based on joint angle torque information. Specifically, the steps described above for determining the frictional force of the hydraulic cylinder of the excavator to be calibrated based on joint angle torque information are as follows: Figure 6 As shown, it includes:
[0079] Step 601: Determine the hydraulic cylinder friction force of the joint to be calibrated based on the joint angle torque information.
[0080] Step 602: Determine the gravitational torque of the joint to be calibrated based on the frictional force of the hydraulic cylinder.
[0081] Step 603: Determine the parameters of the gravity torque to be fitted based on the gravity torque and joint data.
[0082] Step 604: Determine the new gravity torque based on the gravity torque parameters to be fitted, and determine the new hydraulic cylinder friction force based on the new gravity torque.
[0083] Step 605: Repeat steps 602-604 until the new hydraulic cylinder friction force meets the preset conditions. Use the new friction force as the hydraulic cylinder friction force of the joint to be calibrated, and use the new gravitational torque as the gravitational torque of the joint to be calibrated.
[0084] Optionally, the joint to be calibrated can be the boom, arm, or bucket of the excavator to be calibrated. In this application, steps 601-605 above can be performed sequentially on each joint of the excavator to be calibrated to obtain the hydraulic cylinder friction force of each joint.
[0085] The initial hydraulic cylinder friction force can be determined based on joint angle torque information. For example, the initial hydraulic cylinder friction force can be based on the difference in vertical movement or the root mean square error of the joint to be calibrated, as found in the joint angle torque information.
[0086] In this application, during the data acquisition phase, motion data of each joint under low-speed constant motion can be collected separately. Since only one joint moves during the data acquisition process, the hinge body connected to that joint can be considered a rigid body. When the joint moves smoothly at low speed, it can be assumed that only external forces such as gravity and friction are at play. As shown in the following equation (1), the joint torque τ converted from the driving force is... act Frictional torque τ converted from frictional force fri The difference between the active driving torque and the gravitational torque τ g balance.
[0087] τ g =τ act -τ fri =(F act -F fri )*γ (1)
[0088] Where γ is the ratio of the hydraulic cylinder driving torque to the joint torque mapping, which can be calculated based on the triangle formed by the hydraulic cylinder and the joint. F act This represents the torque of the hydraulic cylinder thrust converted to the joint.
[0089] After calculating the hydraulic cylinder thrust based on joint data and estimating the initial hydraulic cylinder friction force based on joint angle torque information, the initial gravitational torque τ can be estimated based on the above equation (1). g .
[0090] The gravitational torque is related to the joint angle of the joint to be calibrated, and can be expressed as the following formula (2).
[0091] τ g =l*sin(θ) i +b) (2)
[0092] Where l and b are the gravitational torque parameters to be fitted at joint i, and θ i It is the angle between joint i and the gravity axis, which can be expressed as the following formula (3).
[0093]
[0094] After estimating the gravitational torque based on step 602 above, l and b can be fitted and calculated based on the gravitational torque and joint angle according to the above formula (2) to obtain the gravitational torque parameters to be fitted.
[0095] After determining the gravity fitting parameters, a new gravity torque can be calculated based on the above equation (2) and the gravity fitting parameters. After obtaining the new gravity torque, a new hydraulic cylinder friction force can be calculated based on the above equation (1).
[0096] After obtaining the new hydraulic cylinder friction force, the new hydraulic cylinder friction force can be used as the hydraulic cylinder friction force of the joint to be calibrated, and steps 602-604 can be executed again until the new hydraulic cylinder friction force converges to the preset threshold, or the new hydraulic cylinder friction force fails to converge and an error is reported. At this time, the currently obtained new hydraulic cylinder friction force can be used as the hydraulic cylinder friction force of the joint to be calibrated, and the currently obtained new gravitational torque can be used as the gravitational torque of the joint to be calibrated.
[0097] It is worth noting that steps 601-605 above are merely an explanation of the calibration process for the hydraulic cylinder friction force of the joint to be calibrated. It should be understood that the joint to be calibrated can be the boom, arm, or bucket of the excavator to be calibrated. Based on steps 601-605 above, the boom, arm, and bucket of the excavator to be calibrated can be used as the joints to be calibrated respectively, and the bucket friction force F can be calibrated separately using the joint data of each joint. fri_bucket Forearm friction force F fri_arm Upper arm friction force F fri_boom And the gravitational torque of each joint.
[0098] Furthermore, the steps described above for determining the parameters of the gravity torque to be fitted based on the gravitational torque and joint data include:
[0099] The gravitational torque parameters are obtained by fitting calculations based on the joint angle and gravitational torque of the joint to be calibrated.
[0100] The joint angle of the joint to be calibrated can be the angle between the joint to be calibrated and the gravity axis. By performing fitting calculations according to the above formula (2), the gravity torque parameters l and b to be fitted can be obtained.
[0101] Before calibrating the linkage gravity parameters, a coordinate system can be established for each joint of the excavator. The origin is at the center of the rotary joint axis, the y-axis coincides with the rotary joint axis, the x-axis points to the center of the next joint axis, and the distance between joints is L. i Then the second transformation matrix can be obtained as equation (4), and the homogeneous transformation matrix from the upper arm joint to the i-th coordinate system is equation (5), where the distance x in the x-axis direction from the upper arm joint to the i-th coordinate system is... i It is given by equation (6). Where T[1][4] represents the value in the first row and fourth column of matrix T.
[0102]
[0103] x i =Tx=T[1][4].z (6)
[0104] For each joint to be calibrated, the mass and center of gravity can be defined first. For example, define the mass m of the upper arm. boom The coordinates of the center of gravity in the boom link coordinate system are (x0, x0), and the mass of the forearm is m. arm The coordinates of the center of gravity in the boom-linkage coordinate system are (x1, z1), and the mass of the bucket is m. bucket The coordinates of the center of gravity in the boom link coordinate system are (x2, z2).
[0105] Transformation matrix from link coordinate system to barycentric coordinate system It can be expressed as the following formula (7):
[0106]
[0107] The transformation from the upper arm joint to the center of gravity of the i-th link arm can be expressed as the following equation (8).
[0108]
[0109] After completing the above definitions, the link gravity parameters can be calculated based on the joint data and transformation matrix. The following is a further explanation of determining the link gravity parameters of the excavator to be calibrated. Figure 7 Step 203 above includes:
[0110] Step 701: Based on the joint data, determine the boom gravity parameters and bucket gravity parameters of the excavator to be calibrated.
[0111] The forearm gravity parameters include the mass of the forearm and the center of gravity position of the forearm joint, while the bucket gravity parameters include the mass of the bucket and the center of gravity position of the bucket joint.
[0112] Step 702: Determine the boom gravity parameters of the excavator to be calibrated based on the boom gravity parameters and bucket gravity parameters.
[0113] Optionally, the upper arm gravity parameters include the mass of the upper arm and the position of the center of gravity of the upper arm joint.
[0114] In this embodiment, by first calculating the bucket gravity parameters and the boom gravity parameters, the influence of the bucket on the boom gravity parameter calibration can be minimized, thereby improving the accuracy of the calibration results.
[0115] In this application, after calculating the hydraulic cylinder friction force and gravitational torque for each joint, gravity parameters can be calibrated based on the gravitational torque and joint data for each joint. Specifically, refer to... Figure 8 Step 701 above includes:
[0116] Step 801: Determine the first lever arm and the second lever arm based on the joint data. The first lever arm represents the gravity lever arm of the bucket, and the second lever arm represents the gravity lever arm of the boom.
[0117] Step 802: Determine the weight parameters of the forearm and the weight parameters of the bucket based on the gravitational torque of the first lever arm, the second lever arm, and the forearm.
[0118] As an example, the forearm gravity parameters and bucket gravity parameters can be calibrated based on the following equation (9).
[0119]
[0120] in, This represents the gravitational torque of the forearm, m_bucket represents the mass of the bucket, and m_arm represents the mass of the forearm. This represents the distance in the x-direction from the center of gravity of the bucket joint to the base of the boom. This represents the distance in the x-direction from the center of gravity of the forearm joint to the root of the upper arm. This represents the lever arm of the bucket joint. This represents the lever arm of gravity at the forearm joint.
[0121] It should be noted that formula (4) ultimately calculates the effect of the torque generated by all the gravity on the forearm joint. Based on this, the gravity of the bucket is equivalent to the torque on the forearm joint. By adding the torque of the forearm gravity on the forearm joint, the torque generated by all the gravity on the forearm joint can be obtained.
[0122] It is a function that includes the bucket gravity parameter, so based on the above equation (9), the bucket center of gravity parameter can be calculated simultaneously.
[0123] Furthermore, step 702 above includes:
[0124] The boom gravity parameters of the excavator to be calibrated are obtained by fitting and calculating the gravitational torque of the boom, the gravity parameters of the forearm, and the gravity parameters of the bucket.
[0125] As an example, the gravity parameters of the boom can be obtained by fitting the following equation (10).
[0126]
[0127] in, This represents the gravitational torque of the upper arm, and m_boom represents the mass of the upper arm. The center of gravity of the boom joint is indicated by the formula (9) above. Since the weight parameters of the forearm and the bucket have been determined by the formula (10) above, the center of gravity of the boom joint can be calculated directly from the formula (10).
[0128] The following describes the process of acquiring the joint data mentioned above. The data acquisition process includes:
[0129] When the boom joint and forearm joint are stationary, the bucket joint of the excavator to be calibrated is moved along a preset excitation trajectory to obtain bucket joint data.
[0130] When the boom joint is stationary, the boom joint of the excavator to be calibrated is moved along a preset excitation trajectory at multiple bucket joint positions to obtain boom joint data.
[0131] When the fixed bucket joint and boom joint are stationary, the boom joint of the excavator to be calibrated is moved along a preset excitation trajectory to obtain boom joint data.
[0132] When collecting bucket joint data, the boom and arm joints can be kept stationary, and a predefined excitation trajectory can be executed on the bucket joint to collect hydraulic data, joint angle data, rotation direction, etc., for forward and reverse rotation of the bucket joint, thus obtaining bucket joint data.
[0133] When collecting data on the forearm joint, the boom joint can be fixed at a stationary position. At multiple different stationary bucket joint positions, forward and reverse excitation trajectories can be executed to record the hydraulic data, joint angle data, and rotation direction of the forearm, thereby obtaining the forearm joint data.
[0134] When collecting boom joint data, the forearm joint and bucket joint can be kept stationary, and positive and negative excitation trajectories can be applied to the boom joint. Hydraulic data, joint angle data, and rotation direction can be recorded to obtain boom joint data.
[0135] The excitation trajectory can include a positive excitation trajectory, which is a rotation in the positive direction from the upper limit position of the joint to the lower limit position of the joint, and it can also include a negative excitation trajectory, which is a rotation in the opposite direction from the lower limit position of the joint to the upper limit position of the joint.
[0136] It should be noted that in this application, the joint can be controlled to move at a low and constant speed, allowing a single joint to rotate at a low speed with the smallest and smoothest possible joint speed, thereby obtaining joint data for each joint.
[0137] Based on the same inventive concept, this application also provides an excavator parameter calibration device corresponding to the excavator parameter calibration method. Since the principle of the device in this application is similar to the excavator parameter calibration method described above in this application, the implementation of the device can refer to the implementation of the method, and the repeated parts will not be described again.
[0138] Figure 9 A schematic diagram of the structure of an excavator parameter calibration device provided in an embodiment of this application is shown.
[0139] The first determining module 901 is used to filter the joint data of the excavator to be calibrated based on a preset threshold to obtain the joint angle torque information of the excavator to be calibrated. The joint angle torque information is used to characterize the relationship between the joint angle and the driving torque of the excavator to be calibrated.
[0140] The second determining module 902 is used to determine the hydraulic cylinder friction force and joint gravity torque of the excavator to be calibrated based on the joint angle torque information.
[0141] The third determining module 903 is used to determine the link gravity parameters of the excavator to be calibrated based on the joint data and joint gravity torque.
[0142] In one feasible implementation, the first determining module 901 is specifically used for:
[0143] Based on the joint data, the torque information of each moving joint and the first curve of each moving joint are determined. The first curve is used to characterize the relationship between time and joint velocity.
[0144] Based on the first curve, the preset first threshold, and the joint data, a second curve is generated. The second curve is used to characterize the relationship between the joint angle and the driving torque.
[0145] The joint angle torque information of the excavator to be calibrated is determined based on the second curve.
[0146] In one feasible implementation, the first determining module 901 is specifically used for:
[0147] The first curves corresponding to each joint are filtered according to the first threshold to determine the first sub-curve;
[0148] The second curve is generated based on the first sub-curve and the joint data.
[0149] In one feasible implementation, the first determining module 901 is specifically used for:
[0150] The second curve is filtered based on the second threshold to obtain at least one second sub-curve;
[0151] The joint angle and driving torque information corresponding to each second sub-curve are used as joint angle and torque information.
[0152] In one feasible implementation, the second determining module 902 is specifically used for:
[0153] A. Determine the hydraulic cylinder friction force of the joint to be calibrated based on the joint angle torque information;
[0154] B. Determine the gravitational torque of the joint to be calibrated based on the frictional force of the hydraulic cylinder;
[0155] C. Determine the parameters of the gravity torque to be fitted based on the gravity torque and joint data;
[0156] D. Determine the new gravity torque based on the gravity torque parameters to be fitted, and determine the new hydraulic cylinder friction force based on the new gravity torque;
[0157] Repeat steps BD until the new hydraulic cylinder friction force meets the preset conditions. Use the new friction force as the hydraulic cylinder friction force of the joint to be calibrated, and use the new gravitational torque as the gravitational torque of the joint to be calibrated.
[0158] In one feasible implementation, the second determining module 902 is specifically used for:
[0159] The gravitational torque parameters are obtained by fitting calculations based on the joint angle and gravitational torque of the joint to be calibrated.
[0160] In one feasible implementation, the third determining module 903 is specifically used for:
[0161] Based on the joint data, determine the boom gravity parameters and bucket gravity parameters of the excavator to be calibrated;
[0162] Based on the boom and bucket parameters, determine the boom parameters of the excavator to be calibrated.
[0163] In one feasible implementation, the third determining module 903 is specifically used for:
[0164] The first lever arm and the second lever arm are determined based on the joint data. The first lever arm represents the gravity lever arm of the bucket, and the second lever arm represents the gravity lever arm of the boom.
[0165] The gravity parameters of the forearm and the gravity parameters of the bucket are determined based on the gravitational torque of the first lever arm, the second lever arm, and the forearm.
[0166] In one feasible implementation, the third determining module 903 is specifically used for:
[0167] The boom gravity parameters of the excavator to be calibrated are obtained by fitting and calculating the gravitational torque of the boom, the gravity parameters of the forearm, and the gravity parameters of the bucket.
[0168] In one feasible implementation, the joint data includes: bucket joint data, forearm joint data, and boom joint data.
[0169] In one feasible implementation, the device further includes a data acquisition module for:
[0170] When the boom joint and forearm joint are stationary, the bucket joint of the excavator to be calibrated is moved along a preset excitation trajectory to obtain bucket joint data.
[0171] When the boom joint is stationary, the boom joint of the excavator to be calibrated is moved along a preset excitation trajectory at multiple bucket joint positions to obtain boom joint data.
[0172] When the fixed bucket joint and boom joint are stationary, the boom joint of the excavator to be calibrated is moved along a preset excitation trajectory to obtain boom joint data.
[0173] This application addresses the unique characteristics of excavator operation scenarios by calibrating only the dominant factors, thus reducing calibration complexity. Furthermore, based on the special structure of the excavator arm, it proposes an optimized calibration method for friction and gravity parameters, improving data calibration accuracy, increasing the robustness and reliability of the calibration algorithm, and reducing the amount of data collection required.
[0174] Figure 10 This illustration shows a schematic diagram of an electronic device provided in an embodiment of this application, including: a processor 1001, a storage medium 1002, and a bus 1003. The storage medium 1002 stores machine-readable instructions executable by the processor 1001. When the electronic device runs an excavator parameter calibration method as described in the embodiment, the processor 1001 communicates with the storage medium 1002 via the bus 1003. The processor 1001 executes the machine-readable instructions. The preamble of the method item in the processor 1001 performs the following steps:
[0175] Based on a preset threshold, the joint data of the excavator to be calibrated is filtered to obtain the joint angle torque information of the excavator to be calibrated. The joint angle torque information is used to characterize the relationship between the joint angle and the driving torque of the excavator to be calibrated.
[0176] Based on the joint angle torque information, determine the hydraulic cylinder friction force and joint gravity torque of the excavator to be calibrated;
[0177] The link gravity parameters of the excavator to be calibrated are determined based on the joint data and joint gravity torque.
[0178] In one feasible implementation, when the processor 1001 executes the process of determining the joint angle torque information of the excavator to be calibrated based on the joint data of the excavator to be calibrated, it is specifically used for:
[0179] Based on the joint data, the torque information of each moving joint and the first curve of each moving joint are determined. The first curve is used to characterize the relationship between time and joint velocity.
[0180] Based on the first curve, the preset first threshold, and the joint data, a second curve is generated. The second curve is used to characterize the relationship between the joint angle and the driving torque.
[0181] The joint angle torque information of the excavator to be calibrated is determined based on the second curve.
[0182] In one feasible implementation, when the processor 1001 generates a second curve based on the first curve, a preset first threshold, and joint data, it is specifically used for:
[0183] The first curves corresponding to each joint are filtered according to the first threshold to determine the first sub-curve;
[0184] The second curve is generated based on the first sub-curve and the joint data.
[0185] In one feasible implementation, when the processor 1001 executes the process of determining the joint angle torque information of the excavator to be calibrated based on the second curve, it is specifically used for:
[0186] The second curve is filtered based on the second threshold to obtain at least one second sub-curve;
[0187] The joint angle and driving torque information corresponding to each second sub-curve are used as joint angle and torque information.
[0188] In one feasible implementation, when the processor 1001 performs the task of determining the hydraulic cylinder friction force and joint gravity torque of the excavator to be calibrated based on the joint angle torque information, it is specifically used for:
[0189] A. Determine the hydraulic cylinder friction force of the joint to be calibrated based on the joint angle torque information;
[0190] B. Determine the gravitational torque of the joint to be calibrated based on the frictional force of the hydraulic cylinder;
[0191] C. Determine the parameters of the gravity torque to be fitted based on the gravity torque and joint data;
[0192] D. Determine the new gravity torque based on the gravity torque parameters to be fitted, and determine the new hydraulic cylinder friction force based on the new gravity torque;
[0193] Repeat steps BD until the new hydraulic cylinder friction force meets the preset conditions. Use the new friction force as the hydraulic cylinder friction force of the joint to be calibrated, and use the new gravitational torque as the gravitational torque of the joint to be calibrated.
[0194] In one feasible implementation, when the processor 1001 performs the task of determining the gravity torque parameters to be fitted based on the gravity torque and joint data, it is specifically used for:
[0195] The gravitational torque parameters are obtained by fitting calculations based on the joint angle and gravitational torque of the joint to be calibrated.
[0196] In one feasible implementation, when the processor 1001 performs the task of determining the linkage gravity parameters of the excavator to be calibrated based on the joint data, it is specifically used for:
[0197] Based on the joint data, determine the boom gravity parameters and bucket gravity parameters of the excavator to be calibrated;
[0198] Based on the boom and bucket parameters, determine the boom parameters of the excavator to be calibrated.
[0199] In one feasible implementation, when the processor 1001 performs the task of determining the boom gravity parameters and bucket gravity parameters of the excavator to be calibrated based on joint data and gravitational torque, it is specifically used for:
[0200] The first lever arm and the second lever arm are determined based on the joint data. The first lever arm represents the gravity lever arm of the bucket, and the second lever arm represents the gravity lever arm of the boom.
[0201] The gravity parameters of the forearm and the gravity parameters of the bucket are determined based on the gravitational torque of the first lever arm, the second lever arm, and the forearm.
[0202] In one feasible implementation, when the processor 1001 determines the boom gravity parameters of the excavator to be calibrated based on the boom gravity parameters and the bucket gravity parameters, it is specifically used for:
[0203] The boom gravity parameters of the excavator to be calibrated are obtained by fitting and calculating the gravitational torque of the boom, the gravity parameters of the forearm, and the gravity parameters of the bucket.
[0204] In one feasible implementation, the joint data includes: bucket joint data, forearm joint data, and boom joint data.
[0205] In one feasible implementation, before executing the process of determining the joint angle torque information of the excavator to be calibrated based on the joint data of the excavator to be calibrated, the processor 1001 is specifically used for:
[0206] When the boom joint and forearm joint are stationary, the bucket joint of the excavator to be calibrated is moved along a preset excitation trajectory to obtain bucket joint data.
[0207] When the boom joint is stationary, the boom joint of the excavator to be calibrated is moved along a preset excitation trajectory at multiple bucket joint positions to obtain boom joint data.
[0208] When the fixed bucket joint and boom joint are stationary, the boom joint of the excavator to be calibrated is moved along a preset excitation trajectory to obtain boom joint data.
[0209] This application addresses the unique characteristics of excavator operation scenarios by calibrating only the dominant factors, thus reducing calibration complexity. Furthermore, based on the special structure of the excavator arm, it proposes an optimized calibration method for friction and gravity parameters, improving data calibration accuracy, increasing the robustness and reliability of the calibration algorithm, and reducing the amount of data collection required.
[0210] This application embodiment also provides a computer-readable storage medium storing a computer program, which is executed by a processor, wherein the processor performs the following steps:
[0211] Based on a preset threshold, the joint data of the excavator to be calibrated is filtered to obtain the joint angle torque information of the excavator to be calibrated. The joint angle torque information is used to characterize the relationship between the joint angle and the driving torque of the excavator to be calibrated.
[0212] Based on the joint angle torque information, determine the hydraulic cylinder friction force and joint gravity torque of the excavator to be calibrated;
[0213] The link gravity parameters of the excavator to be calibrated are determined based on the joint data and joint gravity torque.
[0214] In one feasible implementation, when the processor determines the joint angle torque information of the excavator to be calibrated based on the joint data of the excavator to be calibrated, it is specifically used for:
[0215] Based on the joint data, the torque information of each moving joint and the first curve of each moving joint are determined. The first curve is used to characterize the relationship between time and joint velocity.
[0216] Based on the first curve, the preset first threshold, and the joint data, a second curve is generated. The second curve is used to characterize the relationship between the joint angle and the driving torque.
[0217] The joint angle torque information of the excavator to be calibrated is determined based on the second curve.
[0218] In one feasible implementation, when the processor generates a second curve based on the first curve, a preset first threshold, and joint data, it is specifically used for:
[0219] The first curves corresponding to each joint are filtered according to the first threshold to determine the first sub-curve;
[0220] The second curve is generated based on the first sub-curve and the joint data.
[0221] In one feasible implementation, when the processor performs the task of determining the joint angle torque information of the excavator to be calibrated based on the second curve, it is specifically used for:
[0222] The second curve is filtered based on the second threshold to obtain at least one second sub-curve;
[0223] The joint angle and driving torque information corresponding to each second sub-curve are used as joint angle and torque information.
[0224] In one feasible implementation, when the processor determines the hydraulic cylinder friction force and joint gravity torque of the excavator to be calibrated based on the joint angle torque information, it is specifically used for:
[0225] A. Determine the hydraulic cylinder friction force of the joint to be calibrated based on the joint angle torque information;
[0226] B. Determine the gravitational torque of the joint to be calibrated based on the frictional force of the hydraulic cylinder;
[0227] C. Determine the parameters of the gravity torque to be fitted based on the gravity torque and joint data;
[0228] D. Determine the new gravity torque based on the gravity torque parameters to be fitted, and determine the new hydraulic cylinder friction force based on the new gravity torque;
[0229] Repeat steps BD until the new hydraulic cylinder friction force meets the preset conditions. Use the new friction force as the hydraulic cylinder friction force of the joint to be calibrated, and use the new gravitational torque as the gravitational torque of the joint to be calibrated.
[0230] In one feasible implementation, when the processor determines the gravity torque parameters to be fitted based on the gravity torque and joint data, it is specifically used for:
[0231] The gravitational torque parameters are obtained by fitting calculations based on the joint angle and gravitational torque of the joint to be calibrated.
[0232] In one feasible implementation, when the processor performs the task of determining the linkage gravity parameters of the excavator to be calibrated based on the joint data, it is specifically used for:
[0233] Based on the joint data, determine the boom gravity parameters and bucket gravity parameters of the excavator to be calibrated;
[0234] Based on the boom and bucket parameters, determine the boom parameters of the excavator to be calibrated.
[0235] In one feasible implementation, when the processor determines the boom gravity parameters and bucket gravity parameters of the excavator to be calibrated based on joint data and gravitational torque, it is specifically used for:
[0236] The first lever arm and the second lever arm are determined based on the joint data. The first lever arm represents the gravity lever arm of the bucket, and the second lever arm represents the gravity lever arm of the boom.
[0237] The gravity parameters of the forearm and the gravity parameters of the bucket are determined based on the gravitational torque of the first lever arm, the second lever arm, and the forearm.
[0238] In one feasible implementation, when the processor determines the boom gravity parameters of the excavator to be calibrated based on the boom gravity parameters and the bucket gravity parameters, it is specifically used for:
[0239] The boom gravity parameters of the excavator to be calibrated are obtained by fitting and calculating the gravitational torque of the boom, the gravity parameters of the forearm, and the gravity parameters of the bucket.
[0240] In one feasible implementation, the joint data includes: bucket joint data, forearm joint data, and boom joint data.
[0241] In one feasible implementation, before the processor performs the task of determining the joint angle torque information of the excavator to be calibrated based on the joint data of the excavator, it is specifically used for:
[0242] When the boom joint and forearm joint are stationary, the bucket joint of the excavator to be calibrated is moved along a preset excitation trajectory to obtain bucket joint data.
[0243] When the boom joint is stationary, the boom joint of the excavator to be calibrated is moved along a preset excitation trajectory at multiple bucket joint positions to obtain boom joint data.
[0244] When the fixed bucket joint and boom joint are stationary, the boom joint of the excavator to be calibrated is moved along a preset excitation trajectory to obtain boom joint data.
[0245] This application addresses the unique characteristics of excavator operation scenarios by calibrating only the dominant factors, thus reducing calibration complexity. Furthermore, based on the special structure of the excavator arm, it proposes an optimized calibration method for friction and gravity parameters, improving data calibration accuracy, increasing the robustness and reliability of the calibration algorithm, and reducing the amount of data collection required.
[0246] In this embodiment, the computer program, when run by the processor, can also execute other machine-readable instructions to perform other methods as described in the embodiments. For details on the specific execution steps and principles, please refer to the description of the embodiments, which will not be repeated here.
[0247] In the embodiments provided in this application, it should be understood that the disclosed apparatus and methods can be implemented in other ways. The apparatus embodiments described above are merely illustrative. For example, the division of units is only a logical functional division, and in actual implementation, there may be other division methods. Furthermore, multiple units or components may be combined or integrated into another system, or some features may be ignored or not executed. Additionally, the displayed or discussed mutual couplings, direct couplings, or communication connections may be through some communication interfaces; indirect couplings or communication connections between devices or units may be electrical, mechanical, or other forms.
[0248] The units described as separate components may or may not be physically separate. The components shown as units may or may not be physical units; that is, they may be located in one place or distributed across multiple network units. Some or all of the units can be selected to achieve the purpose of this embodiment according to actual needs.
[0249] In addition, the functional units in the embodiments provided in this application can be integrated into one processing unit, or each unit can exist physically separately, or two or more units can be integrated into one unit.
[0250] If the aforementioned functions are implemented as software functional units and sold or used as independent products, they can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of this application, in essence, or the part that contributes to the prior art, or a portion of the technical solution, can be embodied in the form of a software product. This computer software product is stored in a storage medium and includes several instructions to cause a computer device (which may be a personal computer, server, or network device, etc.) to execute all or part of the steps of the methods described in the various embodiments of this application. The aforementioned storage medium includes various media capable of storing program code, such as USB flash drives, portable hard drives, read-only memory (ROM), random access memory (RAM), magnetic disks, or optical disks.
[0251] It should be noted that similar labels and letters in the following figures indicate similar items. Therefore, once an item is defined in one figure, it does not need to be further defined and explained in subsequent figures. In addition, the terms "first", "second", "third", etc. are used only to distinguish descriptions and should not be construed as indicating or implying relative importance.
[0252] Finally, it should be noted that the above-described embodiments are merely specific implementations of this application, used to illustrate the technical solutions of this application, and not to limit them. The protection scope of this application is not limited thereto. Although this application has been described in detail with reference to the foregoing embodiments, those skilled in the art should understand that any person skilled in the art can still modify or easily conceive of changes to the technical solutions described in the foregoing embodiments, or make equivalent substitutions for some of the technical features, within the scope of the technology disclosed in this application; and these modifications, changes, or substitutions do not cause the essence of the corresponding technical solutions to deviate from the spirit and scope of the technical solutions of the embodiments of this application. All should be covered within the protection scope of this application. Therefore, the protection scope of this application should be determined by the protection scope of the claims.
Claims
1. A method for calibrating excavator parameters, characterized in that, include: Based on a preset threshold, the joint data of the excavator to be calibrated is filtered to obtain the joint angle torque information of the excavator to be calibrated. The joint angle torque information is used to characterize the relationship between the joint angle and the driving torque of the excavator to be calibrated. Based on the joint angle torque information, determine the hydraulic cylinder friction force and joint gravity torque of the excavator to be calibrated; The link gravity parameters of the excavator to be calibrated are determined based on the joint data and the joint gravity torque. The process of filtering the joint data of the excavator to be calibrated based on a preset threshold to obtain the joint angle and torque information of the excavator to be calibrated includes: Based on the joint data, the torque information of each joint and the first curve of each joint are determined. The first curve is used to characterize the relationship between time and joint velocity. Based on the first curve, the preset first threshold, and the joint data, a second curve is generated. The second curve is used to characterize the relationship between joint angle and driving torque. The joint angle torque information of the excavator to be calibrated is determined based on the second curve.
2. The method according to claim 1, characterized in that, The step of generating a second curve based on the first curve, a preset first threshold, and the joint data includes: Based on the first threshold, the first curves corresponding to each joint are filtered to determine the first sub-curve; A second curve is generated based on the first sub-curve and the joint data.
3. The method according to claim 1, characterized in that, The step of determining the joint angle torque information of the excavator to be calibrated based on the second curve includes: The second curve is filtered based on the second threshold to obtain at least one second sub-curve; The joint angle and driving torque information corresponding to each of the second sub-curves are used as the joint angle and torque information.
4. The method according to claim 1, characterized in that, The step of determining the hydraulic cylinder friction force and joint gravity torque of the excavator to be calibrated based on the joint angle torque information includes: A. Determine the hydraulic cylinder friction force of the joint to be calibrated based on the joint angle torque information. B. Determine the gravitational torque of the joint to be calibrated based on the frictional force of the hydraulic cylinder; C. Determine the gravity torque parameters to be fitted based on the gravity torque and the joint data; D. Determine a new gravitational torque based on the gravitational torque parameters to be fitted, and determine a new hydraulic cylinder friction force based on the new gravitational torque; Repeat steps BD until the new hydraulic cylinder friction force meets the preset conditions. Use the new friction force as the hydraulic cylinder friction force of the joint to be calibrated, and use the new gravitational torque as the gravitational torque of the joint to be calibrated.
5. The method according to claim 4, characterized in that, The step of determining the gravity torque parameter to be fitted based on the gravity torque and the joint data includes: The gravitational torque parameters are obtained by fitting the joint angle of the joint to be calibrated and the gravitational torque.
6. The method according to claim 1, characterized in that, The step of determining the linkage gravity parameters of the excavator to be calibrated based on the joint data includes: Based on the joint data, determine the boom gravity parameters and bucket gravity parameters of the excavator to be calibrated; Based on the forearm gravity parameters and the bucket gravity parameters, the boom gravity parameters of the excavator to be calibrated are determined.
7. The method according to claim 6, characterized in that, The step of determining the boom gravity parameters and bucket gravity parameters of the excavator to be calibrated based on the joint data and the gravitational torque includes: The first lever arm and the second lever arm are determined based on the joint data. The first lever arm represents the gravity lever arm of the bucket, and the second lever arm represents the gravity lever arm of the boom. The gravity parameters of the forearm and the gravity parameters of the bucket are determined based on the gravitational torque of the first lever arm, the second lever arm, and the forearm.
8. The method according to claim 6, characterized in that, The step of determining the boom gravity parameters of the excavator to be calibrated based on the boom gravity parameters and the bucket gravity parameters includes: The boom gravity parameters of the excavator to be calibrated are obtained by fitting and calculating the gravitational torque of the boom, the gravity parameters of the forearm, and the gravity parameters of the bucket.
9. The method according to claim 1, characterized in that, The joint data includes: bucket joint data, forearm joint data, and boom joint data.
10. The method according to claim 9, characterized in that, The process of acquiring the joint data includes: When the boom joint and forearm joint are stationary, the bucket joint of the excavator to be calibrated is moved along a preset excitation trajectory to obtain bucket joint data. When the boom joint is stationary, the boom joint of the excavator to be calibrated is moved along a preset excitation trajectory at multiple bucket joint positions to obtain boom joint data. When the fixed bucket joint and boom joint are stationary, the boom joint of the excavator to be calibrated is moved along a preset excitation trajectory to obtain boom joint data.
11. The method according to claim 10, characterized in that, The excitation trajectory includes: a positive rotation from the upper limit position of the joint to the lower limit position of the joint and a negative rotation from the lower limit position of the joint to the upper limit position of the joint.
12. A parameter calibration device for an excavator, characterized in that, include: The first determining module is used to filter the joint data of the excavator to be calibrated based on a preset threshold to obtain the joint angle torque information of the excavator to be calibrated. The joint angle torque information is used to characterize the relationship between the joint angle and the driving torque of the excavator to be calibrated. The second determining module is used to determine the hydraulic cylinder friction force and joint gravity torque of the excavator to be calibrated based on the joint angle torque information. The third determining module is used to determine the link gravity parameters of the excavator to be calibrated based on the joint data and the joint gravity torque. The first determining module is specifically used for: Based on the joint data, the torque information of each joint and the first curve of each joint are determined. The first curve is used to characterize the relationship between time and joint velocity. Based on the first curve, the preset first threshold, and the joint data, a second curve is generated. The second curve is used to characterize the relationship between joint angle and driving torque. The joint angle torque information of the excavator to be calibrated is determined based on the second curve.
13. An electronic device, characterized in that, include: The device includes a processor, a storage medium, and a bus, wherein the storage medium stores machine-readable instructions executable by the processor, and when the electronic device is running, the processor communicates with the storage medium via the bus, and the processor executes the machine-readable instructions to perform the steps of the excavator parameter calibration method as described in any one of claims 1 to 11.
14. A computer-readable storage medium, characterized in that, The computer-readable storage medium stores a computer program that, when executed by a processor, performs the steps of the excavator parameter calibration method as described in any one of claims 1 to 11.
Citation Information
Patent Citations
Mechanical arm friction identification method and device, apparatus and storage medium
CN107423515A
Parameter separation-based mechanical arm kinetic parameter identification method and device
CN116038681A
