KR20150016933A - Excavator control method and control device - Google Patents

Excavator control method and control device Download PDF

Info

Publication number
KR20150016933A
KR20150016933A KR1020147029134A KR20147029134A KR20150016933A KR 20150016933 A KR20150016933 A KR 20150016933A KR 1020147029134 A KR1020147029134 A KR 1020147029134A KR 20147029134 A KR20147029134 A KR 20147029134A KR 20150016933 A KR20150016933 A KR 20150016933A
Authority
KR
South Korea
Prior art keywords
bucket
control
lever
end attachment
plane
Prior art date
Application number
KR1020147029134A
Other languages
Korean (ko)
Other versions
KR102026348B1 (en
Inventor
춘난 우
Original Assignee
스미도모쥬기가이고교 가부시키가이샤
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 스미도모쥬기가이고교 가부시키가이샤 filed Critical 스미도모쥬기가이고교 가부시키가이샤
Publication of KR20150016933A publication Critical patent/KR20150016933A/en
Application granted granted Critical
Publication of KR102026348B1 publication Critical patent/KR102026348B1/en

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • E02F3/436Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like for keeping the dipper in the horizontal position, e.g. self-levelling
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • E02F3/437Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like providing automatic sequences of movements, e.g. linear excavation, keeping dipper angle constant
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2004Control mechanisms, e.g. control levers
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2004Control mechanisms, e.g. control levers
    • E02F9/2012Setting the functions of the control levers, e.g. changing assigned functions among operations levers, setting functions dependent on the operator or seat orientation
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2058Electric or electro-mechanical or mechanical control devices of vehicle sub-units
    • E02F9/2062Control of propulsion units
    • E02F9/2075Control of propulsion units of the hybrid type
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2278Hydraulic circuits
    • E02F9/2285Pilot-operated systems
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2278Hydraulic circuits
    • E02F9/2296Systems with a variable displacement pump

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Mechanical Engineering (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Paleontology (AREA)
  • Operation Control Of Excavators (AREA)
  • Component Parts Of Construction Machinery (AREA)

Abstract

본 발명의 실시예에 관한 쇼벨의 제어방법은, 레버(26B)의 전후방향으로의 조작에 의하여, 버킷(6)의 높이를 유지하면서 버킷(6)의 X방향 이동제어(평면위치제어)를 실행하고, 혹은, 레버(26A)의 전후방향으로의 조작에 의하여, 버킷(6)의 평면위치를 유지하면서 버킷(6)의 Z방향 이동제어(높이제어)를 실행한다.The control method of the shovel according to the embodiment of the present invention is a method of controlling the X direction movement (planar position control) of the bucket 6 while maintaining the height of the bucket 6 by the operation of the lever 26B in the front- (Height control) of the bucket 6 while maintaining the planar position of the bucket 6 by the operation of the lever 26A in the forward and backward directions.

Description

쇼벨의 제어방법 및 제어장치{Excavator control method and control device}BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to an excavator control method and control device,

본 발명은 쇼벨의 제어방법 및 제어장치에 관한 것으로, 보다 상세하게는, 고르기 정지(整地) 작업, 법면정리 작업 등을 행할 때의 쇼벨의 제어방법 및 제어장치에 관한 것이다.BACKGROUND OF THE INVENTION 1. Field of the Invention [0002] The present invention relates to a control method and a control apparatus for a shovel, and more particularly, to a control method and a control apparatus for controlling a shovel in performing a leveling work, a surface leveling work, and the like.

종래, 고르기 정지 작업을 용이하게 행할 수 있도록 하는 유압쇼벨의 굴삭궤적제어장치가 알려져 있다(예를 들면, 특허문헌 1 참조.).BACKGROUND ART [0002] An excavating locus control device for a hydraulic excavator is known in the past, which makes it possible to easily perform a stopping work (for example, refer to Patent Document 1).

이 굴삭궤적제어장치는, 유압쇼벨의 프론트 어태치먼트의 연장방향으로 수평으로 뻗는 작업허가영역을 설정하고, 암 선단핀의 축심위치가 작업허가영역 내에 있는 경우, 암 및 붐의 동작을 허가한다. 한편, 이 굴삭궤적제어장치는, 작업허가영역의 주위에 작업억제영역을 설정하고, 암 선단핀의 축심위치가 작업억제영역 내에 침입한 경우, 암 당김, 붐 상승 및 붐 하강 중 어느 동작을 금지한다.This excavation locus control device sets a work permitting area extending horizontally in the extending direction of the front attachment of the hydraulic shovel and permits the operation of the arm and the boom when the axial center position of the arm front end pin is within the work permitting area. On the other hand, the excavated locus control device sets a work restraining area around the work permitting area, and prohibits any operation such as pulling the arm, raising the boom and falling the boom when the axial center position of the arm front pin enters the work restraining area do.

이와 같이 하여, 이 굴삭궤적제어장치는, 프론트 어태치먼트의 연장방향에 따른 직선당김작업이나 고르기 정지 작업을 조작자가 용이하게 행할 수 있도록 하고 있다.In this manner, the excavated locus control device allows the operator to easily perform a straight-line pulling operation and a picking-stop operation in accordance with the extending direction of the front attachment.

선행기술문헌Prior art literature

(특허문헌)(Patent Literature)

특허문헌 1: 일본 특허공개공보 평8-277543호Patent Document 1: JP-A-8-277543

그러나, 특허문헌 1에 기재된 굴삭궤적제어장치를 탑재하는 유압쇼벨에서는, 조작자는, 암 및 붐을 움직일 때 각각에 대응하는 개별의 조작레버를 이용한다. 이로 인하여, 조작자는, 직선당김작업이나 고르기 정지 작업에 있어서 버킷을 이동시킬 때에 2개의 조작레버를 동시에 조작할 필요가 있다. 이로 인하여, 유압쇼벨의 조작에 서투른 조작자에게 있어서는 직선당김작업이나 고르기 정지 작업은 여전히 곤란한 작업이며, 그러한 조작자에 대한 지원이 충분하다고는 할 수 없다.However, in the hydraulic excavator equipped with the excavated locus control device described in Patent Document 1, the operator uses an individual operation lever corresponding to each of the arms and the boom when they move. Therefore, it is necessary for the operator to operate the two operation levers at the same time when moving the bucket in the straight pulling operation or the picking stop operation. As a result, the straight pulling operation or the stopping operation is still a difficult task for a poor operator in the operation of the hydraulic shovel, and the support for such an operator is not sufficient.

본 발명은 상기 서술한 과제를 감안하여 이루어진 것이며, 프론트 어태치먼트를 보다 용이하게 조작할 수 있도록 하는 쇼벨의 제어방법 및 제어장치를 제공하는 것을 목적으로 한다.SUMMARY OF THE INVENTION The present invention has been made in view of the above-described problems, and an object of the present invention is to provide a control method and a control apparatus for a shovel which makes it possible to more easily operate a front attachment.

상기 서술한 목적을 달성하기 위해서, 본 발명의 실시예에 관한 쇼벨의 제어방법은, 1개의 레버의 조작에 의하여, 엔드 어태치먼트의 높이를 유지하면서 그 엔드 어태치먼트의 평면위치제어를 실행하고, 혹은, 상기 엔드 어태치먼트의 평면위치를 유지하면서 상기 엔드 어태치먼트의 높이제어를 실행한다.In order to achieve the above-mentioned object, a control method of a shovel according to an embodiment of the present invention is a method of controlling a planar position of an end attachment while maintaining the height of the end attachment by operating one lever, The height control of the end attachment is performed while maintaining the planar position of the end attachment.

또한, 본 발명의 실시예에 관한 쇼벨의 제어장치는, 1개의 레버의 조작에 의하여, 엔드 어태치먼트의 높이를 유지하면서 그 엔드 어태치먼트의 평면위치제어를 실행하고, 혹은, 상기 엔드 어태치먼트의 평면위치를 유지하면서 상기 엔드 어태치먼트의 높이제어를 실행한다.Further, the control device of the shovel according to the embodiment of the present invention can perform the control of the planar position of the end attachment while maintaining the height of the end attachment by the operation of one lever, or the planar position of the end attachment While controlling the height of the end attachment.

상기 서술한 수단에 의하여, 본 발명은, 프론트 어태치먼트를 보다 용이하게 조작할 수 있도록 하는 쇼벨의 제어방법 및 제어장치를 제공할 수 있다.According to the above-described means, the present invention can provide a control method and a control apparatus for a shovel that makes it possible to more easily operate the front attachment.

도 1은 본 발명의 실시예에 관한 제어방법을 실행하는 유압식 쇼벨을 나타내는 측면도이다.
도 2는 유압식 쇼벨의 구동계의 구성예를 나타내는 블록도이다.
도 3은 본 발명의 실시예에 관한 제어방법에서 이용되는 삼차원 직교좌표계의 설명도이다.
도 4는 XZ평면에 있어서의 프론트 어태치먼트의 움직임을 설명하는 도이다.
도 5는 캐빈 내의 운전석의 상면사시도이다.
도 6은 자동고르기모드에 있어서 레버조작을 한 경우의 처리의 흐름을 나타내는 플로우차트이다.
도 7은 X방향 이동제어의 흐름을 나타내는 블록도(그 제1예)이다.
도 8은 X방향 이동제어의 흐름을 나타내는 블록도(그 제2예)이다.
도 9는 Z방향 이동제어의 흐름을 나타내는 블록도(그 제1예)이다.
도 10은 Z방향 이동제어의 흐름을 나타내는 블록도(그 제2예)이다.
도 11은 본 발명의 실시예에 관한 제어방법을 실행하는 하이브리드식 쇼벨의 구동계의 구성예를 나타내는 블록도이다.
도 12는 하이브리드식 쇼벨의 축전계의 구성예를 나타내는 블록도이다.
도 13은 본 발명의 실시예에 관한 제어방법을 실행하는 하이브리드식 쇼벨의 구동계의 다른 구성예를 나타내는 블록도이다.
도 14는 법면정리모드에서 이용되는 좌표계의 설명도(그 1)이다.
도 15는 법면정리모드에서 이용되는 좌표계의 설명도(그 2)이다.
도 16은 법면정리모드에서의 프론트 어태치먼트의 움직임을 설명하는 도이다.
1 is a side view showing a hydraulic type shovel that executes a control method according to an embodiment of the present invention.
2 is a block diagram showing a configuration example of a drive system of a hydraulic type shovel.
3 is an explanatory diagram of a three-dimensional rectangular coordinate system used in the control method according to the embodiment of the present invention.
Fig. 4 is a view for explaining the movement of the front attachment in the XZ plane.
5 is a top perspective view of the driver's seat in the cabin.
Fig. 6 is a flowchart showing the flow of processing in the case where the lever is operated in the automatic selecting mode.
7 is a block diagram (first example thereof) showing the flow of the X-direction movement control.
8 is a block diagram (second example) showing the flow of the X-direction movement control.
9 is a block diagram (first example thereof) showing the flow of the Z-direction movement control.
10 is a block diagram (second example) showing the flow of the Z-direction movement control.
11 is a block diagram showing a configuration example of a drive system of a hybrid type shovel for executing a control method according to an embodiment of the present invention.
12 is a block diagram showing a configuration example of a power storage system of a hybrid type shovel.
13 is a block diagram showing another configuration example of a drive system of a hybrid type shovel for executing a control method according to an embodiment of the present invention.
Fig. 14 is an explanatory diagram (1) of a coordinate system used in the regular plane mode.
Fig. 15 is an explanatory diagram (2) of a coordinate system used in the normal mode.
16 is a view for explaining the movement of the front attachment in the rearrangement mode.

도 1은, 본 발명의 실시예에 관한 제어방법을 실행하는 유압식 쇼벨을 나타내는 측면도이다.1 is a side view showing a hydraulic type shovel that executes a control method according to an embodiment of the present invention.

유압식 쇼벨의 하부주행체(1)에는, 선회기구(2)를 통하여 상부선회체(3)가 탑재되어 있다. 상부선회체(3)에는, 조작체로서의 붐(4)이 장착되어 있다. 붐(4)의 선단에는, 조작체로서의 암(5)이 장착되고, 암(5)의 선단에는 조작체로서의 엔드 어태치먼트인 버킷(6)이 장착되어 있다. 붐(4), 암(5) 및 버킷(6)은, 프론트 어태치먼트를 구성하며, 붐실린더(7), 암실린더(8), 및 버킷실린더(9)에 의하여 각각 유압 구동된다. 상부선회체(3)에는, 캐빈(10)이 마련되고, 또한 엔진 등의 동력원이 탑재된다.An upper revolving structure 3 is mounted on a lower traveling body 1 of a hydraulic type shovel via a revolving mechanism 2. A boom 4 as an operating body is mounted on the upper revolving structure 3. An arm 5 as an operating body is mounted on the front end of the boom 4 and a bucket 6 which is an end attachment as an operating body is mounted on the tip of the arm 5. [ The boom 4, the arm 5 and the bucket 6 constitute a front attachment and are hydraulically driven by the boom cylinder 7, the arm cylinder 8 and the bucket cylinder 9, respectively. In the upper revolving structure 3, a cabin 10 is provided, and a power source such as an engine is mounted.

도 2는, 도 1의 유압식 쇼벨의 구동계의 구성예를 나타내는 블록도이다. 도 2에 있어서, 기계적동력계는 이중선, 고압유압라인은 굵은 실선, 파일럿라인은 파선, 전기구동·제어계는 가는 실선으로 각각 나타나 있다.2 is a block diagram showing a configuration example of a drive system of the hydraulic type shovel of FIG. In Fig. 2, the mechanical dynamometer shows a double line, the high-pressure hydraulic line shows a bold solid line, the pilot line shows a broken line, and the electric drive and control system shows a thin solid line.

기계식 구동부로서의 엔진(11)의 출력축으로는, 유압펌프로서 메인펌프(14) 및 파일럿펌프(15)가 접속되어 있다. 메인펌프(14)에는, 고압유압라인(16)을 통하여 컨트롤밸브(17)가 접속되어 있다. 또한, 메인펌프(14)는, 펌프 1회전당 토출유량이 레귤레이터(14A)에 의하여 제어되는 가변용량형 유압펌프이다.A main pump 14 and a pilot pump 15 are connected to the output shaft of the engine 11 as a mechanical drive unit as a hydraulic pump. A control valve 17 is connected to the main pump 14 via a high-pressure hydraulic line 16. The main pump 14 is a variable displacement type hydraulic pump in which the discharge flow rate per one rotation of the pump is controlled by the regulator 14A.

컨트롤밸브(17)는, 유압식 쇼벨에 있어서의 유압계의 제어를 행하는 유압제어장치이다. 하부주행체(1)용의 유압모터(1A(우측용) 및 1B(좌측용)), 붐실린더(7), 암실린더(8), 및 버킷실린더(9)는, 고압유압라인을 통하여 컨트롤밸브(17)에 접속된다. 또한, 파일럿펌프(15)에는, 파일럿라인(25)을 통하여 조작장치(26)가 접속된다.The control valve 17 is a hydraulic pressure control device for controlling the hydraulic system of the hydraulic type shovel. The hydraulic motors 1A (for the right side) and 1B (for the left side) for the lower traveling body 1, the boom cylinder 7, the arm cylinder 8 and the bucket cylinder 9 are controlled via the high- And is connected to the valve 17. An operating device 26 is connected to the pilot pump 15 through a pilot line 25. [

조작장치(26)는, 레버(26A), 레버(26B), 페달(26C)을 포함한다. 레버(26A), 레버(26B), 및 페달(26C)은, 유압라인((27) 및 (28))을 통하여, 컨트롤밸브(17) 및 압력센서(29)에 각각 접속된다. 압력센서(29)는, 전기계의 구동제어를 행하는 컨트롤러(30)에 접속되어 있다.The operating device 26 includes a lever 26A, a lever 26B, and a pedal 26C. The lever 26A, the lever 26B and the pedal 26C are connected to the control valve 17 and the pressure sensor 29 via the hydraulic lines 27 and 28, respectively. The pressure sensor 29 is connected to a controller 30 that performs drive control of the electric machine.

다만, 본 실시예에서는, 각 조작체의 자세를 검지하기 위한 자세센서가 각 조작체에 장착되어 있다. 구체적으로는, 붐(4)의 경사각도를 검출하기 위한 붐각도센서(4S)가 붐(4)의 지지축에 장착되어 있다. 또한, 암(5)의 개폐각도를 검출하기 위한 암각도센서(5S)가 암(5)의 지지축에 장착되며, 버킷(6)의 개폐각도를 검출하기 위한 버킷각도센서(6S)가 버킷(6)의 지지축에 장착되어 있다. 붐각도센서(4S)는, 검출한 붐각도를 컨트롤러(30)에 공급한다. 또한, 암각도센서(5S)는, 검출한 암 각도를 컨트롤러(30)에 공급하고, 버킷각도센서(6S)는, 검출한 버킷 각도를 컨트롤러(30)에 공급한다.However, in the present embodiment, an attitude sensor for detecting the attitude of each operating body is attached to each operating body. More specifically, a boom angle sensor 4S for detecting the inclination angle of the boom 4 is mounted on the support shaft of the boom 4. [ A rocking angle sensor 5S for detecting the opening and closing angle of the arm 5 is mounted on the support shaft of the arm 5 and a bucket angle sensor 6S for detecting the opening and closing angle of the bucket 6 is mounted on the bucket 6, (6). The boom angle sensor 4S supplies the detected boom angle to the controller 30. The rocking angle sensor 5S supplies the detected arm angle to the controller 30 and the bucket angle sensor 6S supplies the detected bucket angle to the controller 30. [

컨트롤러(30)는, 유압식 쇼벨의 구동제어를 행하는 주제어부로서의 쇼벨제어장치이다. 컨트롤러(30)는, CPU(Central Processing Unit) 및 내부메모리를 포함하는 연산처리장치로 구성되며, CPU가 내부메모리에 격납된 구동제어용의 프로그램을 실행함으로써 실현되는 장치이다.The controller (30) is a show control device as a main control unit that performs drive control of a hydraulic type shovel. The controller 30 is constituted by an arithmetic processing unit including a CPU (Central Processing Unit) and an internal memory, and is realized by a CPU executing a program for drive control stored in an internal memory.

다음으로, 도 3을 참조하면서, 본 발명의 실시예에 관한 제어방법에서 이용되는 삼차원 직교좌표계에 대하여 설명한다. 다만, 도 3의 F3A는, 유압식 쇼벨의 측면도이며, 도 3의 F3B는, 유압식 쇼벨의 상면도이다.Next, a three-dimensional rectangular coordinate system used in the control method according to the embodiment of the present invention will be described with reference to FIG. F3A in Fig. 3 is a side view of the hydraulic type shovel, and F3B in Fig. 3 is a top view of the hydraulic type shovel.

F3A 및 F3B에 나타내는 바와 같이, 삼차원 직교좌표계의 Z축은, 유압식 쇼벨의 선회축(PC)에 상당하고, 삼차원 직교좌표계의 원점(O)은, 선회축(PC)과 유압식 쇼벨의 설치면과의 교점에 상당한다.The Z-axis of the three-dimensional rectangular coordinate system corresponds to the pivot axis PC of the hydraulic type shovel and the origin O of the three-dimensional rectangular coordinate system corresponds to the pivot axis PC and the mounting surface of the hydraulic type shovel, as shown in F3A and F3B Corresponds to the intersection.

또한, Z축과 직교하는 X축은, 프론트 어태치먼트의 연장방향으로 뻗고, 마찬가지로 Z축과 직교하는 Y축은, 프론트 어태치먼트의 연장방향에 수직인 방향으로 뻗는다. 즉, X축 및 Y축은, 유압식 쇼벨의 선회와 함께 Z축 둘레를 회전한다. 다만, 유압식 쇼벨의 선회각도(θ)는, F3B에 나타내는 바와 같은 상면에서 볼 때, X축에 대하여 반시계 방향을 플러스방향으로 한다.The X-axis orthogonal to the Z-axis extends in the extending direction of the front attachment, and the Y-axis orthogonal to the Z-axis extends in the direction perpendicular to the extending direction of the front attachment. That is, the X axis and the Y axis rotate about the Z axis together with the rotation of the hydraulic type shovel. However, the turning angle (?) Of the hydraulic type shovel has a positive direction in the counterclockwise direction with respect to the X-axis when viewed from the upper surface as shown in F3B.

또한, F3A에 나타내는 바와 같이, 상부선회체(3)에 대한 붐(4)의 장착위치는, 붐회전축으로서의 붐핀의 위치인 붐핀위치(P1)로 나타난다. 마찬가지로, 붐(4)에 대한 암(5)의 장착위치는, 암회전축으로서의 암핀의 위치인 암핀위치(P2)로 나타난다. 또한, 암(5)에 대한 버킷(6)의 장착위치는, 버킷회전축으로서의 버킷핀의 위치인 버킷핀위치(P3)로 나타난다. 또한, 버킷(6)의 선단위치는 버킷 선단위치(P4)로 나타난다.As shown in F3A, the mounting position of the boom 4 relative to the upper swivel body 3 is represented by the boom pin position P1, which is the position of the boom pin as the boom rotary shaft. Similarly, the mounting position of the arm 5 with respect to the boom 4 is indicated by the arm pin position P2, which is the position of the arm pin as the arm rotation shaft. The mounting position of the bucket 6 with respect to the arm 5 is indicated by the bucket pin position P3, which is the position of the bucket pin as the bucket rotation axis. The tip end position of the bucket 6 is indicated by the bucket tip end position P4.

또한, 붐핀위치(P1)와 암핀위치(P2)를 연결하는 선분(SG1)의 길이는 붐길이로서 소정치(L1)로 나타나고, 암핀위치(P2)와 버킷핀위치(P3)를 연결하는 선분(SG2)의 길이는 암길이로서 소정치(L2)로 나타나며, 버킷핀위치(P3)와 버킷 선단위치(P4)를 연결하는 선분(SG3)의 길이는 버킷길이로서 소정치(L3)로 나타난다.The length of the line segment SG1 connecting the boom pin position P1 and the arm pin position P2 is expressed by a predetermined value L 1 as a boom length and is defined by connecting the arm pin position P2 and the bucket pin position P3 The length of the line segment SG2 is represented by a predetermined length L 2 and the length of the line segment SG 3 connecting the bucket pin position P 3 and the bucket tip end position P 4 is set to a predetermined value L 3 ).

또한, 선분(SG1)과 수평면과의 사이에 형성되는 각도는 대지각(對地角)(β1)으로 나타나고, 선분(SG2)과 수평면과의 사이에 형성되는 각도는 대지각(β2)으로 나타나며, 선분(SG3)과 수평면과의 사이에 형성되는 각도는 대지각(β3)으로 나타난다. 다만, 이하에서는, 대지각(β1, β2, β3)을 각각 붐회전각도, 암회전각도, 버킷회전각도라고도 칭한다.An angle formed between the line segment SG1 and the horizontal plane is represented by a large angle? 1 and an angle formed between the line segment SG2 and the horizontal plane is represented by a large angle? 2 . , And an angle formed between the line segment SG3 and the horizontal plane is represented by a large perception angle? 3 . Hereinafter, the large crustal angles? 1 ,? 2 ,? 3 are also referred to as boom rotation angle, arm rotation angle, and bucket rotation angle, respectively.

여기에서, 붐핀위치(P1)의 삼차원좌표를 (X, Y, Z)=(H0X, 0, H0Z)로 하고, 버킷 선단위치(P4)의 삼차원좌표를 (X, Y, Z)=(Xe, Ye, Ze)로 하면, Xe, Ze는 각각 식(1) 및 식(2)로 나타난다. 다만, Xe 및 Ye는 엔드 어태치먼트의 평면위치를 나타내고, Ze는 엔드 어태치먼트의 높이를 나타낸다.Here, the three-dimensional coordinates of the bucket pin position P 1 are (X, Y, Z) = (H 0X , 0, H 0Z ) (Xe, Ye, Ze), Xe and Ze are expressed by the equations (1) and (2), respectively. Note that Xe and Ye denote the plane position of the end attachment, and Ze denotes the height of the end attachment.

Xe=H0X+L1cosβ1+L2cosβ2+L3cosβ3…(1) Xe = H 0X + L 1 cosβ 1 + L 2 cosβ 2 + L 3 cosβ 3 ... (One)

Ze=H0z+L1sinβ1+L2sinβ2+L3sinβ3…(2) Ze = H 0z + L 1 sinβ 1 + L 2 sinβ 2 + L 3 sinβ 3 ... (2)

다만, Ye는 0이 된다. 버킷 선단위치(P4)는, XZ평면 상에 존재하기 때문이다.However, Ye becomes 0. This is because the bucket tip position P4 exists on the XZ plane.

또한, 붐핀위치(P1)의 좌표치가 고정치이기 때문에, 대지각(β1, β2, 및 β3)이 정해지면, 버킷 선단위치(P4)의 좌표치가 명시적으로 결정된다. 마찬가지로, 대지각(β1)이 정해지면, 암핀위치(P2)의 좌표치가 명시적으로 결정되고, 대지각(β1 및β2)이 정해지면, 버킷핀위치(P3)의 좌표치가 명시적으로 결정된다.Since the coordinate values of the boom pin position P1 are fixed, when the large face angles? 1 ,? 2 , and? 3 are determined, the coordinate value of the bucket tip position P4 is explicitly determined. Likewise, when the large crank angle? 1 is determined, if the coordinate value of the arm pin position P2 is explicitly determined and the large crank angle? 1 and? 2 are determined, the coordinate value of the bucket pin position P3 becomes .

다음으로, 도 4를 참조하면서, 붐각도센서(4S), 암각도센서(5S), 및 버킷각도센서(6S)의 각각의 출력과 붐회전각도(β1), 암회전각도(β2), 및 버킷회전각도(β3)와의 관계에 대하여 설명한다. 다만, 도 4는, XZ평면에 있어서의 프론트 어태치먼트의 움직임을 설명하는 도이다.Next, with reference to Fig. 4, the respective outputs of the boom angle sensor 4S, the rocking angle sensor 5S, and the bucket angle sensor 6S, the boom rotation angle beta 1 , the arm rotation angle beta 2 , , And the bucket rotation angle? 3 will be described. 4 is a diagram for explaining the movement of the front attachment in the XZ plane.

도 4에 나타내는 바와 같이, 붐각도센서(4S)는 붐핀위치(P1)에 설치되고, 암각도센서(5S)는 암핀위치(P2)에 설치되며, 버킷각도센서(6S)는 버킷핀위치(P3)에 설치된다.4, the boom angle sensor 4S is installed at the boom pin position P1, the dark angle sensor 5S is installed at the arm position P2, and the bucket angle sensor 6S is located at the bucket pin position P3.

또한, 붐각도센서(4S)는, 선분(SG1)과 연직선과의 사이에 형성되는 각도(α1)를 검출하여 출력한다. 암각도센서(5S)는, 선분(SG1)의 연장선과 선분(SG2)과의 사이에 형성되는 각도(α2)를 검출하여 출력한다. 버킷각도센서(6S)는, 선분(SG2)의 연장선과 선분(SG3)과의 사이에 형성되는 각도(α3)를 검출하여 출력한다. 다만, 도 4에 있어서, 각도(α1)는, 선분(SG1)에 관하여 반시계 방향을 플러스방향으로 한다. 마찬가지로, 각도(α2)는, 선분(SG2)에 관하여 반시계 방향을 플러스방향으로 하고, 각도(α3)는, 선분(SG3)에 관하여 반시계 방향을 플러스방향으로 한다. 또한, 도 4에 있어서, 붐회전각도(β1), 암회전각도(β2), 버킷회전각도(β3)는, X축에 평행한 선에 관하여 반시계 방향을 플러스방향으로 한다.Further, the boom angle sensor 4S detects and outputs an angle? 1 formed between the line segment SG1 and the vertical line. The dark angle degree sensor 5S detects and outputs an angle? 2 formed between the extension line of the line segment SG1 and the line segment SG2. The bucket angle sensor 6S detects and outputs an angle? 3 formed between the extension line of the line segment SG2 and the line segment SG3. However, in Fig. 4, the angle? 1 is set to the positive direction in the counterclockwise direction with respect to the line segment SG1. Likewise, the angle? 2 is a positive direction in the counterclockwise direction with respect to the line segment SG2, and the angle? 3 is a positive direction in the counterclockwise direction with respect to the line segment SG3. In Fig. 4, the boom rotation angle beta 1 , the arm rotation angle beta 2 and the bucket rotation angle beta 3 are set in the counterclockwise direction with respect to the line parallel to the X axis.

이상의 관계로부터, 붐회전각도(β1), 암회전각도(β2), 버킷회전각도(β3)는, 각도(α1, α2, α3)를 이용하여 각각 식(3), 식(4), 식(5)로 나타난다.From the above relationship, the boom rotation angle (β 1), arm rotation angle (β 2), the bucket rotation angle (β 3), the angle (α 1, α 2, α 3), respectively the equation (3) using the formula (4) and (5), respectively.

β1=90-α1…(3)β 1 = 90-α 1 ... (3)

β21-α2=90-α1-α2…(4)? 2 =? 1 - ? 2 = 90 -? 1 - ? 2 ... (4)

β32-α3=90-α1-α2-α3…(5)β 3 = β 23 = 90-α 123 (5)

다만, 상기 서술과 같이, β1, β2, β3은, 수평면에 대한 붐(4), 암(5), 버킷(6)의 기울기로서 나타난다.However, as described above,? 1 ,? 2 ,? 3 appear as slopes of the boom 4, the arm 5, and the bucket 6 with respect to the horizontal plane.

따라서, 식(1)~식(5)를 이용하면, 각도(α1, α2, α3)가 정해지면, 붐회전각도(β1), 암회전각도(β2), 버킷회전각도(β3)가 명시적으로 결정되고, 또한, 버킷 선단위치(P4)의 좌표치가 명시적으로 결정된다. 마찬가지로, 각도(α1)가 정해지면, 붐회전각도(β1) 및 암핀위치(P2)의 좌표치가 명시적으로 결정되고, 각도(α1, α2)가 정해지면, 암회전각도(β2) 및 버킷핀위치(P3)의 좌표치가 명시적으로 결정된다.Therefore, when the angles (alpha 1 , alpha 2 , alpha 3 ) are determined using the equations (1) to (5), the boom rotation angle beta 1 , the arm rotation angle beta 2 , beta 3 ) is explicitly determined and the coordinate value of the bucket tip position P4 is explicitly determined. Similarly, when the angle? 1 is determined, the coordinate values of the boom rotation angle? 1 and the armature position P2 are explicitly determined, and when the angles? 1 and? 2 are determined, 2 and the bucket pin position P3 are explicitly determined.

다만, 붐각도센서(4S), 암각도센서(5S), 버킷각도센서(6S)는, 붐회전각도(β1), 암회전각도(β2), 버킷회전각도(β3)를 직접적으로 검출해도 된다. 이 경우, 식(3)~식(5)의 연산을 생략할 수 있다.It should be noted that the boom angle sensor 4S, the rocking angle sensor 5S and the bucket angle sensor 6S are arranged such that the boom rotation angle beta 1 , the arm rotation angle beta 2 and the bucket rotation angle beta 3 are directly May be detected. In this case, the operations of the equations (3) to (5) can be omitted.

다음으로, 도 5를 참조하면서, 본 발명의 실시예에 관한 쇼벨의 제어방법에서 이용되는 조작장치(26)에 대하여 설명한다. 다만, 도 5는, 캐빈(10) 내의 운전석의 상면사시도이며, 운전석의 좌측 전방에 레버(26A)가 배치되고, 운전석의 우측 전방에 레버(26B)가 배치된 상태를 나타낸다. 또한, 도 5의 F5A는, 통상모드일 때의 레버설정을 나타내고, 도 5의 F5B는, 자동고르기모드일 때의 레버설정을 나타낸다.Next, the operation device 26 used in the control method of the shovel according to the embodiment of the present invention will be described with reference to Fig. 5 is a top perspective view of the driver's seat in the cabin 10, showing a state in which the lever 26A is disposed on the left front of the driver's seat and the lever 26B is disposed on the right front of the driver's seat. F5A in Fig. 5 shows the lever setting in the normal mode, and F5B in Fig. 5 shows the lever setting in the automatic selecting mode.

구체적으로는, F5A의 통상모드에서는, 레버(26A)를 전방으로 젖히면 암(5)이 개방되고, 레버(26A)를 후방으로 젖히면 암(5)이 폐쇄된다. 또한, 레버(26A)를 좌측으로 젖히면 상부선회체(3)가 상면에서 볼 때에 반시계방향으로 좌선회하고, 레버(26A)를 우측으로 젖히면 상부선회체(3)가 상면에서 볼 때에 시계방향으로 우선회한다. 또한, 레버(26B)를 전방으로 젖히면 붐(4)이 하강하고, 레버(26B)를 후방으로 젖히면 붐(4)이 상승한다. 또한, 레버(26B)를 좌측으로 젖히면 버킷(6)이 폐쇄되고, 레버(26B)를 우측으로 젖히면 버킷(6)이 개방된다.Specifically, in the normal mode of F5A, the arm 5 is opened when the lever 26A is turned forward, and the arm 5 is closed when the lever 26A is turned backward. When the lever 26A is turned to the left, the upper swivel body 3 turns leftward in the counterclockwise direction when viewed from the upper surface. When the lever 26A is turned to the right, when the upper swivel body 3 is viewed from the upper side, . Further, when the lever 26B is turned forward, the boom 4 descends, and when the lever 26B is turned backward, the boom 4 rises. When the lever 26B is turned to the left, the bucket 6 is closed. When the lever 26B is turned to the right, the bucket 6 is opened.

한편, F5B의 자동고르기모드에서는, 레버(26A)를 전방으로 젖히면 버킷 선단위치(P4)의 X좌표 및 Y좌표의 값을 불변으로 하면서 Z좌표의 값이 감소하도록 붐(4) 및 암(5)의 적어도 일방이 움직인다. 다만, 버킷(6)이 움직여도 된다. 또한, 레버(26A)를 후방으로 젖히면 버킷 선단위치(P4)의 X좌표 및 Y좌표의 값을 불변으로 하면서 Z좌표의 값이 증대하도록 붐(4) 및 암(5)의 적어도 일방이 움직인다. 다만, 버킷(6)이 움직여도 된다. 이하에서는, 레버(26A)의 전후방향으로의 조작, 즉, 엔드 어태치먼트로서의 버킷(6)의 Z방향조작에 따라 실행되는 제어를 "Z방향 이동제어" 또는 "높이제어"라고 한다. 다만, 레버(26A)의 좌우방향으로의 조작은 통상모드의 경우와 동일하다.On the other hand, in the F5B automatic selecting mode, when the lever 26A is turned forward, the values of the Z coordinate are decreased while the values of the X coordinate and Y coordinate of the bucket tip position P4 are made unchanged, At least one of them moves. However, the bucket 6 may be moved. At least one of the boom 4 and the arm 5 is moved such that the value of the Z coordinate is increased while the value of the X coordinate and the Y coordinate of the bucket tip position P4 are made unchanged when the lever 26A is turned backward. However, the bucket 6 may be moved. Hereinafter, the control performed in the forward and backward directions of the lever 26A, that is, the control performed in accordance with the Z directional manipulation of the bucket 6 as the end attachment is referred to as "Z directional motion control" However, the operation of the lever 26A in the left-right direction is the same as that in the normal mode.

또한, F5B의 자동고르기모드에서는, 레버(26B)를 전방으로 젖히면 버킷 선단위치(P4)의 Y좌표 및 Z좌표의 값을 불변으로 하면서 X좌표의 값이 증대하도록 붐(4) 및 암(5)의 적어도 일방이 움직인다. 다만, 버킷(6)이 움직여도 된다. 또한, 레버(26B)를 후방으로 젖히면 버킷 선단위치(P4)의 Y좌표 및 Z좌표의 값을 불변으로 하면서 X좌표의 값이 감소하도록 붐(4) 및 암(5)의 적어도 일방이 움직인다. 다만, 버킷(6)이 움직여도 된다. 이하에서는, 레버(26B)의 전후방향으로의 조작, 즉, 엔드 어태치먼트로서의 버킷(6)의 X방향조작에 따라 실행되는 제어를 "X방향 이동제어" 또는 "평면위치제어"라고 한다.When the lever 26B is turned forward, the values of the Y coordinate and the Z coordinate of the bucket tip end position P4 are made unchanged and the value of the X coordinate is increased so that the boom 4 and the arm 5 At least one of them moves. However, the bucket 6 may be moved. At least one of the boom 4 and the arm 5 is moved such that the value of the X coordinate decreases while the value of the Y coordinate and the Z coordinate of the bucket tip position P4 are made unchanged when the lever 26B is turned backward. However, the bucket 6 may be moved. Hereinafter, the control performed in the forward and backward directions of the lever 26B, that is, the control performed in accordance with the operation of the bucket 6 in the X direction as the end attachment is referred to as "X direction movement control" or "plane position control".

또한, F5B의 자동고르기모드에서는, 레버(26B)를 좌측으로 젖히면 버킷회전각도(β3)가 증대하고, 레버(26B)를 우측으로 젖히면 버킷회전각도(β3)가 감소한다. 즉, 레버(26B)를 좌측으로 젖히면 버킷(6)이 폐쇄되고, 레버(26B)를 우측으로 젖히면 버킷(6)이 개방된다. 이와 같이, 레버(26B)의 좌우방향으로의 조작에 의하여 야기되는 버킷(6)의 움직임은, 통상모드의 경우와 같다. 그러나, 통상모드에서는 레버조작량에 대응하는 유량의 작동유를 버킷실린더(9)에 공급함으로써 버킷(6)을 움직이는데 반하여, 자동고르기모드에서는 레버조작량에 대응하는 버킷회전각도(β3)의 목표치를 결정함으로써 버킷(6)을 움직이는 점에서 상이하다. 또한, 자동고르기모드에서의 제어의 상세에 대해서는 후술된다.When the lever 26B is turned to the left side, the bucket rotation angle beta 3 is increased. When the lever 26B is turned to the right side, the bucket rotation angle beta 3 is decreased in the F5B automatic selection mode. That is, when the lever 26B is turned to the left, the bucket 6 is closed, and when the lever 26B is turned to the right, the bucket 6 is opened. Thus, the movement of the bucket 6 caused by the operation of the lever 26B in the left-right direction is the same as in the case of the normal mode. In the normal mode, on the other hand, the target value of the bucket rotation angle [beta] 3 corresponding to the lever manipulated variable is determined while the bucket 6 is moved by supplying the operating fluid of the flow rate corresponding to the lever manipulated variable to the bucket cylinder 9. [ So that the bucket 6 is moved. Details of the control in the automatic grading mode will be described later.

도 6은, 자동고르기모드에 있어서 레버조작을 행한 경우의 처리의 흐름을 나타내는 플로우차트이다.Fig. 6 is a flowchart showing the flow of processing when lever operation is performed in the automatic selecting mode.

먼저, 컨트롤러(30)는, 캐빈(10) 내의 운전석 부근에 설치되는 모드전환스위치에 있어서 자동고르기모드가 선택되었는지 아닌지를 판단한다(스텝 S1).First, the controller 30 determines whether or not the automatic selection mode is selected in the mode changeover switch provided near the driver's seat in the cabin 10 (step S1).

자동고르기모드가 선택되었다고 판단한 경우(스텝 S1의 YES), 컨트롤러(30)는, 레버조작량을 검출한다(스텝 S2).If it is determined that the automatic selecting mode has been selected (YES in step S1), the controller 30 detects the lever operation amount (step S2).

구체적으로는, 컨트롤러(30)는, 예를 들면, 압력센서(29)의 출력에 근거하여 레버(26A, 26B)의 조작량을 검출한다.Specifically, the controller 30 detects the manipulated variables of the levers 26A and 26B based on the output of the pressure sensor 29, for example.

그 후, 컨트롤러(30)는, X방향조작이 행해졌는지 아닌지를 판단한다(스텝 S3). 구체적으로는, 컨트롤러(30)는, 레버(26B)의 전후방향으로의 조작이 행해졌는지 아닌지를 판단한다.Thereafter, the controller 30 determines whether or not the X-directional operation has been performed (step S3). Specifically, the controller 30 determines whether or not the operation in the forward and backward directions of the lever 26B has been performed.

X방향조작이 행해졌다고 판단한 경우(스텝 S3의 YES), 컨트롤러(30)는, X방향 이동제어(평면위치제어)를 실행한다(스텝 S4).If it is determined that the X direction operation has been performed (YES in step S3), the controller 30 executes the X direction movement control (the plane position control) (step S4).

X방향조작이 행해지지 않았다고 판단한 경우(스텝 S3의 NO), 컨트롤러(30)는, Z방향조작이 행해졌는지 아닌지를 판단한다(스텝 S5). 구체적으로는, 컨트롤러(30)는, 레버(26A)의 전후방향으로의 조작이 행해졌는지 아닌지를 판단한다.If it is determined that the X directional operation has not been performed (NO in step S3), the controller 30 determines whether or not the Z directional operation has been performed (step S5). Specifically, the controller 30 determines whether or not an operation in the forward and backward directions of the lever 26A has been performed.

Z방향조작이 행해졌다고 판단한 경우(스텝 S5의 YES), 컨트롤러(30)는, Z방향 이동제어(높이제어)를 실행한다(스텝 S6).When it is determined that the Z direction operation has been performed (YES in step S5), the controller 30 executes Z direction movement control (height control) (step S6).

Z방향조작이 행해지지 않았다고 판단한 경우(스텝 S5의 NO), 컨트롤러(30)는, θ방향조작이 행해졌는지 아닌지를 판단한다(스텝 S7). 구체적으로는, 컨트롤러(30)는, 레버(26A)의 좌우방향으로의 조작이 행해졌는지 아닌지를 판단한다.When it is determined that the Z direction operation has not been performed (NO in step S5), the controller 30 determines whether or not the operation in the [theta] direction has been performed (step S7). Specifically, the controller 30 determines whether or not an operation in the left-right direction of the lever 26A has been performed.

θ방향조작이 행해졌다고 판단한 경우(스텝 S7의 YES), 컨트롤러(30)는, 선회동작을 실행한다(스텝 S8).When it is determined that the operation in the [theta] direction has been performed (YES in step S7), the controller 30 executes the turning operation (step S8).

θ방향조작이 행해지지 않았다고 판단한 경우(스텝 S7의 NO), 컨트롤러(30)는, β3방향조작이 행해졌는지 아닌지를 판단한다(스텝 S9). 구체적으로는, 컨트롤러(30)는, 레버(26B)의 좌우방향으로의 조작이 행해졌는지 아닌지를 판단한다.If it is determined that the operation in the [theta] direction has not been performed (NO in step S7), the controller 30 determines whether or not the operation in the [beta] 3 direction has been performed (step S9). Specifically, the controller 30 determines whether or not an operation in the left-right direction of the lever 26B has been performed.

β3방향조작이 행해졌다고 판단한 경우(스텝 S9의 YES), 컨트롤러(30)는, 버킷 개폐동작을 실행한다(스텝 S10).If it is determined that the 3- way operation has been performed (YES in step S9), the controller 30 executes the bucket opening / closing operation (step S10).

다만, 도 6에 나타내는 제어의 흐름은, X방향조작, Z방향조작, θ방향조작, 및 β3방향조작 중 1개가 실행되는 단독 조작의 경우의 것이지만, 4개의 조작 중 복수의 조작이 동시에 실행되는 복합조작의 경우에도 마찬가지로 적용될 수 있다. 예를 들면, X방향 이동제어, Z방향 이동제어, 선회동작, 및 버킷 개폐동작 중 복수의 제어가 동시에 실행되어도 된다.However, the flow of control shown in Fig. 6 is the case of a single operation in which one of the X direction operation, the Z direction operation, the? Direction operation, and the? 3 direction operation is executed, But also in the case of the combined operation. For example, a plurality of controls during the X-direction movement control, the Z-direction movement control, the swing operation, and the bucket opening / closing operation may be simultaneously executed.

다음으로, 도 7 및 도 8을 참조하면서, X방향 이동제어(평면위치제어)의 상세에 대하여 설명한다. 다만, 도 7 및 도 8은, X방향 이동제어의 흐름을 나타내는 블록도이다.Next, the details of the X-direction movement control (plane position control) will be described with reference to Figs. 7 and 8. Fig. However, Figs. 7 and 8 are block diagrams showing the flow of X-direction movement control.

레버(26B)로 X방향조작이 행해지면, 컨트롤러(30)는, 도 7에 나타내는 바와 같이, 레버(26B)의 X방향조작에 따라 버킷 선단위치(P4)의 X축방향에 있어서의 변위를 오픈제어한다. 구체적으로는, 컨트롤러(30)는, 예를 들면, 버킷 선단위치(P4)의 이동 후의 X좌표의 값으로서 지령치(Xer)를 생성한다. 보다 구체적으로는, 컨트롤러(30)는, X방향 지령치생성부(CX)를 이용하여, 레버(26B)의 레버조작량(Lx)에 따른 X방향 지령치(Xer)를 생성한다. X방향 지령치생성부(CX)는, 예를 들면, 미리 등록된 테이블 등을 이용하여 레버조작량(Lx)으로부터 X방향 지령치(Xer)를 도출한다. 또한, X방향 지령치생성부(CX)는, 예를 들면, 레버(26B)의 조작량이 클수록, 버킷 선단위치(P4)의 이동 전의 X좌표의 값(Xe)과 이동 후의 X좌표의 값(Xer)과의 차(ΔXe)가 커지도록 값(Xer)을 생성한다. 다만, 컨트롤러(30)는, 레버(26B)의 조작량에 관계없이 ΔXe가 일정해지도록 값(Xer)을 생성해도 된다. 또한, 버킷 선단위치(P4)의 Y좌표 및 Z좌표의 값은 이동의 전후로 불변이다.When the X-directional operation is performed by the lever 26B, the controller 30 calculates the displacement in the X-axis direction of the bucket tip end position P4 in accordance with the X-directional operation of the lever 26B as shown in Fig. Open control. Specifically, the controller 30 generates the command value Xer as the value of the X-coordinate after movement of the bucket tip end position P4, for example. More specifically, the controller 30 generates the X-direction command value Xer in accordance with the lever operation amount Lx of the lever 26B by using the X-direction command value generation unit CX. The X-direction command value generator CX derives the X-direction command value Xer from the lever manipulated variable Lx using, for example, a previously registered table or the like. The larger the manipulated variable of the lever 26B is, for example, the larger the manipulated variable of the lever 26B, the smaller the value Xe of the X coordinate before movement of the bucket tip position P4 and the value Xer of the moved X coordinate Quot; Xe ") is increased. However, the controller 30 may generate the value Xer such that? Xe is constant regardless of the operation amount of the lever 26B. In addition, the values of the Y coordinate and the Z coordinate of the bucket tip position P4 are unchanged before and after the movement.

그 후, 컨트롤러(30)는, 생성한 지령치(Xer)에 근거하여, 붐회전각도(β1), 암회전각도(β2), 및 버킷회전각도(β3)의 각각의 지령치(β1r, β2r, β3r)를 생성한다.Thereafter, the controller 30 calculates the respective set values β 11 , β 2 ) of the boom rotation angle β 1 , the arm rotation angle β 2 and the bucket rotation angle β 3 based on the generated command value Xer and generates r, β r 2, r 3 β).

구체적으로는, 컨트롤러(30)는, 상기 서술한 식(1) 및 식(2)를 이용하여 지령치(β1r, β2r, β3r)를 생성한다. 버킷 선단위치(P4)의 X좌표 및 Z좌표의 값(Xe, Ze)은, 식(1) 및 식(2)에 나타낸 바와 같이, 붐회전각도(β1), 암회전각도(β2), 및 버킷회전각도(β3)의 함수이다. 또한, 버킷 선단위치(P4)의 이동 후의 Z좌표의 값(Zer)에는 현재치가 그대로 이용된다. 이로 인하여, 버킷회전각도(β3)의 지령치(β3r)를 현재치인 채로 하면, 식(1)의 Xe에는 생성된 지령치(Xer)가 대입되고, β3에는 현재치가 그대로 대입된다. 또한, 식(2)의 Ze에는 현재치가 그대로 대입되고, β3에도 현재치가 그대로 대입된다. 그 결과, 2개의 미지수(β1, β2)를 포함하는 식(1) 및 식(2)의 연립 방정식을 푸는 것에 의하여, 붐회전각도(β1) 및 암회전각도(β2)의 값이 도출된다. 컨트롤러(30)는, 이러한 도출된 값을 지령치(β1r, β2r)로 한다.Specifically, the controller 30 generates the command values (? 1 r,? 2 r,? 3 r) by using the above-described equations (1) and (2). The X coordinate and the Z coordinate value Xe and Ze of the bucket tip position P4 are obtained by the boom rotation angle beta 1 and the arm rotation angle beta 2 as shown in the formulas (1) and ( 2 ) , And bucket rotation angle ( 3 ). Further, the current value is used as it is for the Z-coordinate value Zer after the bucket tip end position P4 has moved. Therefore, when the current command value β 3 r of the bucket rotation angle β 3 is kept at the current value, the generated command value Xer is substituted into Xe in the equation (1), and the current value is substituted into the value β 3 as it is. In the equation (2), Ze is substituted for the current value as it is, and the current value is substituted for β 3 as it is. As a result, by solving the simultaneous equations of equations (1) and (2) including two unknowns (β 1 , β 2 ), the values of the boom rotation angle β 1 and the arm rotation angle β 2 . The controller 30 sets these derived values as command values (? 1 r,? 2 r).

그 후, 컨트롤러(30)는, 도 8에 나타내는 바와 같이, 붐회전각도(β1), 암회전각도(β2), 및 버킷회전각도(β3)의 각각의 값이, 생성된 지령치(β1r, β2r, β3r)가 되도록 붐(4), 암(5), 및 버킷(6)을 동작시킨다. 다만, 컨트롤러(30)는, 식(3)~식(5)를 이용하여, 지령치(β1r, β2r, β3r)에 대응하는 지령치(α1r, α2r, α3r)를 도출해도 된다. 그리고, 컨트롤러(30)는, 붐각도센서(4S), 암각도센서(5S), 버킷각도센서(6S)의 출력인 각도(α1, α2, α3)가, 도출된 지령치(α1r, α2r, α3r)가 되도록 붐(4), 암(5), 및 버킷(6)을 동작시켜도 된다.8, each value of the boom rotation angle beta 1 , the arm rotation angle beta 2 and the bucket rotation angle beta 3 is set to a predetermined value the arm 5, and the bucket 6 are operated so that the buckets 4, 6 1 r, 2 2 r, and 3 3 r. However, the controller 30, the equation (3) to (5) using, command values (β 1 r, β 2 r, β 3 r) command value (α 1 r, α 2 r, α 3 corresponding to r) may be derived. The controller 30 determines whether or not the angles alpha 1 , alpha 2 and alpha 3 which are the outputs of the boom angle sensor 4S, the dark angle sensor 5S and the bucket angle sensor 6S satisfy the derived command value alpha 1 the r, 2 α r, α r 3) is a boom 4, arm 5 and bucket 6, even if the operation to be.

구체적으로는, 컨트롤러(30)는, 붐회전각도(β1)의 현재치와 지령치(β1r)와의 차(Δβ1)에 대응하는 붐실린더 파일럿압 지령을 생성한다. 그리고, 붐실린더 파일럿압 지령에 대응하는 제어전류를 붐전자비례밸브에 대해서 출력한다. 붐전자비례밸브는, 자동고르기모드에서는, 붐실린더 파일럿압 지령에 대응하는 제어전류에 따른 파일럿압을 붐제어밸브에 대해서 출력한다. 다만, 붐전자비례밸브는, 통상모드에서는, 레버(26B)의 전후방향으로의 조작량에 따른 파일럿압을 붐제어밸브에 대해서 출력한다.Specifically, the controller 30 generates the current value and the boom cylinder pilot pressure command corresponding to the difference (Δβ 1) with the command value (β r 1) of the boom rotation angle (β 1). Then, a control current corresponding to the boom cylinder pilot pressure command is outputted to the boom electromotive proportional valve. In the automatic selecting mode, the boom electromagnetic proportional valve outputs a pilot pressure corresponding to the control current corresponding to the boom cylinder pilot pressure command to the boom control valve. However, in the normal mode, the boom electromagnetic proportional valve outputs a pilot pressure corresponding to the operation amount in the forward and backward directions of the lever 26B to the boom control valve.

그 후, 붐전자비례밸브로부터의 파일럿압을 받은 붐제어밸브는, 메인펌프(14)가 토출하는 작동유를, 파일럿압에 대응하는 흐름방향 및 유량으로 붐실린더(7)에 공급한다. 붐실린더(7)는, 붐제어밸브를 통하여 공급되는 작동유에 의하여 신축한다. 붐각도센서(4S)는, 신축하는 붐실린더(7)에 의하여 움직이는 붐(4)의 각도(α1)를 검출한다.Thereafter, the boom control valve, which has received the pilot pressure from the boom electromagnetic proportional valve, supplies the operating fluid discharged from the main pump 14 to the boom cylinder 7 in the flow direction and flow rate corresponding to the pilot pressure. The boom cylinder 7 is expanded and contracted by operating oil supplied through the boom control valve. The boom angle sensor 4S detects the angle? 1 of the boom 4 moving by the expanding and shrinking boom cylinder 7.

그 후, 컨트롤러(30)는, 붐각도센서(4S)가 검출한 각도(α1)를 식(3)에 대입하여 붐회전각도(β1)를 산출한다. 그리고, 붐실린더 파일럿압 지령을 생성할 때에 이용하는 붐회전각도(β1)의 현재치로서, 산출한 값을 피드백한다.Thereafter, the controller 30 substitutes the angle? 1 detected by the boom angle sensor 4S into the equation (3) to calculate the boom rotation angle? 1 . The calculated value is fed back as the current value of the boom rotation angle (? 1 ) used when generating the boom cylinder pilot pressure command.

다만, 상기 서술한 설명은, 지령치(β1r)에 근거하는 붐(4)의 동작에 관한 것이지만, 지령치(β2r)에 근거하는 암(5)의 동작, 및, 지령치(β3r)에 근거하는 버킷(6)의 동작에도 마찬가지로 적용 가능하다. 이로 인하여, 지령치(β2r)에 근거하는 암(5)의 동작, 및, 지령치(β3r)에 근거하는 버킷(6)의 동작의 흐름에 대해서는 그 설명을 생략한다.It should be noted that the above description relates to the operation of the boom 4 based on the command value beta 1 r but the operation of the arm 5 based on the command value beta 2 r and the operation of the command value beta 3 r The operation of the bucket 6 based on the buckets 6 is also applicable. For this reason, the description thereof is omitted for the flow of an operation of the bucket (6) based on the operation, and a command value (β r 3) of the arm 5 based on the command value (β r 2).

또한, 컨트롤러(30)는, 도 7에 나타내는 바와 같이, 펌프토출량도출부(CP1, CP2, CP3)를 이용하여, 지령치(β1r, β2r, β3r)로부터 펌프토출량을 도출한다. 본 실시예에서는, 펌프토출량도출부(CP1, CP2, CP3)는, 미리 등록된 테이블 등을 이용하여 지령치(β1r, β2r, β3r)로부터 펌프토출량을 도출한다. 펌프토출량도출부(CP1, CP2, CP3)가 도출한 펌프토출량은 합계되어, 합계펌프토출량으로서 펌프유량연산부에 입력된다. 펌프유량연산부는, 입력된 합계펌프토출량에 근거하여 메인펌프(14)의 토출량을 제어한다. 본 실시예에서는, 펌프유량연산부는, 합계펌프토출량에 따라 메인펌프(14)의 사판경전각(斜板傾轉角)을 변경함으로써 메인펌프(14)의 토출량을 제어한다.As it is shown in Figure 7 the controller 30, using a pump discharge amount derivation unit (CP1, CP2, CP3), to derive the pump discharge amount from the reference value (β 1 r, β 2 r, β 3 r) . In this embodiment, the pump flow rate derived portions (CP1, CP2, CP3) is to derive a pump discharge amount from the reference value (β r 1, r 2 β, 3 β r) by using a table registered in advance. The pump discharge amounts derived by the pump discharge amount derivation units CP1, CP2, and CP3 are summed and input to the pump flow rate calculation unit as the total pump discharge amount. The pump flow rate calculation section controls the discharge amount of the main pump 14 based on the input total pump discharge flow rate. In this embodiment, the pump flow rate calculation unit controls the discharge amount of the main pump 14 by changing the swash plate inclination angle of the main pump 14 in accordance with the total pump discharge amount.

그 결과, 컨트롤러(30)는, 붐제어밸브, 암제어밸브, 버킷제어밸브의 개구제어와 메인펌프(14)의 토출량의 제어를 실행함으로써, 붐실린더(7), 암실린더(8), 버킷실린더(9)에 적절한 양의 작동유를 분배할 수 있다.As a result, the controller 30 controls the opening of the boom control valve, the arm control valve, and the bucket control valve and the control of the discharge amount of the main pump 14 so that the boom cylinder 7, the arm cylinder 8, It is possible to distribute an appropriate amount of working oil to the cylinder (9).

이와 같이, 컨트롤러(30)는, 지령치(Xer)의 생성, 지령치(β1r, β2r, 및 β3r)의 생성, 메인펌프(14)의 토출량의 제어, 및, 각도센서(4S, 5S, 6S)의 출력에 근거하는 조작체(4, 5, 6)의 피드백제어를 1 제어사이클로 하여, 이 제어사이클을 반복함으로써, 버킷 선단위치(P4)의 X방향 이동제어를 행한다.Thus, the controller 30 generates a command value (Xer), reference value (β 1 r, β 2 r, and β 3 r) controlling the amount of ejection of the product, the main pump (14) of, and, the angle sensor (4S 5, and 6 based on the output of the bucket tip position P4, 5S, and 6S is set as one control cycle, and this control cycle is repeated to perform the X-direction movement control of the bucket tip position P4.

또한, 상기 서술한 설명에서는, 버킷회전각도(β3)의 지령치(β3r)로서 버킷회전각도(β3)의 현재치가 그대로 이용되고 있다. 그러나, 암회전각도(β2)의 값에 따라 명시적으로 정해지는 값, 예를 들면, 암회전각도(β2)의 값에 고정치를 더한 값이 버킷회전각도(β3)의 지령치(β3r)로서 이용되어도 된다.Further, in the above-mentioned description, the command value of the bucket rotation angle (β 3) (β 3 r ) is the current value of the bucket rotation angle (β 3) used as it is as. However, the arm command value of the rotation angle (β 2) the value, for which explicitly determined according to the value g., Arm rotation angle (β 2), the value and the value obtained by adding the value bucket rotation angle (β 3) of the ( beta 3 r).

또한, X방향 이동제어에서는 버킷 선단위치(P4)의 Y좌표 및 Z좌표를 고정으로 하면서 버킷 선단위치(P4)의 X좌표의 변위가 오픈제어된다. 그러나, 버킷핀위치(P3)의 Y좌표 및 Z좌표를 고정으로 하면서 버킷핀위치(P3)의 X좌표의 변위가 오픈제어되어도 된다. 이 경우, 지령치(β3r)의 생성 및 버킷(6)의 제어는 생략된다.Further, in the X direction movement control, the displacement of the X coordinate of the bucket tip end position P4 is controlled open while the Y coordinate and Z coordinate of the bucket tip end position P4 are fixed. However, the displacement of the X coordinate of the bucket pin position P3 may be open-controlled while the Y coordinate and the Z coordinate of the bucket pin position P3 are fixed. In this case, generation of the command value? 3 r and control of the bucket 6 are omitted.

다음으로, 도 9 및 도 10을 참조하면서, Z방향 이동제어(높이제어)의 상세에 대하여 설명한다. 다만, 도 9 및 도 10은, Z방향 이동제어의 흐름을 나타내는 블록도이다.Next, details of the Z-direction movement control (height control) will be described with reference to Figs. 9 and 10. Fig. However, Figs. 9 and 10 are block diagrams showing the flow of Z-direction movement control.

레버(26A)로 Z방향조작이 행해지면, 컨트롤러(30)는, 도 9에 나타내는 바와 같이, 레버(26A)의 Z방향조작에 따라 버킷 선단위치(P4)의 Z축방향에 있어서의 변위를 오픈제어한다. 구체적으로는, 컨트롤러(30)는, 예를 들면, 버킷 선단위치(P4)의 이동 후의 Z좌표의 값으로서 지령치(Zer)를 생성한다. 보다 구체적으로는, 컨트롤러(30)는, Z방향 지령치생성부(CZ)를 이용하여, 레버(26A)의 조작량(Lz)에 따른 Z방향 지령치(Zer)를 생성한다. Z방향 지령치생성부(CZ)는, 예를 들면, 미리 등록된 테이블 등을 이용하여 레버조작량(Lz)으로부터 Z방향 지령치(Zer)를 도출한다. 또한, Z방향 지령치생성부(CZ)는, 예를 들면, 레버(26A)의 조작량이 클수록, 버킷 선단위치(P4)의 이동 전의 Z좌표의 값(Ze)과 이동 후의 Z좌표의 값(Zer)과의 차(ΔZe)가 커지도록 값(Zer)을 생성한다. 다만, 컨트롤러(30)는, 레버(26A)의 조작량에 관계없이 ΔZe가 일정해지도록 값(Zer)을 생성해도 된다. 또한, 버킷 선단위치(P4)의 X좌표 및 Y좌표의 값은 이동의 전후로 불변이다.When the Z-directional operation is performed by the lever 26A, the controller 30 calculates the displacement in the Z-axis direction of the bucket tip end position P4 in accordance with the Z-directional operation of the lever 26A as shown in Fig. Open control. Specifically, the controller 30 generates the command value Zer as the Z-coordinate value after the bucket tip end position P4 has been moved, for example. More specifically, the controller 30 generates the Z-direction command value Zer in accordance with the manipulated variable Lz of the lever 26A by using the Z-direction command value generator CZ. The Z-direction command value generator CZ derives the Z-direction command value Zer from the lever manipulated variable Lz using, for example, a previously registered table or the like. The Z-direction command value generation section CZ calculates the Z value of the Z-coordinate value before movement of the bucket tip end position P4 and the Z value of the Z-coordinate value after movement, for example, as the manipulated variable of the lever 26A is larger Zer is generated so that the difference? However, the controller 30 may generate the value Zer such that? Ze is constant regardless of the operation amount of the lever 26A. In addition, the values of the X coordinate and the Y coordinate of the bucket tip position P4 are unchanged before and after the movement.

그 후, 컨트롤러(30)는, 생성한 지령치(Zer)에 근거하여, 붐회전각도(β1), 암회전각도(β2), 및 버킷회전각도(β3)의 각각의 지령치(β1r, β2r, β3r)를 생성한다.Then, the controller 30, based on the generated command value (Zer), the boom rotation angle (β 1), arm rotation angle (β 2), and each command value of the bucket rotation angle (β 3)1 and generates r, β r 2, r 3 β).

구체적으로는, 컨트롤러(30)는, 상기 서술한 식(1) 및 식(2)를 이용하여 지령치(β1r, β2r, β3r)를 생성한다. 버킷 선단위치(P4)의 X좌표 및 Z좌표의 값(Xe, Ze)은, 식(1) 및 식(2)에 나타낸 바와 같이, 붐회전각도(β1), 암회전각도(β2), 및 버킷회전각도(β3)의 함수이다. 또한, 버킷 선단위치(P4)의 이동 후의 X좌표의 값(Xer)에는 현재치가 그대로 이용된다. 이로 인하여, 버킷회전각도(β3)의 지령치(β3r)를 현재치인 채로 하면, 식(1)의 Xe에는 현재치가 그대로 대입되고, β3에도 현재치가 그대로 대입된다. 또한, 식(2)의 Ze에는 생성된 지령치(Zer)가 대입되고, β3에는 현재치가 그대로 대입된다. 그 결과, 2개의 미지수(β1, β2)를 포함한 식(1) 및 식(2)의 연립 방정식을 푸는 것에 의하여, 붐회전각도(β1) 및 암회전각도(β2)의 값이 도출된다. 컨트롤러(30)는, 이들 도출된 값을 지령치(β1r, β2r)로 한다.Specifically, the controller 30 generates the command values (? 1 r,? 2 r,? 3 r) by using the above-described equations (1) and (2). The X coordinate and the Z coordinate value Xe and Ze of the bucket tip position P4 are obtained by the boom rotation angle beta 1 and the arm rotation angle beta 2 as shown in the formulas (1) and ( 2 ) , And bucket rotation angle ( 3 ). Further, the current value is used as it is for the X-coordinate value Xer after the bucket tip end position P4 has moved. Due to this, the bucket when the command value (β r 3) of the rotation angle (β 3) while the current hit by the formula (1) Xe has been assigned as the present value, to be present value is substituted as β 3. The generated command value Zer is substituted into Ze in the equation (2), and the current value is substituted into the value of? 3 as it is. The value of the result, two unknowns (β 1, β 2) expression, including (1) and (2) by solving the simultaneous equations, the boom rotation angle (β 1) and the arm rotation angle (β 2) of the Lt; / RTI > The controller 30 sets these derived values as command values (? 1 r,? 2 r).

그 후, 컨트롤러(30)는, 도 10에 나타내는 바와 같이, 붐회전각도(β1), 암회전각도(β2), 및 버킷회전각도(β3)의 각각의 값이, 생성된 지령치(β1r, β2r, β3r)가 되도록 붐(4), 암(5), 및 버킷(6)을 동작시킨다. 다만, 붐(4), 암(5), 및 버킷(6)의 동작, 및 메인펌프(14)의 토출량의 제어에 대해서는, X방향 이동제어에서 설명한 내용이 그대로 적용 가능하기 때문에, 여기에서는 그 설명을 생략한다.10, each of the values of the boom rotation angle beta 1 , the arm rotation angle beta 2 and the bucket rotation angle beta 3 is set to a predetermined value the arm 5, and the bucket 6 are operated so that the buckets 4, 6 1 r, 2 2 r, and 3 3 r. However, since the operation of the boom 4, the arm 5, and the bucket 6 and the control of the discharge amount of the main pump 14 can be applied as they are in the X-direction movement control, The description will be omitted.

이와 같이, 컨트롤러(30)는, 지령치(Zer)의 생성, 지령치(β1r, β2r, 및 β3r)의 생성, 메인펌프(14)의 토출량의 제어 및 각도센서(4S, 5S, 6S)의 출력에 근거하는 조작체(4, 5, 6)의 피드백제어를 1 제어사이클로 하여, 이 제어사이클을 반복함으로써, 버킷 선단위치(P4)의 Z방향 이동제어를 행한다.Thus, the controller 30 generates a command value (Zer), reference value (β 1 r, β 2 r, and β 3 r) of the product, the main pump 14 is controlled and the angle sensor (4S, 5S of the discharge rate of the 5 and 6 based on the output of the bucket tip end position P4 and 6S is set as one control cycle and the control cycle is repeated to perform the Z direction movement control of the bucket tip position P4.

또한, 상기 서술한 설명에서는, 버킷회전각도(β3)의 지령치(β3r)로서 버킷회전각도(β3)의 현재치가 그대로 이용되고 있다. 그러나, 암회전각도(β2)의 값에 따라 명시적으로 정해지는 값, 예를 들면, 암회전각도(β2)의 값에 고정치를 더한 값이 버킷회전각도(β3)의 지령치(β3r)로서 이용되어도 된다.Further, in the above-mentioned description, the command value of the bucket rotation angle (β 3) (β 3 r ) is the current value of the bucket rotation angle (β 3) used as it is as. However, the arm command value of the rotation angle (β 2) the value, for which explicitly determined according to the value g., Arm rotation angle (β 2), the value and the value obtained by adding the value bucket rotation angle (β 3) of the ( beta 3 r).

또한, Z방향 이동제어에서는 버킷 선단위치(P4)의 X좌표 및 Y좌표를 고정으로 하면서 버킷 선단위치(P4)의 Z좌표의 변위가 오픈제어된다. 그러나, 버킷핀위치(P3)의 X좌표 및 Y좌표를 고정으로 하면서 버킷핀위치(P3)의 Z좌표의 변위가 오픈제어되어도 된다. 이 경우, 지령치(β3r)의 생성 및 버킷(6)의 제어는 생략된다.In the Z direction movement control, the displacement of the Z coordinate of the bucket tip end position P4 is open-controlled while the X coordinate and the Y coordinate of the bucket tip end position P4 are fixed. However, the displacement of the Z coordinate of the bucket pin position P3 may be open-controlled while the X coordinate and Y coordinate of the bucket pin position P3 are fixed. In this case, generation of the command value? 3 r and control of the bucket 6 are omitted.

이상에 설명한 바와 같이, 본 발명의 실시예에 관한 쇼벨의 제어방법은, 레버의 조작량을, 붐실린더(7), 암실린더(8), 및 버킷실린더(9)의 각각의 신축제어가 아닌, 버킷 선단위치(P4)의 위치제어에 이용한다. 이로 인하여, 본 제어방법은, 버킷회전각도(β3) 및 버킷 선단위치(P4)의 X좌표 및 Y좌표의 값을 유지하면서, Z좌표의 값을 증감시키는 동작을 1개의 레버의 조작으로 실현시킬 수 있다. 또한, 버킷회전각도(β3) 및 버킷 선단위치(P4)의 Y좌표 및 Z좌표의 값을 유지하면서, X좌표의 값을 증감시키는 동작을 1개의 레버의 조작으로 실현시킬 수 있다.As described above, the control method of the shovel according to the embodiment of the present invention is not limited to the expansion and contraction control of each of the boom cylinder 7, the arm cylinder 8, and the bucket cylinder 9, And is used for position control of the bucket tip position P4. This control method realizes the operation of increasing and decreasing the Z coordinate while maintaining the values of the X coordinate and Y coordinate of the bucket rotation angle 3 and the bucket tip end position P4 by the operation of one lever . It is also possible to realize the operation of increasing or decreasing the value of the X coordinate while maintaining the values of the Y coordinate and Z coordinate of the bucket rotation angle 3 and the bucket tip end position P4 with the operation of one lever.

또한, 본 제어방법은, 엔드 어태치먼트의 평면위치와 엔드 어태치먼트의 높이를 버킷핀위치(P3)로 하여, 레버조작량을 버킷핀위치(P3)의 위치제어에 이용할 수도 있다. 이 경우, 본 제어방법은, 버킷핀위치(P3)의 X좌표 및 Y좌표의 값을 유지하면서, Z좌표의 값을 증감시키는 동작을 1개의 레버의 조작으로 실현시킬 수 있다. 또한, 버킷핀위치(P3)의 Y좌표 및 Z좌표의 값을 유지하면서, X좌표의 값을 증감시키는 동작을 1개의 레버의 조작으로 실현시킬 수 있다. 이 경우, 버킷핀위치(P3)의 삼차원좌표를 (X, Y, Z)=(XP3, YP3, ZP3)로 하면, XP3, ZP3은 각각 식(6) 및 식(7)로 나타난다.Further, in this control method, the plane position of the end attachment and the height of the end attachment may be used as the bucket pin position P3, and the lever manipulated variable may be used for position control of the bucket pin position P3. In this case, this control method can realize the operation of increasing and decreasing the Z coordinate value by operating one lever while maintaining the values of the X coordinate and Y coordinate of the bucket pin position P3. The operation of increasing or decreasing the value of the X coordinate can be realized by the operation of one lever while maintaining the Y coordinate and the Z coordinate of the bucket pin position P3. In this case, X P3 and Z P3 are expressions (6) and (7) respectively when the three-dimensional coordinate of the bucket pin position P3 is (X, Y, Z) = (X P3 , Y P3 , Z P3 ) Respectively.

XP3=H0X+L1cosβ1+L2cosβ2…(6) X P3 = H 0X + L 1 cosβ 1 + L 2 cosβ 2 ... (6)

ZP3=H0z+L1sinβ1+L2sinβ2…(7) Z P3 = H 0z + L 1 sinβ 1 + L 2 sinβ 2 ... (7)

다만, YP3은 0이 된다. 버킷핀위치(P3)는, XZ평면 상에 존재하기 때문이다.However, Y P3 becomes zero. This is because the bucket pin position P3 exists on the XZ plane.

또한, 이 경우, X방향 이동제어로 지령치(Xer)로부터 지령치(β3r)가 생성되는 일은 없으며, Z방향 이동제어로 지령치(Zer)로부터 지령치(β3r)가 생성되는 일은 없다.In this case, there is no thing which is generated command value (β r 3) from the command value (Xer) in the X direction movement control, which do not command value (β r 3) is produced from the command value (Zer) in Z direction movement control.

다음으로, 도 11을 참조하면서, 본 발명의 실시예에 관한 제어방법을 실행하는 하이브리드 쇼벨에 대해서 설명한다. 다만, 도 11은, 하이브리드 쇼벨의 구동계의 구성예를 나타내는 블록도이다. 도 11에 있어서, 기계적동력계는 이중선, 고압유압라인은 굵은 실선, 파일럿라인은 파선, 전기구동·제어계는 가는 실선으로 각각 나타나 있다. 또한, 도 11의 구동계는, 전동발전기(12), 변속기(13), 인버터(18), 및 축전계(120)를 구비하는 점, 선회용 유압모터(21B) 대신에, 인버터(20), 선회용전동기(21), 리졸버(22), 메커니컬브레이크(23), 및 선회변속기(24)로 구성되는 부하구동계를 구비하는 점에서 도 2의 구동계와 상이하다. 단, 그 외의 점에 있어서 도 2의 구동계와 공통된다. 이로 인하여, 공통점의 설명을 생략하면서 상이점을 상세하게 설명한다.Next, with reference to Fig. 11, a hybrid shovel for executing the control method according to the embodiment of the present invention will be described. Fig. 11 is a block diagram showing a configuration example of a drive system of a hybrid showbear. In Fig. 11, the mechanical dynamometer shows double lines, the high-pressure hydraulic line shows a thick solid line, the pilot line shows a broken line, and the electric drive and control system shows a thin solid line. 11 includes the electric motor 12, the transmission 13, the inverter 18 and the power storage system 120 in place of the swing hydraulic motor 21B. The inverter 20, 2 in that it includes a load driving system composed of a swinging electric motor 21, a resolver 22, a mechanical brake 23, and a swing transmission 24. However, in other respects, it is common to the drive system of Fig. Therefore, description of common points will be omitted and differences will be described in detail.

도 11에 있어서, 기계식 구동부로서의 엔진(11)과, 발전도 행하는 어시스트구동부로서의 전동발전기(12)는, 변속기(13)의 2개의 입력축에 각각 접속되어 있다. 변속기(13)의 출력축에는, 유압펌프로서의 메인펌프(14) 및 파일럿펌프(15)가 접속되어 있다.11, the engine 11 as a mechanical drive unit and the electric motor generator 12 as an assist drive unit for generating electric power are connected to two input shafts of the transmission 13, respectively. A main pump 14 and a pilot pump 15 are connected to the output shaft of the transmission 13 as a hydraulic pump.

전동발전기(12)에는, 인버터(18)를 통하여, 축전기로서의 커패시터를 포함하는 축전계(축전장치)(120)가 접속되어 있다.A power storage system (power storage device) 120 including a capacitor as a capacitor is connected to the motor generator 12 via an inverter 18. [

축전계(120)는, 인버터(18)와 인버터(20)와의 사이에 배치되어 있다. 이로써, 전동발전기(12) 및 선회용전동기(21)의 적어도 일방이 역행운전을 행하고 있을 때에는, 축전계(120)는 역행운전에 필요한 전력을 공급함과 함께, 적어도 일방이 발전운전을 행하고 있을 때에는, 축전계(120)는 발전운전에 의하여 발생한 전력을 전기에너지로서 축적한다.The power storage system 120 is disposed between the inverter 18 and the inverter 20. [ Thus, when at least one of the electric motor generator 12 and the electric motor for swiveling 21 is performing the backward operation, the power storage system 120 supplies the electric power necessary for backward operation and, when at least one of them performs the power generation operation , And a power storage system (120) accumulates electric power generated by the power generation operation as electric energy.

도 12는 축전계(120)의 구성예를 나타내는 블록도이다. 축전계(120)는, 축전기로서의 커패시터(19)와 승강압컨버터(100)와 DC버스(110)를 포함한다. 제2 축전기로서의 DC버스(110)는, 제1 축전기로서의 커패시터(19)와 전동발전기(12)와 선회용전동기(21)와의 사이에서의 전력의 수수(授受)를 제어한다. 커패시터(19)에는, 커패시터전압치를 검출하기 위한 커패시터전압검출부(112)와, 커패시터전류치를 검출하기 위한 커패시터전류검출부(113)가 마련되어 있다. 커패시터전압검출부(112) 및 커패시터전류검출부(113)에 의하여 검출되는 커패시터전압치 및 커패시터전류치는, 컨트롤러(30)에 공급된다. 또한, 상기 서술에서는, 축전기의 예로서 커패시터(19)를 나타냈지만, 커패시터(19) 대신에 리튬이온 배터리 등의 충전가능한 이차전지, 리튬이온 커패시터, 또는, 전력의 수수가 가능한 그 외의 형태의 전원을 축전기로서 이용해도 된다.12 is a block diagram showing an example of the configuration of a power storage system 120. In Fig. The power storage system 120 includes a capacitor 19 as a capacitor, a step-up / down converter 100, and a DC bus 110. The DC bus 110 as the second capacitor controls the transfer of electric power between the capacitor 19 as the first capacitor, the electric motor generator 12 and the electric motor for swiveling 21. The capacitor 19 is provided with a capacitor voltage detecting portion 112 for detecting the capacitor voltage value and a capacitor current detecting portion 113 for detecting the capacitor current value. The capacitor voltage value and the capacitor current value detected by the capacitor voltage detection section 112 and the capacitor current detection section 113 are supplied to the controller 30. [ Although the capacitor 19 is shown as an example of the capacitor in the above description, the capacitor 19 may be replaced with a rechargeable secondary battery such as a lithium ion battery or the like, a lithium ion capacitor, or any other type of power source May be used as a capacitor.

승강압컨버터(100)는, 전동발전기(12) 및 선회용전동기(21)의 운전상태에 따라, DC버스전압치가 일정한 범위 내에 들어가도록 승압동작과 강압동작을 전환하는 제어를 행한다. DC버스(110)는, 인버터(18, 20)와 승강압컨버터(100)와의 사이에 배치되어 있으며, 커패시터(19), 전동발전기(12), 선회용전동기(21)의 사이에서의 전력의 수수를 행한다.The step-up and step-down converter 100 performs control for switching the step-up operation and step-down operation so that the DC bus voltage value falls within a predetermined range in accordance with the operation state of the electric motor generator 12 and the swing electric motor 21. [ The DC bus 110 is disposed between the inverters 18 and 20 and the up / down converter 100. The DC bus 110 is connected between the capacitor 19, the motor / generator 12, And carry out.

도 11로 되돌아와, 인버터(20)는, 선회용전동기(21)와 축전계(120)와의 사이에 마련되며, 컨트롤러(30)로부터의 지령에 근거하여, 선회용전동기(21)에 대해서 운전제어를 행한다. 이로써, 인버터(20)는, 선회용전동기(21)가 역행운전을 하고 있을 때에는, 필요한 전력을 축전계(120)로부터 선회용전동기(21)에 공급한다. 또한, 선회용전동기(21)가 발전운전을 하고 있을 때에는, 선회용전동기(21)에 의하여 발전된 전력을 축전계(120)의 커패시터(19)에 축전한다.11, the inverter 20 is provided between the swing motor 21 and the power storage system 120, and based on a command from the controller 30, drives the swing motor 21 Control is performed. Thus, the inverter 20 supplies necessary electric power from the power storage system 120 to the swinging electric motor 21 when the swinging electric motor 21 is performing the reverse operation. Further, when the electric motor for swiveling 21 is under power generation operation, electric power generated by the swivel electric motor 21 is stored in the capacitor 19 of the electric storage system 120.

선회용전동기(21)는, 역행운전 및 발전운전의 쌍방이 가능한 전동기이면 되고, 상부선회체(3)의 선회기구(2)를 구동하기 위해서 마련되어 있다. 역행운전 시에는, 선회용전동기(21)의 회전구동력이 선회변속기(24)에서 증폭되고, 상부선회체(3)가 가감속제어되어 회전운동을 행한다. 또한, 발전운전 시에는, 상부선회체(3)의 관성회전은, 선회변속기(24)에서 회전수가 증가되어 선회용전동기(21)에 전달되고, 회생전력을 발생시킬 수 있다. 여기에서는, 선회용전동기(21)는, PWM(Pulse Width Modulation)제어신호에 따라 인버터(20)에 의하여 교류구동되는 전동기이다. 선회용전동기(21)는, 예를 들면, 자석내장형의 IPM 모터로 구성할 수 있다. 이로써, 보다 큰 유도기전력을 발생시킬 수 있으므로, 회생 시에 선회용전동기(21)에서 발전되는 전력을 증대시킬 수 있다.The swivel electric motor 21 is provided for driving the swivel mechanism 2 of the upper swivel body 3 as long as it is an electric motor capable of both backward operation and power generation operation. During the backward running, the rotational driving force of the swinging electric motor 21 is amplified in the swing transmission 24, and the upper swing body 3 is controlled to accelerate and decelerate to perform rotational motion. During the power generation operation, the inertial rotation of the upper revolving structure 3 is increased in the number of revolutions in the swing transmission 24 and is transmitted to the swinging electric motor 21 to generate regenerative electric power. Here, the swing electric motor 21 is an AC motor driven by the inverter 20 in accordance with a PWM (Pulse Width Modulation) control signal. The swinging electric motor 21 can be constituted by, for example, a magnet built-in IPM motor. As a result, a larger induced electromotive force can be generated, so that the electric power generated by the swing motor 21 at the time of regeneration can be increased.

다만, 축전계(120)의 커패시터(19)의 충방전제어는, 커패시터(19)의 충전상태, 전동발전기(12)의 운전상태(역행운전 또는 발전운전), 선회용전동기(21)의 운전상태(역행운전 또는 회생운전)에 근거하여, 컨트롤러(30)에 의하여 행해진다.The charging and discharging control of the capacitor 19 of the power storage system 120 is performed by controlling the charging state of the capacitor 19, the operating state of the electric motor generator 12 (reverse operation or power generation operation), the operation of the electric motor 21 Is performed by the controller (30) based on the state (reverse operation or regenerative operation).

리졸버(22)는, 선회용전동기(21)의 회전축(21A)의 회전위치 및 회전각도를 검출하는 센서이다. 구체적으로는, 리졸버(22)는, 선회용전동기(21)의 회전 전의 회전축(21A)의 회전위치와, 좌회전 또는 우회전한 후의 회전위치와의 차를 검출함으로써, 회전축(21A)의 회전각도 및 회전방향을 검출한다. 선회용전동기(21)의 회전축(21A)의 회전각도 및 회전방향을 검출함으로써, 선회기구(2)의 회전각도 및 회전방향이 도출된다.The resolver 22 is a sensor for detecting the rotational position and the rotational angle of the rotational shaft 21A of the swinging electric motor 21. [ More specifically, the resolver 22 detects the difference between the rotational position of the rotational shaft 21A before the rotation of the electric motor 21 for swiveling and the rotational position after the left or right rotation, The rotation direction is detected. The rotational angle and rotational direction of the swivel mechanism 2 are derived by detecting the rotational angle and rotational direction of the rotational shaft 21A of the swiveling electric motor 21. [

메커니컬브레이크(23)는, 기계적인 제동력을 발생시키는 제동장치이며, 선회용전동기(21)의 회전축(21A)을 기계적으로 정지시킨다. 이 메커니컬브레이크(23)는, 전자식 스위치에 의하여 제동/해제가 전환된다. 이 전환은, 컨트롤러(30)에 의하여 행해진다.The mechanical brake 23 is a braking device that generates a mechanical braking force and mechanically stops the rotating shaft 21A of the swinging electric motor 21. [ The mechanical brake 23 is switched between braking / releasing by an electronic switch. This switching is performed by the controller 30. Fig.

선회변속기(24)는, 선회용전동기(21)의 회전축(21A)의 회전을 감속하여 선회기구(2)에 기계적으로 전달하는 변속기이다. 이로써, 역행운전 시에는, 선회용전동기(21)의 회전력을 증력시켜, 보다 큰 회전력을 상부선회체(3)에 전달할 수 있다. 이와는 반대로, 회생운전 시에는, 상부선회체(3)에서 발생한 회전을 증속하여 선회용전동기(21)에 기계적으로 전달할 수 있다.The swivel transmission 24 is a transmission that mechanically transmits the rotation of the rotary shaft 21A of the swivel electric motor 21 to the swivel mechanism 2 at a reduced speed. Thus, at the time of backward running, the rotational force of the swinging electric motor 21 can be increased, and a larger rotational force can be transmitted to the upper swing body 3. On the contrary, during the regenerative operation, the rotation generated in the upper revolving structure 3 can be increased and mechanically transmitted to the swivel electric motor 21.

선회기구(2)는, 선회용전동기(21)의 메커니컬브레이크(23)가 해제된 상태로 선회 가능해져, 이로써, 상부선회체(3)가 좌방향 또는 우방향으로 선회된다.The turning mechanism 2 is pivotable in a state in which the mechanical brake 23 of the swinging electric motor 21 is released so that the upper swing body 3 is turned leftward or rightward.

컨트롤러(30)는, 전동발전기(12)의 운전제어(전동어시스트운전 또는 발전운전의 전환)를 행함과 함께, 승강압제어부로서의 승강압컨버터(100)를 구동제어하는 것에 의한 커패시터(19)의 충방전제어를 행한다. 컨트롤러(30)는, 커패시터(19)의 충전상태, 전동발전기(12)의 운전상태(전동어시스트운전 또는 발전운전), 및 선회용전동기(21)의 운전상태(역행운전 또는 회생운전)에 근거하여, 승강압컨버터(100)의 승압동작과 강압동작의 전환제어를 행하여, 이로써 커패시터(19)의 충방전제어를 행한다. 또한, 컨트롤러(30)는, 커패시터(19)에 충전하는 양(충전전류 또는 충전전력)의 제어도 행한다.The controller 30 performs the operation control of the electric motor generator 12 (switching of electric assist operation or electric power generation operation) and the control of the voltage of the capacitor 19 Charge / discharge control is performed. The controller 30 determines whether or not the charging state of the capacitor 19, the operating state (electric assist operation or power generation operation) of the electric motor generator 12 and the operation state (reverse operation or regenerative operation) Down converter 100 and performs switching control of the step-down operation, thereby performing charge / discharge control of the capacitor 19. [ The controller 30 also controls the amount of charge (charge current or charge power) charged in the capacitor 19. [

이 승강압컨버터(100)의 승압동작과 강압동작의 전환제어는, DC버스전압검출부(111)에 의하여 검출되는 DC버스전압치, 커패시터전압검출부(112)에 의하여 검출되는 커패시터전압치, 및 커패시터전류검출부(113)에 의하여 검출되는 커패시터전류치에 근거하여 행해진다.The step-up and step-down operations of the step-up and step-down converter 100 are controlled by the DC bus voltage value detected by the DC bus voltage detection unit 111, the capacitor voltage value detected by the capacitor voltage detection unit 112, Based on the value of the capacitor current detected by the current detection unit 113.

어시스트모터인 전동발전기(12)가 발전한 전력은, 인버터(18)를 통하여 축전계(120)의 DC버스(110)에 공급되어, 승강압컨버터(100)를 통하여 커패시터(19)에 공급된다. 또한, 선회용전동기(21)가 회생운전하여 생성한 회생전력은, 인버터(20)를 통하여 축전계(120)의 DC버스(110)에 공급되어, 승강압컨버터(100)를 통하여 커패시터(19)에 공급된다.The electric power generated by the motor generator 12 as an assist motor is supplied to the DC bus 110 of the power storage system 120 via the inverter 18 and supplied to the capacitor 19 through the up / down converter 100. The regenerative power generated by the regenerative operation of the swing motor 21 is supplied to the DC bus 110 of the power storage system 120 through the inverter 20 and is supplied to the capacitor 19 .

다음으로, 도 13을 참조하면서, 본 발명의 실시예에 관한 제어방법을 실행하는 하이브리드 쇼벨의 다른 예에 대하여 설명한다. 또한, 도 13은, 하이브리드 쇼벨의 구동계의 구성예를 나타내는 블록도이다. 도 13에 있어서, 기계적동력계는 이중선, 고압유압라인은 굵은 실선, 파일럿라인은 파선, 전기구동·제어계는 가는 실선으로 각각 나타나 있다. 또한, 도 13의 구동계는, 엔진(11) 및 전동발전기(12)의 2개의 출력축이 변속기(13)를 통하여 메인펌프(14)에 접속되는 구성(패럴렐방식) 대신에, 인버터(18A)를 통하여 전기적으로 구동되는 펌프용 전동기(400)의 출력축이 메인펌프(14)에 접속되는 구성(시리얼방식)을 채용하는 점에서 도 11의 구동계와 상이하다. 단, 그 외의 점에 있어서 도 11의 구동계와 공통된다.Next, another example of the hybrid showbear for executing the control method according to the embodiment of the present invention will be described with reference to FIG. 13 is a block diagram showing a configuration example of a drive system of hybrid shovel. In Fig. 13, the mechanical dynamometer shows double lines, the high-pressure hydraulic line shows a bold solid line, the pilot line shows a broken line, and the electric drive and control system shows a thin solid line. The drive system of Fig. 13 is different from the drive system of Fig. 13 in that the two output shafts of the engine 11 and the motor generator 12 are connected to the main pump 14 via the transmission 13 11 in that an output shaft of an electric motor 400 driven by a pump is connected to the main pump 14 (serial method). However, in other respects, it is common to the drive system of Fig.

본 발명의 실시예에 관한 제어방법은, 이상과 같은 구성을 가지는 하이브리드식 쇼벨에도 적용 가능하다.The control method according to the embodiment of the present invention is also applicable to the hybrid shovel having the above configuration.

다음으로, 도 14를 참조하여, 자동고르기모드의 일례인 법면정리모드에 대하여 설명한다. 다만, 도 14는, 법면정리모드에서 이용되는 좌표계의 설명도이며, 도 3의 F3A에 대응한다. 또한, 법면정리모드 시의 레버설정은, 도 5의 F5B에 나타내는 자동고르기모드 시의 레버설정과 동일하다. 또한, 도 14는, 법면에 평행한 U축, 법면에 수직인 W축을 포함하는 UVW 삼차원 직교좌표계를 이용한 점에서, 수평면에 평행한 X축, 수평면에 수직인 Z축을 포함하는 XYZ 삼차원 직교좌표계를 이용하는 도 3의 F3A와 상이하지만 그 외의 점에서 공통된다. 다만, 법면각도(γ1)는, 법면정리모드를 실행하기 전에 조작자에 의하여 법면각도입력부를 통하여 설정될 수 있다. 또한, 도 14에서는, W축방향에 있어서의 부의 방향으로, 즉, 쇼벨로부터 보아 하강구배가 되도록, 법면이 형성되는 경우를 나타낸다.Next, with reference to Fig. 14, a description will be given of a normalizing mode, which is an example of the automatic selecting mode. Fig. 14 is an explanatory diagram of a coordinate system used in the normal plane arrangement mode, and corresponds to F3A in Fig. 3. The lever setting in the normal mode is the same as the lever setting in the automatic selection mode shown in F5B of Fig. 14 shows an XYZ three-dimensional orthogonal coordinate system including an X-axis parallel to a horizontal plane and a Z-axis perpendicular to a horizontal plane at a point using a UVW three-dimensional Cartesian coordinate system including a U-axis parallel to the oblique plane and a W- 3, which is different from F3A in Fig. However, the surface angle? 1 can be set by the operator through the surface angle input unit before executing the surface leveling mode. 14 shows a case in which a flat surface is formed in a negative direction in the W-axis direction, that is, a downward slope as viewed from the showbell.

여기에서, 붐핀위치(P1)의 삼차원좌표를 (U, V, W)=(H0U, 0, H0W)로 하고, 버킷 선단위치(P4)의 삼차원좌표를 (U, V, W)=(Ue, Ve, We)로 하면, Ue, We는, 상기 서술한 (1)식 및 (2)식과 마찬가지로, 각각 식(1)’및 식(2)’로 나타난다. 다만, Ue 및 Ve는 엔드 어태치먼트의 UV평면에 있어서의 위치를 나타내고, We는 엔드 어태치먼트의 UV평면으로부터의 거리를 나타낸다.Here, the three-dimensional coordinates of bumpin position (P1) (U, V, W) = (H 0U, 0, H 0W) , the three-dimensional coordinates of the bucket tip position (P4) and (U, V, W) = Ue and We are expressed by the equations (1) 'and (2)', respectively, as in the above-described equations (1) and (2). Where Ue and Ve represent the position in the UV plane of the end attachment and We represent the distance from the UV plane of the end attachment.

Ue=H0U+L1cosβ1’+L2cosβ2’+L3cosβ3’…(1)’ Ue = H 0U + L 1 cosβ 1 '+ L 2 cosβ 2' + L 3 cosβ 3 '... (One)'

We=H0W+L1sinβ1’+L2sinβ2’+L3sinβ3’…(2)’We = H 0W + L 1 sin? 1 '+ L 2 sin? 2 ' + L 3 sin? 3 '(2)'

다만, Ve는 0이 된다. 버킷 선단위치(P4)는, UW평면 상에 존재하기 때문이다. 또한, 각도(β1’)는, 대지각(β1)에 법면각도(γ1)를 가산한 각도이다. 마찬가지로, 각도(β2’)는, 대지각(β2)에 법면각도(γ1)를 가산한 각도이며, 각도(β3’)는, 대지각(β3)에 법면각도(γ1)를 가산한 각도이다.However, Ve becomes 0. This is because the bucket tip position P4 exists on the UW plane. Further, the angle (β 1 ') is a perceptual angle for the slopes obtained by adding the angle (γ 1) to (β 1). Similarly, the angle (β 2 ') is, for perception and angle (β 2) adding the slopes an angle (γ 1), the angle (β 3') is, for perception slopes an angle (γ 1) to (β 3) .

또한, 버킷핀위치(P3)의 삼차원좌표를 (U, V, W)=(UP3, VP3, WP3)로 하면, UP3, WP3은, 상기 서술한 (6)식 및 (7)식과 마찬가지로, 각각 식(6)’및 식(7)’로 나타난다.When the three-dimensional coordinates of the bucket pin position P3 are (U, V, W) = (U P3 , V P3 , W P3 ), UP3 and WP3 are calculated by the above- Similarly, they are expressed by equations (6) 'and (7)', respectively.

UP3=H0U+L1cosβ1’+L2cosβ2’…(6)’ U P3 = H 0U + L 1 cosβ 1 '+ L 2 cosβ 2' ... (6) '

WP3=H0W+L1sinβ1’+L2sinβ2’…(7)’W P3 = H 0W + L 1 sin? 1 '+ L 2 sin? 2 ' ... (7) '

법면정리모드에서는, 레버(26B)를 전방으로 젖히면, 버킷 선단위치(P4)의 V좌표의 값(Ve) 및 W좌표의 값(We)을 불변으로 하면서, U좌표의 값(Ue)이 증대하도록, 붐(4), 암(5), 및 버킷(6)의 적어도 1개가 움직인다.The U coordinate value Ue of the U coordinate is increased while the value Ve of the V coordinate of the bucket tip position P4 and the value We of the W coordinate are made unchanged when the lever 26B is turned forward , At least one of the boom (4), the arm (5), and the bucket (6) moves.

또한, 법면정리모드에서는, 레버(26B)를 후방으로 젖히면, 버킷 선단위치(P4)의 V좌표의 값(Ve) 및 W좌표의 값(We)을 불변으로 하면서, U좌표의 값(Ue)이 감소하도록, 붐(4), 암(5), 및 버킷(6)의 적어도 1개가 움직인다.When the lever 26B is turned backward, the value U of the U coordinate is obtained while the value Ve of the V coordinate of the bucket tip end position P4 and the value We of the W coordinate are made unchanged, At least one of the boom (4), the arm (5), and the bucket (6) moves.

즉, 레버(26B)의 전후방향으로의 조작(도 5의 F5B의 X방향조작에 상당하고, 이하, "U방향조작"이라고 한다.)에 따라, 버킷 선단위치(P4)는 U축방향으로 움직인다. 또한, 레버(26A)의 전후방향으로의 조작(도 5의 F5B의 Z방향조작에 상당하고, 이하, "W방향조작"이라고 한다.)에 따라 버킷 선단위치(P4)는 W축방향으로 움직인다. 또한, UVW 삼차원 직교좌표계와 XYZ 삼차원 직교좌표계를 조합하여, 컨트롤러(30)가, 조작자의 레버(26B)의 전후방향으로의 조작에 따라 버킷 선단위치(P4)를 U축방향으로 움직여, 조작자의 레버(26A)의 전후방향으로의 조작에 따라 버킷 선단위치(P4)를 Z축방향으로 움직이도록 설정할 수도 있다.That is, according to the operation in the forward and backward direction of the lever 26B (corresponding to the X direction operation in F5B in Fig. 5, hereinafter referred to as "U direction operation"), the bucket tip position P4 is shifted in the U- It moves. The bucket tip end position P4 moves in the W axial direction in accordance with the operation of the lever 26A in the forward and backward direction (corresponding to the Z directional operation of F5B in Fig. 5, hereinafter referred to as "W directional operation & . Further, the controller 30 may combine the UVW three-dimensional orthogonal coordinate system and the XYZ three-dimensional orthogonal coordinate system to move the bucket tip end position P4 in the U-axis direction in accordance with the operation of the operator's lever 26B in the anteroposterior direction, The bucket tip end position P4 may be set to move in the Z-axis direction in accordance with the operation of the lever 26A in the forward and backward directions.

다만, 법면정리모드에 있어서의 이러한 레버(26A, 26B)의 전후방향으로의 조작, 즉, 엔드 어태치먼트로서의 버킷(6)의 W방향조작, U방향조작에 따라 실행되는 제어를 "법면위치제어"라고 칭한다. 또한, 법면정리모드에 있어서의 레버(26A)의 좌우방향으로의 조작, 및, 레버(26B)의 좌우방향으로의 조작에 따라 실행되는 제어는, 자동고르기모드의 경우와 같다.However, the control executed in the forward and backward directions of the levers 26A and 26B in the flat surface sorting mode, that is, the control performed in accordance with the U directional operation and the U directional operation of the bucket 6 as the end attachment is referred to as " Quot; Control performed in accordance with the operation of the lever 26A in the lateral direction and the operation of the lever 26B in the lateral direction in the normal mode is the same as in the automatic selecting mode.

이와 같이 하여, 조작자는, 자동고르기모드에 있어서의 X방향 이동제어(평면위치제어)의 일례로서의, 법면정리모드에 있어서의 법면위치제어를 이용하여, 원하는 법면을 따른 버킷(6)의 이동을 용이하게 실현할 수 있다.In this manner, the operator can move the bucket 6 along the desired surface by using the lateral surface position control in the rear surface rearrangement mode as an example of the X-direction movement control (plane position control) in the automatic selecting mode It can be easily realized.

다음으로, 도 15 및 도 16을 참조하여, 법면정리모드의 다른 일례에 대하여 설명한다. 다만, 도 15는, 법면정리모드에서 이용되는 좌표계의 설명도이며, 도 3의 F3A에 대응한다. 또한, 도 16은, XZ평면에 있어서의 프론트 어태치먼트의 움직임을 설명하는 도이며, 도 4에 대응한다. 또한, 법면정리모드 시의 레버설정은, 도 5의 F5B에 나타내는 자동고르기모드 시의 레버설정과 동일하다. 또한, 도 15, 도 16은, 법면각도 γ1와 버킷 선단위치(P4)의 추이를 도시한 점에서, 도 3의 F3A, 도 4와 상이하지만 그 외의 점에서 공통된다. 다만, 법면각도(γ1)는, 법면정리모드를 실행하기 전에 조작자에 의하여 설정될 수 있다. 또한, 도 15, 도 16에서는, Z축방향에 있어서의 부의 방향으로, 즉, 쇼벨로부터 보아 하강구배가 되도록, 법면이 형성되는 경우를 나타낸다.Next, another example of the normal mode will be described with reference to Figs. 15 and 16. Fig. FIG. 15 is an explanatory diagram of a coordinate system used in the normal plane mode, and corresponds to F3A in FIG. 3. Fig. 16 is a view for explaining the movement of the front attachment in the XZ plane, and corresponds to Fig. The lever setting in the normal mode is the same as the lever setting in the automatic selection mode shown in F5B of Fig. 15 and Fig. 16 are common to F3A and Fig. 4 in Fig. 3 but in other points in that they show the transition of the normal angle? 1 and the bucket tip position P4. However, the curved surface angle? 1 can be set by the operator before executing the surface arrangement mode. Figs. 15 and 16 show a case in which a flat surface is formed in a negative direction in the Z-axis direction, that is, a downward slope as viewed from the showbell.

법면정리모드에서는, 레버(26B)를 전방으로 젖히면, 버킷 선단위치(P4)의 Y좌표의 값(Ye)을 불변으로 하고, 또한, 각도(γ1)의 법면(SF1)과 버킷 선단위치(P4)와의 사이의 거리를 불변으로 하면서, X좌표의 값(Xe)이 증대하도록, 붐(4), 암(5), 및 버킷(6)의 적어도 1개가 움직인다. 즉, 버킷 선단위치(P4)가 법면(SF1)에 평행한 평면(SF2) 상을 Y축에 수직인 방향으로 또한 쇼벨로부터 멀어지는 방향으로 이동한다. 이 때, Z좌표의 값(Ze)은, 쇼벨로부터 보아 상승구배의 법면인 경우에 증대하고, 쇼벨로부터 보아 하강구배의 법면인 경우에 감소한다. 다만, 도 15는, 쇼벨로부터 보아 하강구배의 법면(SF1)을 나타낸다.The slopes cleanup mode, jeothimyeon the lever (26B) in the forward direction, and a value (Ye) in Y coordinates of the bucket tip position (P4) unchanged, and, angle of slopes (SF1) and the bucket tip position (γ 1) ( At least one of the boom 4, the arm 5, and the bucket 6 moves so that the X-coordinate value Xe increases while the distance between the boom 4 and the bucket 6 is constant. That is, the bucket tip position P4 moves on the plane SF2 parallel to the flat surface SF1 in the direction perpendicular to the Y-axis and in the direction away from the showbell. At this time, the value of the Z coordinate (Ze) increases when it is a surface of a rising gradient as viewed from a showbell, and decreases when it is a surface of a descending gradient as viewed from a showbell. 15. Fig. 15 shows a downward slope SF1 viewed from the showbell.

또한, 법면정리모드에서는, 레버(26B)를 후방으로 젖히면, 버킷 선단위치(P4)의 Y좌표의 값(Ye)을 불변으로 하고, 또한, 법면(SF1)과 버킷 선단위치(P4)와의 사이의 거리를 불변으로 하면서, X좌표의 값(Xe)이 감소하도록, 붐(4), 암(5), 및 버킷(6)의 적어도 1개가 움직인다. 즉, 버킷 선단위치(P4)가 법면(SF1)에 평행한 평면(SF2) 상을 Y축에 수직인 방향으로 또한 쇼벨에 가까워지는 방향으로 이동한다. 이 때, Z좌표의 값(Ze)은, 쇼벨로부터 보아 상승구배의 법면인 경우에 감소하고, 쇼벨로부터 보아 하강구배의 법면인 경우에 증대한다.When the lever 26B is retracted rearward, the Y value of the Y coordinate of the bucket tip end position P4 is made unchanged and also between the normal surface SF1 and the bucket tip end position P4 At least one of the boom 4, the arm 5, and the bucket 6 moves such that the X-coordinate value Xe decreases while the distance of the bucket 6 is constant. That is, the bucket tip end position P4 moves on the plane SF2 parallel to the plain surface SF1 in the direction perpendicular to the Y-axis and in the direction toward the shovel. At this time, the value of the Z coordinate (Ze) decreases when it is a surface of a rising gradient as viewed from a showbell, and increases when it is a surface of a descending gradient as viewed from a showbell.

여기에서, 현시점의 버킷 선단위치(P4)의 삼차원좌표를 (X, Y, Z)=(Xe, Ye, Ze)로 하고, 이동 후의 버킷 선단위치(P4)’의 삼차원좌표를 (X, Y, Z)=(Xe’, Ye’, Ze’)로 하며, X축방향의 이동량을 ΔXe(=Xe’-Xe)로 하면, Z축방향의 이동량 ΔZe(=Ze’-Ze)는, 식(8)로 나타난다.Here, the three-dimensional coordinates of the current bucket tip position P4 are (X, Y, Z) = (Xe, Ye, Ze) (= Ze'-Ze) in the Z-axis direction is expressed by the following equation (7): Ze = Zea = (8).

ΔZe=ΔXe×tanγ1…(8)? Ze =? Xe x tan? 1 ... (8)

또한, 법면정리모드에서는, 버킷 선단위치(P4)의 위치제어 대신에, 버킷핀위치(P3)의 위치제어가 실행되어도 된다. 이 경우, 버킷핀위치(P3)의 Y좌표의 값(YP3)을 불변으로 하고, 또한, 각도(γ1)의 법면(SF1)과 버킷핀위치(P3)와의 사이의 거리를 불변으로 하면서, X좌표의 값(Xp3)이 변화하도록, 붐(4), 암(5), 및 버킷(6)의 적어도 1개가 움직인다. 즉, 버킷핀위치(P3)가 법면(SF1)에 평행한 평면 상을 Y축에 수직인 방향으로 이동한다.Further, in the normal mode, the position control of the bucket pin position P3 may be performed instead of the position control of the bucket tip position P4. In this case, the Y coordinate value Y P3 of the bucket pin position P3 is made unchanged and the distance between the rectangular face SF1 of the angle 1 and the bucket pin position P3 is made unchanged At least one of the boom 4, the arm 5, and the bucket 6 moves such that the value Xp3 of the X coordinate changes. That is, the bucket pin position P3 moves in a direction perpendicular to the Y axis on a plane parallel to the flat surface SF1.

여기에서, 현시점의 버킷핀위치(P3)의 삼차원좌표를 (X, Y, Z)=(XP3, YP3, ZP3)로 하고, 이동 후의 버킷핀위치(P3’)의 삼차원좌표를(X, Y, Z)=(Xp3’, Yp3’, Zp3’)로 하며, X축방향의 이동량을 ΔXp3(=Xp3’-Xp3)로 하면, Z축방향의 이동량 ΔZp3(=Zp3’-Zp3)은, 식(9)로 나타난다.Here, the three-dimensional coordinates of the current bucket pin position P3 are (X, Y, Z) = (X P3 , Y P3 , Z P3 ) X, Y, Z) = (X p3 ', Y p3', Z p3 ') to, and the amount of movement of the X-axis direction ΔX p3 (= X p3' -X p3) when, the amount of movement of the Z-axis direction by ΔZ p3 (= Z p3 '- Z p3 ) is expressed by equation (9).

ΔZp3=ΔXp3×tanγ1…(9)? Zp 3 =? Xp 3 x tan? 1 ... (9)

다만, 본 실시예에서는, 법면정리모드에 있어서의 이러한 레버(26B)의 전후방향으로의 조작, 즉, 엔드 어태치먼트로서의 버킷(6)의 X방향조작에 따라 실행되는 제어를 "법면위치제어"라고 칭한다. 또한, 법면정리모드에 있어서의 레버(26A)의 조작, 및, 레버(26B)의 좌우방향으로의 조작에 따라 실행되는 제어는, 자동고르기모드의 경우와 같다.However, in the present embodiment, the control executed in the forward and backward directions of the lever 26B in the flattening mode, that is, the control performed in accordance with the X directional operation of the bucket 6 as the end attachment is referred to as " It is called. The control performed in accordance with the operation of the lever 26A in the normal mode and the operation in the lateral direction of the lever 26B are the same as those in the automatic selecting mode.

이와 같이 하여, 조작자는, 자동고르기모드에 있어서의 X방향 이동제어(평면위치제어)의 일례로서의, 법면정리모드에 있어서의 법면위치제어를 이용하여, 원하는 법면에 따른 버킷(6)의 이동을 용이하게 실현할 수 있다.In this manner, the operator can move the bucket 6 according to the desired surface by using the lateral surface position control in the rear surface rearrangement mode as an example of the X-direction movement control (plane position control) in the automatic still mode It can be easily realized.

이상, 본 발명의 바람직한 실시예에 대하여 자세히 설명했지만, 본 발명은, 상기 서술한 실시예에 제한되지 않으며, 본 발명의 범위를 일탈하는 일 없이 상기 서술한 실시예에 다양한 변형 및 치환을 더할 수 있다.Although the preferred embodiments of the present invention have been described in detail, the present invention is not limited to the above-described embodiments, and various modifications and permutations may be added to the above-described embodiments without departing from the scope of the present invention. have.

예를 들면, 상기 서술한 실시예에서는, 엔드 어태치먼트로서 버킷(6)을 이용하지만, 리프팅 마그넷, 브레이커 등이 이용되어도 된다.For example, in the above-described embodiment, the bucket 6 is used as the end attachment, but a lifting magnet, a breaker, or the like may be used.

또한, 본원은, 2012년 6월 8일에 출원한 일본 특허출원 2012-131013호에 근거하여 우선권을 주장하는 것이며 그 일본 특허출원의 전체 내용을 본원에 참조에 의하여 원용한다.The present application is based on Japanese Patent Application No. 2012-131013 filed on June 8, 2012, the entire contents of which are incorporated herein by reference.

1: 하부주행체
1A, 1B: 주행용 유압모터
2: 선회기구
3: 상부선회체
4: 붐
4S: 붐각도센서
5: 암
5S: 암각도센서
6: 버킷
6S: 버킷각도센서
7: 붐실린더
8: 암실린더
9: 버킷실린더
10: 캐빈
11: 엔진
12: 전동발전기
13: 변속기
14: 메인펌프
14A: 레귤레이터
15: 파일럿펌프
16: 고압유압라인
17: 컨트롤밸브
18: 인버터
19: 커패시터
20: 인버터
21: 선회용전동기
21A: 회전축
22: 리졸버
23: 메커니컬브레이크
24: 선회변속기
25: 파일럿라인
26: 조작장치
26A, 26B: 레버
26C: 페달
27, 28: 유압라인
29: 파일럿압센서
30: 컨트롤러
100: 승강압컨버터
110: DC버스
111: DC버스전압검출부
112: 커패시터전압검출부
113: 커패시터전류검출부
120: 축전계
CP1, CP2, CP3: 펌프토출량도출부
CX: X방향 지령치생성부
CZ: Z방향 지령치생성부
1: Lower traveling body
1A, 1B: Driving hydraulic motor
2: Swivel mechanism
3: upper revolving body
4: Boom
4S: Boom angle sensor
5: Cancer
5S: Rock angle sensor
6: Bucket
6S: Bucket angle sensor
7: Boom cylinder
8: Female cylinder
9: Bucket cylinder
10: Cabin
11: Engine
12: Electric generator
13: Transmission
14: main pump
14A: Regulator
15: Pilot pump
16: High pressure hydraulic line
17: Control valve
18: Inverter
19: Capacitors
20: Inverter
21: Motor for turning
21A:
22: Resolver
23: Mechanical brake
24: turning transmission
25: Pilot line
26: Operation device
26A, 26B: Lever
26C: Pedal
27, 28: Hydraulic line
29: Pilot pressure sensor
30: Controller
100: Step-up / down converter
110: DC bus
111: DC bus voltage detector
112: Capacitor voltage detector
113: Capacitor current detector
120: power storage system
CP1, CP2, CP3: pump discharge amount deriving unit
CX: X-direction command value generator
CZ: Z-direction command value generator

Claims (16)

1개의 레버의 조작에 의하여, 엔드 어태치먼트의 높이를 유지하면서 상기 엔드 어태치먼트의 평면위치제어를 실행하거나, 상기 엔드 어태치먼트의 평면위치를 유지하면서 상기 엔드 어태치먼트의 높이제어를 실행하는, 쇼벨의 제어방법.Wherein the control of the height of the end attachment is performed while the height of the end attachment is controlled by the operation of one lever or the height control of the end attachment is executed while maintaining the plane position of the end attachment. 제 1 항에 있어서,
상기 평면위치제어 또는 상기 높이제어를 실행하는 경우에 상기 엔드 어태치먼트의 수평면에 대한 각도를 유지하는, 쇼벨의 제어방법.
The method according to claim 1,
And maintains an angle with respect to a horizontal plane of the end attachment when performing the planar position control or the height control.
제 1 항 또는 제 2 항에 있어서,
상기 1개의 레버의 조작량에 근거하여, 적어도, 조작체 중 붐 및 암의 동작에 관한 지령치를 생성하는, 쇼벨의 제어방법.
3. The method according to claim 1 or 2,
And generates an instruction value relating to at least an operation of the boom and the arm in the operating body based on the operation amount of the one lever.
제 1 항 또는 제 2 항에 있어서,
다른 1개의 레버의 조작에 의하여, 상기 엔드 어태치먼트의 수평면에 대한 각도를 독립하여 조정하는, 쇼벨의 제어방법.
3. The method according to claim 1 or 2,
And the angle of the end attachment with respect to the horizontal plane is independently adjusted by operation of another one of the levers.
제 1 항 또는 제 2 항에 있어서,
다른 1개의 레버의 조작에 의하여 선회를 독립하여 제어하는, 쇼벨의 제어방법.
3. The method according to claim 1 or 2,
And controlling the turning independently by the operation of another one of the levers.
제 3 항에 있어서,
상기 조작체의 각각에 장착된 자세센서의 출력에 근거하여 상기 조작체의 각각을 피드백제어하는, 쇼벨의 제어방법.
The method of claim 3,
And feedback control is performed on each of the operating bodies based on an output of an attitude sensor mounted on each of the operating bodies.
제 1 항 또는 제 2 항에 있어서,
상기 1개의 레버의 조작에 의하여, 설정된 법면각도를 가지는 법면에 평행한 평면에 대해서 상기 엔드 어태치먼트의 평면위치제어 또는 높이제어를 실행하는, 쇼벨의 제어방법.
3. The method according to claim 1 or 2,
And performing plane position control or height control of the end attachment with respect to a plane parallel to the obtuse surface having the set obtuse angle by the operation of the one lever.
제 1 항 또는 제 2 항에 있어서,
상기 1개의 레버의 조작에 의하여, 설정된 법면각도를 가지는 법면에 평행한 평면에 대해서 상기 엔드 어태치먼트의 평면위치제어를 실행하고, 또한, 다른 레버의 조작에 의하여, 상기 법면 또는 수평면에 평행한 평면에 대해서 상기 엔드 어태치먼트의 높이제어를 실행하는, 쇼벨의 제어방법.
3. The method according to claim 1 or 2,
The plane position control of the end attachment is performed on the plane parallel to the plane having the set angle of the side face by the operation of the one lever and the plane position control is performed on the plane parallel to the plane or the horizontal plane Wherein the height control of the end attachment is performed with respect to the end attachment.
1개의 레버의 조작에 의하여, 엔드 어태치먼트의 높이를 유지하면서 상기 엔드 어태치먼트의 평면위치제어를 실행하거나, 상기 엔드 어태치먼트의 평면위치를 유지하면서 상기 엔드 어태치먼트의 높이제어를 실행하는, 쇼벨의 제어장치.Wherein the control of the height of the end attachment is performed while the height of the end attachment is controlled by the operation of one lever or the height of the end attachment is controlled while maintaining the plane position of the end attachment. 제 9 항에 있어서,
상기 평면위치제어 또는 상기 높이제어를 실행하는 경우에 상기 엔드 어태치먼트의 수평면에 대한 각도를 유지하는, 쇼벨의 제어장치.
10. The method of claim 9,
And maintains an angle with respect to a horizontal plane of the end attachment in the case of executing the plane position control or the height control.
제 9 항 또는 제 10 항에 있어서,
상기 1개의 레버의 조작량에 근거하여, 적어도, 조작체 중 붐 및 암의 동작에 관한 지령치를 생성하는, 쇼벨의 제어장치.
11. The method according to claim 9 or 10,
And generates at least a command value relating to the operation of the boom and the arm in the operating body based on the operation amount of the one lever.
제 9 항 또는 제 10항에 있어서,
다른 1개의 레버의 조작에 의하여, 상기 엔드 어태치먼트의 수평면에 대한 각도를 독립하여 조정하는, 쇼벨의 제어장치.
11. The method according to claim 9 or 10,
And the angle of the end attachment with respect to the horizontal plane is adjusted independently by operation of another one of the levers.
제 9 항 또는 제 10 항에 있어서,
다른 1개의 레버의 조작에 의하여 선회를 독립하여 제어하는, 쇼벨의 제어장치.
11. The method according to claim 9 or 10,
And controlling the turning independently by the operation of another one of the levers.
제 11 항에 있어서,
상기 조작체의 각각에 장착된 자세센서의 출력에 근거하여 상기 조작체의 각각을 피드백제어하는, 쇼벨의 제어장치.
12. The method of claim 11,
And feedback control is performed on each of the operating bodies based on an output of an attitude sensor mounted on each of the operating bodies.
제 9 항 또는 제 10 항에 있어서,
상기 1개의 레버의 조작에 의하여, 설정된 법면각도를 가지는 법면에 평행한 평면에 대해서 상기 엔드 어태치먼트의 평면위치제어 또는 높이제어를 실행하는, 쇼벨의 제어장치.
11. The method according to claim 9 or 10,
Wherein the planar position control or the height control of the end attachment is performed on a plane parallel to a surface having a set surface angle by operation of the one lever.
제 9 항 또는 제 10 항에 있어서,
상기 1개의 레버의 조작에 의하여, 설정된 법면각도를 가지는 법면에 평행한 평면에 대해서 상기 엔드 어태치먼트의 평면위치제어를 실행하고, 또한, 다른 레버의 조작에 의하여, 상기 법면 또는 수평면에 평행한 평면에 대해서 상기 엔드 어태치먼트의 높이제어를 실행하는, 쇼벨의 제어장치.
11. The method according to claim 9 or 10,
The plane position control of the end attachment is performed on the plane parallel to the plane having the set angle of the side face by the operation of the one lever and the plane position control is performed on the plane parallel to the plane or the horizontal plane And controls the height of the end attachment with respect to the height of the end attachment.
KR1020147029134A 2012-06-08 2013-06-04 Excavator control method and control device KR102026348B1 (en)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2012131013 2012-06-08
JPJP-P-2012-131013 2012-06-08
PCT/JP2013/065509 WO2013183654A1 (en) 2012-06-08 2013-06-04 Excavator control method and control device

Related Child Applications (1)

Application Number Title Priority Date Filing Date
KR1020197027803A Division KR102137346B1 (en) 2012-06-08 2013-06-04 Excavator control method and control device

Publications (2)

Publication Number Publication Date
KR20150016933A true KR20150016933A (en) 2015-02-13
KR102026348B1 KR102026348B1 (en) 2019-11-04

Family

ID=49712043

Family Applications (2)

Application Number Title Priority Date Filing Date
KR1020197027803A KR102137346B1 (en) 2012-06-08 2013-06-04 Excavator control method and control device
KR1020147029134A KR102026348B1 (en) 2012-06-08 2013-06-04 Excavator control method and control device

Family Applications Before (1)

Application Number Title Priority Date Filing Date
KR1020197027803A KR102137346B1 (en) 2012-06-08 2013-06-04 Excavator control method and control device

Country Status (6)

Country Link
US (2) US9915054B2 (en)
EP (1) EP2860315A4 (en)
JP (4) JP6088508B2 (en)
KR (2) KR102137346B1 (en)
CN (2) CN104246081B (en)
WO (1) WO2013183654A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20170058125A (en) 2015-11-18 2017-05-26 두산인프라코어 주식회사 Control method for construction machinery

Families Citing this family (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2860315A4 (en) * 2012-06-08 2016-01-06 Sumitomo Heavy Industries Excavator control method and control device
SE537716C2 (en) * 2013-06-25 2015-10-06 Steelwrist Ab Systems, methods and computer programs to control movement of a construction machine's work tools
JP5856685B1 (en) * 2014-06-02 2016-02-10 株式会社小松製作所 Construction machine control system, construction machine, and construction machine control method
JP6591531B2 (en) * 2015-03-27 2019-10-16 住友建機株式会社 Excavator
EP3640401B1 (en) * 2015-09-16 2023-04-26 Sumitomo Heavy Industries, Ltd. Excavator
WO2017072877A1 (en) 2015-10-28 2017-05-04 株式会社小松製作所 Work machine calibration device, work machine, and work machine calibration method
CA2978389A1 (en) * 2016-09-08 2018-03-08 Harnischfeger Technologies, Inc. System and method for semi-autonomous control of an industrial machine
JP6450008B2 (en) * 2016-11-29 2019-01-09 株式会社小松製作所 Work machine control device and work machine
WO2017086488A1 (en) * 2016-11-29 2017-05-26 株式会社小松製作所 Control device for construction equipment and control method for construction equipment
JP6714534B2 (en) * 2017-03-29 2020-06-24 日立建機株式会社 Construction machinery
WO2019131721A1 (en) 2017-12-27 2019-07-04 株式会社クボタ Work equipment and method for producing work equipment
JP6946173B2 (en) * 2017-12-27 2021-10-06 株式会社クボタ Work machine
DE202018100592U1 (en) * 2018-02-02 2019-05-03 Liebherr-Hydraulikbagger Gmbh Operating device for a working device and working device with appropriate operating device
CN111868336B (en) * 2018-03-30 2022-08-16 住友重机械工业株式会社 Construction machine and information processing device
JP7082011B2 (en) * 2018-08-23 2022-06-07 株式会社神戸製鋼所 Hydraulic drive of excavation work machine
JP7096105B2 (en) * 2018-08-23 2022-07-05 株式会社神戸製鋼所 Hydraulic drive of excavation work machine
JP7301875B2 (en) * 2018-11-14 2023-07-03 住友重機械工業株式会社 excavator, excavator controller
CN111335396B (en) * 2020-03-16 2021-09-17 盐城工业职业技术学院 Echo state network-based closed-loop control device and method for telex excavator position
US20220025616A1 (en) * 2020-07-22 2022-01-27 Deere & Company Mobile machine control system
CN112095710A (en) * 2020-09-16 2020-12-18 上海三一重机股份有限公司 Excavator pose display method and device and excavator applying same
JP7424960B2 (en) 2020-11-17 2024-01-30 株式会社小松製作所 Information acquisition system and information acquisition method
DE102022105450A1 (en) 2022-03-08 2023-09-14 Wacker Neuson Linz Gmbh Construction machine or agricultural machine
CN114753433B (en) * 2022-05-30 2023-06-06 江苏朗禾控制系统有限公司 Control method of novel excavator single-handle control system

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5424623A (en) * 1993-05-13 1995-06-13 Caterpillar Inc. Coordinated control for a work implement
JPH09170244A (en) * 1995-10-31 1997-06-30 Samsung Heavy Ind Co Ltd Control method of excavator
JPH09287165A (en) * 1996-04-23 1997-11-04 Sumitomo Constr Mach Co Ltd Automatic straight digger of hydraulic shovel
JPH10292417A (en) * 1997-04-21 1998-11-04 Hitachi Constr Mach Co Ltd Front control device for construction machine
JPH11247217A (en) * 1998-03-05 1999-09-14 Komatsu Ltd Working machine control device for construction machine
US20080041805A1 (en) * 2006-08-16 2008-02-21 Jarkko Jantti Control Of A Boom Construction And A Tool Articulated Thereto
US20110318157A1 (en) * 2009-03-06 2011-12-29 Komatsu Ltd. Construction Machine, Method for Controlling Construction Machine, and Program for Causing Computer to Execute the Method

Family Cites Families (56)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5530038A (en) * 1978-08-23 1980-03-03 Komatsu Ltd Control device for a working machine
JPS60152733A (en) * 1984-01-18 1985-08-12 Kubota Ltd Backhoe working vehicle
JPH0637781B2 (en) * 1985-12-30 1994-05-18 株式会社加藤製作所 Control device for power shovel
US4712376A (en) * 1986-10-22 1987-12-15 Caterpillar Inc. Proportional valve control apparatus for fluid systems
US5178510A (en) * 1988-08-02 1993-01-12 Kabushiki Kaisha Komatsu Seisakusho Apparatus for controlling the hydraulic cylinder of a power shovel
EP0380665B1 (en) * 1988-08-02 1993-10-27 Kabushiki Kaisha Komatsu Seisakusho Method and apparatus for controlling working units of power shovel
US5002454A (en) * 1988-09-08 1991-03-26 Caterpillar Inc. Intuitive joystick control for a work implement
US5160239A (en) * 1988-09-08 1992-11-03 Caterpillar Inc. Coordinated control for a work implement
US5470190A (en) * 1990-02-21 1995-11-28 Bamford Excavators, Limited Loader vehicle
JPH0630254U (en) * 1991-07-09 1994-04-19 雄介 丸山 Interlocking control lever
JP3364303B2 (en) * 1993-12-24 2003-01-08 株式会社小松製作所 Work machine control device
US5620053A (en) * 1994-01-28 1997-04-15 Komatsu, Ltd. Blade apparatus and its control method in bulldozer
JPH07305375A (en) * 1994-05-12 1995-11-21 Hitachi Constr Mach Co Ltd Working device for tamping
JP3537520B2 (en) * 1994-12-12 2004-06-14 ヤンマー株式会社 Drilling control device
JP3457762B2 (en) 1995-04-07 2003-10-20 日立建機株式会社 Excavation trajectory control device for hydraulic excavator
US5957989A (en) * 1996-01-22 1999-09-28 Hitachi Construction Machinery Co. Ltd. Interference preventing system for construction machine
US5704429A (en) * 1996-03-30 1998-01-06 Samsung Heavy Industries Co., Ltd. Control system of an excavator
JP3441886B2 (en) * 1996-06-18 2003-09-02 日立建機株式会社 Automatic trajectory control device for hydraulic construction machinery
JPH1037230A (en) * 1996-07-23 1998-02-10 Hitachi Constr Mach Co Ltd Track automatic controller of hydraulic dredging machine
JPH1088609A (en) * 1996-09-11 1998-04-07 Yanmar Diesel Engine Co Ltd Control mechanism of excavation working machine
JP3462683B2 (en) * 1996-12-25 2003-11-05 株式会社クボタ Backhoe
JP3462686B2 (en) * 1997-01-22 2003-11-05 株式会社クボタ Backhoe
KR100353566B1 (en) * 1997-02-13 2003-01-06 히다치 겡키 가부시키 가이샤 A slope excavation control device of a hydraulic excavator, a target slope setting device, and a slope excavation forming method
JPH1136361A (en) * 1997-07-18 1999-02-09 Kubota Corp Back hoe
US6025686A (en) * 1997-07-23 2000-02-15 Harnischfeger Corporation Method and system for controlling movement of a digging dipper
JPH11336129A (en) * 1998-05-28 1999-12-07 Hitachi Constr Mach Co Ltd Operating pedal device for construction machine
JP2000064336A (en) * 1998-08-19 2000-02-29 Sumitomo Constr Mach Co Ltd Automatically and horizontally drawing device for crane specification hydraulic shovel
WO2000034591A1 (en) * 1998-12-04 2000-06-15 Shin Caterpillar Mitsubishi Ltd. Construction machine
US6226902B1 (en) * 1999-07-16 2001-05-08 Case Corporation Operator presence system with bypass logic
US6435289B1 (en) * 1999-09-22 2002-08-20 Komatsu Ltd. Apparatus for altering operation apparatus and actuator combinations, and operation lever apparatus
JP3661596B2 (en) * 2001-02-23 2005-06-15 コベルコ建機株式会社 Construction machine operation circuit
JP2002250047A (en) * 2001-02-23 2002-09-06 Hitachi Constr Mach Co Ltd Pipe support structure for hydraulic back hoe
JP3657894B2 (en) * 2001-07-18 2005-06-08 マルマテクニカ株式会社 Manual operation of hydraulic excavator
JP3779919B2 (en) * 2001-12-07 2006-05-31 日立建機株式会社 Construction machine operation device
AU2003261824B2 (en) * 2002-09-05 2007-05-17 Hitachi Construction Machinery Co., Ltd. Hydraulic driving system of construction machinery
JP2004132194A (en) * 2002-10-08 2004-04-30 Calsonic Kansei Corp Steering operation unit for vehicle
US8424302B2 (en) * 2005-10-28 2013-04-23 Komatsu Ltd. Control device of engine, control device of engine and hydraulic pump, and control device of engine, hydraulic pump, and generator motor
EP1835079B1 (en) * 2006-03-17 2008-05-07 Qinghua He Electromechanically controlled excavator and method for controlling the electromechanically controlled excavator.
US9074352B2 (en) * 2006-03-27 2015-07-07 John R. Ramun Universal control scheme for mobile hydraulic equipment and method for achieving the same
US7979181B2 (en) * 2006-10-19 2011-07-12 Caterpillar Inc. Velocity based control process for a machine digging cycle
KR101265342B1 (en) * 2006-12-22 2013-05-20 두산인프라코어 주식회사 Flat and slant improvement device of excavator
GB0625764D0 (en) * 2006-12-22 2007-02-07 Bamford Excavators Ltd Control apparatus for a machine
US8621855B2 (en) * 2007-06-08 2014-01-07 Deere & Company Electro-hydraulic auxiliary mode control
US20100254793A1 (en) * 2007-06-15 2010-10-07 Boris Trifunovic Electronic Anti-Spill
JP2009197425A (en) * 2008-02-20 2009-09-03 Komatsu Ltd Construction machine
CN201305864Y (en) * 2008-10-12 2009-09-09 姚实现 Novel leveling type link mechanism and working device thereof, working machine including overhead working truck, loader and the like
WO2010143628A1 (en) * 2009-06-09 2010-12-16 住友重機械工業株式会社 Hybrid excavator and manufacturing method therefor
US8401746B2 (en) * 2009-12-18 2013-03-19 Trimble Navigation Limited Excavator control using ranging radios
CN201581425U (en) * 2010-01-08 2010-09-15 徐工集团工程机械股份有限公司科技分公司 Loader bucket flatting automatic control device
US8272468B2 (en) * 2010-02-25 2012-09-25 Yanmar Co., Ltd. Work machine
JP5584539B2 (en) * 2010-07-09 2014-09-03 キャタピラー エス エー アール エル Work range control device for work machines
US8380402B2 (en) * 2010-09-14 2013-02-19 Bucyrus Intl. Inc. Control systems and methods for heavy equipment
US8340875B1 (en) * 2011-06-16 2012-12-25 Caterpillar Inc. Lift system implementing velocity-based feedforward control
US20130180744A1 (en) * 2012-01-12 2013-07-18 Caterpillar, Inc. Operator Interface for an Implement Control System
EP2816159B1 (en) * 2012-02-15 2018-01-10 Hitachi Construction Machinery Co., Ltd. Dual-arm work machine
EP2860315A4 (en) 2012-06-08 2016-01-06 Sumitomo Heavy Industries Excavator control method and control device

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5424623A (en) * 1993-05-13 1995-06-13 Caterpillar Inc. Coordinated control for a work implement
JPH09170244A (en) * 1995-10-31 1997-06-30 Samsung Heavy Ind Co Ltd Control method of excavator
JPH09287165A (en) * 1996-04-23 1997-11-04 Sumitomo Constr Mach Co Ltd Automatic straight digger of hydraulic shovel
JPH10292417A (en) * 1997-04-21 1998-11-04 Hitachi Constr Mach Co Ltd Front control device for construction machine
JPH11247217A (en) * 1998-03-05 1999-09-14 Komatsu Ltd Working machine control device for construction machine
US20080041805A1 (en) * 2006-08-16 2008-02-21 Jarkko Jantti Control Of A Boom Construction And A Tool Articulated Thereto
US20110318157A1 (en) * 2009-03-06 2011-12-29 Komatsu Ltd. Construction Machine, Method for Controlling Construction Machine, and Program for Causing Computer to Execute the Method

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20170058125A (en) 2015-11-18 2017-05-26 두산인프라코어 주식회사 Control method for construction machinery

Also Published As

Publication number Publication date
KR20190110650A (en) 2019-09-30
JP2019178608A (en) 2019-10-17
CN108425389A (en) 2018-08-21
JP7009424B2 (en) 2022-01-25
JP7051785B2 (en) 2022-04-11
JP6088508B2 (en) 2017-03-01
EP2860315A4 (en) 2016-01-06
US20180187394A1 (en) 2018-07-05
EP2860315A1 (en) 2015-04-15
CN104246081B (en) 2018-05-22
JP6675995B2 (en) 2020-04-08
US11248361B2 (en) 2022-02-15
US9915054B2 (en) 2018-03-13
JP2017075529A (en) 2017-04-20
CN104246081A (en) 2014-12-24
KR102026348B1 (en) 2019-11-04
US20150039189A1 (en) 2015-02-05
JP2020029769A (en) 2020-02-27
KR102137346B1 (en) 2020-07-23
WO2013183654A1 (en) 2013-12-12
JPWO2013183654A1 (en) 2016-02-01

Similar Documents

Publication Publication Date Title
JP7009424B2 (en) Excavator
US9187880B2 (en) Electric drive unit for construction machine
KR20100115706A (en) Hybrid type work machine
CN110945187B (en) Excavator
KR101565057B1 (en) Slew drive device
JP6894847B2 (en) Work machine and control method of work machine
CN106661871B (en) Control system, work machine, and control method
US9654038B2 (en) Control device and method for controlling electric motor
CN114026293A (en) Excavator
CN112411662B (en) Excavator
KR20230015315A (en) Systems for shovel and shovel
CN105829615A (en) Construction Machine, Hybrid Hydraulic Shovel, And Method For Controlling Output Torque Of Motor Generator
EP3951086B1 (en) Excavator
JPWO2015199249A1 (en) Work vehicle and control method thereof
KR101656765B1 (en) Working vehicle and working vehicle control method
KR20190017719A (en) Work machine and control method of work machine
EP4317610A1 (en) Electric work machine
KR20120114945A (en) Reference swing speed control method for a excavator

Legal Events

Date Code Title Description
E902 Notification of reason for refusal
E701 Decision to grant or registration of patent right
A107 Divisional application of patent
GRNT Written decision to grant