CN113957939A

CN113957939A - Excavator and control method thereof

Info

Publication number: CN113957939A
Application number: CN202110819676.3A
Authority: CN
Inventors: 金韩率; 林永燮; 柳煜铉; 宋圣缟; 金允慧; 李昌浩
Original assignee: Doosan Infracore Co Ltd
Current assignee: Hyundai Yingweigao Co ltd
Priority date: 2020-07-20
Filing date: 2021-07-20
Publication date: 2022-01-21
Anticipated expiration: 2041-07-20
Also published as: EP3943669A1; CN113957939B; KR20220010795A

Abstract

The present invention relates to an excavator capable of performing precise work, the excavator including: an excavator mounted with a bucket including a plurality of bucket tips; a sensor capable of measuring an angle of a working unit of the excavator; and a control unit that detects distances between the work surface and at least two bucket tips, respectively, based on a size of the bucket and an angle between a virtual straight line connecting the bucket tips of the bucket and the work surface.

Description

Excavator and control method thereof

Technical Field

The present invention relates to an excavator, and more particularly, to an excavator capable of performing precise work and a method for controlling the excavator.

Background

In general, an excavator is a construction machine that performs operations such as excavation work for excavating a ground in civil engineering, construction, and construction sites, loading work for transporting earth and sand, crushing work for dismantling a building, and soil preparation work for working up the ground.

Documents of the prior art

Korean laid-open patent No. 10-2014-0101701 (published 2014-20/08)

Disclosure of Invention

Technical problem

An object of the present invention is to provide an excavator capable of performing precise work and a control method thereof.

Technical scheme

The excavator of the present invention for achieving the above object includes: an excavator mounted with a bucket including a plurality of bucket tips; a sensor capable of measuring an angle of a working unit of the excavator; and a control unit that detects distances between the work surface and at least two bucket tips, respectively, based on a size of the bucket and an angle between a virtual straight line connecting the bucket tips of the bucket and the work surface.

The excavator further includes a mechanism for inputting the size of the bucket.

A pop-up window is provided that is selectable among the at least two bucket tips.

The excavator further includes: a display mechanism that displays the distance, the display mechanism displaying a shortest distance of the at least two distances.

The excavator further includes: a first connecting pin connecting the swivel body and a first joint of the boom; a second connecting pin connecting a second joint of the boom and a first joint of the arm; a third connecting pin connecting the second joint of the arm and the joint of the bucket; a boom cylinder connected to a cylinder connection part of the boom and a first cylinder connection part of the arm; an arm cylinder connected to the second cylinder connection portion of the arm and the cylinder connection portion of the bucket; a bucket link connected to a cylinder connection part of the bucket and a third joint of the arm; a boom cylinder pin connecting a cylinder connecting portion of the boom and the boom cylinder; a first arm cylinder pin connecting the first cylinder connection portion of the arm and the boom cylinder; a second arm cylinder pin that connects the second cylinder connection portion of the arm and the arm cylinder; and a bucket pin that connects the arm cylinder, the bucket link, and the cylinder connection portion of the bucket.

The control part detects the height of the center tip from the height of the center tip, the height of the third connecting pin, the length of a line segment connecting the third connecting pin and the center tip, and an angle between a virtual vertical line and the line segment, and the virtual vertical line represents a line parallel to the direction of gravity; the control unit detects a height of a first edge tip from the height of the first edge tip, the height of the center tip, the width of the bucket, and an angle between the virtual straight line and the work surface; the control unit detects the height of the second edge tip from the height of the second edge tip, the height of the center tip, the width of the bucket, and an angle between the virtual straight line and the work surface.

Further, a control method of an excavator according to the present invention for achieving the above object includes: detecting a size of a bucket and an angle between a virtual straight line connecting a bucket tip of the bucket and a working plane; and a step of detecting distances between the work surface and at least two bucket tips respectively based on the size of the bucket and the detected angle.

The distance between the work surface and the at least two bucket tips includes at least two of a distance between the work surface and a center one of the bucket tips located at a center portion of the bucket, a distance between the work surface and a first one of the bucket tips located at one side edge of the bucket, and a distance between the work surface and a second one of the bucket tips located at the other side edge of the bucket.

The distance between the working face and the central tip is less than the distance between the working face and the first edge tip and greater than the distance between the working face and the second edge tip.

ADVANTAGEOUS EFFECTS OF INVENTION

The excavator and the control method thereof according to the present invention can perform precise work.

Drawings

Fig. 1 is a diagram showing an excavator according to an embodiment of the present invention.

Fig. 2 is a diagram for explaining a method of measuring the height of the boom cylinder pin of fig. 1.

Fig. 3 is a diagram for explaining a method of measuring the height of the first arm cylinder pin of fig. 1.

Fig. 4 is a diagram for explaining a method of measuring the height of the second arm cylinder pin of fig. 1.

Fig. 5 is a diagram for explaining a method of measuring the height of the bucket pin of fig. 1.

Fig. 6 is a diagram for explaining a method of measuring the height of the bucket rear wall of fig. 1.

Fig. 7 is a diagram for explaining a method of measuring the height of the bucket tip of fig. 1.

Fig. 8 is a diagram showing a screen for selecting a bucket tip to be measured.

Fig. 9 is a diagram showing a screen including various information about the bucket.

Fig. 10 is a diagram showing various sensors for calculating the angle of the working unit of the excavator and a screen for displaying the numerical values measured by these sensors.

Fig. 11 is a diagram illustrating a screen for inputting the size of the bucket.

Fig. 12 is a diagram for explaining a method of measuring a distance between the working surface and the bucket tip when the excavator of fig. 1 is disposed on an inclined ground surface.

Fig. 13 is a diagram for explaining a control method of an excavator according to the present invention.

Description of the symbols

300: a bucket, 900: ground, 999: work surface, 380: bucket rear wall, 340E 1: first edge tip, 340C: center tip, 340E 2: second edge tip, LL: a virtual straight line.

Detailed Description

The advantages, features, and methods of accomplishing the same will become apparent from the following detailed description of the embodiments when considered in conjunction with the accompanying drawings. However, the present invention is not limited to the embodiments disclosed below, but may be implemented in various forms, and the embodiments are provided only to complete the disclosure of the present invention and to fully inform the scope of the present invention to those skilled in the art to which the present invention pertains, and the present invention is defined only by the scope of the claims. Accordingly, in several embodiments, some well-known process steps, well-known element structures, and well-known techniques have not been described in detail in order to avoid obscuring the present invention. Throughout the specification, the same reference numerals refer to the same constituent elements.

In the present specification, when a part is connected to another part, the part may be directly connected to the other part, or may be electrically connected to the other part with another element interposed therebetween. Further, when a part includes a certain constituent element, unless otherwise stated to the contrary, it means that another constituent element may be included instead of excluding another constituent element.

In the present specification, the terms first, second, third, and the like may be used to describe various constituent elements, but these constituent elements are not limited to these terms. These terms are used for the purpose of distinguishing one element from another. For example, a first constituent element may be named as a second or third constituent element, etc., and similarly, a second or third constituent element may also be named interchangeably, without departing from the scope of the present invention.

Unless otherwise defined, all terms (including technical and scientific terms) used herein may be used in the same sense as commonly understood by one of ordinary skill in the art to which this invention belongs. Furthermore, unless clearly defined otherwise, terms defined in commonly used dictionaries should not be interpreted ideally or excessively.

The excavator and the control method thereof of the present invention will be described in detail with reference to fig. 1 to 10.

As shown in fig. 1, the excavator according to the embodiment of the present invention may include a swing body 520, a traveling body 510, a vehicle attachment portion 530, a boom 100, an arm 200, a bucket 300, a boom cylinder 150, an arm cylinder 250, a boom cylinder pin 120, a first arm cylinder pin 221, a second arm cylinder pin 222, a bucket link 400, a first link pin 11, a second link pin 22, a third link pin 33, a bucket pin 44, a first angle sensor 701, a second angle sensor 702, a third angle sensor 703, and a control portion 600. Among other things, bucket 300 may include a plurality of bucket tips 340.

The vehicle connection portion 530 connects the traveling body 510 and the turning body 520. The swivel body 520 is rotatably connected to the vehicle connection part 530. For example, the swivel body 520 may rotate 360 degrees around the vehicle connection part 530.

The first joint 101 of the boom 100 is rotatably connected to the swivel body 520. The second joint 102 of the boom 100 is rotatably connected to the first joint 201 of the arm 200. The first joint 101 of the boom 100 may be disposed at one side end of the boom 100, and the second joint 102 of the boom 100 may be disposed at the other side end of the boom 100. The swivel body 520 and the first joint 101 of the boom 100 may be hingedly connected by a first connection pin 11, and the second joint 102 of the boom 100 and the first joint 201 of the stick 200 may be hingedly connected by a second connection pin 22.

The first joint 201 of the arm 200 is rotatably connected to the second joint 102 of the boom 100. The second joint 202 of the stick 200 is connected to the joint 301 of the bucket 300. The first joint 201 of the arm 200 may be disposed at one end of the arm 200, and the second joint 202 of the arm 200 may be disposed at the other end of the arm 200. The second joint 202 of the stick 200 and the joint 301 of the bucket 300 may be hingedly connected by the third connection pin 33.

Joint 301 of bucket 300 is rotatably connected to second joint 202 of stick 200. Joint 301 of bucket 300 may be disposed at one end of bucket 300. On the other hand, a plurality of bucket tips 340 may be disposed at the other side end portion of the bucket 300.

One end of the boom cylinder 150 is connected to the cylinder connection portion 110 of the boom 100. At this time, one end of the boom cylinder 150 is connected to the cylinder connection portion 110 of the boom 100 by the boom cylinder pin 120. One end of the boom cylinder 150 is rotatably connected to the cylinder connection portion 110 of the boom 100.

The other end of the boom cylinder 150 is connected to the first cylinder connection portion 211 of the arm 200. At this time, the other end of boom cylinder 150 is connected to first cylinder connection portion 211 of arm 200 by first arm cylinder pin 221. The other end of the boom cylinder 150 is rotatably connected to the first cylinder connection portion 211 of the arm 200.

One end of the arm cylinder 250 is connected to the second cylinder connection portion 212 of the arm 200. At this time, one end portion of arm cylinder 250 is connected to second cylinder connection portion 212 of arm 200 by second arm cylinder pin 222. One end portion of the arm cylinder 250 is rotatably connected to the second cylinder connection portion 212 of the arm 200.

The other end of arm cylinder 250 is connected to bucket link 400. At this time, the other end of arm cylinder 250 is connected to cylinder connection portion 410 of bucket link 400 and bucket 300 by bucket pin 44. The other end of arm cylinder 250 is rotatably connected to connecting portion 410 between bucket link 400 and bucket 300.

One end of bucket link 400 is rotatably connected to third joint 203 of arm 200, and the other end of bucket link 400 is rotatably connected to the other end of arm cylinder 250 and cylinder connection portion 410 of bucket 300.

The first angle sensor 701 may be disposed at the boom 100. The first angle sensor 701 detects an angle of the boom 100.

The second angle sensor 702 may be disposed on the boom 200. The second angle sensor 702 detects the angle of the bucket lever 200.

Third angle sensor 703 may be configured with bucket 300. Third angle sensor 703 detects the angle of bucket 300.

Control 600 may calculate the height of boom cylinder pin 120, first arm cylinder pin 221, second arm cylinder pin 222, bucket pin 44, bucket back wall 380, and bucket tip 340 from ground 900.

Fig. 2 is a diagram for explaining a method of measuring the height of the boom cylinder pin 120 of fig. 1.

The height H1 of the boom cylinder pin 120 can be calculated by the aforementioned control section 600.

The height H1 of boom cylinder pin 120 refers to the height H1 in the vertical direction from the ground 900 to the boom cylinder pin 120. The height H1 of such a boom cylinder pin 120 can be calculated by the following mathematical formula 1.

< equation 1>

Y_{BoomCylinderPin}＝Y_JointPin1+L_Boom*sin(θ_Boom+θ_BommCylinder)

In the above mathematical formula 1, Y_{BoomCylinderPin}Indicating the height H1, Y of the boom cylinder pin 120_JointPin1Indicating the height h1, L of the first connecting pin 11_BoomA length θ of a virtual first line segment L1 connecting the first connecting pin 11 and the boom cylinder pin 120_BoomRefers to an angle between a virtual horizontal line HL and a virtual second line L2, and theta_BommCylinderRefers to the angle between the first line segment L1 and the second line segment L2. Wherein the height h1 of the first coupling pin 11 means a distance from the ground 900 to the first coupling pin 11 in a vertical direction, the virtual horizontal line HL means a line extending from the first coupling pin 11 toward the front surface of the swivel body 520 and perpendicular to a gravity direction, and the second line segment L2 means a straight line connecting the first coupling pin 11 and the second coupling pin 22. At this time, Y_JointPin1、L_BoomAnd theta_BommCylinderIs a fixed value. However, the Y is_JointPin1、 _BoomAnd theta_BommCylinderMay be different depending on the model of the excavator. On the other hand, [ theta ]_BoomCan be detected by the aforementioned first angle sensor 701.

"L" of the above mathematical formula 1_Boom*sin(θ_Boom+θ_Boom) "refers to a height h 1' in the vertical direction from the horizontal line HL to the boom cylinder pin 120. Therefore, the height H1 in the vertical direction from the ground 900 to the boom cylinder pin 120 can be calculated by the above mathematical formula 1. In the case of the example shown in FIG. 2, "θ_Boom+θ_Boom"less than 90 degrees in the counterclockwise direction with reference to the horizontal line HL, thus" sin (θ)_Boom+θ_Boom) "has a positive value. Thus, the formula 1 represents the height of the first connecting pin 11 plus "sin (θ)_Boom+θ_Boom) "size of value.

Fig. 3 is a diagram for explaining a method of measuring the height of first arm cylinder pin 221 of fig. 1.

The height H2 of the first arm cylinder pin 221 may be calculated by the aforementioned control portion 600.

Height H2 of first arm cylinder pin 221 indicates a height H2 in a vertical direction from ground 900 to first arm cylinder pin 221. The height H2 of such first arm cylinder pin 221 can be calculated by the following mathematical formula 2.

< equation 2>

Y_{ArmCylinderPin1}＝Y_JointPin2-L_Arm1*cos(θ_Arm+θ_ArmCylinder1)

In the above mathematical formula 2, Y_{ArmCylinderPin1}Height H2, Y of first arm cylinder pin 221_JointPin2Indicating the height h2, L of the second connecting pin 22_Arm1A length θ of a virtual third line segment L3 that connects the second connecting pin 22 and the first arm cylinder pin 221_ArmRepresents an angle between an imaginary vertical line VL and an imaginary fourth line segment L4, and θ_ArmCylinderRepresenting the angle between the fourth line segment L4 and the third line segment L3. Wherein the height h2 of the second link pin 22 represents the distance from the ground 900 to the second link pin 22 in the vertical direction, the virtual vertical line VL indicates a line parallel to the direction of gravity, and the third line segment L3 indicates a straight line connecting the second link pin 22 and the first stick cylinder pin 221A line, and a fourth line segment L4 indicates a straight line connecting the second connecting pin 22 and the third connecting pin 33. At this time, L_Arm1Is a fixed value. However, this L_Arm1May be different depending on the model of the excavator. On the other hand, [ theta ]_ArmMay be detected by the aforementioned second angle sensor 702.

"L" of the above mathematical formula 2_Arm1*cos(θ_Arm+θ_ArmCylinder1) "refers to the height h 2' in the vertical direction from the second connecting pin 22 to the first arm cylinder pin 221. Therefore, the height H2 in the vertical direction from the ground 900 to the first stick cylinder pin 221 can be calculated by the above mathematical formula 2. In the case of the example shown in FIG. 3, "(θ)_Arm+θ_ArmCylinder1) "greater than 90 degrees in the counterclockwise direction with reference to the vertical line VL, thus" cos (θ)_Arm+θ_ArmCylinder1) "has a negative value. Thus, equation 2 represents the height of the second connecting pin 22 plus "cos (θ)_Arm+θ_ArmCylinder1) "size of value.

On the other hand, Y in the formula 2_JointPin2Can be defined by the following mathematical formula 3.

< expression 3>

Y_JointPin2＝Y_JointPin1+L_Boom*sin(θ_Boom)

Fig. 4 is a diagram for explaining a method of measuring the height of second arm cylinder pin 222 of fig. 1.

The height H3 of second arm cylinder pin 222 may be calculated by control 600 as described above.

Height H3 of second arm cylinder pin 222 indicates a height H3 in the vertical direction from ground 900 to second arm cylinder pin 222. The height H3 of such second arm cylinder pin 222 can be calculated by the following equation 4.

< expression 4>

Y_{ArmCylinderPin2}＝Y_JointPin2-L_Arm2*cos(θ_Arm+θ_ArmCylinder2)

In the above mathematical formula 4, Y_{ArmCylinderPin2}Height H3, Y of second arm cylinder pin 222_JointPin2Indicating the height h3, L of the second connecting pin 22_Arm2A length θ of a virtual fifth line segment L5 showing the connection between the second connecting pin 22 and the second arm cylinder pin 222_ArmRefers to an angle between an imaginary vertical line VL and an imaginary fourth line segment L4, and θ_ArmCylinder2Refers to the angle between the fourth line segment L4 and the fifth line segment L5. Where the height h3 of the second link pin 22 refers to the distance from the ground 900 to the second link pin 22 in the vertical direction, the imaginary vertical line VL refers to a line parallel to the direction of gravity, the fifth line segment L5 refers to a straight line connecting the second link pin 22 and the second arm cylinder pin 222, and the fourth line segment L4 refers to a straight line connecting the second link pin 22 and the third link pin 33. At this time, L_Arm2Is a fixed value. However, this L_Arm2May be different depending on the model of the excavator. On the other hand, [ theta ]_ArmCan be detected by the aforementioned second angle sensor 702.

"L" of the above mathematical formula 4_Arm2*cos(θ_Arm+θ_ArmCylinder2) "refers to a height h 3' in the vertical direction from second link pin 22 to second arm cylinder pin 222. Accordingly, the height H3 in the vertical direction from the ground 900 to the second arm cylinder pin 222 can be calculated by the above equation 4. In the case of the example shown in FIG. 4, "(θ)_Arm+θ_ArmCylinder2) "greater than 90 degrees in the counterclockwise direction with reference to the vertical line VL, thus" cos (θ)_Arm+θ_ArmCylinder2) "has a negative value. Thus, equation 4 represents the height of the second connecting pin 22 plus "cos (θ)_Arm+θ_ArmCylinder2) "size of value.

On the other hand, Y in the formula 2_JointPinCan be defined by the aforementioned mathematical formula 3.

Fig. 5 is a diagram for explaining a method of measuring the height of the bucket pin 44 of fig. 1.

The height H4 of the bucket pin 44 may be calculated by the aforementioned control portion 600.

Height H4 of bucket pin 44 refers to the height H4 in the vertical direction from ground 900 to bucket pin 44. The height H4 of such a bucket pin 44 can be calculated by the following equation 5.

< equation 5>

Y_BucketPin＝Y_JointPin3-L_BucketLink*cos(θ_Bucket+θ_Bucketlink)

In the above mathematical formula 5, Y_BucketPinIndicating the height H4, Y of bucket pin 44_JointPin3Indicating the height h4, L of the third connecting pin 33_BucketLinkA length θ of a virtual sixth line segment L6 connecting the third link pin 33 and the bucket pin 44_BucketRefers to an angle between the virtual vertical line VL and the virtual seventh line segment L7, and θ_BucketlinkRefers to the angle between the sixth line segment L6 and the seventh line segment L7. Wherein the height h4 of the third link pin 33 refers to the distance from the ground 900 to the third link pin 33 in the vertical direction, the virtual vertical line VL refers to a line parallel to the direction of gravity, the sixth line segment L6 refers to a straight line connecting the third link pin 33 and the bucket pin 44, and the seventh line segment L7 refers to a straight line connecting the third link pin 33 and the bucket tip 340. At this time, L_BucketLinkIs a fixed value. However, this L_BucketLinkMay be different according to the model number of the excavator. On the other hand, [ theta ]_BucketMay be detected by the aforementioned third angle sensor 703.

"L" of the above mathematical formula 5_BucketLink*cos(θ_Bucket+θ_Bucketlink)"refers to the distance h 4' in the vertical direction from the third link pin 33 to the bucket pin 44. Therefore, the height H4 in the vertical direction from the ground 900 to the bucket pin 44 can be calculated by the above mathematical formula 5. In the case of the example shown in FIG. 5, "(θ)_Bucket+θ_Bucketlink) "greater than 90 degrees in the counterclockwise direction with reference to the vertical line VL, thus" cos (θ)_Bucket+θ_Bucketlink) "has a negative value. Therefore, the equation 5 represents the height of the third connecting pin 33 plus "cos (θ)_Bucket+θ_Bucketlink) "size of value.

On the other hand, Y in the formula 5_JointPin3Can be defined by the following mathematical formula 6.

< expression 6>

Y_JointPin3＝Y_JointPin2–L_Arm*cos(θ_Arm)

L of the numerical formula 6_ArmRefers to the length of the aforementioned fourth line segment L4. At this time, L_ArmIs a fixed value. However, the L_ArmMay be different depending on the model of the excavator.

Fig. 6 is a diagram for explaining a method of measuring the height of the bucket rear wall 380 of fig. 1.

The height H5 of the bucket rear wall 380 may be calculated by the aforementioned control portion 600.

The height H5 of the bucket rear wall 380 refers to the height in the vertical direction from the ground 900 to the bucket rear wall 380. The height H5 of such a bucket rear wall 380 can be calculated by the following mathematical formula 7.

< equation 7>

Y_BucketBack＝Y_JointPin3-L_BucketBack*cos(θ_Bucket+θ_BucketBack)

In the above mathematical formula 7, Y_BucketBackIndicating the height H5, Y of the bucket back wall 380_JointPin3Indicates the height h5, L of the third connecting pin 33_BucketBackA length θ of an eighth line segment L8 that represents a virtual line connecting the third connecting pin 33 and the bucket rear wall 380_BucketRefers to an angle between the virtual vertical line VL and the virtual seventh line segment L7, and θ_BucketBackRefers to the angle between the seventh line segment L7 and the eighth line segment L8. Wherein the height h5 of the third link pin 33 refers to the distance from the ground 900 to the third link pin 33 in the vertical direction, the virtual vertical line VL refers to a line parallel to the direction of gravity, the eighth line segment L8 refers to a straight line connecting the third link pin 33 and the bucket rear wall 380, and the seventh line segment L7 refers to a straight line connecting the third link pin 33 and the bucket tip 340. At this time, L_BucketBackIs a fixed value. However, this L_BucketBackMay be different depending on the model of the excavator.

"L" of the above mathematical formula 7_BucketBack*cos(θ_Bucket+θ_BucketBack) "refers to the height in the vertical direction from the third connecting pin 33 to the bucket rear wall 380. Thus, can pass the aboveEquation 7 calculates the height H5 in the vertical direction from the ground 900 to the bucket back wall 380. In the case of the example shown in FIG. 6, "(θ)_Bucket+θ_BucketBack) "90 degrees in the counterclockwise direction with reference to the vertical line VL, thus" cos (θ)_Bucket+θ_BucketBack) "has a value of 0. Therefore, the expression 7 represents the height of the third connecting pin 33 plus "cos (θ)_Bucket+θ_BucketBack) "size of value.

On the other hand, Y in the formula 7_JointPin3Can be defined by the aforementioned mathematical formula 6.

Fig. 7 is a diagram for explaining a method of measuring the height of the bucket tip 340 of fig. 1.

The height H5 of the bucket tip 340 may be calculated by the aforementioned control 600.

The height H5 of the bucket tip 340 refers to the height in the vertical direction from the ground 900 to the bucket tip 340. The height H6 of such a bucket tip 340 can be calculated by the following mathematical formula 8.

< equation 8>

Y_BucketTip＝Y_JointPin3-L_Bucket*cos(θ_Bucket)

In the above numerical formula 8, Y_BucketTipIndicating the height H5, Y of the bucket tip 340_JointPin3Indicates the height h5, L of the third connecting pin 33_BucketIndicates the length of a line segment (i.e., a seventh line segment L7) connecting the third connecting pin 33 and the bucket tip 340, θ_BucketAn angle between the virtual vertical line VL and the seventh line segment L7 is indicated.

"L" of the above mathematical formula 8_Bucket*cos(θ_Bucket) "refers to the height in the vertical direction from the third connecting pin 33 to the bucket tip 340. Accordingly, the height H6 in the vertical direction from the ground 900 to the bucket tip 340 can be calculated by the above mathematical formula 8. In the case of the example shown in FIG. 7, "θ_Bucket"less than 90 degrees in the counterclockwise direction with reference to the vertical line VL, thus" cos (θ)_Bucket) "has a positive value. Thus, the equation 8 represents subtracting "L" from the height of the third connecting pin 33_Bucket*cos (θ_Bucket) "size of value.

On the other hand, Y in the formula 8_JointPin3Can be defined by the aforementioned mathematical formula 6.

Fig. 8 is a diagram showing a screen for selecting a bucket tip to be measured.

A display 800 is disposed on the dashboard of the excavator according to the present invention, and a window 850 as shown in fig. 8 can be created on the screen of the display 800. The operator may select, in this window 850, the distance between the work surface and the first edge tip located on the left side of the bucket 300, the distance between the work surface and the center tip located at the center of the bucket 300, and the distance between the work surface and the second edge tip located on the right side of the bucket 300. For example, when "left side" is selected in the window 850, the distance between the work surface and the first edge tip may be detected and displayed on the screen of the display 800, when "middle" is selected in the window, the distance between the work surface and the middle tip may be detected and displayed on the screen of the display 800, and when "right side" is selected in the window, the distance between the work surface and the second edge tip may be detected and displayed on the screen of the display 800. At this time, at least two of "left", "middle", and "right" may be selected, in which case the respective heights of those selected tips may be detected and displayed on the screen of the display 800. The operator can easily recognize the distance of the selected position among the "left side", "middle", and "right side" on the screen. For example, when the worker performs work while the ground and the bucket are tilted as shown in fig. 12, the worker can select and observe the position from the position closest to the ground to the position farthest from the ground according to the work tendency of the worker.

When the tip of the bucket to be measured is selected as shown in the aforementioned fig. 8, the tip thereof is emphasized by another color as shown in fig. 9.

Further, as shown in fig. 9, the slope on the front face of the bucket, the distance of the selected tip of the bucket and the work surface may be displayed on the screen.

As shown in fig. 10, the excavator of the present invention may include a boom angle sensor for sensing an angle of a boom, an arm angle sensor for sensing an angle of an arm, a bucket angle sensor for sensing an angle of a bucket, and an attitude measurement sensor for measuring an attitude of the excavator.

The measurement values regarding the posture of the boom, arm, bucket, and excavator measured by the boom angle sensor, arm angle sensor, bucket angle sensor, and posture measurement sensor may be displayed on the display 800.

In order to calculate the coordinates differently for different positions of the bucket end when the body of the excavator is tilted, as shown in fig. 11, a screen for inputting the size of the bucket may be provided.

Points D and G of fig. 11 represent coordinates of each bucket pin of the bucket link 400, point Q represents a coordinate of a maximum projecting portion in the back surface of the bucket, and point N represents a coordinate of an end portion of the bucket tip.

As shown in fig. 11, a length between points D and G, a length between D and N, a length between D and Q, a length between N and Q, a bucket width, and a bucket Tooth (Tooth) may be input. At this time, when entering the bucket theory (Tooth), an average value of each length for both bucket tips may be entered. These values are variables required to calculate the coordinates of the bucket tip set by the slope of the excavator body.

When the ground 900 where the excavator is disposed and the working surface 999 where the excavating work is to be performed by the excavator are not parallel, the distance between the working surface 999 and the bucket tip may be different. For example, the distance between the work surface 999 and the bucket tip (hereinafter referred to as the center tip 340C) located at the center of the bucket 300, the distance between the work surface 999 and the bucket tip (hereinafter referred to as the first edge tip 340E1) located at one side edge of the bucket 300, and the distance between the work surface 999 and the bucket tip (hereinafter referred to as the second edge tip 340E2) located at the other side edge of the bucket 300 may be different. In this case, in the present invention, the distances between the work surface 999 and at least two bucket tips can be detected based on the size of the bucket 300 and the angle between the virtual straight line connecting the bucket tips 340 of the bucket 300 and the work surface 999 as shown in fig. 11, respectively.

As shown in FIG. 12, when the excavator is disposed at an inclination θ with respect to the working plane 999_ChassisThe distance H between the working surface 999 and the central tip 340C when on the ground 900_cSubstantially the same as the distance H6 between the ground 900 and the bucket tip 340 measured in fig. 7 previously described.

On the other hand, the distance H of the first edge tip 340E1 of the bucket tip that is farthest from the work surface 999_E1Than the distance H between the working surface 999 and the central tip 340C_cThe distance H of the long, second edge tip 340E2 of the bucket tip closest to the work surface 999_E2Than the distance H between the working surface 999 and the center tip 340C_cShort.

Distance H between work surface 999 and first edge tip 340E1_E1And the distance H between the work surface 999 and the second edge tip 340E2_E2May be calculated by the aforementioned control section 600.

First, the distance H between the work surface 999 and the first edge tip 340E1 is calculated_E1The method of (2) is described.

Distance H between work surface 999 and first edge tip 340E1_E1Refers to the distance in the vertical direction from the work surface 999 to the first edge tip 340E 1. Distance H between such work surface 999 and first edge tip 340E1_E1Can be calculated by the following mathematical formula 9.

< expression 9>

Y_{BucketTip_E1}＝Y_{BucketTip_C}+W/2*sin(θ_Chassis)

In the above numerical formula 8, Y_{BucketTip_E1}Indicates the height, Y, between the working surface 999 and the first edge tip 340E1_{BucketTip_C}Represents the distance between the work surface 999 and the center tip 340C (i.e., the distance between the bucket tips 340), W represents the width of the bucket 300, and θ_ChassisRepresenting the angle between the ground and the work surface 999. In other words, θ_ChassisIs an angle indicating the degree of inclination of the excavator with respect to the working surface 999. More specifically, θ_ChassisIs an angle indicating the degree to which bucket 300 is tilted with respect to ground 900. E.g. theta_ChassisAn angle formed by a virtual straight line LL connecting the end of the bucket tip and the working surface 999 is shown.

"W/2 sin (θ) of the above mathematical formula 9_Chassis) "refers to the distance h in the vertical direction from the center portion of the center tip 340C to the outer edge of the first edge tip 340E1_e. In addition, "W/2 sin (θ) of the formula 9_Chassis) "refers to the distance h in the vertical direction from the center portion of the center tip 340C to the outer edge of the second edge tip 340E2_e. Therefore, the distance H in the vertical direction from the work surface 999 to the first edge tip 340E1 can be calculated by the above equation 9_E1. In the case of the example shown in fig. 12, "θ_Chassis"less than 90 degrees in the counterclockwise direction with reference to the straight line LL, and thus" sin (θ)_Chassis) "has a positive value. Thus, the height H of the center tip 340C is expressed by the mathematical formula 9_CPlus "W/2 sin (theta)_Chassis) "size of value.

Next, a method of calculating the height of the second rim tip 340E2 will be described.

Distance H between work surface 999 and second marginal tip 340E2_E2Refers to the distance in the vertical direction from the work surface 999 to the second edge tip 340E 2. Distance H between such work surface 999 and second edge tip 340E2_E2Can be calculated by the following mathematical formula 10.

< equation 10>

Y_{BucketTip_E2}＝Y_{BucketTip_C}-W/2*sin(θ_Chassis)

In the above numerical formula 10, Y_{BucketTip_E2}Indicating the distance, Y, between the work surface 999 and the second marginal tip 340E2_{BucketTip_C}Indicating the distance H between the work surface 999 and the center tip 340C (i.e., the distance between the work surface 999 and the bucket tip)_CW represents the width of bucket 300, and θ_ChassisRepresenting the angle between the ground 900 and the work surface 999. In other words, θ_ChassisIs an angle indicating the degree of inclination of the excavator with respect to the working surface 999. More specifically, θ_ChassisIs an angle indicating the degree to which bucket 300 is tilted with respect to ground 900. E.g. theta_ChassisAn angle formed by a virtual straight line LL connecting the end of the bucket tip and the working surface 999 is shown.

"W/2 sin (θ) of the above mathematical formula 10_Chassis) "refers to the distance h in the vertical direction from the center portion of the center tip 340C to the outer edge of the first edge tip 340E1_e. In addition, "W/2 sin (θ) of the formula 10_Chassis) "means the distance Hh in the vertical direction from the center portion of the center tip 340C to the outer peripheral edge of the second edge tip 340E2_e. Therefore, the distance H in the vertical direction from the work surface 999 to the second edge tip 340E2 can be calculated by the above equation 10_E2. In the case of the example shown in FIG. 8, "θ_Chassis"less than 90 degrees in the counterclockwise direction with reference to the straight line LL, and thus" sin (θ)_Chassis) "has a positive value. Thus, equation 10 represents subtracting "W/2 x sin (θ) from the height of the central tip 340C_Chassis) "size of value.

According to the present invention, even when the body of the excavator is tilted, the heights of the bucket 300 and the work surface 999 can be detected for different positions of the bucket tip 340, and thus more precise work can be performed on the work object.

First, controlThe control unit 600 detects the heights of the boom 100, the arm 200, and the bucket 300. For example, the control part 600 detects the heights (e.g., the distance between the ground and the bucket tip) of the boom cylinder pin 120, the first arm cylinder pin 221, the second arm cylinder pin 222, the bucket pin 44, the bucket rear wall 380, and the bucket tip 340 of the excavator (S1). Further, the control unit 600 detects the slope of the excavator body (S1). In addition, as shown in fig. 11, the size of the bucket 300 is detected. The slope may be, for example, an angle θ between a virtual straight line LL connecting the bucket tip 340 of the bucket 300 and the working surface 999_Chassis。

Next, at least one of the bucket tips 340 of the bucket 300 may be selected. For example, at least one of the central cusp 340C, the first edge cusp 340E1, and the second edge cusp 340E2 may be selected.

Next, the distance between the selected bucket tip and the work surface is detected. For example, the distance from the work surface 999 to the selected bucket tip may be detected.

The present invention described above is not limited to the above-described embodiments and drawings, and it will be apparent to those skilled in the art to which the present invention pertains that various substitutions, modifications, and changes may be made without departing from the technical spirit of the present invention.

Claims

1. An excavator, comprising:

an excavator mounted with a bucket including at least two bucket tips;

a sensor capable of measuring an angle of a working unit of the excavator;

a pop-up window enabling selection among the at least two dipper ends; and

and a control unit that detects a distance between the work surface and the selected bucket tip based on a size of the bucket and an angle between a virtual straight line connecting the tips of the bucket and the work surface.

2. The excavating machine of claim 1,

the bucket includes a plurality of bucket tips,

the control unit detects a distance between the work surface and the bucket tips.

3. The excavating machine of claim 2,

providing a pop-up window that is selectable among the plurality of bucket tips.

4. The excavating machine of claim 1,

5. The excavator of claim 1 further comprising:

a display mechanism that displays the distance,

the display mechanism displays the detected distance.

6. The excavating machine of claim 5,

displaying the selected bucket end at the display mechanism.

7. The excavating machine of claim 6,

the bucket end shown is the bucket tip.

8. The excavation machine of claim 3, further comprising:

a first connecting pin connecting the swivel body and a first joint of the boom;

a second connecting pin connecting a second joint of the boom and a first joint of the arm;

a third connecting pin connecting the second joint of the arm and the joint of the bucket;

a boom cylinder connected to a cylinder connection portion of the boom and a first cylinder connection portion of the arm;

an arm cylinder connected to the second cylinder connection portion of the arm and the cylinder connection portion of the bucket;

a bucket link connected to a cylinder connection part of the bucket and a third joint of the arm;

a boom cylinder pin connecting a cylinder connecting portion of the boom and the boom cylinder;

a first arm cylinder pin that connects the first cylinder connection portion of the arm and the boom cylinder;

a second arm cylinder pin connecting a second cylinder connection part of the arm and the arm cylinder; and

and a bucket pin that connects the arm cylinder, the bucket link, and the cylinder connection portion of the bucket.

9. The excavating machine of claim 4,

the control part detects the height of the center tip from the height of the center tip, the height of the third connecting pin, the length of a line segment connecting the third connecting pin and the center tip, and an angle between a virtual vertical line and the line segment, and the virtual vertical line represents a line parallel to the direction of gravity;

the control unit detects a height of a first edge tip from the height of the first edge tip, the height of the center tip, the width of the bucket, and an angle between the virtual straight line and the work surface;

the control unit detects the height of the second edge tip from the height of the second edge tip, the height of the center tip, the width of the bucket, and an angle between the virtual straight line and the work surface.

10. A control method for an excavator, comprising:

detecting a size of a bucket and an angle between a virtual straight line connecting bucket ends of the bucket and a working plane; and the number of the first and second groups,

a step of detecting distances between the work surface and at least two bucket ends respectively based on the size of the bucket and the detected angle.

11. The control method of an excavator according to claim 10,

the bucket includes a plurality of bucket tips,

12. The control method of an excavator according to claim 11,