Construction equipment, parameter determination method thereof and storage medium
By determining the pivot point parameters of the functional parts between the robotic arm and the bucket and calculating the bucket parameters, the problem that the existing technology cannot adapt to the rapid loading and unloading and tilting rotating excavators is solved, and the user experience and operation efficiency are improved.
Patent Information
- Application Number
- CN202411279211.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-12
- Publication Date
- 2024-11-26
AI Technical Summary
The existing excavator guidance system cannot be adapted to excavators with quick loading and unloading functions and/or tilt rotation functions, resulting in poor user experience.
By determining the pivot point parameters of the functional parts between the robotic arm and the bucket, including quick change equipment and tilt, the bucket parameters of the bucket are calculated, providing a data basis to reduce operational difficulty and improve user experience.
The parameters of excavators equipped with quick change equipment and/or tilts are realized, which reduces the difficulty of operation of construction equipment, improves user experience, and can meet the tip accuracy even after the structure of the functional parts is changed in one calculation. Require.
Smart Images

Figure CN119021293A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of engineering technology, and in particular to a construction device and a parameter determination method and a storage medium thereof. Background Art
[0002] As a common engineering machinery for land and road leveling operations, excavators are widely used in earthwork operations such as road and bridge construction and mines. In the actual earthwork process, in order to ensure the compliance of the construction surface and the requirements of elevation error, reduce construction measurement and slope inspection, and improve construction efficiency, it is often necessary to measure the position coordinates of the vehicle body (such as bucket tip coordinates) in real time.
[0003] The current excavator guidance system can receive data collected by the Global Navigation Satellite System (GNSS) equipment and inertial navigation equipment through the on-board computer, use the GNSS antenna to determine the heading and position of the excavator, and then combine the angle data of the vehicle body, boom, arm, connecting rod or bucket tilt sensor and mechanical model parameters to calculate the real-time posture of the excavator and the position coordinates of any point of interest on the vehicle body. In this way, combined with the operation design data set by the system, the user can be guided to perform the operation in real time.
[0004] However, the above-mentioned excavator guidance system is usually only suitable for excavators with traditional structures, and cannot support excavators with quick loading and unloading functions and / or tilting and rotating functions (i.e., equipped with quick-change equipment and / or tiltrotators), which affects the user experience. Summary of the invention
[0005] The present invention provides a construction equipment and a parameter determination method and storage medium thereof, which can accurately determine the parameters of the construction equipment equipped with a quick-change device and / or a tilting device, thereby providing a data basis for guiding the operation of the construction equipment, reducing the operating difficulty of the construction equipment, and improving the user experience.
[0006] According to one aspect of the present invention, a method for determining parameters of construction equipment is provided, wherein a functional part is installed between a mechanical arm and a bucket of the construction equipment, and the functional part includes a quick-change device and / or a tilting device; the method includes:
[0007] Determine the mounting point parameters of the robot arm;
[0008] According to the mounting point parameters, the axis point parameters of the functional part directly connected to the bucket are calculated, wherein when the functional part only includes the quick-change device, the functional part directly connected to the bucket is the quick-change device; when the functional part only includes the tilting device, or the functional part includes the quick-change device and the tilting device, the functional part directly connected to the bucket is the tilting device;
[0009] The bucket parameters of the bucket are determined according to the axis point parameters of the functional parts directly connected to the bucket.
[0010] Optionally, when the functional part includes only a quick-change device, the axis point parameters of the quick-change device are calculated according to the mounting point parameters, including:
[0011] Determine a first angle, wherein the first angle is an angle between a bottom edge of the quick-change device and a horizontal plane;
[0012] The axis point parameters of the quick-change device are calculated according to the mounting point parameters, the first angle, the first distance and the second distance, wherein the first distance is the distance from the mounting point of the quick-change device to the bottom edge of the quick-change device, the mounting point of the quick-change device coincides with the mounting point of the robotic arm, and the second distance is the horizontal offset from the mounting point of the quick-change device to the quick-change point of the quick-change device.
[0013] Optionally, the bucket parameters include the axis point parameters and bucket tip parameters of the bucket, and the quick-change point of the quick-change device coincides with the mounting point of the bucket;
[0014] According to the axis point parameters of the quick-change equipment, determine the bucket parameters of the bucket, including:
[0015] The axis point parameters of the quick-change device are used as the axis point parameters of the bucket;
[0016] Calculate the bucket tip parameters based on the bucket axis point parameters.
[0017] Optionally, when the functional component only includes a tilting device, the axis point parameters of the tilting device are calculated according to the mounting point parameters, including:
[0018] Determining a second angle, wherein the second angle is an angle between the tilt axis of the tilting device and the horizontal plane;
[0019] The axis point parameters of the tilting device are calculated according to the mounting point parameters, the second angle, the third distance and the fourth distance, wherein the third distance is the distance from the mounting point of the tilting device to the tilting axis of the tilting device, the mounting point of the tilting device coincides with the mounting point of the robotic arm, and the fourth distance is the distance from the quick change point of the tilting device to the rotation axis of the tilting device.
[0020] Optionally, when the functional part includes a quick-change device and a tilting device, the axis point parameters of the tilting device are calculated according to the mounting point parameters, including:
[0021] Determine a first angle and a second angle, wherein the first angle is an angle between a bottom side of the quick-change device and a horizontal plane, and the second angle is an angle between a tilt axis of the tilting device and the horizontal plane;
[0022] Calculate the axis point parameters of the quick-change device according to the mounting point parameters, the first angle, the first distance and the second distance, wherein the first distance is the distance from the mounting point of the quick-change device to the bottom edge of the quick-change device, the mounting point of the quick-change device coincides with the mounting point of the robot arm, and the second distance is the horizontal offset from the mounting point of the quick-change device to the quick-change point of the quick-change device;
[0023] The axis point parameters of the tilting device are calculated according to the axis point parameters of the quick-change device, the second angle, the third distance and the fourth distance, wherein the third distance is the distance from the mounting point of the tilting device to the tilt axis of the tilting device, the mounting point of the tilting device coincides with the quick-change point of the quick-change device, and the fourth distance is the distance from the quick-change point of the tilting device to the rotation axis of the tilting device.
[0024] Optionally, the bucket parameters include the bucket axis point parameters and bucket tip parameters, and the quick change point of the tiltrotator coincides with the mounting point of the bucket;
[0025] According to the axis point parameters of the tilting device, the bucket parameters of the bucket are determined, including:
[0026] Calculate the axis point parameters of the bucket according to the axis point parameters of the tilting device, the second angle, the fourth distance and the fifth distance, wherein the fifth distance is the distance from the quick change point of the tilting device to the tilting axis of the tilting device;
[0027] Determine a third angle, wherein the third angle is an angle between a bottom edge of the tilting device and a tilting axis of the tilting device;
[0028] Determine the relative position of the bucket tip with respect to the axis point of the tiltrotator according to the third angle, the length of the bucket, the width of the bucket and the opening angle of the bucket;
[0029] The relative position is transformed, and the bucket tip parameters of the bucket are determined according to the relative position after the position transformation and the axis point parameters of the tilting device.
[0030] Optionally, the relative position is transformed, including:
[0031] Determine a fourth angle and a fifth angle, wherein the fourth angle is an inclination angle of the bucket around the inclination axis of the inclinometer, and the fifth angle is a rotation angle of the bucket around the rotation axis of the inclinometer;
[0032] According to the fifth angle, the fourth angle and the second angle, the relative position is rotated, tilted and pitched in sequence to obtain the relative position after position transformation.
[0033] Optionally, after determining the bucket parameters of the bucket, it also includes:
[0034] Adjust the bucket axis and the midpoint of the bucket tip to be on a plumb line to complete the calibration of the bucket opening angle.
[0035] According to another aspect of the present invention, there is provided a construction equipment, the construction equipment comprising:
[0036] at least one processor; and a memory in communication with the at least one processor; wherein,
[0037] The memory stores a computer program that can be executed by at least one processor. The computer program is executed by at least one processor so that the at least one processor can execute the parameter determination method of the construction equipment according to any embodiment of the present invention.
[0038] According to another aspect of the present invention, a computer-readable storage medium is provided, which stores computer instructions for implementing the method for determining parameters of construction equipment according to any embodiment of the present invention when executed by a processor.
[0039] The technical solution of the embodiment of the present invention determines the mounting point parameters of the mechanical arm, and then calculates the axis point parameters of the functional parts directly connected to the bucket according to the mounting point parameters, thereby determining the bucket parameters of the bucket according to the axis point parameters of the functional parts directly connected to the bucket. The parameter determination method of the construction equipment, on the one hand, can be applied to the following three situations: 1) the functional parts only include quick-change equipment, 2) the functional parts only include tilting devices, and 3) the functional parts include quick-change equipment and tilting devices. It covers various construction equipment structures and has universal applicability. The determined bucket parameters can provide a data basis for the guidance of construction equipment, so as to reduce the operating difficulty of construction equipment and improve user experience. On the other hand, the calibration of the bucket angle can be completed with a plumb bob, which reduces the calibration difficulty and the requirements for the calibration equipment. In addition, in the case where the functional parts include quick-change equipment and tilting devices, after the bucket parameters of the bucket are calculated once and the bucket angle is calibrated, even if the structure of the subsequent functional parts changes, there is no need to calibrate again, and the bucket tip accuracy still meets the requirements.
[0040] It should be understood that the contents described in this section are not intended to identify the key or important features of the embodiments of the present invention, nor are they intended to limit the scope of the present invention. Other features of the present invention will become easily understood through the following description. BRIEF DESCRIPTION OF THE DRAWINGS
[0041] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0042] Figure 1 is a schematic diagram of the basic structure of an excavator provided by an embodiment of the present invention;
[0043] Figure 2 is a structural schematic diagram of a quick-change device provided by an embodiment of the present invention;
[0044] Figure 3 is a schematic structural diagram of a tilting device provided by an embodiment of the present invention;
[0045] Figure 4 is a flow chart of a method for determining parameters of construction equipment provided by an embodiment of the present invention;
[0046] Figure 5 It is a two-dimensional rotation matrix principle diagram provided by an embodiment of the present invention;
[0047] Figure 6 It is a schematic diagram of a bucket posture provided by an embodiment of the present invention;
[0048] Figure 7 is a coordinate transfer schematic diagram provided by an embodiment of the present invention;
[0049] Figure 8 is a flow chart of another method for determining parameters of construction equipment provided by an embodiment of the present invention;
[0050] Fig. 9 is a schematic diagram of a bucket calibration provided by an embodiment of the present invention;
[0051] Fig.10 is a structural schematic diagram of a parameter determination device provided by an embodiment of the present invention;
[0052] Fig.11 is a structural schematic diagram of another parameter determination device provided by an embodiment of the present invention;
[0053] Fig.12 It is a structural schematic diagram of a construction equipment provided by an embodiment of the present invention. DETAILED DESCRIPTION
[0054] In order to enable those skilled in the art to better understand the scheme of the present invention, the technical scheme in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present invention.
[0055] It should be noted that the terms "first", "second", "third", "fourth", "fifth", etc. in the specification and claims of the present invention and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchangeable where appropriate, so that the embodiments of the present invention described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "including" and "having" and any variations thereof 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 that are clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.
[0056] The construction equipment provided by the embodiment of the present invention may be an excavator, a dredge, or other equipment that can control a mechanical arm to drive a bucket to work. For example, Figure 1 Schematic diagram of the basic structure of an excavator provided by an embodiment of the present invention. Figure 1 As shown, the excavator includes a body 101, a boom 102, an arm 103, a connecting rod 104 and a bucket 105. The boom 102 and the arm 103 constitute the mechanical arm of the excavator. The connection point between the body 101 and the boom 102 is the axis of the boom. The connection point between the boom 102 and the arm 103 is the axis of the arm. The connection point between the connecting rod 104 and the bucket 105 and the connection point between the arm 103 and the bucket 105 are the two axis centers of the bucket 105.
[0057] exist Figure 1 On the basis of the excavator shown, a functional part can also be provided on the excavator, and the functional part is installed between the mechanical arm and the bucket. The functional part can enable the excavator to achieve certain specific functions, such as fast loading and unloading of attachments, tilting / rotating attachments, etc. In the present invention, the functional part includes a quick-change device and / or a tilting device.
[0058] Figure 2 Schematic diagram of a quick-change device provided by an embodiment of the present invention. Figure 2 As shown, the quick-change device has a mounting point H, an auxiliary mounting point H', a quick-change point Q and an auxiliary quick-change point Q'. Figure 3 Schematic diagram of the structure of a tilting device provided by an embodiment of the present invention. Figure 3 As shown, the tiltrotator has a mounting point A, an auxiliary mounting point A', a quick-change point B and an auxiliary quick-change point B'.
[0059] Figure 4This is a flow chart of a method for determining parameters of construction equipment provided by an embodiment of the present invention. This embodiment is applicable to the case of determining parameters of construction equipment (such as an excavator). The method can be executed by a parameter determination device, which can be implemented in the form of hardware and / or software. The parameter determination device can be configured in the construction equipment (such as a controller integrated in the construction equipment). Figure 4 As shown, the method includes:
[0060] S410: Determine the mounting point parameters of the robot arm.
[0061] As can be seen from the above description, the construction equipment includes a vehicle body, a mechanical arm and a bucket, and the mechanical arm and the bucket can be directly connected or connected through a functional part (ie, a functional part is installed between the mechanical arm and the bucket). The functional part includes a quick-change device and / or a tilting device.
[0062] In the case where the mechanical arm and the bucket are directly connected, a conventional excavator guidance system can be used to determine the position coordinates of any point of interest on the vehicle body, and the embodiment of the present invention does not impose specific restrictions on this. In the case where a functional part is installed between the mechanical arm and the bucket, the mounting point parameters of the mechanical arm need to be determined first.
[0063] In the present invention, the mounting point of the robot arm generally refers to the connection point between the forearm and the functional part. Specifically, the mounting point parameters of the robot arm can be determined by the axis of the upper arm. The mounting point parameters of the robot arm can be expressed in the form of coordinates or in the form of relative positions.
[0064] S420. Calculate the axis point parameters of the functional component directly connected to the bucket according to the mounting point parameters, wherein when the functional component only includes a quick-change device, the functional component directly connected to the bucket is the quick-change device; when the functional component only includes a tiltrotator, or the functional component includes a quick-change device and a tiltrotator, the functional component directly connected to the bucket is the tiltrotator.
[0065] S430. Determine bucket parameters of the bucket according to the axis point parameters of the functional parts directly connected to the bucket.
[0066] Generally, bucket parameters include bucket axis point parameters (such as mounting axis point parameters) and bucket tip parameters, and bucket tip parameters include at least left bucket tip parameters and right bucket tip parameters.
[0067] Combining steps S420 - S430 , it can be seen that before executing step S420 , the specific structure of the functional component needs to be determined first.
[0068] Exemplarily, the judgment may be made according to the direction transmitted from the end of the forearm to the bucket tip: first determine whether the functional part includes a quick-change device, and then determine whether the functional part includes a tilting device.
[0069] If the functional parts only include the quick-change device, the relationship between the excavator's mechanical arm and the carrier is: arm + arm + quick-change device + bucket. The functional part directly connected to the bucket is the quick-change device. The implementation method of steps S420-S430 is: according to the mounting point parameters, the axis point parameters of the quick-change device are calculated; and then the bucket parameters of the bucket can be determined according to the axis point parameters of the quick-change device.
[0070] If the functional parts only include the tiltrotator, the relationship between the excavator's mechanical arm and the carrier is: arm + arm + tiltrotator + bucket. The functional part directly connected to the bucket is the tiltrotator. Steps S420-S430 are implemented as follows: according to the mounting point parameters, the axis point parameters of the tiltrotator are calculated; and then the bucket parameters of the bucket can be determined according to the axis point parameters of the tiltrotator.
[0071] If the functional parts include a quick-change device and a tiltrotator, the relationship between the excavator's mechanical arm and the carrier is: arm + arm + quick-change device + tiltrotator + bucket. The functional part directly connected to the bucket is the tiltrotator. Steps S420-S430 are implemented as follows: according to the mounting point parameters, the axis point parameters of the quick-change device are calculated; then, according to the axis point parameters of the quick-change device, the axis point parameters of the tiltrotator are calculated; finally, the bucket parameters of the bucket can be determined according to the axis point parameters of the tiltrotator.
[0072] Three examples are provided below to illustrate steps S420 - S430 in detail.
[0073] Example 1: Functional parts only include quick-change devices, and the functional parts directly connected to the bucket are quick-change devices. The relationship between the excavator's mechanical arm and the carrier is: arm + arm + quick-change device + bucket.
[0074] In Example 1, combined with Figure 2 It can be seen that the mounting point H of the quick-change device is connected to the forearm of the excavator, the auxiliary mounting point H' of the quick-change device is connected to the connecting rod, and the quick-change point Q and the auxiliary quick-change point Q' of the quick-change device are respectively connected to the two axes of the bucket. The quick-change device can realize the rapid loading and disassembly of the bucket.
[0075] Based on the definition in step S410, since the mounting point of the robot arm is the connection point between the forearm and the functional part, in Example 1, the mounting point H of the quick-change device coincides with the mounting point of the robot arm, and the mounting point parameter of the robot arm is the point H parameter. The axis point of the quick-change device is the quick-change point Q of the quick-change device.
[0076] According to the H point parameters, the method for calculating the Q point parameters may include the following steps:
[0077] Step a1: Determine a first angle, wherein the first angle is the angle between the bottom edge of the quick-change device and the horizontal plane.
[0078] The bottom side of the quick-change device is the line between the quick-change point Q and the auxiliary quick-change point Q' of the quick-change device, and the X-axis of the coordinate system is parallel to the horizontal plane. Therefore, the first angle is the angle between QQ' and the X-axis, which is denoted as α.
[0079] Optionally, the first angle α may be acquired by an angle sensor provided on the construction equipment.
[0080] Step a2: Calculate the axis point parameters of the quick-change device based on the mounting point parameters, the first angle, the first distance and the second distance, wherein the first distance is the distance from the mounting point of the quick-change device to the bottom edge of the quick-change device, and the mounting point of the quick-change device coincides with the mounting point of the robotic arm; the second distance is the horizontal offset from the mounting point of the quick-change device to the quick-change point of the quick-change device.
[0081] When the H point parameters, the first angle α and related parameters of the quick-change device are known, the Q point parameters can be determined based on the two-dimensional rotation matrix principle.
[0082] Specifically, the relevant parameters of the quick-change device can be stored in the construction equipment, or can be obtained by querying the model of the quick-change device through the Internet.
[0083] The relevant parameters of the quick-change device include at least the first distance and the second distance. Figure 2 As shown, the first distance is the distance from the mounting point H of the quick-change device to the bottom edge QQ' of the quick-change device, which is recorded as QH2; the second distance is the horizontal offset from the mounting point H of the quick-change device to the quick-change point Q of the quick-change device, which is recorded as QH4. Optionally, the relevant parameters of the quick-change device may also include the distance QH1 between the mounting point H of the quick-change device and the auxiliary mounting point H', and the angle QH3 between the connecting line between the mounting point H of the quick-change device and the auxiliary mounting point H' and the bottom edge QQ' of the quick-change device.
[0084] Figure 5 is a two-dimensional rotation matrix principle diagram provided by an embodiment of the present invention. Figure 5 As shown, there is a point P in the Cartesian plane rectangular coordinate system XOY, and its coordinates in the coordinate system XOY are (x, y). After the point P rotates about the origin by θ, the coordinates of the new point P′ are (x′, y′).
[0085] The coordinates of P′ are (x′, y′) and satisfy the following relationship:
[0086] Therefore, with the direction from the cab to the construction equipment as the positive direction and the Z axis vertically upward as the positive direction, the Q point parameters can be expressed as:
[0087]
[0088] Furthermore, since the quick-change point Q of the quick-change device coincides with the mounting point of the bucket, the mounting point of the bucket is the mounting axis point of the bucket. Therefore, the axis point parameter of the bucket is the Q point parameter, and the bucket tip parameter of the bucket can be calculated based on the Q point parameter.
[0089] Example 2: The functional parts only include the tiltrotator, and the functional part directly connected to the bucket is the tiltrotator. The relationship between the excavator's mechanical arm and the carrier is: arm + arm + tiltrotator + bucket.
[0090] In Example 2, combined with Figure 3 It can be seen that the mounting point A of the tiltrotator is connected to the forearm of the excavator, the auxiliary mounting point A' of the tiltrotator is connected to the connecting rod, and the quick-change point B and the auxiliary quick-change point B' of the tiltrotator are respectively connected to the two axes of the bucket. The tiltrotator can be used to adjust the position of the bucket.
[0091] Based on the definition in step S410, since the mounting point of the robot arm is the connection point between the forearm and the functional part, in Example 2, the mounting point A of the tilting device coincides with the mounting point of the robot arm, and the mounting point parameter of the robot arm is the parameter of point A. The axis point of the tilting device is the intersection I of the tilt axis and the rotation axis.
[0092] According to the parameters of point A, the method for calculating the parameters of point I may include the following steps:
[0093] Step b1: Determine a second angle, wherein the second angle is the angle between the tilt axis of the tilting device and the horizontal plane.
[0094] The second angle is the angle between the tilt axis of the tilt device and the horizontal plane, which is denoted as λ. It should be noted that the drawings of the present invention are all drawn based on the example that the tilt device does not rotate, tilt or pitch, and the second angle λ is 0° at this time. In actual applications, the size of the second angle λ can be determined by measurement.
[0095] Optionally, the second angle λ may be acquired by an angle sensor provided on the construction equipment.
[0096] Step b2: Calculate the axis point parameters of the tilting device according to the mounting point parameters, the second angle, the third distance and the fourth distance, wherein the third distance is the distance from the mounting point of the tilting device to the tilting axis of the tilting device, the mounting point of the tilting device coincides with the mounting point of the robotic arm, and the fourth distance is the distance from the quick change point of the tilting device to the rotation axis of the tilting device.
[0097] When the parameters of point A, the second angle λ and related parameters of the tilting device are known, the parameters of point I can be determined according to the principle of two-dimensional rotation matrix.
[0098] Specifically, the relevant parameters of the tilting device can be stored in the construction equipment, or can be obtained by querying the model of the tilting device through the Internet.
[0099] The relevant parameters of the tilting device include at least the third distance and the fourth distance. Figure 3 As shown, the third distance is the distance from the mounting point A of the tilting device to the tilting axis of the tilting device, which is recorded as TR3; the fourth distance is the distance from the quick-change point B of the tilting device to the rotation axis of the tilting device, which is recorded as TR5. Optionally, the relevant parameters of the tilting device may also include: the distance TR1 from the mounting point A of the tilting device to the rotation axis of the tilting device, the distance TR2 between the mounting point A of the tilting device and the auxiliary mounting point A', the distance TR4 from the quick-change point B of the tilting device to the tilting axis of the tilting device, the distance TR6 between the quick-change point B of the tilting device and the auxiliary quick-change point B', the angle TR7 between AA' and the tilting axis, and the angle TR8 between BB' and the tilting axis.
[0100] Taking the direction from the cab to the construction equipment as the positive direction and the vertical upward direction of the Z axis as the positive direction, the parameters of point I can be expressed as:
[0101]
[0102] Furthermore, since the quick-change point B of the tilting device coincides with the mounting point of the bucket, the mounting point of the bucket is the mounting axis point of the bucket. Therefore, the parameters of point B must first be determined based on the parameters of point I, and then the bucket tip parameters of the bucket must be calculated based on the parameters of point B. Specifically, the following steps are included:
[0103] Step c1: Calculate the bucket's axis point parameters according to the tilting device's axis point parameters, the second angle, the fourth distance, and the fifth distance, wherein the fifth distance is the distance from the tilting device's quick-change point to the tilting axis of the tilting device.
[0104] When the parameters of point I, the second angle λ and related parameters of the tilting device are known, the parameters of point B can be determined according to the principle of two-dimensional rotation matrix.
[0105] Taking the direction from the cab to the construction equipment as the positive direction and the vertical upward direction of the Z axis as the positive direction, the parameters of point B can be expressed as:
[0106]
[0107] Step c2: Determine a third angle, wherein the third angle is the angle between the bottom edge of the tilting device and the tilting axis of the tilting device.
[0108] The bottom side of the tilting device is the line between the quick-change point B and the auxiliary quick-change point B' of the tilting device, that is, the third angle θ2 in the following formula is Figure 3 TR8 in.
[0109] Step c3: Determine the relative position of the bucket tip with respect to the axis point of the tiltrotator according to the third angle, the length l of the bucket, the width w of the bucket and the opening angle γ of the bucket.
[0110] Figure 6 Schematic diagram of a bucket posture provided by an embodiment of the present invention. Figure 6 The coordinate system is defined as follows: facing the bucket with your back to the cab, stretch out your right hand, with your thumb pointing to the right (X axis) and your index finger pointing to the cab (Y axis). The positive azimuth direction is from Y to Z. The angle between the bucket and the Y axis is expressed as:
[0111] θ3=180°-γ-θ2.
[0112] Assume that the parameters of point B are B(0,y b ,z b ), the relative position of the bucket tip relative to the axis of the tilting device (including the bucket tip midpoint coordinates, the left bucket tip coordinates and the right bucket tip coordinates) can be expressed as:
[0113] Coordinates of the midpoint of bucket tip:
[0114] The coordinates of the left bucket tip are:
[0115] The coordinates of the right bucket tip are:
[0116] Step c4: Transform the relative position, and determine the bucket tip parameters of the bucket according to the relative position after the position transformation and the axis point parameters of the tilting device.
[0117] Specifically, the fourth angle β and the fifth angle ρ can be determined first, wherein the fourth angle is the inclination angle of the bucket around the tilting axis of the tilting device, and the fifth angle is the rotation angle of the bucket around the rotation axis of the tilting device; according to the fifth angle ρ, the fourth angle β and the second angle λ, the relative position is rotated, tilted, and pitched in sequence to obtain the relative position after the position transformation.
[0118] It can be understood that the second angle λ reflects the position of the tilting device relative to the horizontal plane, and the fifth angle ρ and the fourth angle β reflect the position of the bucket relative to the tilting device. The fifth angle ρ, the fourth angle β and the second angle λ may be 0° or may not be 0°. In practical applications, the sizes of the fifth angle ρ, the fourth angle β and the second angle λ can be determined by measurement.
[0119] For example, the rotation transformation can be performed according to the formula The tilt transformation can be performed according to the formula The pitch transformation can be carried out according to the formula conduct.
[0120] Finally, the bucket tip parameters are determined according to the relative position after position transformation and the parameters of point I. For example, the left bucket tip parameters are equal to the sum of the relative coordinates of the left bucket tip after position transformation and the parameters of point I, and the right bucket tip parameters are equal to the sum of the relative coordinates of the right bucket tip after position transformation and the parameters of point I.
[0121] Example 3: The functional parts include a quick-change device and a tilting device, and the functional part directly connected to the bucket is the tilting device. The relationship between the excavator's mechanical arm and the carrier is: arm + arm + quick-change device + tilting device + bucket.
[0122] In Example 3, Figure 7 Schematic diagram of coordinate transfer provided by an embodiment of the present invention. Figure 2 , Figure 3 and Figure 7 It can be seen that the mounting point H of the quick-change device is connected to the forearm of the excavator, the auxiliary mounting point H' of the quick-change device is connected to the connecting rod, the quick-change point Q of the quick-change device is connected to the mounting point A of the tiltrotator, the auxiliary quick-change point Q' of the quick-change device is connected to the auxiliary mounting point A' of the tiltrotator, and the quick-change point B and auxiliary quick-change point B' of the tiltrotator are respectively connected to the two axes of the bucket. The quick-change device can realize the rapid loading and disassembly of the tiltrotator and the bucket; the tiltrotator can realize the adjustment of the bucket posture.
[0123] Based on the definition in step S410, since the mounting point of the robot arm is the connection point between the forearm and the functional part, in Example 3, the mounting point H of the quick-change device coincides with the mounting point of the robot arm, and the mounting point parameter of the robot arm is the H point parameter. The axis point of the quick-change device is the quick-change point Q of the quick-change device. The mounting point A of the tilting device coincides with the quick-change point Q of the quick-change device, that is, the Q point parameter = the A point parameter, and the axis point of the tilting device is the intersection I of the tilt axis and the rotation axis.
[0124] According to the H point parameters, the method for calculating the I point parameters may include the following steps:
[0125] Step d1: Determine a first angle and a second angle, wherein the first angle is the angle between the bottom edge of the quick-change device and the horizontal plane, and the second angle is the angle between the tilt axis of the tilting device and the horizontal plane.
[0126] The bottom edge of the quick-change device is the line between the quick-change point Q and the auxiliary quick-change point Q' of the quick-change device, and the X-axis of the coordinate system is parallel to the horizontal plane. Therefore, the first angle is the angle between QQ' and the X-axis, denoted as α. The second angle is the angle between the tilt axis of the tilting device and the horizontal plane, denoted as λ.
[0127] Optionally, the first angle α and the second angle λ may be acquired by an angle sensor provided on the construction equipment.
[0128] Step d2: Calculate the axis point parameters of the quick-change device based on the mounting point parameters, the first angle, the first distance and the second distance, wherein the first distance is the distance from the mounting point of the quick-change device to the bottom edge of the quick-change device, and the mounting point of the quick-change device coincides with the mounting point of the robotic arm; the second distance is the horizontal offset from the mounting point of the quick-change device to the quick-change point of the quick-change device.
[0129] When the H point parameters, the first angle α and related parameters of the quick-change device are known, the Q point parameters can be determined based on the two-dimensional rotation matrix principle.
[0130] Specifically, the relevant parameters of the quick-change device can be stored in the construction equipment, or can be obtained by querying the model of the quick-change device through the Internet.
[0131] The relevant parameters of the quick-change device include at least the first distance and the second distance. Figure 2 As shown, the first distance is the distance from the mounting point H of the quick-change device to the bottom edge QQ' of the quick-change device, which is recorded as QH2; the second distance is the horizontal offset from the mounting point H of the quick-change device to the quick-change point Q of the quick-change device, which is recorded as QH4. Optionally, the relevant parameters of the quick-change device may also include the distance QH1 between the mounting point H of the quick-change device and the auxiliary mounting point H', and the angle QH3 between the connecting line between the mounting point H of the quick-change device and the auxiliary mounting point H' and the bottom edge QQ' of the quick-change device.
[0132] Therefore, with the direction from the cab to the construction equipment as the positive direction and the Z axis vertically upward as the positive direction, the Q point parameters can be expressed as:
[0133]
[0134] Step d3: Calculate the axis point parameters of the tilting device according to the axis point parameters of the quick-change device, the second angle, the third distance and the fourth distance, wherein the third distance is the distance from the mounting point of the tilting device to the tilt axis of the tilting device, the mounting point of the tilting device coincides with the quick-change point of the quick-change device, and the fourth distance is the distance from the quick-change point of the tilting device to the rotation axis of the tilting device.
[0135] When the Q-point parameters, the second angle λ and related parameters of the tilting device are known, the I-point parameters can be determined according to the principle of the two-dimensional rotation matrix.
[0136] Specifically, the relevant parameters of the tilting device can be stored in the construction equipment, or can be obtained by querying the model of the tilting device through the Internet.
[0137] The relevant parameters of the tilting device include at least the third distance and the fourth distance. Figure 3As shown, the third distance is the distance from the mounting point A of the tilting device to the tilting axis of the tilting device, which is recorded as TR3; the fourth distance is the distance from the quick-change point B of the tilting device to the rotation axis of the tilting device, which is recorded as TR5. Optionally, the relevant parameters of the tilting device may also include: the distance TR1 from the mounting point A of the tilting device to the rotation axis of the tilting device, the distance TR2 between the mounting point A of the tilting device and the auxiliary mounting point A', the distance TR4 from the quick-change point B of the tilting device to the tilting axis of the tilting device, the distance TR6 between the quick-change point B of the tilting device and the auxiliary quick-change point B', the angle TR7 between AA' and the tilting axis, and the angle TR8 between BB' and the tilting axis.
[0138] Taking the direction from the cab to the construction equipment as the positive direction and the vertical upward direction of the Z axis as the positive direction, the parameters of point I can be expressed as:
[0139]
[0140] Furthermore, since the quick-change point B of the tilting device coincides with the mounting point of the bucket, the mounting point of the bucket is the mounting axis point of the bucket. Therefore, the parameters of point B must first be determined based on the parameters of point I, and then the bucket tip parameters of the bucket must be calculated based on the parameters of point B. Specifically, the following steps are included:
[0141] Step e1: Calculate the bucket's axis point parameters according to the tilting device's axis point parameters, the second angle, the fourth distance and the fifth distance, wherein the fifth distance is the distance from the tilting device's quick-change point to the tilting axis of the tilting device.
[0142] When the parameters of point I, the second angle λ and related parameters of the tilting device are known, the parameters of point B can be determined according to the principle of two-dimensional rotation matrix.
[0143] Taking the direction from the cab to the construction equipment as the positive direction and the vertical upward direction of the Z axis as the positive direction, the parameters of point B can be expressed as:
[0144]
[0145] Step e2: Determine a third angle, wherein the third angle is the angle between the bottom edge of the tilting device and the tilting axis of the tilting device.
[0146] The bottom side of the tilting device is the line between the quick-change point B and the auxiliary quick-change point B' of the tilting device, that is, the third angle θ2 in the following formula is Figure 3 TR8 in.
[0147] Step e3: Determine the relative position of the bucket tip with respect to the axis point of the tiltrotator according to the third angle, the length l of the bucket, the width w of the bucket and the opening angle γ of the bucket.
[0148] The angle between the bucket and the Y axis is expressed as: θ3 = 180° - γ - θ2.
[0149] Assume that the parameters of point B are B(0,y b ,z b ), the relative position of the bucket tip relative to the axis of the tilting device (including the bucket tip midpoint coordinates, the left bucket tip coordinates and the right bucket tip coordinates) can be expressed as:
[0150] Coordinates of the midpoint of bucket tip:
[0151] The coordinates of the left bucket tip are:
[0152] The coordinates of the right bucket tip are:
[0153] Step e4: Transform the relative position, and determine the bucket tip parameters according to the relative position after the position transformation and the axis point parameters of the tilting device.
[0154] Specifically, the fourth angle β and the fifth angle ρ can be determined first, wherein the fourth angle is the inclination angle of the bucket around the tilting axis of the tilting device, and the fifth angle is the rotation angle of the bucket around the rotation axis of the tilting device; according to the fifth angle ρ, the fourth angle β and the second angle λ, the relative position is rotated, tilted, and pitched in sequence to obtain the relative position after the position transformation.
[0155] For example, the rotation transformation can be performed according to the formula The tilt transformation can be performed according to the formula The pitch transformation can be carried out according to the formula conduct.
[0156] Finally, the bucket tip parameters are determined according to the relative position after position transformation and the parameters of point I. For example, the left bucket tip parameters are equal to the sum of the relative coordinates of the left bucket tip after position transformation and the parameters of point I, and the right bucket tip parameters are equal to the sum of the relative coordinates of the right bucket tip after position transformation and the parameters of point I.
[0157] Optionally, based on the above embodiment, Figure 8 FIG. 1 is a flow chart of another method for determining parameters of construction equipment provided by an embodiment of the present invention. Figure 8 As shown, after step S430 is executed, step S440 is also included.
[0158] S440. Adjust the axis of the bucket and the midpoint of the bucket tip to be on a plumb line to complete the calibration of the bucket opening angle.
[0159] Fig. 9 FIG. 1 is a schematic diagram of a bucket calibration provided by an embodiment of the present invention. Fig. 9As shown, the axis point 1 and the axis point 2 are the upper edge of the bucket, J' is the intersection of the plumb line passing through the upper edge of the bucket and the bucket tip, the distance between the axis point 2 and J' is the bucket length, and the distance between J1 and J2 is the bucket width. The angle θ4 between the upper edge of the bucket and the horizontal plane can be determined by the angles of TR7 and TR8.
[0160] Therefore, the bucket opening angle can be calibrated by using a plumb bob to adjust the bucket's axis point 2 and the midpoint of the bucket tip to be on a plumb line.
[0161] That is, the bucket angle γ = θ4 + 90°.
[0162] The technical solution of the embodiment of the present invention determines the mounting point parameters of the mechanical arm, and then calculates the axis point parameters of the functional parts directly connected to the bucket according to the mounting point parameters, thereby determining the bucket parameters of the bucket according to the axis point parameters of the functional parts directly connected to the bucket. The parameter determination method of the construction equipment, on the one hand, can be applied to the following three situations: 1) the functional parts only include quick-change equipment, 2) the functional parts only include tilting devices, and 3) the functional parts include quick-change equipment and tilting devices. It covers various construction equipment structures and has universal applicability. The determined bucket parameters can provide a data basis for the guidance of construction equipment, so as to reduce the operating difficulty of construction equipment and improve user experience. On the other hand, the calibration of the bucket angle can be completed with a plumb bob, which reduces the calibration difficulty and the requirements for the calibration equipment. In addition, in the case where the functional parts include quick-change equipment and tilting devices, after the bucket parameters of the bucket are calculated once and the bucket angle is calibrated, even if the structure of the subsequent functional parts changes, there is no need to calibrate again, and the bucket tip accuracy still meets the requirements.
[0163] Fig.10 is a schematic diagram of the structure of a parameter determination device provided by an embodiment of the present invention. The device is configured in a construction equipment, such as Fig.10 As shown, the device includes: an acquisition module 1001 and a calculation module 1002.
[0164] The acquisition module 1001 is used to determine the mounting point parameters of the robot arm;
[0165] The calculation module 1002 is used to calculate the axis point parameters of the functional parts directly connected to the bucket according to the mounting point parameters, wherein when the functional parts only include quick-change devices, the functional parts directly connected to the bucket are the quick-change devices; when the functional parts only include tiltrotators, or the functional parts include quick-change devices and tiltrotators, the functional parts directly connected to the bucket are the tiltrotators; the bucket parameters of the bucket are determined according to the axis point parameters of the functional parts directly connected to the bucket.
[0166] Optionally, when the functional part only includes a quick-change device, the calculation module 1002 is specifically used to determine a first angle, wherein the first angle is the angle between the bottom edge of the quick-change device and the horizontal plane; according to the mounting point parameters, the first angle, the first distance and the second distance, the axis point parameters of the quick-change device are calculated, wherein the first distance is the distance from the mounting point of the quick-change device to the bottom edge of the quick-change device, the mounting point of the quick-change device coincides with the mounting point of the robot arm, and the second distance is the horizontal offset from the mounting point of the quick-change device to the quick-change point of the quick-change device.
[0167] Optionally, the bucket parameters include the axis point parameters and bucket tip parameters of the bucket, and the quick change point of the quick change device coincides with the mounting point of the bucket; the calculation module 1002 is specifically used to use the axis point parameters of the quick change device as the axis point parameters of the bucket; and calculate the bucket tip parameters of the bucket based on the axis point parameters of the bucket.
[0168] Optionally, when the functional component only includes a tilting device, the calculation module 1002 is specifically used to determine the second angle, wherein the second angle is the angle between the tilting axis of the tilting device and the horizontal plane; the axis point parameters of the tilting device are calculated according to the mounting point parameters, the second angle, the third distance and the fourth distance, wherein the third distance is the distance from the mounting point of the tilting device to the tilting axis of the tilting device, the mounting point of the tilting device coincides with the mounting point of the robotic arm, and the fourth distance is the distance from the quick change point of the tilting device to the rotation axis of the tilting device.
[0169] Optionally, when the functional component includes a quick-change device and a tilting device, the calculation module 1002 is specifically used to determine a first angle and a second angle, wherein the first angle is the angle between the bottom edge of the quick-change device and the horizontal plane, and the second angle is the angle between the tilting axis of the tilting device and the horizontal plane; the axis point parameters of the quick-change device are calculated according to the mounting point parameters, the first angle, the first distance, and the second distance, wherein the first distance is the distance from the mounting point of the quick-change device to the bottom edge of the quick-change device, the mounting point of the quick-change device coincides with the mounting point of the robotic arm, and the second distance is the horizontal offset from the mounting point of the quick-change device to the quick-change point of the quick-change device; the axis point parameters of the tilting device are calculated according to the axis point parameters of the quick-change device, the second angle, the third distance, and the fourth distance, wherein the third distance is the distance from the mounting point of the tilting device to the tilting axis of the tilting device, the mounting point of the tilting device coincides with the quick-change point of the quick-change device, and the fourth distance is the distance from the quick-change point of the tilting device to the rotation axis of the tilting device.
[0170] Optionally, the bucket parameters include the bucket's pivot point parameters and bucket tip parameters, and the quick-change point of the tiltrotator coincides with the bucket's mounting point; the calculation module 1002 is specifically used to calculate the bucket's pivot point parameters based on the tiltrotator's pivot point parameters, the second angle, the fourth distance and the fifth distance, wherein the fifth distance is the distance from the tiltrotator's quick-change point to the tilt axis of the tiltrotator; determine the third angle, wherein the third angle is the angle between the bottom edge of the tiltrotator and the tilt axis of the tiltrotator; determine the relative position of the bucket tip relative to the pivot point of the tiltrotator based on the third angle, the bucket's length, the bucket's width and the bucket's opening angle; transform the relative position, and determine the bucket tip parameters based on the transformed relative position and the tiltrotator's pivot point parameters.
[0171] Optionally, the calculation module 1002 is specifically used to determine a fourth angle and a fifth angle, wherein the fourth angle is the inclination angle of the bucket around the inclination axis of the tilting device, and the fifth angle is the rotation angle of the bucket around the rotation axis of the tilting device; and the relative position is subjected to rotation transformation, tilt transformation, and pitch transformation in sequence according to the fifth angle, the fourth angle, and the second angle, respectively, to obtain the relative position after the position transformation.
[0172] Optional, combined Fig.10 , Fig.11 FIG. 1 is a schematic diagram of the structure of another parameter determination device provided by an embodiment of the present invention. Fig.11 As shown, the device also includes: a calibration module 1002.
[0173] The calibration module 1002 is used to adjust the axis of the bucket and the midpoint of the bucket tip to be located on a plumb line to complete the calibration of the bucket opening angle.
[0174] The parameter determination device provided in the embodiment of the present invention can execute the parameter determination method of the construction equipment provided in any embodiment of the present invention, and has the corresponding functional modules and beneficial effects of the execution method.
[0175] Fig.12 A schematic diagram of a construction device 10 that can be used to implement an embodiment of the present invention is shown. An electronic device is integrated into the construction device, and the electronic device is intended to represent various forms of digital computers, such as laptop computers, desktop computers, workbenches, personal digital assistants, servers, blade servers, mainframe computers, and other suitable computers. The electronic device can also represent various forms of mobile devices, such as personal digital processing, cellular phones, smart phones, wearable devices (such as helmets, glasses, watches, etc.) and other similar computing devices. The components shown herein, their connections and relationships, and their functions are merely examples and are not intended to limit the implementation of the present invention described and / or claimed herein.
[0176] like Fig.12As shown, the construction equipment 10 includes at least one processor 11, and a memory connected to the at least one processor 11, such as a read-only memory (ROM) 12, a random access memory (RAM) 13, etc., wherein the memory stores a computer program that can be executed by at least one processor, and the processor 11 can perform various appropriate actions and processes according to the computer program stored in the read-only memory (ROM) 12 or the computer program loaded from the storage unit 18 to the random access memory (RAM) 13. Various programs and data required for the operation of the construction equipment 10 can also be stored in the RAM 13. The processor 11, ROM 12 and RAM 13 are connected to each other through a bus 14. An input / output (I / O) interface 15 is also connected to the bus 14.
[0177] A number of components in the construction equipment 10 are connected to the I / O interface 15, including: an input unit 16, such as a keyboard, a mouse, etc.; an output unit 17, such as various types of displays, speakers, etc.; a storage unit 18, such as a disk, an optical disk, etc.; and a communication unit 19, such as a network card, a modem, a wireless communication transceiver, etc. The communication unit 19 allows the construction equipment 10 to exchange information / data with other devices through a computer network such as the Internet and / or various telecommunication networks.
[0178] The processor 11 may be a variety of general and / or special processing components with processing and computing capabilities. Some examples of the processor 11 include, but are not limited to, a central processing unit (CPU), a graphics processing unit (GPU), various special artificial intelligence (AI) computing chips, various processors running machine learning model algorithms, a digital signal processor (DSP), and any appropriate processor, controller, microcontroller, etc. The processor 11 executes the various methods and processes described above, such as a method for determining parameters of construction equipment.
[0179] In some embodiments, the parameter determination method of the construction equipment may be implemented as a computer program, which is tangibly contained in a computer-readable storage medium, such as a storage unit 18. In some embodiments, part or all of the computer program may be loaded and / or installed on the construction equipment 10 via the ROM 12 and / or the communication unit 19. When the computer program is loaded into the RAM 13 and executed by the processor 11, one or more steps of the parameter determination method of the construction equipment described above may be performed. Alternatively, in other embodiments, the processor 11 may be configured to execute the parameter determination method of the construction equipment in any other appropriate manner (e.g., by means of firmware).
[0180] Various implementations of the systems and techniques described above herein can be implemented in digital electronic circuit systems, integrated circuit systems, field programmable gate arrays (FPGAs), application specific integrated circuits (ASICs), application specific standard products (ASSPs), systems on chips (SOCs), load programmable logic devices (CPLDs), computer hardware, firmware, software, and / or combinations thereof. These various implementations can include: being implemented in one or more computer programs that can be executed and / or interpreted on a programmable system including at least one programmable processor, which can be a special purpose or general purpose programmable processor that can receive data and instructions from a storage system, at least one input device, and at least one output device, and transmit data and instructions to the storage system, the at least one input device, and the at least one output device.
[0181] Computer programs for implementing the methods of the present invention may be written in any combination of one or more programming languages. These computer programs may be provided to a processor of a general-purpose computer, a special-purpose computer, or other programmable data processing device, so that when the computer program is executed by the processor, the functions / operations specified in the flow chart and / or block diagram are implemented. The computer program may be executed entirely on the machine, partially on the machine, partially on the machine and partially on a remote machine as a stand-alone software package, or entirely on a remote machine or server.
[0182] In the context of the present invention, a computer-readable storage medium may be a tangible medium that may contain or store a computer program for use by or in combination with an instruction execution system, device or equipment. A computer-readable storage medium may include, but is not limited to, electronic, magnetic, optical, electromagnetic, infrared, or semiconductor systems, devices or equipment, or any suitable combination of the foregoing. Alternatively, a computer-readable storage medium may be a machine-readable signal medium. A more specific example of a machine-readable storage medium may include an electrical connection based on one or more lines, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing.
[0183] To provide interaction with a user, the systems and techniques described herein may be implemented on construction equipment having: a display device (e.g., a CRT (cathode ray tube) or LCD (liquid crystal display) monitor) for displaying information to a user; and a keyboard and pointing device (e.g., a mouse or trackball) through which a user can provide input to the construction equipment. Other types of devices may also be used to provide interaction with a user; for example, the feedback provided to the user may be any form of sensory feedback (e.g., visual feedback, auditory feedback, or tactile feedback); and input from the user may be received in any form (including acoustic input, voice input, or tactile input).
[0184] The systems and techniques described herein may be implemented in a computing system that includes backend components (e.g., as a data server), or a computing system that includes middleware components (e.g., an application server), or a computing system that includes frontend components (e.g., a user computer with a graphical user interface or a web browser through which a user can interact with implementations of the systems and techniques described herein), or a computing system that includes any combination of such backend components, middleware components, or frontend components. The components of the system may be interconnected by any form or medium of digital data communication (e.g., a communication network). Examples of communication networks include: a local area network (LAN), a wide area network (WAN), a blockchain network, and the Internet.
[0185] A computing system may include a client and a server. The client and the server are generally remote from each other and usually interact through a communication network. The client and server relationship is generated by computer programs running on the corresponding computers and having a client-server relationship with each other. The server may be a cloud server, also known as a cloud computing server or cloud host, which is a host product in the cloud computing service system to solve the defects of difficult management and weak business scalability in traditional physical hosts and VPS services.
[0186] An embodiment of the present invention further provides a computer program product, including a computer program, which, when executed by a processor, implements the behavior operation determination method provided by any embodiment of the present invention.
[0187] In the process of implementation, the computer program product can be written in one or more programming languages or a combination thereof to perform the computer program code of the present invention, including object-oriented programming languages, such as Java, Smalltalk, C++, and conventional procedural programming languages, such as "C" language or similar programming languages. The program code can be executed entirely on the user's computer, partially on the user's computer, as a separate software package, partially on the user's computer and partially on a remote computer, or entirely on a remote computer or server. In the case of a remote computer, the remote computer can be connected to the user's computer through any type of network, including a local area network (LAN) or a wide area network (WAN), or can be connected to an external computer (for example, using an Internet service provider to connect through the Internet).
[0188] It should be understood that the various forms of processes shown above can be used to reorder, add or delete steps. For example, the steps described in the present invention can be executed in parallel, sequentially or in different orders, as long as the desired results of the technical solution of the present invention can be achieved, and this document does not limit this.
[0189] The above specific implementations do not constitute a limitation on the protection scope of the present invention. It should be understood by those skilled in the art that various modifications, combinations, sub-combinations and substitutions can be made according to design requirements and other factors. Any modification, equivalent substitution and improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims
1. A method for determining parameters of construction equipment, characterized in that: A functional part is installed between the mechanical arm and the bucket of the construction equipment, and the functional part includes a quick-change device and / or a tilting device; the method includes: Determining the mounting point parameters of the robotic arm; According to the mounting point parameters, the axis point parameters of the functional component directly connected to the bucket are calculated, wherein when the functional component only includes a quick-change device, the functional component directly connected to the bucket is the quick-change device; when the functional component only includes a tilting device, or the functional component includes a quick-change device and a tilting device, the functional component directly connected to the bucket is the tilting device; The bucket parameters of the bucket are determined according to the axis point parameters of the functional component directly connected to the bucket.
2. The method for determining parameters of construction equipment according to claim 1, characterized in that: When the functional part only includes a quick-change device, calculating the axis point parameters of the quick-change device according to the mounting point parameters includes: Determine a first angle, wherein the first angle is an angle between a bottom edge of the quick-change device and a horizontal plane; The axis point parameters of the quick-change device are calculated according to the mounting point parameters, the first angle, the first distance and the second distance, wherein the first distance is the distance from the mounting point of the quick-change device to the bottom edge of the quick-change device, and the mounting point of the quick-change device coincides with the mounting point of the robotic arm; and the second distance is the horizontal offset from the mounting point of the quick-change device to the quick-change point of the quick-change device.
3. The method for determining parameters of construction equipment according to claim 2, characterized in that: The bucket parameters include the axis point parameters and bucket tip parameters of the bucket, and the quick change point of the quick change device coincides with the mounting point of the bucket; Determining the bucket parameters of the bucket according to the axis point parameters of the quick-change device includes: Using the axis point parameters of the quick-change device as the axis point parameters of the bucket; The bucket tip parameters of the bucket are calculated according to the axis point parameters of the bucket.
4. The method for determining parameters of construction equipment according to claim 1, characterized in that: When the functional component only includes a tilting device, the step of calculating the axis point parameters of the tilting device according to the mounting point parameters includes: Determining a second angle, wherein the second angle is an angle between the tilt axis of the tilting device and a horizontal plane; The axis point parameters of the tilting device are calculated according to the mounting point parameters, the second angle, the third distance and the fourth distance, wherein the third distance is the distance from the mounting point of the tilting device to the tilting axis of the tilting device, the mounting point of the tilting device coincides with the mounting point of the robotic arm, and the fourth distance is the distance from the quick-change point of the tilting device to the rotation axis of the tilting device.
5. The method for determining parameters of construction equipment according to claim 1, characterized in that: When the functional part includes a quick-change device and a tilting device, the calculating the axis point parameters of the tilting device according to the mounting point parameters includes: Determine a first angle and a second angle, wherein the first angle is the angle between the bottom side of the quick-change device and the horizontal plane, and the second angle is the angle between the tilt axis of the tilting device and the horizontal plane; Calculate the axis point parameters of the quick-change device according to the mounting point parameters, the first angle, the first distance and the second distance, wherein the first distance is the distance from the mounting point of the quick-change device to the bottom edge of the quick-change device, the mounting point of the quick-change device coincides with the mounting point of the robot arm, and the second distance is the horizontal offset from the mounting point of the quick-change device to the quick-change point of the quick-change device; The axis point parameters of the tilting device are calculated according to the axis point parameters of the quick-change device, the second angle, the third distance and the fourth distance, wherein the third distance is the distance from the mounting point of the tilting device to the tilt axis of the tilting device, the mounting point of the tilting device coincides with the quick-change point of the quick-change device, and the fourth distance is the distance from the quick-change point of the tilting device to the rotation axis of the tilting device.
6. The method for determining parameters of construction equipment according to claim 4 or 5, characterized in that: The bucket parameters include the bucket axis point parameters and bucket tip parameters, and the quick change point of the tilting device coincides with the mounting point of the bucket; Determining the bucket parameters of the bucket according to the axis point parameters of the tilting device includes: Calculating the axis point parameters of the bucket according to the axis point parameters of the tilting device, the second angle, the fourth distance and the fifth distance, wherein the fifth distance is the distance from the quick change point of the tilting device to the tilting axis of the tilting device; Determine a third angle, wherein the third angle is an angle between a bottom edge of the tilting device and a tilting axis of the tilting device; Determining a relative position of the bucket tip with respect to the axis point of the tilting device according to the third angle, the length of the bucket, the width of the bucket, and the opening angle of the bucket; The relative position is transformed, and the bucket tip parameters of the bucket are determined according to the relative position after the position transformation and the axis point parameters of the tilting device.
7. The method for determining parameters of construction equipment according to claim 6, characterized in that: The step of transforming the relative position comprises: Determine a fourth angle and a fifth angle, wherein the fourth angle is an inclination angle of the bucket around the inclination axis of the inclinometer, and the fifth angle is a rotation angle of the bucket around the rotation axis of the inclinometer; According to the fifth angle, the fourth angle and the second angle, the relative position is subjected to rotation transformation, tilt transformation and pitch transformation in sequence to obtain the relative position after the position transformation.
8. The method for determining parameters of construction equipment according to claim 1, characterized in that: After determining the bucket parameters of the bucket, the method further comprises: The axis of the bucket and the midpoint of the bucket tip are adjusted to be located on a plumb line to complete the calibration of the bucket opening angle.
9. A construction equipment, characterized in that: The construction equipment includes: at least one processor; and a memory in communication with the at least one processor; wherein, The memory stores a computer program executable by the at least one processor, and the computer program is executed by the at least one processor so that the at least one processor can execute the parameter determination method of the construction equipment according to any one of claims 1 to 8.
10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a processor to implement the parameter determination method of the construction equipment according to any one of claims 1 to 8 when executed.
Citation Information
Patent Citations
Control system for tool coupling
CN101903599A
Three-dimensional attitude display and remote automatic control system of excavator
CN107882103A
Mechanical equipment model parameter calibration method and device, electronic equipment and storage medium
CN117076821A
Quick change device for use in hydraulic excavator to receive e.g. crane bucket, has rotating device completely or partially integrated within natural quick-change unit frame, where frame and rotating device housing form unit
DE102010045842A1
Excavator quick hitch with multiple mounting position arrangements
GB201611531D0
Cited By
Construction apparatus and parameter determination method therefor, and storage medium
WO2026056124A1
