Excavator control method and device
By calculating the angles of the excavator's main arm, forearm and bucket, and using the space conversion matrix to control the bucket movement, the stability and accuracy problems when the excavator's bucket posture remains unchanged, and the stability of the operation is improved and accuracy.
Patent Information
- Application Number
- CN202210392337.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-04-14
- Publication Date
- 2024-11-05
- Estimated Expiration
- 2042-04-14
AI Technical Summary
When the prior art keeps the excavator bucket posture unchanged, the stability and accuracy of the control process cannot be guaranteed, and relying on manual operations leads to insufficient stability and accuracy of complex operations.
By receiving the bucket lock command, the angle between the upper plane of the bucket and the ground is obtained, and the angle between the upper plane of the bucket and the forearm is calculated based on the length and angle of the big arm and forearm is included, and the angle between the upper plane of the bucket and the forearm is calculated, using space conversion The matrix controls the movement of the bucket to ensure that the posture of the bucket remains unchanged.
The excavator operation process in complex operating scenarios is achieved to be more stable and accurate, and the operator's skills and experience requirements are reduced.
Smart Images

Figure CN115126020B_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of automation control technology, and more particularly to an excavator control method, an excavator control device, an electronic device, and a computer-readable storage medium. Background Art
[0002] When an excavator completes complex operations, it usually requires a combined control of the arm and bucket, such as trenching, leveling and slopes. It is a common requirement to keep the bucket in a constant posture during the operation. For example, when leveling and shoveling, the bottom of the bucket needs to be kept level with the ground, and when loading, the top of the bucket needs to be kept level with the ground so that the material in the bucket does not spill out. In order to keep the bucket posture unchanged during this operation, the arm, forearm and bucket need to be controlled at the same time to work together. This requires the excavator operator to have high skills and experience, making the excavator control process dependent on manual labor, and the stability and accuracy of the control process cannot be guaranteed. Summary of the invention
[0003] The embodiments of the present application provide an excavator control method, device, electronic device and computer-readable storage medium to solve the problem in the prior art that the stability and accuracy of the excavator control process cannot be guaranteed due to reliance on manual labor when keeping the bucket posture unchanged.
[0004] The embodiment of the present application provides an excavator control method, which is applied to a control device of the excavator, and includes:
[0005] In response to receiving a bucket locking instruction at a first time point, obtaining a first locked angle of a plane where an upper edge of the bucket is located relative to the ground;
[0006] In response to the boom and / or arm of the excavator being controlled to be in motion at a second time point, obtaining a second angle of the boom relative to the ground and a third angle between the arm and the boom;
[0007] Based on the length of the boom, the length of the forearm, the first angle, the second angle, the third angle, and a space transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system, a fourth angle between the plane where the upper edge of the bucket is located and the forearm is calculated;
[0008] Based on the fourth angle, the movement of the bucket is controlled.
[0009] Optionally, obtaining a locked first angle of a plane where the upper edge of the bucket is located relative to the ground includes:
[0010] In response to receiving a bucket locking instruction at a first time point, based on inclination sensors respectively arranged on the boom, the arm, and the bucket, a first initial angle a between the boom and a horizontal plane, a second initial angle b between the arm and a horizontal plane, and a third initial angle c between a plane where an upper edge of the bucket is located and a horizontal plane are sensed;
[0011] Based on the first initial angle a, the second initial angle b, the third initial angle c and the pre-constructed conversion equation, a first target angle a1 between the boom and the ground, a second target angle b1 between the forearm and the boom, and a third target angle c1 between the plane where the upper edge of the bucket is located and the forearm are calculated at the first time point, wherein the conversion equation represents the following conversion relationship between the initial angle and the target angle: a1=k–a; b1=a-b+m; c1=b-c+n, wherein k, m, n are pre-calibrated constants;
[0012] Based on the length of the upper arm, the length of the lower arm, the first target angle, the second target angle, and the third target angle, the spatial transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system is solved, and the first angle is extracted from the solved spatial transformation matrix.
[0013] Optionally, at the first time point, the spatial transformation matrix is: Tg=T(AB,a1)*T(BC, b1)*T(0,c1), where T(x,y) is a 4x4 spatial rotation matrix, AB is the length of the upper arm, and BC is the length of the lower arm.
[0014] Optionally, at the second time point, the spatial transformation matrix is expressed as: Tg=T(AB,a2)* T(BC,b2)*T(0,c2), where T(x,y) represents a 4x4 spatial rotation matrix, AB is the length of the boom, BC is the length of the forearm, a2 is the second angle of the boom relative to the ground at the second time point, b2 is the third angle between the forearm and the boom at the second time point, and c2 represents the fourth angle between the plane where the upper edge of the bucket is located and the forearm to be solved.
[0015] Optionally, the calculating and obtaining a fourth angle between the plane where the upper edge of the bucket is located and the forearm based on the length of the boom, the length of the forearm, the first angle, the second angle, the third angle, and a space transformation matrix from a coordinate system of a plane where the upper edge of the bucket is located to a ground coordinate system comprises:
[0016] The length AB of the boom, the length BC of the forearm, the second angle a2, and the third angle b2 are brought into the space transformation matrix Tg=T(AB,a2)*T(BC,b2)*T(0,c2), the pitch angle Tg0 of Tg is the locked first angle, and the fourth angle c2 between the plane where the upper edge of the bucket is located and the forearm is solved as the solved value, and T(0,c2)=T -1 (BC,b2)*T -1 (AB,a2)*Tg, and recover c2 from the solved T(0,c2) matrix.
[0017] Optionally, the step of obtaining a second angle between the boom and the ground and a third angle between the forearm and the boom includes:
[0018] The second angle a2 and the third angle b2 are calculated using the following conversion relationship: a2=k-a, b2=a-b+m; wherein a and b are the first initial angle between the boom and the horizontal plane and the second initial angle between the arm and the horizontal plane respectively sensed by the inclination sensors arranged on the boom, arm and bucket, and k and m are pre-calibrated constants.
[0019] Optionally, the step of obtaining a second angle between the boom and the ground and a third angle between the forearm and the boom includes:
[0020] A second angle and a third angle sent by the excavator operating terminal are received, where the second angle and the third angle are target angles estimated by the excavator operating terminal based on the motion states of the boom and the arm.
[0021] Optionally, receiving a bucket locking instruction at a first time point includes:
[0022] The bucket locking instruction sent by the excavator operating terminal is received at the first time point.
[0023] Optionally, controlling the movement of the bucket based on the fourth angle includes:
[0024] The PID control algorithm is used to control the bucket to reach the position of the fourth angle.
[0025] The present application also provides an excavator control device, the device comprising:
[0026] A first angle obtaining unit, configured to obtain a locked first angle of a plane where an upper edge of the bucket is located relative to the ground in response to receiving a bucket locking instruction at a first time point;
[0027] A second and third angle acquisition unit, for acquiring a second angle of the boom relative to the ground and a third angle between the forearm and the boom in response to the boom and / or the arm of the excavator being controlled to be in motion at a second time point;
[0028] a fourth angle calculation unit, configured to calculate a fourth angle between the plane where the upper edge of the bucket is located and the forearm based on the length of the boom, the length of the forearm, the first angle, the second angle, the third angle, and a space transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system;
[0029] A bucket motion control unit is used to control the bucket motion based on the fourth angle.
[0030] An embodiment of the present application also provides an electronic device, including a processor and a memory; wherein the memory is used to store one or more computer instructions, wherein the one or more computer instructions are executed by the processor to implement the above method.
[0031] An embodiment of the present application also provides a computer-readable storage medium on which one or more computer instructions are stored, and the instructions are executed by a processor to implement the above method.
[0032] Compared with the prior art, the embodiments of the present application have the following advantages:
[0033] The excavator control method provided in the embodiment of the present application is responsive to receiving a bucket locking instruction at a first time point, obtaining a locked first angle of the plane where the upper edge of the bucket is located relative to the ground; responsive to the excavator's boom and / or forearm being controlled to be in motion at a second time point, obtaining a second angle of the boom relative to the ground and a third angle between the forearm and the boom; calculating and obtaining a fourth angle between the plane where the upper edge of the bucket is located and the forearm based on the length of the boom, the length of the forearm, the first angle, the second angle, the third angle and the space conversion matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system; and controlling the movement of the bucket based on the fourth angle. After obtaining the locked first angle of the plane where the upper edge of the bucket is located relative to the ground, the method calculates and obtains the fourth angle between the plane where the upper edge of the bucket is located and the forearm through the conversion matrix based on the first angle and the measurement data such as the length of the boom, the length of the forearm, the second angle, the third angle, etc. The fourth angle can represent the positional relationship of the bucket relative to the forearm in real time, and the movement of the bucket can be controlled by the positional relationship, so that the bucket can move in a posture unchanged relative to the ground. By using this method, the operation process of the excavator in a complex operation scenario where the bucket posture remains unchanged can be made more stable and accurate. BRIEF DESCRIPTION OF THE DRAWINGS
[0034] Figure 1is a flow chart of the excavator control method provided by the first embodiment of the present application;
[0035] Figure 1-A It is a schematic diagram of the structure of an excavator provided in an embodiment of the present application;
[0036] Figure 1-B It is a schematic diagram of various parts of an excavator provided in an embodiment of the present application;
[0037] Figure 1-C is a schematic diagram of an excavator operating terminal provided in an embodiment of the present application;
[0038] Figure 2 is a unit block diagram of an excavator control device provided in a second embodiment of the present application;
[0039] Figure 3 It is a schematic diagram of the logical structure of an electronic device provided in the third embodiment of the present application. DETAILED DESCRIPTION
[0040] 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, so the present application is not limited by the specific implementation disclosed below.
[0041] It should be noted that the terms "first", "second" and "third" in the various parts and drawings of the embodiments of the present application are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. Such data can be interchanged where appropriate, so that the embodiments of the present application described herein can be implemented in a sequence other than that illustrated or described herein. The terms "including" and "having" and any of their variations are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device comprising 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.
[0042] In the process of automatic control of an excavator, in order to meet the operation requirements for complex operation scenarios, so that the operation process of the excavator in complex operation scenarios where the bucket posture remains unchanged is more stable and accurate, the present application provides an excavator control method, an excavator control method device corresponding to the method, an electronic device that can implement the method, and a computer-readable storage medium. The following provides embodiments to describe the above method, device, electronic device, and computer-readable storage medium in detail.
[0043] A first embodiment of the present application provides an excavator control method, and the application subject of the method can be a control device of the excavator. Figure 1 This is a flowchart of the excavator control method provided in the first embodiment of the present application. Figure 1 The excavator control method provided by this embodiment is described in detail. The embodiments described below are used to explain the principle of the method and are not intended to be limiting in actual use.
[0044] like Figure 1 As shown, the excavator control method provided in this embodiment includes the following steps:
[0045] S101, in response to receiving a bucket locking instruction at a first time point, obtaining a first locked angle of a plane where an upper edge of the bucket is located relative to the ground.
[0046] like Figure 1-A As shown, the control process of the excavator arm needs to control the following four mechanisms: the boom (also called the main arm), the extended arm (also called the forearm), the bucket (also called the shovel bucket) and the rotation angle of the cabin. This embodiment mainly takes the main arm, the forearm and the bucket as the control objects to describe the control process of the excavator.
[0047] This step is used to obtain a first locked angle between the plane where the upper edge of the bucket (the bucket opening) is located and the ground when a bucket locking instruction is received at a first time point. For example, when an operator uses an excavator operation terminal (such as Figure 1-C When operating an excavator (as shown in the figure), in intelligent operations where the bucket posture needs to remain unchanged (for example, when doing ground shoveling operations, the bottom of the bucket needs to be kept level with the ground, and when loading operations, the top of the bucket needs to be kept level with the ground so that the materials in the bucket will not spill), turn on the bucket locking function through the excavator operation terminal (as shown in the figure). Figure 1-C As shown, two types of bucket locking button modes are set based on the remote control of the boom, arm, cockpit, bucket and left and right crawlers. Click the Y button to turn the bucket lock on or off; press and hold the A button to lock the bucket, and release the A button to automatically unlock the bucket, so that the operator can conveniently choose whether to lock the bucket when operating the excavator. In addition, when the bucket is not locked, the operator can control the direction and speed of the bucket rotation by operating the right joystick up and down. When the bucket is locked, the operator can also control the bucket movement by operating the right joystick, and the program automatically releases the bucket lock. ), the excavator operation terminal sends a bucket locking instruction to the control device of the excavator, the implementation subject of this embodiment, and the excavator control device can receive the bucket locking instruction sent by the excavator operation terminal, and the bucket locking instruction is used to indicate that the bucket posture remains unchanged.
[0048] In this embodiment, the locked first angle of the plane where the upper edge of the bucket is located relative to the ground can be obtained specifically in the following manner:
[0049] In response to receiving a bucket locking instruction at a first time point, based on inclination sensors respectively arranged on the boom, the arm, and the bucket, a first initial angle a between the boom and a horizontal plane, a second initial angle b between the arm and a horizontal plane, and a third initial angle c between a plane where an upper edge of the bucket is located and a horizontal plane are sensed;
[0050] Based on the first initial angle a, the second initial angle b, the third initial angle c and the pre-constructed conversion equation, the first target angle a1 between the boom and the ground, the second target angle b1 between the forearm and the boom, and the third target angle c1 between the plane where the upper edge of the bucket is located and the forearm at the first time point are calculated (such as Figure 1-B As shown), the conversion equation represents the following conversion relationship between the initial angle and the target angle: a1=k-a; b1=a-b+m; c1=b-c+n, where k, m, and n are pre-calibrated constants, which are related to the installation postures of the arm and bucket sensors, respectively. Specifically, k is related to the angle between the arm sensor installation plane and the AB straight line, m is related to the angle between the arm sensor installation plane and the BC straight line, and n is related to the angle between the bucket sensor installation plane and the upper edge plane of the bucket.
[0051] Based on the length of the boom, the length of the forearm, the first target angle, the second target angle, and the third target angle, a spatial transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system is solved, and the first angle is extracted from the solved spatial transformation matrix as atan (m 13 / m 33 ), where atan is the inverse tangent function, m 13 and m 33 They are respectively the first row and third column elements and the third row and third column elements of the solved space transformation matrix.
[0052] In this embodiment, at the first time point, the spatial transformation matrix is: Tg = T(AB, a1) * T(BC, b1) * T(0, c1), where AB is the length of the upper arm, BC is the length of the lower arm, and T(x, y) is a 4x4 spatial rotation matrix, which is specifically in the following form:
[0053]
[0054] S102, in response to the boom and / or arm of the excavator being controlled to be in motion at the second time point, obtaining a second angle of the boom relative to the ground and a third angle between the arm and the boom.
[0055] After obtaining the locked first angle of the plane where the upper edge of the bucket is located relative to the ground through the above steps, this step is used to obtain the second angle of the boom relative to the ground and the third angle between the boom and the boom when the boom or arm of the excavator is controlled to be in motion at a second time point, or when the boom and the arm are controlled to be in motion at the same time.
[0056] In this embodiment, the second angle between the boom and the ground and the third angle between the forearm and the boom can be obtained in the following two ways:
[0057] Method 1, using the following conversion relationship to calculate the second angle a2 and the third angle b2: a2=k-a, b2=a-b+m; wherein a and b are respectively the first initial angle between the boom and the horizontal plane and the second initial angle between the arm and the horizontal plane sensed by the inclination sensors arranged on the boom, arm and bucket, and k and m are pre-calibrated constants.
[0058] Method 2, receiving the second angle and the third angle sent by the excavator operating terminal, wherein the second angle and the third angle are the target angles estimated by the excavator operating terminal based on the motion state of the boom and the forearm. The operating terminal can control the movement of point C at the end of the forearm in space or control the rotation of the forearm and the arm respectively. For the first case, the planning program can calculate the target angles that the forearm and the arm need to reach based on the target position that the end point C needs to move to. For the second case, the operating terminal directly sends the angle change of the forearm and the arm, and the target angles that the forearm and the arm need to reach can also be obtained based on the angle change.
[0059] S103, based on the length of the upper arm, the length of the lower arm, the first angle, the second angle, the third angle, and the space transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system, calculate the fourth angle between the plane where the upper edge of the bucket is located and the lower arm.
[0060] After obtaining the locked first angle of the plane where the upper edge of the bucket is located relative to the ground in the above steps, and obtaining the second angle of the boom relative to the ground and the third angle between the forearm and the boom, this step is used to calculate the fourth angle between the plane where the upper edge of the bucket is located and the forearm based on the length of the boom, the length of the forearm, the first angle, the second angle, the third angle and the spatial transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system.
[0061] In this embodiment, at the above-mentioned second time point, the space conversion matrix is expressed as: Tg=T(AB,a2)*T(BC,b2)*T(0,c2), wherein AB is the length of the boom, BC is the length of the forearm, a2 is the second angle of the boom relative to the ground at the second time point, b2 is the third angle between the forearm and the boom at the second time point, c2 represents the fourth angle between the plane where the upper edge of the bucket is located and the forearm to be solved, and T(x,y) is a 4x4 space rotation matrix, and the specific form is as follows:
[0062]
[0063] The above-mentioned space transformation matrix based on the length of the boom, the length of the forearm, the first angle, the second angle, the third angle, and the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system is used to calculate the fourth angle between the plane where the upper edge of the bucket is located and the forearm. Specifically, the length AB of the boom, the length BC of the forearm, the second angle a2, and the third angle b2 are brought into the space transformation matrix Tg=T(AB,a2)*T(BC,b2)*T(0,c2), the pitch angle Tg0 of Tg is the locked first angle, and the fourth angle c2 between the plane where the upper edge of the bucket is located and the forearm is solved as the solved value to obtain T(0,c2)=T -1 (BC,b2)*T -1 (AB,a2)*Tg, where the matrix T -1 is the inverse matrix of T, and c2 can be recovered from the solved T(0,c2) matrix.
[0064] S104, controlling the movement of the bucket based on the fourth angle.
[0065] After the fourth angle between the plane where the upper edge of the bucket is located and the forearm is calculated in the above steps, this step is used to control the movement of the bucket based on the fourth angle, specifically: using the PID position control algorithm to control the bucket to reach the position corresponding to the fourth angle.
[0066] By using the excavator control method provided by the embodiment of the present application, after obtaining the locked first angle of the plane where the upper edge of the bucket is located relative to the ground, based on the first angle and the measurement data such as the length of the boom, the length of the forearm, the second angle, and the third angle, the fourth angle between the plane where the upper edge of the bucket is located and the forearm is obtained through conversion matrix calculation. The fourth angle can represent the positional relationship of the bucket relative to the forearm in real time. By controlling the movement of the bucket through the positional relationship, the bucket can move in an unchanged posture relative to the ground. By using this method, the operation process of the excavator in complex operation scenarios where the posture of the bucket remains unchanged can be made more stable and accurate.
[0067] The first embodiment described above provides an excavator control method. Correspondingly, the second embodiment of the present application also provides an excavator control device, which can be applied to the control system of the excavator in the form of software or hardware to perform excavator control work. Since the device embodiment is basically similar to the method embodiment, the description is relatively simple. For details of the relevant technical features, please refer to the corresponding description of the method embodiment provided above. The following description of the device embodiment is only illustrative.
[0068] Please refer to Figure 2 To understand this embodiment, the figure is a unit block diagram of the excavator control device provided by this embodiment. Figure 2 As shown, the excavator control device provided in this embodiment includes:
[0069] A first angle obtaining unit 201 is used for obtaining a locked first angle of a plane where the upper edge of the bucket is located relative to the ground in response to receiving a bucket locking instruction at a first time point;
[0070] The second and third angle acquisition unit 202 is used for acquiring a second angle of the boom relative to the ground and a third angle between the forearm and the boom in response to the boom and / or the arm of the excavator being controlled to be in motion at a second time point;
[0071] A fourth angle calculation unit 203 is used to calculate a fourth angle between the plane where the upper edge of the bucket is located and the forearm based on the length of the boom, the length of the forearm, the first angle, the second angle, the third angle, and a space transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system;
[0072] The bucket motion control unit 204 is used to control the bucket motion based on the fourth angle.
[0073] Optionally, obtaining a locked first angle of a plane where the upper edge of the bucket is located relative to the ground includes:
[0074] In response to receiving a bucket locking instruction at a first time point, based on inclination sensors respectively arranged on the boom, the arm, and the bucket, a first initial angle a between the boom and a horizontal plane, a second initial angle b between the arm and a horizontal plane, and a third initial angle c between a plane where an upper edge of the bucket is located and a horizontal plane are sensed;
[0075] Based on the first initial angle a, the second initial angle b, the third initial angle c and the pre-constructed conversion equation, a first target angle a1 between the boom and the ground, a second target angle b1 between the forearm and the boom, and a third target angle c1 between the plane where the upper edge of the bucket is located and the forearm are calculated at the first time point, wherein the conversion equation represents the following conversion relationship between the initial angle and the target angle: a1=k–a; b1=a-b+m; c1=b-c+n, wherein k, m, n are pre-calibrated constants;
[0076] Based on the length of the upper arm, the length of the lower arm, the first target angle, the second target angle, and the third target angle, the spatial transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system is solved, and the first angle is extracted from the solved spatial transformation matrix.
[0077] Optionally, at the first time point, the spatial transformation matrix is: Tg=T(AB,a1)*T(BC, b1)*T(0,c1), where T(x,y) is a 4x4 spatial rotation matrix, AB is the length of the upper arm, and BC is the length of the lower arm.
[0078] Optionally, at the second time point, the spatial transformation matrix is expressed as: Tg=T(AB,a2)* T(BC,b2)*T(0,c2), where T(x,y) is a 4x4 spatial rotation matrix, AB is the length of the boom, BC is the length of the forearm, a2 is the second angle of the boom relative to the ground at the second time point, b2 is the third angle between the forearm and the boom at the second time point, and c2 represents the fourth angle between the plane where the upper edge of the bucket is located and the forearm to be solved.
[0079] Optionally, the calculating and obtaining a fourth angle between the plane where the upper edge of the bucket is located and the forearm based on the length of the boom, the length of the forearm, the first angle, the second angle, the third angle, and a space transformation matrix from a coordinate system of a plane where the upper edge of the bucket is located to a ground coordinate system comprises:
[0080] The length AB of the boom, the length BC of the forearm, the second angle a2, and the third angle b2 are brought into the space transformation matrix Tg=T(AB,a2)*T(BC,b2)*T(0,c2), the pitch angle Tg0 of Tg is the locked first angle, and the fourth angle c2 between the plane where the upper edge of the bucket is located and the forearm is solved as the solved value, and T(0,c2)=T -1 (BC,b2)*T -1 (AB,a2)*Tg, and recover c2 from the solved T(0,c2) matrix.
[0081] Optionally, the step of obtaining a second angle between the boom and the ground and a third angle between the forearm and the boom includes:
[0082] The second angle a2 and the third angle b2 are calculated using the following conversion relationship: a2=k-a, b2=a-b+m; wherein a and b are the first initial angle between the boom and the horizontal plane and the second initial angle between the arm and the horizontal plane respectively sensed by the inclination sensors arranged on the boom, arm and bucket, and k and m are pre-calibrated constants.
[0083] Optionally, the step of obtaining a second angle between the boom and the ground and a third angle between the forearm and the boom includes:
[0084] A second angle and a third angle sent by the excavator operating terminal are received, where the second angle and the third angle are target angles estimated by the excavator operating terminal based on the motion states of the boom and the arm.
[0085] Optionally, receiving a bucket locking instruction at a first time point includes:
[0086] The bucket locking instruction sent by the excavator operating terminal is received at the first time point.
[0087] Optionally, controlling the movement of the bucket based on the fourth angle includes:
[0088] The PID control algorithm is used to control the bucket to reach the position of the fourth angle.
[0089] By using the control device for an excavator provided in the embodiment of the present application, the operation process of the excavator in a complex operation scenario where the bucket posture is kept unchanged can be made more stable and accurate.
[0090] In the above embodiments, a method and an apparatus are provided. In addition, the third embodiment of the present application further provides an electronic device. Since the electronic device embodiment is basically similar to the method embodiment, the description is relatively simple. For details of the relevant technical features, please refer to the corresponding description of the method embodiment provided above. The following description of the electronic device embodiment is only illustrative. The electronic device embodiment is as follows:
[0091] Please refer to Figure 3 To understand this embodiment, Figure 3 A schematic diagram of the logical structure of the electronic device provided in this embodiment.
[0092] like Figure 3 As shown, the electronic device provided in this embodiment includes: a processor 301 and a memory 302;
[0093] The memory 302 is used to store computer instructions for executing the game scene display method. When the computer instructions are read and executed by the processor 301, the following operations are performed: in response to receiving a bucket locking instruction at a first time point, obtaining a locked first angle of the plane where the upper edge of the bucket is located relative to the ground;
[0094] In response to the boom and / or arm of the excavator being controlled to be in motion at a second time point, obtaining a second angle of the boom relative to the ground and a third angle between the arm and the boom;
[0095] Based on the length of the boom, the length of the forearm, the first angle, the second angle, the third angle, and a space transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system, a fourth angle between the plane where the upper edge of the bucket is located and the forearm is calculated;
[0096] Based on the fourth angle, the movement of the bucket is controlled.
[0097] Optionally, obtaining a locked first angle of a plane where the upper edge of the bucket is located relative to the ground includes:
[0098] In response to receiving a bucket locking instruction at a first time point, based on inclination sensors respectively arranged on the boom, the arm, and the bucket, a first initial angle a between the boom and a horizontal plane, a second initial angle b between the arm and a horizontal plane, and a third initial angle c between a plane where an upper edge of the bucket is located and a horizontal plane are sensed;
[0099] Based on the first initial angle a, the second initial angle b, the third initial angle c and the pre-constructed conversion equation, a first target angle a1 between the boom and the ground, a second target angle b1 between the forearm and the boom, and a third target angle c1 between the plane where the upper edge of the bucket is located and the forearm are calculated at the first time point, wherein the conversion equation represents the following conversion relationship between the initial angle and the target angle: a1=k–a; b1=a-b+m; c1=b-c+n, wherein k, m, n are pre-calibrated constants;
[0100] Based on the length of the upper arm, the length of the lower arm, the first target angle, the second target angle, and the third target angle, the spatial transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system is solved, and the first angle is extracted from the solved spatial transformation matrix.
[0101] Optionally, at the first time point, the spatial transformation matrix is: Tg=T(AB,a1)*T(BC, b1)*T(0,c1), where T(x,y) is a 4x4 spatial rotation matrix, AB is the length of the upper arm, and BC is the length of the lower arm.
[0102] Optionally, at the second time point, the spatial transformation matrix is expressed as: Tg=T(AB,a2)* T(BC,b2)*T(0,c2), where T(x,y) represents a 4x4 rotation matrix composed of x displacement in the Z-axis direction and y pitch angle, AB is the length of the boom, BC is the length of the forearm, a2 is the second angle of the boom relative to the ground at the second time point, b2 is the third angle between the forearm and the boom at the second time point, and c2 represents the fourth angle between the plane where the upper edge of the bucket is located and the forearm to be solved.
[0103] Optionally, based on the length of the boom, the length of the forearm, the first angle, the second angle, the third angle, and a space transformation matrix from a coordinate system of a plane where an upper edge of the bucket is located to a ground coordinate system, calculating a fourth angle between a plane where an upper edge of the bucket is located and the forearm includes:
[0104] The length AB of the boom, the length BC of the forearm, the second angle a2, and the third angle b2 are brought into the space transformation matrix Tg=T(AB,a2)*T(BC,b2)*T(0,c2), the pitch angle Tg0 of Tg is the locked first angle, and the fourth angle c2 between the plane where the upper edge of the bucket is located and the forearm is solved as the solved value, and T(0,c2)=T -1 (BC,b2)*T -1 (AB,a2)*Tg, and recover c2 from the solved T(0,c2) matrix.
[0105] Optionally, obtaining the second angle of the boom relative to the ground and the third angle between the forearm and the boom includes: calculating the second angle a2 and the third angle b2 using the following conversion relationship: a2=k-a, b2=a-b+m; wherein a and b are respectively the first initial angle between the boom and the horizontal plane and the second initial angle between the forearm and the horizontal plane sensed by inclination sensors arranged on the boom, the forearm and the bucket, and k and m are pre-calibrated constants.
[0106] Optionally, obtaining the second angle of the boom relative to the ground and the third angle between the forearm and the boom includes: receiving the second angle and the third angle sent by the excavator operating terminal, the second angle and the third angle being target angles estimated by the excavator operating terminal based on the motion states of the boom and the forearm.
[0107] Optionally, receiving a bucket locking instruction at a first time point includes:
[0108] The bucket locking instruction sent by the excavator operating terminal is received at the first time point.
[0109] Optionally, controlling the movement of the bucket based on the fourth angle includes:
[0110] The PID control algorithm is used to control the bucket to reach the position of the fourth angle.
[0111] Compared with the existing methods, by using the electronic device provided in this embodiment, the operation process of the excavator in complex operation scenarios where the bucket posture is kept unchanged can be made more stable and accurate.
[0112] In the above embodiments, a method, an apparatus and an electronic device are provided. In addition, the fourth embodiment of the present application further provides a computer-readable storage medium for implementing the above method. The computer-readable storage medium embodiment provided in the present application is described in a relatively simple manner. For the relevant parts, please refer to the corresponding description of the above method embodiment. The embodiments described below are merely illustrative.
[0113] The computer-readable storage medium provided in this embodiment stores computer instructions, and when the instructions are executed by a processor, the following steps are implemented: in response to receiving a bucket locking instruction at a first time point, obtaining a locked first angle of a plane where the upper edge of the bucket is located relative to the ground;
[0114] In response to the boom and the arm of the excavator being controlled to be in motion at a second time point, obtaining a second angle of the boom relative to the ground and a third angle between the arm and the boom;
[0115] Based on the length of the boom, the length of the forearm, the first angle, the second angle, the third angle, and a space transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system, a fourth angle between the plane where the upper edge of the bucket is located and the forearm is calculated;
[0116] Based on the fourth angle, the movement of the bucket is controlled.
[0117] Optionally, obtaining a locked first angle of the plane where the upper edge of the bucket is located relative to the ground comprises: in response to receiving a bucket locking instruction at a first time point, based on inclination sensors respectively arranged on the boom, the arm, and the bucket, sensing and obtaining a first initial angle a between the boom and the horizontal plane, a second initial angle b between the arm and the horizontal plane, and a third initial angle c between the plane where the upper edge of the bucket is located and the horizontal plane; based on the first initial angle a, the second initial angle b, the third initial angle c, and a pre-constructed conversion equation, calculating and obtaining a first target angle a1 between the boom and the ground, a second target angle b1 between the arm and the boom, and a third target angle c1 between the plane where the upper edge of the bucket is located and the arm at the first time point, wherein the conversion equation represents the following conversion relationship between the initial angles and the target angles: a1=k–a; b1= a-b+m; c1=b-c+n, wherein k, m, and n are pre-calibrated constants; based on the length of the upper arm, the length of the lower arm, the first target angle, the second target angle, and the third target angle, the spatial transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system is solved, and the first angle is extracted from the solved spatial transformation matrix.
[0118] Optionally, at the first time point, the spatial transformation matrix is: Tg=T(AB,a1)*T(BC, b1)*T(0,c1), where T(x,y) is a 4x4 spatial rotation matrix, AB is the length of the upper arm, and BC is the length of the lower arm.
[0119] Optionally, at the second time point, the spatial transformation matrix is expressed as: Tg=T(AB,a2)* T(BC,b2)*T(0,c2), where T(x,y) represents a 4x4 spatial rotation matrix, AB is the length of the boom, BC is the length of the forearm, a2 is the second angle of the boom relative to the ground at the second time point, b2 is the third angle between the forearm and the boom at the second time point, and c2 represents the fourth angle between the plane where the upper edge of the bucket is located and the forearm to be solved.
[0120] Optionally, the fourth angle between the plane where the upper edge of the bucket is located and the forearm is calculated based on the length of the boom, the length of the forearm, the first angle, the second angle, the third angle and the space transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system, including: bringing the length AB of the boom, the length BC of the forearm, the second angle a2, and the third angle b2 into the space transformation matrix Tg=T(AB,a2)*T(BC,b2)*T(0,c2), the pitch angle Tg0 of Tg is the locked first angle, and solving with the fourth angle c2 between the plane where the upper edge of the bucket is located and the forearm as the solved value to obtain T(0,c2)=T -1 (BC,b2)*T -1 (AB,a2)*Tg, and recover c2 from the solved T(0,c2) matrix.
[0121] Optionally, obtaining the second angle of the boom relative to the ground and the third angle between the forearm and the boom includes: calculating the second angle a2 and the third angle b2 using the following conversion relationship: a2=k-a, b2=a-b+m; wherein a and b are respectively the first initial angle between the boom and the horizontal plane and the second initial angle between the forearm and the horizontal plane sensed by inclination sensors arranged on the boom, the forearm and the bucket, and k and m are pre-calibrated constants.
[0122] Optionally, obtaining the second angle of the boom relative to the ground and the third angle between the forearm and the boom includes: receiving the second angle and the third angle sent by the excavator operating terminal, the second angle and the third angle being target angles estimated by the excavator operating terminal based on the motion states of the boom and the forearm.
[0123] Optionally, receiving a bucket locking instruction at a first time point includes:
[0124] The bucket locking instruction sent by the excavator operating terminal is received at the first time point.
[0125] Optionally, controlling the movement of the bucket based on the fourth angle includes:
[0126] The PID control algorithm is used to control the bucket to reach the position of the fourth angle.
[0127] By executing the computer instructions stored on the computer-readable storage medium provided in this embodiment, the operation process of the excavator in a complex operation scenario where the bucket posture is kept unchanged can be made more stable and accurate.
[0128] In a typical configuration, a computing device includes one or more processors (CPU), input / output interfaces, network interfaces, and memory.
[0129] 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.
[0130] 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), other types of random access memory (RAM), 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 devices or any other non-transmission media that can be used to store information that can be accessed by a computing device. As defined herein, computer-readable media does not include non-transitory media such as modulated data signals and carrier waves.
[0131] 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.
[0132] 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 controlling an excavator, characterized in that: The method is applied to a control device of an excavator, comprising: In response to receiving a bucket locking instruction at a first time point, based on the inclination sensors respectively arranged on the boom, the forearm and the bucket of the excavator, a first initial angle a between the boom and the horizontal plane, a second initial angle b between the forearm and the horizontal plane, and a third initial angle c between the plane where the upper edge of the bucket is located and the horizontal plane are sensed; based on the first initial angle a, the second initial angle b, the third initial angle c and a pre-constructed conversion equation, a first target angle a1 between the boom and the ground, a second target angle b1 between the forearm and the boom, and a third target angle c1 between the plane where the upper edge of the bucket is located and the forearm are calculated at the first time point; based on the length of the boom, the length of the forearm, the first target angle, the second target angle, and the third target angle, a spatial transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system is solved, and a first locked angle of the plane where the upper edge of the bucket is located relative to the ground is extracted from the solved spatial transformation matrix; In response to the boom and / or arm of the excavator being controlled to be in motion at a second time point, obtaining a second angle of the boom relative to the ground and a third angle between the arm and the boom; Based on the length of the boom, the length of the forearm, the first angle, the second angle, the third angle, and a space transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system, a fourth angle between the plane where the upper edge of the bucket is located and the forearm is calculated; Based on the fourth angle, the movement of the bucket is controlled.
2. The method according to claim 1, characterized in that The conversion equation represents the following conversion relationship between the initial angle and the target angle: a1 = k–a; b1 = a-b+m; c1=b-c+n, where k, m, and n are pre-calibrated constants.
3. The method according to claim 2, characterized in that At the first time point, the space transformation matrix is: Tg = T(AB, a1) * T(BC, b1) * T(0, c1); Among them, AB is the length of the upper arm, BC is the length of the lower arm, and T(x,y) is the 4x4 spatial rotation matrix.
4. The method according to claim 1, characterized in that: At the second time point, the spatial transformation matrix is expressed as: Tg = T(AB, a2) * T(BC, b2) * T(0, c2), wherein T(x, y) is a 4x4 spatial rotation matrix, AB is the length of the boom, BC is the length of the forearm, a2 is the second angle of the boom relative to the ground at the second time point, b2 is the third angle between the forearm and the boom at the second time point, and c2 represents the fourth angle between the plane where the upper edge of the bucket is located and the forearm to be solved.
5. The method according to claim 4, characterized in that The fourth angle between the plane where the upper edge of the bucket is located and the forearm is calculated based on the length of the boom, the length of the forearm, the first angle, the second angle, the third angle, and a space transformation matrix from a coordinate system of a plane where the upper edge of the bucket is located to a ground coordinate system, comprising: The length AB of the boom, the length BC of the forearm, the second angle a2, and the third angle b2 are brought into the space transformation matrix Tg = T(AB, a2) * T(BC, b2) * T(0, c2), the pitch angle Tg0 of Tg is the locked first angle, and the fourth angle c2 between the plane where the upper edge of the bucket is located and the forearm is solved as the solved value, and T(0, c2) = T -1 (BC, b2) * T -1 (AB, a2) * Tg, and recover c2 from the solved T(0, c2) matrix.
6. The method according to claim 4, characterized in that The obtaining of the second angle between the boom and the ground and the third angle between the forearm and the boom comprises: The second angle a2 and the third angle b2 are calculated using the following conversion relationship: a2 = k–a, b2 = a-b+m; wherein a and b are respectively the first initial angle between the boom and the horizontal plane and the second initial angle between the arm and the horizontal plane sensed by the inclination sensors arranged on the boom, arm and bucket, and k and m are pre-calibrated constants.
7. The method according to claim 4, characterized in that The obtaining of the second angle between the boom and the ground and / or the third angle between the forearm and the boom comprises: A second angle and a third angle sent by the excavator operating terminal are received, where the second angle and the third angle are target angles estimated by the excavator operating terminal based on the motion states of the boom and the arm.
8. The method according to claim 1, characterized in that The receiving a bucket locking instruction at a first time point includes: The bucket locking instruction sent by the excavator operating terminal is received at the first time point.
9. The method according to claim 1, characterized in that: The step of controlling the bucket movement based on the fourth angle includes: The PID position control algorithm is used to control the bucket to reach the position corresponding to the fourth angle.
10. An excavator control device, characterized in that: The device comprises: A first angle obtaining unit is used for, in response to receiving a bucket locking instruction at a first time point, sensing and obtaining a first initial angle a between the boom and a horizontal plane, a second initial angle b between the arm and a horizontal plane, and a third initial angle c between a plane where an upper edge of the bucket is located and a horizontal plane based on inclination sensors respectively arranged on a boom, an arm, and a bucket of the excavator; calculating and obtaining a first target angle a1 between the boom and the ground, a second target angle b1 between the arm and the boom, and a third target angle c1 between a plane where an upper edge of the bucket is located and the arm at the first time point based on the first initial angle a, the second initial angle b, the third initial angle c, and a pre-constructed conversion equation; solving a space conversion matrix from a coordinate system of a plane where an upper edge of the bucket is located to a ground coordinate system based on a length of the boom, a length of the arm, the first target angle, the second target angle, and the third target angle, and extracting a locked first angle of a plane where an upper edge of the bucket is located relative to the ground from the solved space conversion matrix; A second and third angle acquisition unit, for acquiring a second angle of the boom relative to the ground and a third angle between the forearm and the boom in response to the boom and / or the arm of the excavator being controlled to be in motion at a second time point; a fourth angle calculation unit, configured to calculate a fourth angle between the plane where the upper edge of the bucket is located and the forearm based on the length of the boom, the length of the forearm, the first angle, the second angle, the third angle, and a space transformation matrix from the coordinate system of the plane where the upper edge of the bucket is located to the ground coordinate system; A bucket motion control unit is used to control the bucket motion based on the fourth angle.
11. An electronic device, characterized in that: comprising a processor and a memory; wherein, The memory is used to store one or more computer instructions, wherein the one or more computer instructions are executed by the processor to implement the method according to any one of claims 1 to 9.
12. A computer-readable storage medium having one or more computer instructions stored thereon, characterized in that: The instructions are executed by a processor to implement the method according to any one of claims 1 to 9.
