Excavator parameter calibration method, device and electronic equipment

By constructing optimization functions and meeting constraints, efficiently calibrating the external parameters and arm length of the excavator sensors, the problem of inaccurate calibration in the existing technology is solved, and the effect of automatic control of excavator is improved.

CN118345900BActive Publication Date: 2024-11-15NETEASE LINGDONG (HANGZHOU) TECHNOLOGY CO LTD
View PDF 5 Cites 0 Cited by

Patent Information

Application Number
CN202410330226.1
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-03-20
Publication Date
2024-11-15
Estimated Expiration
2044-03-20

AI Technical Summary

Technical Problem

The lack of efficient methods in the prior art to calibrate the precise dimensions of the excavator arm connecting rod and the external parameters of the sensor, resulting in poor automation control effects.

Method used

By obtaining sensor readings at multiple positions on the same horizontal line of the bucket teeth, an optimization function is constructed to minimize the difference between the target distance and the third distance, determine the external parameters of the sensor and the calibration length of the arm, satisfying the constraints. Such as angle range and mapping error.

Benefits of technology

It realizes efficient calibration of external parameters of the sensor and precise size of the arm connecting rod, and improves the automatic control accuracy and reliability of the excavator.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118345900B_ABST
    Figure CN118345900B_ABST
Patent Text Reader

Abstract

The present application discloses a parameter calibration method, device, electronic device, computer-readable storage medium and excavator for an excavator, wherein the method comprises: obtaining the first reading and the second reading corresponding to each sensor when the bucket tooth tip is respectively located at a first position and at least six second positions on the same horizontal line as the first position; constructing a function to be optimized based on the first reading, the second reading, the external parameters to be calibrated of each sensor and the length to be calibrated of each arm; optimizing and solving the function to be optimized based on constraints and optimization objectives, determining the calibrated length of each arm and the calibrated external parameters of each sensor, wherein the constraints comprise: the calibration angle corresponding to each joint is within a preset angle range, and the difference between the calibrated length of each arm and the measured length is less than a preset mapping error. The present application can efficiently calibrate the external parameters of the sensor and the precise dimensions of the arm connecting rod, thereby realizing the automatic control of the excavator.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of mechanical technology, and in particular to a method and device for calibrating parameters of an excavator, an electronic device, a computer-readable storage medium, and an excavator. Background Art

[0002] With the continuous development of mechanical technology, the automation of excavators has received extensive attention. In order to realize the automatic control of the excavator arm, it is necessary to obtain the precise size of the excavator arm connecting rod and the rotation joint angle between the arm connecting rods, so as to obtain the kinematic chain and coordinate change relationship of the arm connecting rod. These parameters are generally provided by the manufacturer, but due to processing and manufacturing errors, they may not be completely consistent with the actual physical structure of the excavator.

[0003] In the related art, sensors are usually installed on the excavator arm connecting rod to obtain the rotation joint angle, such as an inclination sensor for measuring the angle. However, due to the mechanical structure limitations of the excavator arm connecting rod, there is a deviation between the sensor data and the actual rotation joint angle. It is usually necessary to calibrate the external parameters of the sensor first, and determine the actual rotation joint angle based on the calibrated external parameters. At the same time, combined with the precise size of the arm connecting rod, automatic control of the arm connecting rod can be achieved.

[0004] At present, there is a lack of means to efficiently calibrate the precise dimensions of the three arm links of the excavator and the external parameters of the sensors. Therefore, how to efficiently calibrate the external parameters of the sensors and the precise dimensions of the arm links has become an urgent problem to be solved. Summary of the invention

[0005] The present application provides a parameter calibration method, device, electronic device, computer-readable storage medium and excavator for an excavator, which can efficiently calibrate the external parameters of the sensor and the precise size of the arm connecting rod, thereby realizing automatic control of the excavator. The specific scheme is as follows:

[0006] In a first aspect, an embodiment of the present application provides a method for calibrating parameters of an excavator, the method comprising:

[0007] Obtaining a first reading corresponding to each sensor when a target part on the bucket is located at a first position, and a second reading corresponding to each sensor when the target part is located at at least six second positions on the same horizontal line as the first position, wherein the first position is different from the second position, and each sensor is respectively configured on each arm of the excavator or on a hydraulic cylinder corresponding to each arm, and each arm includes a boom, a dipper rod and a bucket;

[0008] A function to be optimized is constructed based on the first reading, the second reading, the external parameters to be calibrated of each sensor, and the length to be calibrated of each arm, wherein the optimization target of the function to be optimized is to minimize the difference between the target distance and a third distance, the third distance is the difference between the first position and the second position, the target distance is the difference between the first distance and the second distance, the first distance is the distance between the first position and the boom joint in the horizontal direction, the second distance is the distance between the second position and the boom joint in the horizontal direction, wherein the boom joint is a joint corresponding to the hinge between the boom and the cabin;

[0009] The function to be optimized is optimized and solved based on the constraint conditions and the optimization target to determine the calibrated length of each arm and the calibrated external parameters of each sensor, wherein the constraint conditions include: the calibrated angle corresponding to each joint is within a preset angle range, the difference between the calibrated length of each arm and the measured length of each arm is less than a preset surveying error, and the calibrated angle corresponding to each joint is determined based on the calibrated external parameters of each sensor.

[0010] In a second aspect, an embodiment of the present application provides a parameter calibration device for an excavator, the device comprising:

[0011] an acquisition unit, configured to acquire a first reading corresponding to each sensor when a target part on the bucket is located at a first position, and a second reading corresponding to each sensor when the target part is located at at least six second positions on the same horizontal line as the first position, wherein the first position is different from the second position, and each sensor is respectively configured on each arm of the excavator or on a hydraulic cylinder corresponding to each arm, and each arm includes a boom, a dipper rod and a bucket;

[0012] a construction unit, configured to construct a function to be optimized based on the first reading, the second reading, the external parameters to be calibrated of each sensor, and the length to be calibrated of each arm, wherein the optimization target of the function to be optimized is to minimize the difference between a target distance and a third distance, the third distance is the difference between the first position and the second position, the target distance is the difference between the first distance and the second distance, the first distance is the distance between the first position and a boom joint in the horizontal direction, the second distance is the distance between the second position and the boom joint in the horizontal direction, wherein the boom joint is a joint corresponding to a hinge between the boom and the cabin;

[0013] A determination unit is used to optimize and solve the function to be optimized based on constraints and the optimization target, and determine the calibrated length of each arm and the calibrated external parameters of each sensor, wherein the constraints include: the calibration angle corresponding to each joint is within a preset angle range, and the difference between the calibrated length of each arm and the measured length of each arm is less than a preset surveying error, wherein the calibration angle corresponding to each joint is determined based on the calibrated external parameters of each sensor.

[0014] In a third aspect, an embodiment of the present application provides an excavator, the excavator comprising at least:

[0015] An excavator body, sensors arranged on the arms of the excavator body or on the hydraulic cylinders corresponding to the arms, and a parameter calibration device for the excavator as described in the second aspect.

[0016] In a fourth aspect, the present application further provides an electronic device, including:

[0017] Processor; and

[0018] The memory is used to store a data processing program. After the electronic device is powered on and the program is run by the processor, the method described in the first aspect is executed.

[0019] In a fifth aspect, an embodiment of the present application further provides a computer-readable storage medium storing a data processing program, which is executed by a processor to perform the method described in the first aspect.

[0020] Compared with the prior art, this application has the following advantages:

[0021] The parameter calibration method of the excavator provided in the embodiment of the present application includes obtaining a first reading corresponding to each sensor when the target part on the bucket is located at a first position, and a second reading corresponding to each sensor when the target part is located at at least six second positions on the same horizontal line as the first position, wherein the first position is different from the second position, and each sensor is respectively configured on each arm of the excavator or on a hydraulic cylinder corresponding to each arm, and each arm includes a boom, a dipper rod and a bucket; based on the first reading, the second reading, the external parameters to be calibrated of each sensor and the length to be calibrated of each arm, a function to be optimized is constructed, wherein the optimization goal of the function to be optimized is to minimize the difference between the target distance and the third distance, and the third distance is the first The target distance is the difference between the first position and the second position, the target distance is the difference between the first distance and the second distance, the first distance is the distance between the first position and the boom joint, and the second distance is the distance between the second position and the boom joint, wherein the boom joint is the joint corresponding to the hinge between the boom and the cabin; based on the constraints and the optimization objectives, the optimization function to be optimized is solved to determine the calibrated length of each arm and the calibrated external parameters of each sensor, and the constraints include: the calibration angle corresponding to each joint is within a preset angle range, and the difference between the calibrated length of each arm and the measured length of each arm is less than a preset surveying error, wherein the calibration angle corresponding to each joint is determined based on the calibrated external parameters of each sensor.

[0022] It can be seen that the excavator parameter calibration method provided in the embodiment of the present application only needs to construct the function to be optimized through the corresponding readings of the sensors when the bucket tooth tip is located at least seven positions on the same horizontal line, the corresponding external parameters of the sensors, and the lengths of each arm of the excavator. By optimizing and solving the function to be optimized through constraints, the external parameters of the three sensors and the lengths of the three arms of the excavator can be determined at one time. Therefore, the excavator parameter calibration method provided in the embodiment of the present application can efficiently calibrate the external parameters of the sensors and the precise dimensions of the arm connecting rods, thereby realizing the automatic control of the excavator. BRIEF DESCRIPTION OF THE DRAWINGS

[0023] Figure 1 is a flow chart of a parameter calibration method for an excavator provided in an embodiment of the present application;

[0024] Figure 2 is a structural diagram of an excavator in a parameter calibration method for an excavator provided in an embodiment of the present application;

[0025] Figure 3 It is a schematic diagram of a method for calibrating parameters of an excavator provided in an embodiment of the present application, in which a bucket tooth tip is located at a first position and a second position respectively;

[0026] Figure 4It is a schematic diagram of each joint in the parameter calibration method of the excavator provided in the embodiment of the present application;

[0027] Figure 5 It is a schematic diagram of the first distance, the second distance and the third distance in the parameter calibration method of the excavator provided in the embodiment of the present application;

[0028] Figure 6 It is a schematic diagram of an example of constructing a geometric relationship based on an excavator in a parameter calibration method for an excavator provided in an embodiment of the present application;

[0029] Figure 7 It is a schematic diagram of each arm of the excavator moving to the extreme position in the parameter calibration method of the excavator provided in the embodiment of the present application;

[0030] Figure 8 It is a structural block diagram of an example of a parameter calibration device for an excavator provided in an embodiment of the present application;

[0031] Fig. 9 It is a structural block diagram of an example of an electronic device provided in an embodiment of the present application. DETAILED DESCRIPTION

[0032] Many specific details are described in the following description to facilitate a full understanding of the present application. However, the present application can be implemented in many other ways than those described herein, and those skilled in the art can make similar generalizations without violating the connotation of the present application. Therefore, the present application is not limited to the specific implementation disclosed below.

[0033] It should be noted that the terms "first", "second", "third", etc. in the claims, description and drawings of the present application are used to distinguish similar objects and are not used to describe a specific order or sequence. The data used in this way are interchangeable where appropriate, so that the embodiments of the present application described herein can be implemented in an order other than that illustrated or described herein. In addition, the terms "including", "having" and their variants are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.

[0034] Before describing the implementation methods of the present application in detail, relevant concepts are first introduced and the prior art is further described.

[0035] Related concepts:

[0036] A sensor (transducer / sensor) is a detection device that can sense the information being measured and convert the sensed information into electrical signals or other information outputs according to certain rules to meet the requirements of information transmission, processing, storage, display, recording and control. Sensors have the characteristics of miniaturization, digitization, intelligence, multi-function, systematization and networking. They are the primary factors in realizing automation technologies such as automatic control and automatic detection. Sensors are divided into many types according to their specific sensing content, such as temperature sensors, pressure sensors, inclination sensors, motion sensors, ranging sensors, etc.

[0037] A distance sensor is a sensor used to measure the distance of objects in the environment. It can output the perceived distance of objects in the form of position information, including laser distance sensors, ultrasonic distance sensors, infrared distance sensors, etc. Compared with ordinary cameras, distance sensors can sense the three-dimensional position information of every point on every object in the surrounding environment. Therefore, distance sensors have become an indispensable tool for collecting environmental information in various fields such as industrial automation and intelligent platforms.

[0038] A coordinate system is a reference for describing the position and posture of an object. It is also called a reference system or a reference frame. In order to perform dot multiplication and difference multiplication during calculation, an n-dimensional coordinate system is often composed of n orthogonal unit vectors. The description of an object in a coordinate system is called a coordinate.

[0039] Further description of the prior art:

[0040] An excavator is a piece of heavy engineering equipment, mainly used to dig soil, coal, sand and gravel and other materials, and can load these materials into transport vehicles or unload them to stockpiles. Excavators have become one of the important tools in the fields of construction, transportation and mining.

[0041] At present, the automatic control of excavators has become a hot topic. In order to realize the automatic control of excavators, it is necessary to accurately determine the length of the excavator arm and the joint angle between the arm links. However, due to the structural complexity of the excavator arm, there will be a certain angle deviation when the sensor is fixedly installed on the excavator. Therefore, when determining the joint angle based on the value of the sensor on the adjacent link, it is necessary to first remove this angle deviation, which is the external parameter of the sensor.

[0042] Therefore, it becomes extremely important to efficiently calibrate the external parameters of the sensor and the length of the excavator arm.

[0043] Based on the above reasons, in order to efficiently calibrate the external parameters of the sensor and the length of the excavator arm, thereby realizing automatic control of the excavator, the first embodiment of the present application provides a parameter calibration method for an excavator. The method is applied to an electronic device, which can be a vehicle-mounted device configured on the excavator, or a terminal device independent of the excavator, or other electronic equipment capable of calibrating the excavator, which is not specifically limited in the embodiments of the present application.

[0044] The following, combined Figure 1 to Figure 7 The parameter calibration method of an excavator provided in an embodiment of the present application is introduced.

[0045] like Figure 1 As shown, the excavator parameter calibration method provided in the present application includes the following steps S101 to S103.

[0046] Step S101: obtaining first readings corresponding to each sensor when a target part on the bucket is located at a first position, and second readings corresponding to each sensor when the target part is located at at least six second positions on the same horizontal line as the first position.

[0047] Wherein, each sensor is respectively configured on each arm of the excavator or on a hydraulic cylinder corresponding to each arm, and each arm includes a boom, a dipper rod and a bucket.

[0048] In order to better understand the parameter calibration method of the excavator provided in this application, the following is combined with Figure 2 The structure of the excavator in the parameter calibration method of the excavator provided in an embodiment of the present application is introduced.

[0049] like Figure 2 As shown, it is a structural diagram of an excavator in the parameter calibration method of an excavator provided in an embodiment of the present application. The excavator includes a cabin 13 and multiple arms, wherein the multiple arms include a boom 10 (also called a boom), a stick 11 (also called a forearm) and a bucket 12. The boom 10 is a long rod extending from the cabin 13, used to support the stick 11 and the bucket 12. The stick 11 is a shorter rod connected to the boom 10 and can move up and down. The bucket 12 is installed at the end of the stick 11 and is used for digging and loading materials. Each arm of the excavator corresponds to a sensor, the boom 10 corresponds to the sensor 20, the stick 11 corresponds to the sensor 21, and the bucket 12 corresponds to the sensor 22. It should be noted that Figure 1 In the description, each sensor is configured on each arm of the excavator. In a specific implementation, each sensor can also be configured on a hydraulic cylinder corresponding to each arm of the excavator, and the present application does not specifically limit this.

[0050] In a specific implementation, the sensor corresponding to each arm can be a tilt sensor or a distance sensor. Among them, the tilt sensor is also called an inclinometer, a level, an inclinometer, etc., which is used to measure the inclination of the measured plane relative to the horizontal plane, or the parallelism and verticality between two components. As a detection tool, the tilt sensor has been used in many fields, such as bridge construction, railway laying, aviation and navigation, industrial automation, mechanical processing, etc. A distance sensor is a sensor used to measure the distance of objects in the environment, which can output the perceived distance of the object in the form of position information, including laser distance sensors, ultrasonic distance sensors, infrared distance sensors, etc. Compared with ordinary cameras and cameras, distance sensors can sense the three-dimensional position information of every point on every object in the surrounding environment. Therefore, distance sensors have become an indispensable environmental information collection tool in many fields such as industrial automation and intelligent platforms.

[0051] The target part is a fixed part on the bucket, for example, the target part is a tooth tip of the bucket or a part on the surface of the bucket. When operating the excavator, the target part may come into contact with other objects. Figure 2 The target area can be Figure 2 12-1 (bucket tooth tip) shown, the target part can also be Figure 2 12-2 (a portion of the bucket surface) is shown.

[0052] It should be noted that in the embodiment of the present application, the calibrated length of the bucket is the component of the distance between the target part and the bucket joint in the vertical plane. When the target part is the bucket tooth tip, the length of the bucket is the component of the distance between the bucket joint and the bucket tooth tip in the vertical plane.

[0053] In order to more clearly illustrate the parameter calibration method of the excavator provided in the embodiment of the present application, the bucket tooth tip is used as an example to introduce the target part in the embodiment of the present application, which is not used to limit the present application.

[0054] In an embodiment of the present application, the first reading and the second reading can be specifically achieved by manually operating the arms of the excavator to move, recording the first reading of each sensor when the bucket tooth tip is in the first position, and recording the second reading of each sensor when the bucket tooth tip is in the second position.

[0055] It should be noted that the first position and the second position are positions on the same horizontal line and do not overlap each other. In an optional embodiment, a piece of flat ground can be selected, and the bucket tooth tip can be operated to contact at least seven different non-overlapping positions on the flat ground. One of the positions is used as the first position, and the remaining at least six positions are used as the second position. Since the function to be optimized is established through the first reading and the second reading in the subsequent steps of this application, at least six functions to be optimized can be established through a first position and at least six second positions, which provides a basis for calibrating the external parameters of the three sensors and the lengths of the three arms in this application. For the sensor corresponding to each arm, the corresponding calibrated external parameter is a constant, and the calibrated length of each arm is also a constant. This application aims to determine these constants.

[0056] like Figure 3 As shown, it is a schematic diagram of the bucket tooth tip being located at the first position and the second position respectively in the parameter calibration method of the excavator provided in an embodiment of the present application. The first position 31 and the second position 32 are two non-overlapping positions on the horizontal line 30. When the bucket tooth tip is located at the first position 31, the reading of the sensor corresponding to each arm of the excavator is obtained, and the reading is the first reading. When the bucket tooth tip is located at the second position 32, the reading of the sensor corresponding to each arm of the excavator is obtained, and the reading is the second reading.

[0057] Step S102: constructing a function to be optimized based on the first reading, the second reading, the external parameters to be calibrated of each sensor, and the length to be calibrated of each arm.

[0058] The optimization objective of the function to be optimized is to minimize the difference between the target distance and the third distance, the third distance is the difference between the first position and the second position, the target distance is the difference between the first distance and the second distance, the first distance is the distance between the first position and the boom joint, the second distance is the distance between the second position and the boom joint, wherein the boom joint is the joint corresponding to the hinge between the boom and the cabin.

[0059] It should be noted that the joints of the excavator refer to the joints corresponding to the hinges between the two movable parts on the excavator, and the joints include the boom joint, the stick joint and the bucket joint. The boom joint can be understood as a point on the hinge between the boom and the cabin, and the hinge between the boom and the cabin is a hardware structure for connecting the boom and the cabin. The stick joint can be understood as a point on the hinge between the stick and the boom, and the hinge between the stick and the boom is a hardware structure for connecting the stick and the boom. The bucket joint can be understood as a point on the hinge between the bucket and the stick, and the hinge between the bucket and the stick is a hardware structure for connecting the bucket and the stick. In practical applications, the boom joint can also be called the boom base point, the stick joint can also be called the stick base point, and the bucket joint can also be called the bucket base point.

[0060] like Figure 4 As shown, it is a schematic diagram of each joint in the parameter calibration method of the excavator provided in an embodiment of the present application, wherein point O is the boom joint, point A is the arm joint, point B is the bucket joint, and point C is the bucket tooth tip.

[0061] Optionally, the length to be calibrated of each arm can be understood as the distance between the base point and the end of each arm, the length to be calibrated of the boom is the distance between the base point of the boom and the end of the boom, the length to be calibrated of the dipper arm is the distance between the base point of the dipper arm and the end of the dipper arm, and the length to be calibrated of the bucket is the distance between the base point of the bucket and the tip of the bucket tooth. Among them, the base point of the boom is connected to the cabin, the end of the boom is connected to the base point of the dipper arm, the end of the dipper arm is connected to the base point of the bucket, the base point of the boom and the boom joint can be regarded as the same point, the end of the boom, the base point of the dipper arm and the dipper arm joint can be regarded as the same point, and the end of the dipper arm, the base point of the bucket and the dipper joint can be regarded as the same point.

[0062] like Figure 4 , which is a schematic diagram of the lengths to be calibrated of each arm in the excavator parameter calibration method provided in an embodiment of the present application, wherein the length to be calibrated of the boom is the length of line segment OA, the length to be calibrated of the arm is the length of line segment AB, and the length to be calibrated of the bucket is the length of line segment BC. The distance between the bucket tooth tip and the boom joint in the horizontal direction is the component of line segment OC in the horizontal direction.

[0063] In an embodiment of the present application, when the bucket tooth tip is at the first position and each second position, the first reading, the corresponding second reading, the external parameters to be calibrated of each sensor, and the length to be calibrated of each arm can be determined through the kinematic relationship to construct the corresponding function to be optimized.

[0064] For each second position and first position, a function to be optimized can be constructed by using the readings of the three sensors, external parameters and the lengths of the three arms. In this way, at least six functions to be optimized can be constructed by using at least six second positions and first positions.

[0065] The target distance in the present application is a positive value. In practical applications, the first distance may be smaller than the second distance, or may be larger than the second distance. In a specific implementation, the target distance is the absolute value of the difference between the first distance and the second distance.

[0066] Ideally, the difference between the calculated second distance and the calculated first distance should be equal to the third distance between the first position and the second position, that is, the difference between the target distance and the third distance should be 0 in an ideal state.

[0067] like Figure 5 As shown, it is a schematic diagram of the first distance, the second distance and the third distance in the parameter calibration method of the excavator provided in an embodiment of the present application, wherein d1 is the distance between the first position 31 and the boom joint in the horizontal direction, that is, d1 is the first distance, d2 is the distance between the second position 32 and the boom joint in the horizontal direction, that is, d2 is the second distance, and d3 is the distance between the first position 31 and the second position 32, that is, d3 is the third distance.

[0068] In the present application, a function to be optimized may be constructed according to the relationship between the distances, and the optimization goal of the function to be optimized is to minimize the difference between the target distance and the third distance.

[0069] Step S103: Optimizing and solving the function to be optimized based on the constraint conditions and the optimization target, and determining the calibrated length of each arm and the calibrated external parameters of each sensor.

[0070] Among them, the constraint conditions include: the calibrated angle corresponding to each joint is within a preset angle range, and the difference between the calibrated length of each arm and the measured length of each arm is less than a preset surveying error.

[0071] Wherein, the calibration angle corresponding to each joint is determined based on the calibration external parameters of each sensor.

[0072] In this application, the above-obtained function to be optimized is optimized and solved through preset constraints to obtain the optimal solution for the length of each arm and the optimal solution for the external parameters of the sensor. The obtained optimal solution is the calibrated length of each arm and the calibrated external parameters of the sensor.

[0073] The first constraint condition is that the calibration angle corresponding to each joint is within a preset angle range, and the second constraint condition is that the difference between the calibration length of each arm and the measured length of each arm is less than a preset mapping error. The first constraint condition and the second constraint condition are used to optimize the optimization function to be solved, thereby completing the calibration external parameters of the three sensors and the calibration lengths of the three arms of the excavator.

[0074] The preset angle range includes a boom joint angle range corresponding to the boom joint, a stick joint angle range corresponding to the arm joint, and a bucket joint angle range corresponding to the bucket joint.

[0075] It should be noted that the preset angle range can be provided by the manufacturer of the excavator or obtained by manual measurement. The preset angle range is a known angle range. In specific implementation, the preset angle range can be obtained by the known maximum limit angle and the known minimum limit angle. The measurement length corresponding to each arm can be obtained by manually measuring each arm. The calibration angle corresponding to each joint refers to the expression of the angle calculated by the sensor reading and the calibration external parameters. The preset surveying error can be provided by the manufacturer of the excavator, or the surveying error can be evaluated by measuring the measurement length of each arm multiple times. This application does not specifically limit the preset angle range and the method for determining the preset surveying error.

[0076] In this way, the at least six functions to be optimized are optimized by the constraint conditions, the difference between the target distance and the third distance is minimized, and the calibrated external parameters of the three sensors and the calibrated lengths of the three arms of the excavator are obtained. It can be understood that the more the number of second positions is, the more the number of functions to be optimized is constructed, and accordingly, the calibrated external parameters of the three sensors and the calibrated lengths of the three arms of the excavator are closer to the optimal solution.

[0077] The parameter calibration method of the excavator provided in the embodiment of the present application includes obtaining a first reading corresponding to each sensor when the target part on the bucket is located at a first position, and a second reading corresponding to each sensor when the target part is located at at least six second positions on the same horizontal line as the first position, wherein the first position is different from the second position, and each sensor is respectively configured on each arm of the excavator or on a hydraulic cylinder corresponding to each arm, and each arm includes a boom, a dipper rod and a bucket; based on the first reading, the second reading, the external parameters to be calibrated of each sensor and the length to be calibrated of each arm, a function to be optimized is constructed, wherein the optimization goal of the function to be optimized is to minimize the difference between the target distance and the third distance, and the third distance is the first The target distance is the difference between the first position and the second position, the target distance is the difference between the first distance and the second distance, the first distance is the distance between the first position and the boom joint, and the second distance is the distance between the second position and the boom joint, wherein the boom joint is the joint corresponding to the hinge between the boom and the cabin; based on the constraints and the optimization objectives, the optimization function to be optimized is solved to determine the calibrated length of each arm and the calibrated external parameters of each sensor, and the constraints include: the calibration angle corresponding to each joint is within a preset angle range, and the difference between the calibrated length of each arm and the measured length of each arm is less than a preset surveying error, wherein the calibration angle corresponding to each joint is determined based on the calibrated external parameters of each sensor.

[0078] It can be seen that the excavator parameter calibration method provided in the embodiment of the present application only needs to construct the function to be optimized through the corresponding readings of the sensors when the bucket tooth tip is located at least seven positions on the same horizontal line, the corresponding external parameters of the sensors, and the lengths of each arm of the excavator. By optimizing and solving the function to be optimized through constraints, the external parameters of the three sensors and the lengths of the three arms of the excavator can be determined at one time. Therefore, the excavator parameter calibration method provided in the embodiment of the present application can efficiently calibrate the external parameters of the sensors and the precise dimensions of the arm connecting rods, thereby realizing the automatic control of the excavator.

[0079] In an optional implementation, the above step S102 can be implemented by the following steps S201 to S203.

[0080] Step S201: Determine the expression corresponding to each first angle of each joint based on the first reading and the external parameters to be calibrated of each sensor, and determine the expression corresponding to each second angle of each joint based on the second reading and the external parameters to be calibrated.

[0081] It can be understood that each joint has a corresponding joint angle, and the joint angle can be understood as the angle value of each joint of the excavator in the corresponding position. The boom joint angle corresponding to the boom joint is the angle value between the boom and the cabin, the arm joint angle corresponding to the stick joint is the angle value between the stick and the boom, and the bucket joint angle corresponding to the bucket joint is the angle value between the bucket and the stick.

[0082] The above-mentioned first angle is the joint angle corresponding to each joint when the bucket tooth tip is in the first position, and the first angle specifically includes: the boom joint angle corresponding to the boom joint when the bucket tooth tip is in the first position, the arm joint angle corresponding to the stick joint, and the bucket joint angle corresponding to the bucket joint; the above-mentioned second angle is the joint angle corresponding to each joint when the bucket tooth tip is in the second position, and the second angle specifically includes: the boom joint angle corresponding to the boom joint, the arm joint angle corresponding to the stick joint, and the bucket joint angle corresponding to the bucket joint when the bucket tooth tip is in the second position.

[0083] Combined with the figure, the boom joint angle corresponding to the boom joint is the angle θ between the Z1 axis and the line segment OA α The arm joint angle corresponding to the arm joint is the angle θ between the Z2 axis and the line segment AB. β The bucket joint angle corresponding to the bucket joint is the angle θ between the Z3 axis and the line segment BC γ .

[0084] It should be noted that there may be a preset analytical function between the joint angle and the sensor reading. It should be noted that for those skilled in the art, the analytical function is common knowledge, and the analytical function is shown in formula (1):

[0085] θ=f(q;Φ) Formula (1)

[0086] Where θ is the joint angle, q is the sensor reading, and Φ is the sensor's external parameter.

[0087] It should be noted that, in the above formula (1), if the joint angle θ is the boom joint angle corresponding to the boom joint, the sensor reading q is the data corresponding to the sensor configured on the boom or the hydraulic cylinder corresponding to the boom; if the joint angle θ is the boom joint angle corresponding to the arm joint, the sensor reading q is the data corresponding to the sensor configured on the arm or the hydraulic cylinder corresponding to the arm; if the joint angle θ is the bucket joint angle corresponding to the bucket joint, the sensor reading q is the data corresponding to the sensor configured on the bucket or the hydraulic cylinder corresponding to the bucket.

[0088] Assuming that the first reading is q1, the second reading is q2, the first angle is θ1, and the second angle is θ2, substituting q1 and θ1 into the above formula (1) can obtain the following expression (1), and substituting q2 and θ2 into the above formula (1) can obtain the following expression (2):

[0089] θ1=f(q1;Φ) Expression (1)

[0090] θ2=f(q2;Φ) Expression (2)

[0091] The above expression (1) is the expression corresponding to the first angle, and the expression (2) is the expression corresponding to the second angle.

[0092] Step S202: Determine a first expression for the first distance based on the length to be calibrated of each arm and the expressions corresponding to the first angles, and determine a second expression for the second distance based on the length to be calibrated of each arm and the expressions corresponding to the second angles.

[0093] It should be noted that the first distance and the second distance are both the distances between the bucket tooth tip and the boom joint. The first distance is the distance between the bucket tooth tip and the boom joint in the horizontal direction when the bucket tooth tip is located in the first position, and the second distance is the distance between the bucket tooth tip and the boom joint in the horizontal direction when the bucket tooth tip is located in the second position.

[0094] In an embodiment of the present application, when the bucket tooth tip is in the first position, the distance between the bucket tooth tip and the boom joint in the horizontal direction can be determined through a kinematic relationship. Specifically, the distance between the bucket tooth tip and the boom joint in the horizontal direction when the bucket tooth tip is in the first position can be determined by using an expression of the length to be calibrated of each arm and the first angle of each joint.

[0095] Correspondingly, when the bucket tooth tip is in the second position, the distance between the bucket tooth tip and the boom joint in the horizontal direction can be determined through the kinematic relationship. Specifically, the distance between the bucket tooth tip and the boom joint in the horizontal direction when the bucket tooth tip is in the second position can be determined by the expression of the length to be calibrated of each arm and the second angle of each joint.

[0096] Step S203: construct a function to be optimized according to the third distance between the first position and the second position, the first expression and the second expression.

[0097] In a specific implementation, the third distance between the first position and the second position may be obtained first, and the third distance may be obtained by manual measurement. Then, the function to be optimized is constructed according to the third distance, the first expression and the second expression.

[0098] Specifically, the above function to be optimized is shown in the following formula (2):

[0099] loss=(d i -d1-d3) 2 Formula (2)

[0100] Among them, d i is the second distance, d1 is the first distance, and d3 is the third distance.

[0101] In a specific implementation manner, the first expression of the first distance in the above step S202 can be implemented by the following steps:

[0102] Determine, according to the expressions corresponding to the lengths to be calibrated of each arm and each first angle, an expression of the first coordinate of the first position in the first coordinate system, wherein the first coordinate system is a coordinate system with the arm joint as the origin and the horizontal axis as the horizontal direction;

[0103] An expression of the horizontal axis coordinate in the expression of the first coordinate is determined as a first expression of the first distance.

[0104] Accordingly, the second expression of the second distance in the above step S202 can be implemented by the following steps:

[0105] Determine an expression of the second coordinate of the second position in the first coordinate system according to the length to be calibrated of each arm and the expressions corresponding to each second angle;

[0106] The expression of the horizontal axis coordinate in the expression of the second coordinate is determined as a second expression of the second distance.

[0107] The first coordinate system refers to the coordinate system established with the boom joint as the origin. Figure 4 In the figure, the first coordinate system refers to the coordinate system established with point O as the origin.

[0108] Since the first distance is the horizontal distance between the bucket tooth tip and the boom joint when the bucket tooth tip is in the first position, the first distance refers to the horizontal axis coordinate corresponding to the coordinate of the first position of the bucket tooth tip in the first coordinate system established with the boom joint as the origin.

[0109] Correspondingly, since the second distance is the horizontal distance between the bucket tooth tip and the boom joint when the bucket tooth tip is in the second position, the second distance refers to the horizontal axis coordinate corresponding to the coordinate of the second position of the bucket tooth tip in the first coordinate system established with the boom joint as the origin.

[0110] In an optional implementation, in the present application, a second coordinate system may be established with the bucket tooth tip as the origin, and the first expression of the first distance and the second expression of the second distance may be determined by the first coordinate system and the second coordinate system.

[0111] Specifically, the excavator parameter calibration method provided in the embodiment of the present application may further include the following steps:

[0112] An expression of a target transformation matrix is ​​determined, where the target transformation matrix is ​​used to characterize a transformation relationship from a second coordinate system with the bucket tooth tip as the origin to the first coordinate system.

[0113] The transformation matrix from one coordinate system to another usually refers to a mathematical tool that converts the point (vector) representation in one coordinate system into the corresponding position representation in another coordinate system. This transformation can include operations such as rotation, translation, scaling, and mirroring. In three-dimensional space, the transformation matrix from coordinate system A to coordinate system B is usually a 4x4 homogeneous coordinate matrix.

[0114] The homogeneous coordinate matrix from coordinate system A to coordinate system B is shown in the following formula (3):

[0115]

[0116] Among them, T AB is the homogeneous coordinate matrix from coordinate system A to coordinate system B, R is a 3x3 rotation matrix, which describes the change in the direction of the coordinate axis corresponding to the coordinate system A to coordinate system B, t is a column vector composed of three elements, representing the translation vector of the origin of coordinate system B relative to the origin of coordinate system A, and the last row (0, 0, 0, 1) in the homogeneous transformation matrix is ​​used to process the translation operation and keep the dimension invariant of the point.

[0117] In a specific implementation, the rotation matrix R from the second coordinate system to the first coordinate system can be determined by the calibrated length of each arm and the joint angle corresponding to each joint, and the translation vector t from the origin of the first coordinate system (boom joint) to the origin of the second coordinate system (bucket tooth tip) can be determined, and then the target transformation matrix for transforming the second coordinate system with the bucket tooth tip as the origin to the first coordinate system with the boom joint as the origin can be determined.

[0118] It can be understood that the target transformation matrix can not only transform the second coordinate system with the bucket tooth tip as the origin into the first coordinate system with the boom joint as the origin, but also transform the coordinates of a position point in the second coordinate system into the coordinates in the first coordinate system.

[0119] Therefore, the specific implementation of the above step of "determining the expression of the first coordinate of the first position in the first coordinate system according to the length to be calibrated of each arm and the expression corresponding to each first angle" is as follows:

[0120] Determine an expression of the first coordinate of the first position in the first coordinate system according to the length to be calibrated of each arm, the expression corresponding to each first angle, and the expression of the target transformation matrix;

[0121] The specific implementation of the above step of "determining the expression of the second coordinate of the second position in the first coordinate system according to the length to be calibrated of each arm and the expression corresponding to each second angle" is as follows:

[0122] According to the lengths to be calibrated of each arm, the expressions corresponding to the second angles and the expression of the target transformation matrix, the expression of the second coordinate of the second position in the first coordinate system is determined.

[0123] It can be understood that when the bucket tooth tip is in the first position, the second coordinate system with the bucket tooth tip as the origin can be understood as a coordinate system with the first position as the origin. The first angle corresponding to each joint when the bucket tooth tip is in the first position is substituted into the target transformation matrix, and the first target transformation matrix for transforming the coordinate system with the first position as the origin into the first coordinate system with the boom joint as the origin can be obtained. The expression of the first target transformation matrix is ​​a function of the first target transformation matrix, in which the independent variables are the length to be calibrated of each arm and the first angles, and the dependent variable is the first target transformation matrix.

[0124] Correspondingly, when the bucket tooth tip is located at the second position, the second coordinate system with the bucket tooth tip as the origin can be understood as a coordinate system with the second position as the origin. The second angle corresponding to each joint when the bucket tooth tip is located at the second position is substituted into the target transformation matrix, and the second target transformation matrix for transforming the coordinate system with the second position as the origin into the first coordinate system with the boom joint as the origin can be obtained. The expression of the second target transformation matrix is ​​a function of the second target transformation matrix, in which the independent variables are the length to be calibrated of each arm and the second angles, and the dependent variable is the length to be calibrated of each arm.

[0125] Furthermore, the expression of the first coordinate of the first position in the first coordinate system can be determined by the expression of the first target transformation matrix, and the expression of the second coordinate of the second position in the first coordinate system can be determined by the expression of the second target transformation matrix.

[0126] In an optional specific implementation manner, the above step of "determining the expression of the target transformation matrix" can also be implemented by the following steps:

[0127] Determine respectively an expression of a first transformation matrix, an expression of a second transformation matrix, and an expression of a third transformation matrix, wherein the first transformation matrix is ​​used to characterize the transformation relationship from a third coordinate system with the boom joint as the origin to the first coordinate system, the second transformation matrix is ​​used to characterize the transformation relationship from a fourth coordinate system with the bucket joint as the origin to the third coordinate system, and the third transformation matrix is ​​used to characterize the transformation relationship from the second coordinate system to the fourth coordinate system;

[0128] The product of the expression of the first transformation matrix, the expression of the second transformation matrix, and the expression of the third transformation matrix is ​​determined as the expression of the target transformation matrix.

[0129] In the parameter calibration method of the excavator provided in the present application, respective corresponding coordinate systems can be established for each arm of the excavator. Specifically, the first coordinate system is established with the boom joint as the origin, the third coordinate system is established with the arm joint as the origin, the fourth coordinate system is established with the bucket joint as the origin, and the second coordinate system is established with the bucket tooth tip as the origin.

[0130] In an optional embodiment, the X-axis of the first coordinate system is the horizontal direction, the Z-axis of the second coordinate system, the third coordinate system and the fourth coordinate system are the directions of the lines between each two joints, the Y-axis corresponds to the direction of the joint axis, and the Z-axis is the direction perpendicular to the horizontal plane formed by the X-axis and the Y-axis.

[0131] Combination Figure 4 The first coordinate system, the second coordinate system, the third coordinate system and the fourth coordinate system are introduced. Figure 4 The origin of the first coordinate system is point O, the X-axis is the X1 axis, the Y-axis coincides with the boom joint axis, and the Z-axis is the Z1 axis. The origin of the third coordinate system is point A, the X-axis is the X2 axis, the Y-axis coincides with the arm joint axis, and the Z-axis is the Z2 axis. The origin of the fourth coordinate system is point B, the X-axis is the X3 axis, the Y-axis coincides with the bucket joint axis, and the Z-axis is the Z3 axis. The origin of the second coordinate system is point C, the X-axis is the X4 axis, the Y-axis coincides with the bucket tooth tip axis, and the Z-axis is the Z4 axis.

[0132] The boom joint angle corresponding to the excavator boom joint is θ α , the arm joint angle corresponding to the arm joint is θ β , the bucket joint angle corresponding to the bucket joint is θ γ , the length of the boom to be calibrated is l1, the length of the arm to be calibrated is l2, and the length of the bucket to be calibrated is l3, that is, Figure 4 ∠AOZ1 in is θ α , ∠BAZ2 is θ β , ∠CBZ3 is θ γ, the length of line segment OA is l1, the length of line segment AB is l2, and the length of line segment BC is l3.

[0133] In this way, the input parameter can be determined as the boom joint angle θ α and the length l1 of the boom to be calibrated, and the expression of the first transformation matrix T1 for transforming the third coordinate system with the boom joint as the origin to the first coordinate system with the boom joint as the origin:

[0134]

[0135] Determine the input parameter as the stick joint angle θ β The length l2 of the bucket arm to be calibrated, and the expression of the second transformation matrix T2 for transforming the fourth coordinate system with the bucket joint as the origin to the third coordinate system with the bucket arm joint as the origin:

[0136]

[0137] Determine the input parameter as the bucket joint angle θ γ and the length l3 of the bucket to be calibrated, and the expression of the third transformation matrix T3 for transforming the second coordinate system with the bucket tooth tip as the origin to the fourth coordinate system with the bucket joint as the origin:

[0138]

[0139] According to the expression of the first transformation matrix T1 and the expression of the second transformation matrix T2, the transformation matrix for transforming the fourth coordinate system with the bucket joint as the origin to the first coordinate system with the boom joint as the origin is T1*T2. According to the expression of the third transformation matrix T3, the expression of the target transformation matrix T for transforming the second coordinate system with the bucket tooth tip as the origin to the first coordinate system with the boom joint as the origin is obtained:

[0140] T=T1*T2*T3

[0141] The expression of the target transformation matrix T is: The independent variable is the boom joint angle θ α , the length of the boom to be calibrated l1, the arm joint angle θ β , the length of the bucket arm to be calibrated l2, the bucket joint angle θ γ , the length of the bucket to be calibrated l3, the dependent variable is a function of T.

[0142] In an optional implementation, the above step of “determining an expression of the first coordinate of the first position in the first coordinate system according to the lengths to be calibrated of each arm, the expressions corresponding to the first angles, and the expression of the target transformation matrix” includes:

[0143] Determine a first target transformation matrix according to the lengths to be calibrated of each arm, the expressions corresponding to each first angle, and the expression of the target transformation matrix;

[0144] Determine an expression of a first coordinate of the first position in the first coordinate system according to the position coordinates of the first position in the second coordinate system and the first target transformation matrix;

[0145] The above step of "substituting the expressions corresponding to the second angles as the joint angles into the target transformation matrix to determine the expression of the second coordinates of the second position in the first coordinate system" includes:

[0146] Determine a second target transformation matrix according to the lengths to be calibrated of each arm, the expressions corresponding to each second angle, and the expression of the target transformation matrix;

[0147] Determine an expression of the second coordinate of the second position in the first coordinate system based on the position coordinates of the second position in the second coordinate system and the second target transformation matrix.

[0148] It should be noted that when the bucket tooth tip is located at the first position, the first position is the origin corresponding to the second coordinate system with the bucket tooth tip as the origin, and therefore, the position coordinates of the first position in the second coordinate system are (0, 0, 0).

[0149] Assume that the first angle includes: the first boom joint angle is θ α1 , the first arm joint angle is θ β1 , the first bucket joint angle is θ γ1 , so we can get the first target transformation matrix T 第一 .

[0150] In this way, according to the position coordinates of the first position in the second coordinate system and the first target transformation matrix, the expression of the first coordinate of the first position in the first coordinate system can be:

[0151] (x1,y1,z1)=T 第一 *[0,0,0,1] T

[0152] Correspondingly, when the bucket tooth tip is located at the second position, the second position is the origin corresponding to the second coordinate system with the bucket tooth tip as the origin, and therefore, the position coordinates of the second position in the second coordinate system are (0, 0, 0).

[0153] Assume that the second angle includes: the second boom joint angle is θ α2 , the second arm joint angle is θ β2 , the second bucket joint angle is θ γ2, so we can get the second target transformation matrix T 第二 .

[0154] In this way, according to the position coordinates of the second position in the second coordinate system and the second target transformation matrix, the expression of the second coordinate of the second position in the first coordinate system can be:

[0155] (x2,y2,z2)=T 第二 *[0,0,0,1] T

[0156] Furthermore, it can be concluded that the horizontal axis coordinate corresponding to the first coordinate of the first position in the first coordinate system is the first target transformation matrix T 第一 The element in the first row and fourth column of the second position in the first coordinate system corresponds to the horizontal coordinate of the second target transformation matrix T 第二 The element in the first row and fourth column of .

[0157] From the calculation formula T=T1*T2*T3 of the target transformation matrix T, it can be known that the element T[1][4] in the first row and fourth column of the target transformation matrix T is:

[0158] T[1][4]=l3*sinθ γ *(cosθ α *cosθ β -sinθ α *sinθ β )+l3*cosθ γ *(cosθ α *sinθ β +sinθ α *cosθ β )+l2*(cosθ α *sinθ β +cosθ β *sinθ α )+l1*sinθ α

[0159] Furthermore, the first target transformation matrix T can be obtained 第一 The element T in the first row and fourth column of 第一 [1][4] is:

[0160] T 第一 [1][4] = l3*sinθ γ1 *(cosθ α1 *cosθ β1 -sinθ α1 *sinθ β1 )+l3*cosθ γ1 *(cosθα1 *sinθ β1 +sinθ α1 *cosθ β1 )+l2*(cosθ α1 *sinθ β1 +cosθ β1 *sinθ α1 )+l1*sinθ α1

[0161] The second target transformation matrix T 第二 The element T in the first row and fourth column of 第二 [1][4] is:

[0162] T 第二 [1][4] = l3*sinθ γ2 *(cosθ α2 *cosθ β2 -sinθ α2 *sinθ β2 )+l3*cosθ γ2 *(cosθ α2 *sinθ β2 +sinθ α2 *cosθ β2 )+l2*(cosθ α2 *sinθ β2 +cosθ γ2 *sinθ α2 )+l1*sinθ α2

[0163] Since the expression of the horizontal axis coordinate in the expression of the first coordinate is the first expression of the first distance, and the expression of the horizontal axis coordinate in the expression of the second coordinate is the second expression of the second distance, the first expression of the first distance is T 第一 [1][4] The corresponding expression, the second expression of the second distance is T 第二 [1][4] The corresponding expression is 第一 [1][4] The corresponding expressions and T 第二 Substituting the corresponding expressions of [1][4] into the above formula (2), we can construct the function to be optimized, which includes the variables of the joint angle corresponding to each joint and the length corresponding to each arm.

[0164] Furthermore, by substituting the above expressions (1) and (2) into the function to be optimized, the function to be optimized including the variable of the external parameter corresponding to each sensor and the variable of the length corresponding to each arm can be obtained.

[0165] In an optional implementation, the present application can also construct the function to be optimized by geometric operations. Figure 6 Introduce the construction of the function to be optimized through geometric operations:

[0166] like Figure 6 , which is a schematic diagram of an example of constructing a geometric relationship based on an excavator in a parameter calibration method for an excavator provided in an embodiment of the present application, Figure 6 Yes Figure 4 The geometric relationship is constructed after simplification, where O is the boom joint, A is the arm joint, B is the bucket joint, and C is the bucket tooth tip. The horizontal distance between the bucket tooth tip and the boom joint is the horizontal component of the line segment OC. The line segments OE, BF, and DF are horizontal line segments, and the line segments AE, AF, and CD are vertical line segments. The horizontal component of the line segment OC is the sum of the lengths of the line segments OF and FD, and the length of the line segment FD is the difference between the line segments BF and BD. That is, the calculation formula for the horizontal distance f between the bucket tooth tip and the boom joint is as follows:

[0167] f=l OE +l BF -l BD

[0168] According to the trigonometric function relationship, we can know that:

[0169] l OE = l OA *sin∠OAEl BF = l BA *sin∠BAE

[0170] l BD = l BC *cos∠CBD

[0171] Because l OA =l1,l BA =l2,l BC =l3,∠OAE=θ α , ∠BAE=180°-θ β -∠OAE,∠CBD=180°-θ γ -∠ABF, and ∠ABF=90°-∠BAE, so the distance between the bucket tooth tip and the boom joint in the horizontal direction can be obtained as:

[0172] f=l3*sinθ γ *(cosθ α *cosθ β -sinθ α *sinθ β )+l3*cosθγ *(cosθ α *sinθ β +sinθ α *cosθ β )+l2*(cosθ α *sinθ β +cosθ β *sinθ α )+l1*sinθ α

[0173] It can be seen that the above-mentioned function to be optimized can also be obtained through geometric relations.

[0174] In this way, the preset constraints provided in this application can be used to optimize the function to be optimized, thereby obtaining the external parameters corresponding to each sensor and the length corresponding to each arm, and the obtained external parameters corresponding to each sensor and the length corresponding to each arm are used as the calibration data of the excavator.

[0175] Through the excavator parameter calibration method provided by the present application, it is only necessary to control the excavator bucket tooth tip to be located at at least seven positions on the same horizontal line, and based on the prior knowledge of the mapping error and angle range of the actual length of each arm as constraints, a small amount of sensor data on the same horizontal line is collected as calibration data, so that the external parameters of the three sensors corresponding to the boom, dipper arm and bucket, as well as the length of the boom, dipper arm and bucket, can be accurately and efficiently calibrated. In addition, the excavator parameter calibration method provided by the present application only needs to use the horizontal plane as the reference plane, avoiding the measurement difficulty caused by the lack of reference planes for reference in other directions, and further improving the accuracy of the excavator calibration.

[0176] The following is an introduction to the excavator parameter calibration method provided by this application through a specific implementation step:

[0177] The first step is to manually operate the excavator arm to control the bucket tooth tip to touch the position x0 on the ground, and record the contact point as x0 and the sensor data as q0;

[0178] Step 2: Manually operate the excavator arm to control the bucket tooth tip to touch the position x1 on the ground. x1 does not overlap with x0, and collect the distance p between x1 and x0. i , sensor data q i ;

[0179] Step 3: Repeat step 2 until sufficient data is collected (at least six groups of p i and q i );

[0180] Step 4: Manually survey and map the measured lengths L of the three arms of the excavatorm1 , L m2 , L m3 ;

[0181] Step 5: Manually operate the excavator to move each arm to the limit position and record the limit angle θ of the limit position l and θ h ;

[0182] Step 6: Construct the function to be optimized:

[0183] loss=(T(q i ;L,Φ).xT(q0;L,Φ).xp i ) 2 Among them, T(q i ; L, Φ).x is the aforementioned second distance, T(q0; L, Φ).x is the aforementioned first distance, p i is the aforementioned third distance, q0 is the aforementioned first reading, q i is the aforementioned second reading;

[0184] Step 7: Set constraints. The first is to constrain the calibrated length of each arm according to the surveying accuracy error. The second is to constrain the joint angle of the excavator according to the extreme angle of the excavator joint. The constraints are as follows:

[0185] Constraint 1: L m -ε <L<L m +ε

[0186] Constraint 2: θ l ≥θ l _prior,θ h ≤θ h _prior

[0187] Among them, ε is the maximum surveying error, θ h _prior is the maximum limit angle known to the joint, θ l _prior is the minimum known limit angle of the joint. It should be noted that [θ l _prior,θ h _prior] is the aforementioned preset angle range;

[0188] Step 8. Based on constraint conditions 1 and constraint conditions 2, the optimization function loss is optimized and solved to obtain the calibrated length L of each arm of the excavator and the calibrated external parameter Φ of the sensor.

[0189] In an optional implementation, before step S103, the excavator parameter calibration method provided in the embodiment of the present application may further include the following steps:

[0190] Determine the maximum limit angle and the minimum limit angle corresponding to each joint;

[0191] The interval formed by the maximum limit angle and the minimum limit angle is determined as the preset angle range.

[0192] The maximum limit angle and minimum limit angle of the excavator joint represent the upper and lower limits of the allowed range of motion of the joint. The maximum limit angle and minimum limit angle corresponding to each joint include: the maximum limit angle and minimum limit angle corresponding to the boom joint, the maximum limit angle and minimum limit angle corresponding to the arm joint, and the maximum limit angle and minimum limit angle corresponding to the bucket joint.

[0193] In the specific implementation, the maximum limit angle and the minimum limit angle corresponding to each joint of the excavator can be provided by the manufacturer of the excavator, or the maximum limit angle and the minimum limit angle of the excavator can be obtained through manual measurement. In this way, the angle range corresponding to each joint can be obtained.

[0194] Specifically, in the present application, the maximum limit angle and the minimum limit angle corresponding to each joint can be determined by the following method:

[0195] In response to control operations on the joints of the excavator, controlling the arms to move respectively;

[0196] Determine the maximum limit angle and the minimum limit angle corresponding to the boom joint according to the boom joint angle corresponding to the boom joint when the boom moves to the limit position;

[0197] Determine the maximum limit angle and the minimum limit angle corresponding to the arm joint according to the boom joint angle corresponding to the arm joint when the arm moves to the limit position;

[0198] According to the boom joint angle corresponding to the bucket joint when the bucket moves to the extreme position, the maximum limit angle and the minimum limit angle corresponding to the arm joint are determined.

[0199] In a specific implementation, the joints of the excavator can be manually controlled. First, the joints corresponding to the control operation will move, thereby causing each arm to move. In this application, the boom joint, the arm joint, and the bucket joint can be controlled separately.

[0200] During the movement of the boom joint, the boom joint angle when the boom moves to the maximum limit position with the largest angle with the cockpit is determined as the maximum limit angle corresponding to the boom joint, and the boom joint angle when the boom moves to the minimum limit position with the smallest angle with the cockpit is determined as the minimum limit angle corresponding to the boom joint.

[0201] During the movement of the boom joint, the boom joint angle when the boom moves to the maximum limit position where the angle with the boom is the largest is determined as the maximum limit angle corresponding to the boom joint, and the boom joint angle when the boom moves to the minimum limit position where the angle with the boom is the smallest is determined as the minimum limit angle corresponding to the boom joint.

[0202] During the movement of the bucket joint, the bucket joint angle when the bucket moves to the maximum limit position with the largest angle with the boom is determined as the maximum limit angle corresponding to the bucket joint, and the bucket joint angle when the bucket moves to the minimum limit position with the smallest angle with the boom is determined as the minimum limit angle corresponding to the bucket joint.

[0203] like Figure 7 As shown, it is a schematic diagram of each arm of the excavator moving to the limit position in the parameter calibration method of the excavator provided in the embodiment of the present application. Among them, 601 is the posture diagram of the excavator arm when the excavator arm moves to the maximum limit position, at this time, the arm joint angle is the maximum limit angle, 602 is the posture diagram of the excavator arm when the excavator arm moves to the minimum limit position, at this time, the arm joint angle is the minimum limit angle; 603 is the posture diagram of the excavator arm when the excavator arm moves to the maximum limit position, at this time, the arm joint angle is the maximum limit angle, 604 is the posture diagram of the excavator arm when the excavator arm moves to the minimum limit position, at this time, the arm joint angle is the minimum limit angle; 605 is the posture diagram of the excavator bucket when the excavator bucket moves to the maximum limit position, at this time, the bucket joint angle is the maximum limit angle, 606 is the posture diagram of the excavator bucket when the excavator bucket moves to the minimum limit position, at this time, the bucket joint angle is the minimum limit angle.

[0204] It should be noted that if each sensor is an inclination sensor, the sensor reading is used to indicate the angle between the inclination sensor and the horizontal direction. When each sensor is respectively configured on each arm of the excavator, the external parameter to be calibrated of each sensor is the angle between the sensor and the corresponding arm.

[0205] Corresponding to the excavator parameter calibration method provided in the first embodiment of the present application, the second embodiment of the present application further provides an excavator parameter calibration device, such as Figure 7 As shown, the excavator parameter calibration device 700 includes:

[0206] An acquisition unit 701 is used to acquire a first reading corresponding to each sensor when a target part on the bucket is located at a first position, and a second reading corresponding to each sensor when the target part is located at at least six second positions on the same horizontal line as the first position, wherein the first position is different from the second position, and each sensor is respectively configured on each arm of the excavator or on a hydraulic cylinder corresponding to each arm, and each arm includes a boom, a dipper rod and a bucket;

[0207] A construction unit 702 is used to construct a function to be optimized based on the first reading, the second reading, the external parameters to be calibrated of each sensor, and the length to be calibrated of each arm, wherein the optimization target of the function to be optimized is to minimize the difference between a target distance and a third distance, the third distance is the difference between the first position and the second position, the target distance is the difference between the first distance and the second distance, the first distance is the distance between the first position and the boom joint in the horizontal direction, the second distance is the distance between the second position and the boom joint in the horizontal direction, wherein the boom joint is a joint corresponding to a hinge between the boom and the cabin;

[0208] The determination unit 703 is used to optimize and solve the function to be optimized based on the constraint conditions and the optimization target, and determine the calibrated length of each arm and the calibrated external parameters of each sensor, wherein the constraint conditions include: the calibration angle corresponding to each joint is within a preset angle range, and the difference between the calibrated length of each arm and the measured length of each arm is less than a preset surveying error, wherein the calibration angle corresponding to each joint is determined based on the calibrated external parameters of each sensor.

[0209] Optionally, the construction unit 702 is specifically used for:

[0210] Determine an expression corresponding to each first angle of each joint based on the first reading and the external parameters to be calibrated of each sensor, and determine an expression corresponding to each second angle of each joint based on the second reading and the external parameters to be calibrated, wherein each joint includes the boom joint, the arm joint corresponding to the hinged portion between the boom and the boom, and the bucket joint corresponding to the hinged portion between the boom and the bucket;

[0211] Determine a first expression for the first distance based on the length to be calibrated of each arm and the expression corresponding to each first angle, and determine a second expression for the second distance based on the length to be calibrated of each arm and the expression corresponding to each second angle;

[0212] A function to be optimized is constructed according to the third distance between the first position and the second position, the first expression, and the second expression.

[0213] Optionally, the construction unit 702 is specifically used for:

[0214] Determine, according to the expressions corresponding to the lengths to be calibrated of each arm and each first angle, an expression of the first coordinate of the first position in a first coordinate system, wherein the first coordinate system is a coordinate system with the arm joint as the origin and the horizontal axis as the horizontal direction;

[0215] Determine an expression of the horizontal axis coordinate in the expression of the first coordinate as a first expression of the first distance;

[0216] Determine an expression of the second coordinate of the second position in the first coordinate system according to the length to be calibrated of each arm and the expressions corresponding to each second angle;

[0217] The expression of the horizontal axis coordinate in the expression of the second coordinate is determined as a second expression of the second distance.

[0218] Optionally, the target part is a bucket tooth tip, and the construction unit 702 is specifically used for:

[0219] Determine an expression of a target transformation matrix, wherein the target transformation matrix is ​​used to represent a transformation relationship from a second coordinate system with the bucket tooth tip as the origin to the first coordinate system;

[0220] Determine an expression of the first coordinate of the first position in the first coordinate system according to the length to be calibrated of each arm, the expression corresponding to each first angle, and the expression of the target transformation matrix;

[0221] According to the lengths to be calibrated of each arm, the expressions corresponding to the second angles and the expression of the target transformation matrix, the expression of the second coordinate of the second position in the first coordinate system is determined.

[0222] Optionally, the construction unit 702 is specifically used for:

[0223] Determine respectively an expression of a first transformation matrix, an expression of a second transformation matrix, and an expression of a third transformation matrix, wherein the first transformation matrix is ​​used to characterize the transformation relationship from a third coordinate system with the boom joint as the origin to the first coordinate system, the second transformation matrix is ​​used to characterize the transformation relationship from a fourth coordinate system with the bucket joint as the origin to the third coordinate system, and the third transformation matrix is ​​used to characterize the transformation relationship from the second coordinate system to the fourth coordinate system;

[0224] The product of the expression of the first transformation matrix, the expression of the second transformation matrix, and the expression of the third transformation matrix is ​​determined as the expression of the target transformation matrix.

[0225] Optionally, the construction unit 702 is specifically used for:

[0226] Determine a first target transformation matrix according to the lengths to be calibrated of each arm, the expressions corresponding to each first angle, and the expression of the target transformation matrix;

[0227] Determine an expression of a first coordinate of the first position in the first coordinate system according to the position coordinates of the first position in the second coordinate system and the first target transformation matrix;

[0228] Determine a second target transformation matrix according to the lengths to be calibrated of each arm, the expressions corresponding to each second angle, and the expression of the target transformation matrix;

[0229] Determine an expression of the second coordinate of the second position in the first coordinate system based on the position coordinates of the second position in the second coordinate system and the second target transformation matrix.

[0230] Optionally, the determining unit 703 is further configured to:

[0231] Determine the maximum limit angle and the minimum limit angle corresponding to each joint;

[0232] The interval formed by the maximum limit angle and the minimum limit angle is determined as the preset angle range.

[0233] Optionally, the determining unit 703 is specifically configured to:

[0234] In response to control operations on the joints of the excavator, controlling the arms to move respectively;

[0235] Determine the maximum limit angle and the minimum limit angle corresponding to the boom joint according to the boom joint angle corresponding to the boom joint when the boom moves to the limit position;

[0236] Determine the maximum limit angle and the minimum limit angle corresponding to the arm joint according to the arm joint angle corresponding to the arm joint when the arm moves to the limit position;

[0237] According to the bucket joint angle corresponding to the bucket joint when the bucket moves to the extreme position, the maximum limit angle and the minimum limit angle corresponding to the arm joint are determined.

[0238] Optionally, the first distance is smaller than the second distance, and the function to be optimized constructed by the construction unit 702 is:

[0239] loss=(d i -d1-d3) 2

[0240] Among them, d i is the second distance, d1 is the first distance, and d3 is the third distance.

[0241] The third embodiment of the present application further provides an excavator, comprising at least:

[0242] An excavator body, sensors disposed on each arm of the excavator body or on a hydraulic cylinder corresponding to each arm, and Figure 7 A parameter calibration device 700 for an excavator is shown.

[0243] Corresponding to the excavator parameter calibration method provided in the first embodiment of the present application, the fourth embodiment of the present application further provides an electronic device for excavator parameter calibration. Figure 8 As shown, the electronic device 800 includes: a processor 801; and a memory 802, which is used to store a program of a parameter calibration method for an excavator. After the device is powered on and the program of the parameter calibration method for an excavator is run by the processor, the following steps are performed:

[0244] Obtaining a first reading corresponding to each sensor when a target part on the bucket is located at a first position, and a second reading corresponding to each sensor when the target part is located at at least six second positions on the same horizontal line as the first position, wherein the first position is different from the second position, and each sensor is respectively configured on each arm of the excavator or on a hydraulic cylinder corresponding to each arm, and each arm includes a boom, a dipper rod and a bucket;

[0245] A function to be optimized is constructed based on the first reading, the second reading, the external parameters to be calibrated of each sensor, and the length to be calibrated of each arm, wherein the optimization target of the function to be optimized is to minimize the difference between the target distance and a third distance, the third distance is the difference between the first position and the second position, the target distance is the difference between the first distance and the second distance, the first distance is the distance between the first position and the boom joint in the horizontal direction, the second distance is the distance between the second position and the boom joint in the horizontal direction, wherein the boom joint is a joint corresponding to the hinge between the boom and the cabin;

[0246] The function to be optimized is optimized and solved based on the constraint conditions and the optimization target to determine the calibrated length of each arm and the calibrated external parameters of each sensor, wherein the constraint conditions include: the calibrated angle corresponding to each joint is within a preset angle range, the difference between the calibrated length of each arm and the measured length of each arm is less than a preset surveying error, and the calibrated angle corresponding to each joint is determined based on the calibrated external parameters of each sensor.

[0247] Corresponding to the excavator parameter calibration method provided in the first embodiment of the present application, the fifth embodiment of the present application provides a computer-readable storage medium storing a program of the excavator parameter calibration method, the program is executed by a processor to perform the following steps:

[0248] Obtaining a first reading corresponding to each sensor when a target part on the bucket is located at a first position, and a second reading corresponding to each sensor when the target part is located at at least six second positions on the same horizontal line as the first position, wherein the first position is different from the second position, and each sensor is respectively configured on each arm of the excavator or on a hydraulic cylinder corresponding to each arm, and each arm includes a boom, a dipper rod and a bucket;

[0249] A function to be optimized is constructed based on the first reading, the second reading, the external parameters to be calibrated of each sensor, and the length to be calibrated of each arm, wherein the optimization target of the function to be optimized is to minimize the difference between the target distance and a third distance, the third distance is the difference between the first position and the second position, the target distance is the difference between the first distance and the second distance, the first distance is the distance between the first position and the boom joint in the horizontal direction, the second distance is the distance between the second position and the boom joint in the horizontal direction, wherein the boom joint is a joint corresponding to the hinge between the boom and the cabin;

[0250] The function to be optimized is optimized and solved based on the constraint conditions and the optimization target to determine the calibrated length of each arm and the calibrated external parameters of each sensor, wherein the constraint conditions include: the calibrated angle corresponding to each joint is within a preset angle range, the difference between the calibrated length of each arm and the measured length of each arm is less than a preset surveying error, and the calibrated angle corresponding to each joint is determined based on the calibrated external parameters of each sensor.

[0251] It should be noted that the detailed description of the devices, excavators, electronic devices and computer-readable storage media provided in the second, third, fourth and fifth embodiments of the present application can refer to the relevant description of the first embodiment of the present application, and will not be repeated here.

[0252] Although the present application is disclosed as above in the form of a preferred embodiment, it is not intended to limit the present application. Any technical personnel in this field may make possible changes and modifications without departing from the spirit and scope of the present application. Therefore, the scope of protection of the present application shall be based on the scope defined by the claims of the present application.

[0253] In a typical configuration, a node device in a blockchain includes one or more processors (CPU), input / output interfaces, network interfaces, and memory.

[0254] The memory may include non-permanent storage in a computer-readable medium, random access memory (RAM) and / or non-volatile memory in the form of read-only memory (ROM) or flash RAM. The memory is an example of a computer-readable medium.

[0255] 1. Computer-readable media includes permanent and non-permanent, removable and non-removable media that can be used to store information by any method or technology. Information can be computer-readable instructions, data structures, program modules or other data. Examples of computer storage media include, but are not limited to, phase change memory (PRAM), static random access memory (SRAM), dynamic random access memory (DRAM), random access memory (RAM) of other attributes, read-only memory (ROM), electrically erasable programmable read-only memory (EEPROM), flash memory or other memory technology, compact disk read-only memory (CD-ROM), digital versatile disk (DVD) or other optical storage, magnetic cassettes, magnetic tape magnetic disk storage or other magnetic storage media or any other non-transmission media that can be used to store information that can be accessed by a computing device. As defined in this article, computer-readable media does not include non-transitory media such as modulated data signals and carrier waves.

[0256] 2. Those skilled in the art should understand that the embodiments of the present application can be provided as methods, systems or computer program products. Therefore, the present application can take the form of a complete hardware embodiment, a complete software embodiment or an embodiment combining software and hardware. Moreover, the present application can take the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) containing computer-usable program code.

[0257] Although the present application is disclosed as above in the form of a preferred embodiment, it is not intended to limit the present application. Any technical personnel in this field may make possible changes and modifications without departing from the spirit and scope of the present application. Therefore, the scope of protection of the present application shall be based on the scope defined by the claims of the present application.

Claims

1. A method for calibrating parameters of an excavator, characterized in that: The method comprises: Obtaining a first reading corresponding to each sensor when a target part on the bucket is located at a first position, and a second reading corresponding to each sensor when the target part is located at at least six second positions on the same horizontal line as the first position, wherein the first position is different from the second position, and each sensor is respectively configured on each arm of the excavator or on a hydraulic cylinder corresponding to each arm, and each arm includes a boom, a dipper rod and a bucket; A function to be optimized is constructed based on the first reading, the second reading, the external parameters to be calibrated of each sensor, the length to be calibrated of each arm, and the relationship between each distance, wherein each distance includes a first distance, a second distance, and a third distance, and the optimization goal of the function to be optimized is to minimize the difference between the target distance and the third distance, the third distance is the difference between the first position and the second position, the target distance is the difference between the first distance and the second distance, the first distance is the distance between the first position and the boom joint in the horizontal direction, the second distance is the distance between the second position and the boom joint in the horizontal direction, and the boom joint is the joint corresponding to the hinge between the boom and the cabin; The function to be optimized is optimized and solved based on the constraint conditions and the optimization target to determine the calibrated length of each arm and the calibrated external parameters of each sensor, wherein the constraint conditions include: the calibration angle corresponding to each joint is within a preset angle range, and the difference between the calibrated length of each arm and the measured length of each arm is less than a preset surveying error, wherein the calibration angle corresponding to each joint is determined based on the calibrated external parameters of each sensor.

2. The method according to claim 1, characterized in that The constructing a function to be optimized based on the first reading, the second reading, the external parameters to be calibrated of each sensor, and the length to be calibrated of each arm comprises: Determine an expression corresponding to each first angle of each joint based on the first reading and the external parameters to be calibrated of each sensor, and determine an expression corresponding to each second angle of each joint based on the second reading and the external parameters to be calibrated, wherein each joint includes the boom joint, the arm joint corresponding to the hinged portion between the boom and the boom, and the bucket joint corresponding to the hinged portion between the boom and the bucket; Determine a first expression for the first distance based on the length to be calibrated of each arm and the expression corresponding to each first angle, and determine a second expression for the second distance based on the length to be calibrated of each arm and the expression corresponding to each second angle; A function to be optimized is constructed according to the third distance between the first position and the second position, the first expression, and the second expression.

3. The method according to claim 2, characterized in that The first expression for determining the first distance between the first position and the boom joint in the horizontal direction based on the length to be calibrated of each arm and the expressions corresponding to the first angles includes: Determine, according to the expressions corresponding to the lengths to be calibrated of each arm and each first angle, an expression of the first coordinate of the first position in a first coordinate system, wherein the first coordinate system is a coordinate system with the arm joint as the origin and the horizontal axis as the horizontal direction; Determine an expression of the horizontal axis coordinate in the expression of the first coordinate as a first expression of the first distance; The second expression for determining the second distance between the second position and the boom joint in the horizontal direction based on the length to be calibrated of each arm and the expressions corresponding to each second angle includes: Determine an expression of the second coordinate of the second position in the first coordinate system according to the length to be calibrated of each arm and the expressions corresponding to each second angle; The expression of the horizontal axis coordinate in the expression of the second coordinate is determined as a second expression of the second distance.

4. The method according to claim 3, characterized in that The target part is a bucket tooth tip. Before determining the expression of the first coordinate of the first position in the first coordinate system according to the length to be calibrated of each arm and the expression corresponding to each first angle, the method further includes: Determine an expression of a target transformation matrix, wherein the target transformation matrix is ​​used to represent a transformation relationship from a second coordinate system with the bucket tooth tip as the origin to the first coordinate system; Determining the expression of the first coordinate of the first position in the first coordinate system according to the length to be calibrated of each arm and the expression corresponding to each first angle includes: Determine an expression of the first coordinate of the first position in the first coordinate system according to the length to be calibrated of each arm, the expression corresponding to each first angle, and the expression of the target transformation matrix; Determining the expression of the second coordinate of the second position in the first coordinate system according to the length to be calibrated of each arm and the expression corresponding to each second angle includes: According to the lengths to be calibrated of each arm, the expressions corresponding to the second angles and the expression of the target transformation matrix, the expression of the second coordinate of the second position in the first coordinate system is determined.

5. The method according to claim 4, characterized in that The expression for determining the target transformation matrix includes: Determine respectively an expression of a first transformation matrix, an expression of a second transformation matrix, and an expression of a third transformation matrix, wherein the first transformation matrix is ​​used to characterize the transformation relationship from a third coordinate system with the boom joint as the origin to the first coordinate system, the second transformation matrix is ​​used to characterize the transformation relationship from a fourth coordinate system with the bucket joint as the origin to the third coordinate system, and the third transformation matrix is ​​used to characterize the transformation relationship from the second coordinate system to the fourth coordinate system; The product of the expression of the first transformation matrix, the expression of the second transformation matrix, and the expression of the third transformation matrix is ​​determined as the expression of the target transformation matrix.

6. The method according to claim 5, characterized in that Determining the expression of the first coordinate of the first position in the first coordinate system according to the length to be calibrated of each arm, the expression corresponding to each first angle, and the expression of the target transformation matrix includes: Determine a first target transformation matrix according to the lengths to be calibrated of each arm, the expressions corresponding to each first angle, and the expression of the target transformation matrix; Determine an expression of a first coordinate of the first position in the first coordinate system according to the position coordinates of the first position in the second coordinate system and the first target transformation matrix; Determining the expression of the second coordinate of the second position in the first coordinate system according to the length to be calibrated of each arm, the expression corresponding to each second angle, and the expression of the target transformation matrix includes: Determine a second target transformation matrix according to the lengths to be calibrated of each arm, the expressions corresponding to each second angle, and the expression of the target transformation matrix; Determine an expression of the second coordinate of the second position in the first coordinate system based on the position coordinates of the second position in the second coordinate system and the second target transformation matrix.

7. The method according to claim 1, characterized in that Before optimizing and solving the function to be optimized based on the constraint conditions and the optimization target to determine the calibrated length of each arm and the calibrated external parameters of each sensor, the method further includes: Determine the maximum limit angle and the minimum limit angle corresponding to each joint; The interval formed by the maximum limit angle and the minimum limit angle is determined as the preset angle range.

8. The method according to claim 7, characterized in that Determining the maximum limit angle and the minimum limit angle corresponding to each joint includes: In response to control operations on the joints of the excavator, controlling the arms to move respectively; Determine the maximum limit angle and the minimum limit angle corresponding to the boom joint according to the boom joint angle corresponding to the boom joint when the boom moves to the limit position; Determine the maximum limit angle and the minimum limit angle corresponding to the arm joint according to the arm joint angle corresponding to the arm joint when the arm moves to the limit position; According to the bucket joint angle corresponding to the bucket joint when the bucket moves to the extreme position, the maximum limit angle and the minimum limit angle corresponding to the arm joint are determined.

9. The method according to claim 2, characterized in that: The first distance is smaller than the second distance, and the function to be optimized is: in, is the second distance, is the first distance, is the third distance.

10. A parameter calibration device for an excavator, characterized in that: The device comprises: an acquisition unit, configured to acquire a first reading corresponding to each sensor when a target part on the bucket is located at a first position, and a second reading corresponding to each sensor when the target part is located at at least six second positions on the same horizontal line as the first position, wherein the first position is different from the second position, and each sensor is respectively configured on each arm of the excavator or on a hydraulic cylinder corresponding to each arm, and each arm includes a boom, a dipper rod and a bucket; a construction unit, configured to construct a function to be optimized based on the first reading, the second reading, the external parameters to be calibrated of each sensor, the length to be calibrated of each arm, and the relationship between each distance, wherein each distance includes a first distance, a second distance, and a third distance, an optimization target of the function to be optimized is to minimize the difference between a target distance and a third distance, the third distance is the difference between the first position and the second position, the target distance is the difference between the first distance and the second distance, the first distance is the distance between the first position and a boom joint in a horizontal direction, the second distance is the distance between the second position and the boom joint in a horizontal direction, wherein the boom joint is a joint corresponding to a hinge between the boom and a cabin; A determination unit is used to optimize and solve the function to be optimized based on constraints and the optimization target, and determine the calibrated length of each arm and the calibrated external parameters of each sensor, wherein the constraints include: the calibration angle corresponding to each joint is within a preset angle range, and the difference between the calibrated length of each arm and the measured length of each arm is less than a preset surveying error, wherein the calibration angle corresponding to each joint is determined based on the calibrated external parameters of each sensor.

11. An excavator, characterized in that: The excavator comprises at least: An excavator body, sensors arranged on the arms of the excavator body or on the hydraulic cylinders corresponding to the arms, and a parameter calibration device for the excavator as claimed in claim 10.

12. An electronic device, characterized in that: include: processor; as well as The memory is used to store a data processing program. After the electronic device is powered on and the program is run by the processor, the method according to any one of claims 1 to 9 is executed.

13. A computer-readable storage medium, characterized in that: A data processing program is stored, and the program is run by a processor to execute the method according to any one of claims 1 to 9.

Citation Information

Patent Citations

  • Excavator cutting angle optimization control system and method and excavator

    CN111501867A

  • Excavator unloading operation auxiliary system and trajectory planning method

    CN111733918A

  • Method for controlling boom, excavator, storage medium and processor

    CN115288218A

  • Excavator and method for controlling the same

    EP3943669A1

  • Construction machine

    US20190345697A1