KR20110022100A

KR20110022100A - Cylindrical coordinate system backhoe machine operation interface

Info

Publication number: KR20110022100A
Application number: KR1020090079322A
Authority: KR
Inventors: 윤정원; 오라리우스 마누룽; 성현석; 허민호
Original assignee: 경상대학교산학협력단; 우성정공 주식회사
Priority date: 2009-08-26
Filing date: 2009-08-26
Publication date: 2011-03-07

Abstract

본 발명은 유압 구동 방식의 백호작업기에 사용자 직관적인 조작을 허용하기 위해 암 끝단의 병진움직임 및 버켓의 피치운동을 2개의 전기식 2축 조이스틱 조작을 통해 직관적으로 움직이도록 하고 이때 조이스틱 조작에 대응하여 작업기 끝단이 원통 좌표계에서 움직일 수 있도록 유압 실린더의 위치제어기반 속도 제어 방법을 제공하여 초보자도 숙련된 연습 없이 효율적이고 정밀하게 작업기 제어가 가능 하게 하는 원통좌표계 연동 백호작업기 조작 인터페이스에 관한 것이다.The present invention is to intuitively move the translational movement of the end of the arm and the pitch movement of the bucket to operate the two electric two-axis joystick operation in order to allow the user intuitive operation on the hydraulic back-type backhoe work machine and in response to the joystick operation The present invention relates to a cylindrical coordinate system interlocking backhoe operator operating interface that provides a position control-based speed control method of a hydraulic cylinder so that an end can move in a cylindrical coordinate system.

Description

Operation Interface of Hydraulic Backhoe with Cylindrical Coordinate Control

본 발명은 트랙터나 로더 등에 탈부착이 가능한 유압 구동식 백호작업기에 사용자 직관적인 조작을 허용하기 위해 작업기 끝단의 움직임을 조이스틱들을 통해 직관적으로 움직이도록 하고 조이스틱 조작에 대응하여 작업기가 원통좌표계에서 움직일 수 있도록 유압 실린더의 위치기반 속도 제어를 통해서 초보자도 숙련된 연습 없이 효율적이고 정밀하게 작업기 제어가 가능하게 하는 원통좌표계 연동 백호작업기 조작 인터페이스를 제공하는 것이다.The present invention allows the user to move the end of the work machine intuitively through the joysticks and allow the work machine to move in the cylindrical coordinate system in order to allow the user intuitive operation to the hydraulically driven backhoe work that can be attached to or detached from the tractor or loader. The position-based speed control of the hydraulic cylinder provides a cylindrical coordinate system interlocking backhoe machine operation interface that enables the beginner to control the machine efficiently and precisely without skilled practice.

농업용 트랙터에 탈·부착이 가능한 백호(backhoe) 작업기는 조작밸브, 붐, 아암, 버켓, 아웃터리거장치로 구성되어 토양관리, 밭작물수확, 소규모의 건축, 토목등 농·축산업의 다목적 작업에 사용하기 위한 첨단 농기계용 작업기이다. 기존의 중장비 굴삭기와 같은 구조로 붐(boom), 아암(arm), 버켓(bucket)을 구동하는 3개의 유압 실린더의 변위를 운전 좌석의 조작레버를 조절하여 최종적으로 버켓의 위치 및 피치각을 제어하게 하고, 메인프레임에 부착된 스윙(swing) 실린더의 조작에 작업기 전체의 선회동작을 구현하는 총 4자유도 운동 발생구조를 가져 다양한 굴삭 작업을 수행할 수 있게 한다. 하지만, 오랜 운전 경험을 가진 전문 굴삭기 자격자는 백호 작어기 조작에 어려움이 없지만, 능숙한 굴삭기 작업 기술 습득에 오랜 시간이 걸리고, 평탄화 작업등을 위해 유압 조작밸브 조작 레버를 동시에 작동시켜야 할 경우 피로도가 증대되는 어려움이 있다. 특히, 체계적이고 오랜 훈련을 받지 않은 경우 백호작업기의 효율적인 사용이 거의 불가능하고, 토양관리, 밭작물수확, 소규모의 건축, 토목등 농·축산업의 다목적 작업에 사용하기 위한 요구가 증대됨에 따라 단순 교육을 마친 일반인들의 백호작업기 굴삭 작업의 사용이 증대되고 있어 기존의 굴삭기 조작 인터페이스로는 백호작업기를 이용하여 효율적인 굴삭 작업을 수행하는데 한계를 가지고 있다. The backhoe working machine, which can be attached to or detached from an agricultural tractor, consists of a control valve, a boom, an arm, a bucket, and an outrigger, so that it can be used for multi-purpose work in the agricultural and livestock industry such as soil management, field crop harvesting, small scale construction, and civil engineering. It is an advanced agricultural machinery work machine. With the same structure as the existing heavy equipment excavator, the displacement of the three hydraulic cylinders that drive the boom, arm, and bucket is controlled by adjusting the operating lever of the driving seat to finally control the position and pitch angle of the bucket. In addition, it has a total of four degrees of freedom movement generating structure that implements the swing operation of the whole machine to the operation of the swing cylinder attached to the main frame to perform a variety of excavation work. However, a professional excavator qualified person with long driving experience has no difficulty in manipulating the backhoe compactor, but it takes a long time to acquire skillful excavator working skills, and the fatigue is increased when the hydraulic control valve operating levers must be operated at the same time for flattening work. There is difficulty. In particular, it is almost impossible to use the backhoe work without systematic and long-time training, and the simple education has been increased due to the increasing demand for multipurpose work in agriculture and livestock industry such as soil management, field crop harvesting, small scale construction, and civil engineering. As the use of backhoe workers excavation work has been increased by the general public, the existing excavator operation interface has a limitation in performing an efficient excavation work using a backhoe worker.

유압구동식 백호작업기 굴삭 조작을 위해서 기계식 레버장치가 전통적으로 사용되었으나, 여러 개의 레버 및 발판의 복잡한 인터페이스로 인해 작업자의 불편함이 크고 쉽게 피곤함을 느껴 최근에는 대부분 유압식 조이스틱 타입을 도입하고 있다. Caterpillar 사에서 개발한 조이스틱타입은 2개의 조이스틱을 이용하여 우측 조이스틱의 상하방향은 붐 상승하강으로, 좌우방향은 버켓 ??향조절과 매칭되고, 좌측 조이스틱의 상하 방향은 암의 상승하강 및 좌우방향은 선회동작조절에 매칭되어 사용되었다. 최근에 나온 미니굴삭기를 포함한 대부분의 작업기는 조이스틱타입을 채용하여 작업기의 조작 조건을 많이 향상시키고 있지만, 역시 조이스틱의 움직임이 각 실린더의 운동과 매칭되어, 사용자 직관적이라고 하기엔 많은 훈련이 필요 하다. Mechanical lever device has been traditionally used for excavation operation of hydraulically driven backhoe work machine. However, due to the complicated interface of several levers and scaffolding, the operator's discomfort is large and easily felt. The joystick type developed by Caterpillar Co., Ltd. uses two joysticks, the up and down direction of the right joystick is boom up and down, the left and right directions are matched with the bucket ?? direction control, and the left and right joystick is the up and down direction of the arm Was used to match swing control. Most of the work machines including the recent mini excavator have adopted the joystick type to improve the operation conditions of the work machine, but the movement of the joystick is matched with the motion of each cylinder, which requires a lot of training to be intuitive.

최근 관련연구동향을 살펴보면, 굴삭기용 자동제어장치 개발에 힘을 기울여 굴삭각등 기본정보를 입력하면 자동으로 굴삭작업을 수행하도록 하여 작업자의 피로도를 줄이기 위한 방법(건설기계의 자동 평탄작업장치 및 방법, 특2000-0021934; 굴삭기의 제어방법, 특1997-0021547)들이 제시되고 있으나 굴삭기의 특성상 굴삭 작업의 복잡성, 작업 내용의 변화성, 작업 환경의 다양성 등으로 굴삭기의 자동화를 실제 작업 환경에 적용하기는 쉽지 않다.Looking at the recent research trend, the method to reduce the fatigue of the operator by performing the excavation work automatically by inputting basic information, such as the excavation angle, by focusing on the development of the automatic control device for excavators (automatic flat work equipment and methods of construction machinery) Although the control method of excavators has been proposed, it is proposed to apply the automation of excavators to the actual working environment due to the complexity of the excavation work, the change of work contents, and the diversity of working environment. Is not easy.

기존 굴삭 작업기의 작업 방법은 작업기 끝단에 있는 버켓이 상하, 좌우, 전후의 병진(translation) 운동 및 버켓의 피치운동이 가능하도록 붐, 암, 버켓, 메인프레임을 적절히 조작해야 한다. 따라서, 작업기 역기구학을 임베디드 제어기에 삽입하여 조작 레버의 각 방향 운동을 작업기 각 실린더의 운동으로 매칭하는 것이 아니라 작업기 아암 끝단의 직교좌표운동과 작업레버를 바로 연결시켜 주는 개념의 특허(유압굴삭기용 직교좌표형 조작시스템, 특1995-0011780)가 이미 발표되었다. 하지만, 일반 유압굴삭기는 작업기를 포함하고 있는 베이스가 회전하여 작업자는 항상 작업기를 정면으로 바라보고 있지만, 트랙터 등에 부착되는 소형굴삭용 백호작업기는 소형화 및 장착의 편의성 등을 고려하여 사용자 및 베이스를 제외하고 작업기만 회전하는 방식이다. 따라서, 작업자가 항상 작업기 정면을 바로 보는 것이 아니라서 직교좌표 방식으로는 선회동작 이후의 굴삭작업을 직관적으로 작업하기에는 어려움이 있다. 또한, 실제 조작 장치와 끝단을 연동시키기 위해서는 조작 장치의 입력 값에 따르는 각 유압 실린더의 정밀한 속도제어가 구현되어야 조작기의 입 력과 굴삭작업기 끝단이 효율적으로 연동될 수 있지만, 관련 유압 장치의 제어기 구현 내용이 제시되고 있지 않다. 최근, 원격작업 시 햅틱장치를 통하여 굴삭기 조종을 위한 입력장치(병렬형 햅틱장치를 이용한 굴삭기 조정장치, 특2009-0061508)가 공개되었으며 3자유도 병진 병렬기구를 이용한 햅틱장치 및 버켓조종을 위한 1자유도 햅틱장치의 혼합으로 한 손으로 4자유도의 굴삭기를 제어하고자 하였다. 하지만 원격조작이 아니라 실제 유압굴삭기에 장착할 경우 기존 조작 시스템 개념을 완전히 바꿔야 하는 문제점이 발생하고, 굴삭 작업의 경우 원격조작으로는 다양하고 복잡한 환경 및 굴삭 작업을 수행하는데 제한 사항이 많은 단점이 있다.The existing working method of the excavator is to properly manipulate the boom, arm, bucket, and mainframe so that the bucket at the end of the excavator can perform the translation movement of the bucket up and down, left and right, front and rear, and the pitch movement of the bucket. Therefore, the patent of the concept of inserting the work machine inverse kinematics into the embedded controller to directly connect the work lever with the orthogonal coordinate movement of the work machine arm end, rather than matching the directional motion of the control lever to the motion of each cylinder of the work machine (for hydraulic excavators). Cartesian coordinate control system, in particular 1995-0011780, has already been published. However, the general hydraulic excavator rotates the base including the work machine, and the operator always looks at the front of the work machine, but the backhoe work for small excavators attached to the tractor is excluded from the user and the base in consideration of the miniaturization and convenience of mounting. Only the work machine rotates. Therefore, the operator does not always directly look at the front of the work machine, it is difficult to intuitively work the excavation work after the turning operation in the rectangular coordinate method. In addition, in order to interlock the end with the actual operating device, precise speed control of each hydraulic cylinder according to the input value of the operating device must be implemented so that the input of the manipulator and the end of the excavator can be efficiently interlocked, but the controller of the related hydraulic device is implemented. The content is not presented. Recently, an input device for excavator control through a haptic device for remote operation (excavator adjusting device using a parallel haptic device, special 2009-0061508) has been disclosed, and for haptic device and bucket control using a three degree of freedom translation parallel mechanism. We tried to control four degree of freedom excavator with one hand by mixing the degree of freedom haptic device. However, when mounted on an actual hydraulic excavator, rather than remote operation, there is a problem that the concept of the existing operating system must be completely changed, and in the case of an excavation operation, remote operation has various disadvantages in performing various and complex environments and excavation operations. .

본 발명은 상기한 문제점을 개선하기 위하여 안출된 것으로, 본 발명의 목적은 유압식 백호작업기의 끝단의 움직임을 2개의 전자식 조이스틱을 통해 기존 방식과 유사한 조작 방식을 유지하도록 하면서 원통좌표계(Cylindrical Coordinate) 매칭을 통하여 우측 조이스틱의 전후운동은 작업기 끝단의 상하운동으로 조이스틱 좌우운동은 버켓의 피치운동으로 매칭되고, 좌측 조이스틱의 전후 운동은 작업기 끝단의 전후운동으로, 조이스틱 좌우운동은 선회운동으로 매칭 되도록 하고 조이스틱과 실린더 제어 밸브사이에 기구학 및 밸브제어기를 포함하는 조작 인터페이스회로가 삽입되어 각각 붐, 아암, 버켓 실린더 및 선회운동 실린더를 조절할 수 있도록 하는 직관적 굴삭작업기 조작 방식을 구현할 수 있는 원통좌표계 연동 백호작업기 조작 인터페이스를 제공하는 데 있다. 또한, 본 발명에서는 이와 같은 인터페이스를 이용하여 조이스틱 입력에 대응하는 끝단의 속도제어가 유압장치 및 각 링크에 연성에 의한 비선형성에 강건 할 수 있도록 위치제어기반 속도제어(rate control) 방식의 유압굴삭기 조작제어기를 제시하고자 한다.The present invention has been made to solve the above problems, and an object of the present invention is to match the cylindrical coordinate system (Cylindrical Coordinate) while maintaining the operation of the end of the hydraulic backhoe working machine similar to the conventional method through the two electronic joysticks Through the right and left movement of the right joystick is the vertical movement of the end of the work machine, joystick left and right movement is matched with the pitch movement of the bucket, the left and right joystick is the forward and backward movement of the work machine end, and the joystick left and right movement is matched with the turning movement and the joystick An operation interface circuit including kinematics and a valve controller is inserted between the cylinder control valve and the cylinder control valve to operate an intuitive excavator operation method that can adjust the boom, arm, bucket cylinder and swing cylinder, respectively. Article interface It is in the ball. In addition, in the present invention, the speed control of the end corresponding to the joystick input by using the interface such that the hydraulic excavator of the position control-based speed control (rate control) method to be robust to the nonlinearity of the hydraulic device and each link by ductility I would like to present a controller.

상기한 바와 같은 목적을 달성하기 위한 본 발명에 의한 원통좌표계 연동 백호작업기 조작 인터페이스는, 유압식 실린더의 구동기 및 붐, 암, 버켓, 선회동작 베이스의 본체로 구성된 백호작업기를 조작하기 위한 백호작업기 조작 인터페이스 에 있어서, 백호작업기 끝단(2-End-Effector)을 원통좌표계 연동으로 조작하도록 좌측 전자식 조이스틱(1a), 우측 전자식 조이스틱(1b), 좌표계 변환제어기 인터페이스(4), 붐, 암, 버켓, 선회 실린더밸브들(3-1, 3-2, 3-3, 3-4)를 포함하여 구성되며, 상기 전자식 조이스틱(1a, 1b)으로부터 입력되는 전기신호에 따라 상기 백호작업기 끝단(2-End-Effector)이 원통좌표계 상에서 작동하도록, 상기 좌표계 변환제어기 인터페이스(4)에서 상기 전자식 조이스틱(1a, 1b)의 변위를 입력받고 변위에 비례해서 상기 백호작업기 끝단(2-End-Effector)에 원통좌표계 속도지령을 발생시켜 이에 대응하는 백호작업기 각각의 유압 실린더가 구동되도록 붐, 암, 버켓, 선회 실린더밸브(3-1, 3-2, 3-3, 3-4)를 제어하는 것을 특징으로 한다.Cylindrical coordinate system interlocking backhoe worker operation interface according to the present invention for achieving the above object is a backhoe worker operation interface for operating a backhoe work consisting of the actuator of the hydraulic cylinder and the main body of the boom, arm, bucket, pivoting base , The left electronic joystick (1a), the right electronic joystick (1b), coordinate system controller controller (4), boom, arm, bucket, swing cylinder to operate the back-end work machine end (2-End-Effector) with the cylindrical coordinate system. Valves 3-1, 3-2, 3-3, and 3-4, and end of the backhoe work machine according to an electrical signal input from the electronic joysticks 1a and 1b. ) Receives the displacement of the electronic joystick (1a, 1b) from the coordinate system conversion controller interface (4) so as to operate on the cylindrical coordinate system and the backhoe operator end (2-End-Effector) in proportion to the displacement. To control the boom, arm, bucket, and swing cylinder valves (3-1, 3-2, 3-3, 3-4) to generate the cylinder coordinate system speed command to drive the hydraulic cylinders of the corresponding backhoe work machines. It features.

이 때, 좌측 조이스틱 좌우방향(1-1)은 백호작업기 원통좌표계 회전방향(2-1)을, 좌측 조이스틱 전후방향(1-2)은 백호작업기 원통좌표계 반경방향(2-2)을, 우측 조이스틱 좌우방향(1-3)은 백호작업기 버켓 회전방향(2-3)을, 우측 조이스틱 전후방향(1-4)은 백호작업기 원통좌표계 높이방향(2-4)을 각각 제어하도록 매칭되는 것을 특징으로 한다.At this time, the left joystick left and right direction (1-1) is the backhoe machine cylindrical coordinate system rotation direction (2-1), the left joystick front and rear direction (1-2) is the backhoe worker cylindrical coordinate system radial direction (2-2), right The joystick left and right directions (1-3) are matched to control the backhoe working bucket rotation direction (2-3), and the right joystick front and rear directions (1-4) control the backhoe working cylinder coordinate system height directions (2-4), respectively. It is done.

또한, 상기 좌표계 변환제어기 인터페이스(4)는 두 개의 상기 전자식 조이스틱(1a, 1b)으로부터 변위 신호들(1-1, 1-2, 1-3, 1-4)을 아날로그/디지털(A/D) 변환보드를 통해 입력받되, 입력된 조이스틱 변위에 비례해서 작업기 끝단의 속도지령 값을 발생시키는 레이트제어기(4-1), 변위에 비례해서 원통좌표계 각 축에 대한 속도의 크기를 결정할 수 있는 원통좌표계 속도게인들(4-1a, 4-1b, 4-1c, 4-d), 레이트제어기(4-1)에서 발생된 끝단(2-End-Effector) 이동 지령 값을 피드백 제어하 는 원통좌표계 기반제어(4-2), 원통좌표계 기반제어를 유압 실린더 제어모드로 변환하는 구동기제어기(4-3), 구동기 피드백제어를 위한 각 실린더 변위센서값들(4-DS1, 4-DS2, 4-DS3, 4-DS4)의 입력, 구동기제어기(4-3)의 결과 값을 이용해 전자식 유압비례제어밸브들(3-1, 3-2, 3-3, 3-4)을 구동하기 위한 디지털/아날로그(D/A) 변환기로 구성되는 것을 특징으로 한다.In addition, the coordinate system controller 4 converts the displacement signals 1-1, 1-2, 1-3, 1-4 from the two electronic joysticks 1a, 1b into analog / digital (A / D). Rate controller (4-1), which receives the speed command value at the end of the work machine in proportion to the input joystick displacement, and a cylinder that can determine the magnitude of the velocity for each axis in the cylindrical coordinate system in proportion to the displacement. Cylindrical coordinate system which feedback-controls the value of 2-End-Effector movement command generated from coordinate gains 4-1a, 4-1b, 4-1c, and 4-d and rate controller 4-1. The base controller (4-2), the actuator controller (4-3) for converting the cylindrical coordinate system-based control into the hydraulic cylinder control mode, and the respective cylinder displacement sensor values (4-DS1, 4-DS2, 4- for the driver feedback control). D3, 4-DS4) inputs, and the resultant values of the driver controller 4-3 to drive the electronic hydraulic proportional control valves 3-1, 3-2, 3-3, 3-4. Hair / and being configured to analog (D / A) converter.

이 때, 조이스틱 입력변위(1-a, 1-b)에 따라 좌표계 기반 속도제어를 발생시키는 레이트제어기(4-1)의 출력값과 제어를 시작할 때의 작업기끝단초기값(4-1-Initial)과 합해져서 좌표계명령값(4-2-Command)이 발생되고, 상기 좌표계명령값(4-2-Command)은 원통좌표계 기반제어기(4-2) 입력 값으로 들어가며, 상기 좌표계명령값(4-2-Command)과 좌표계피드백제어와 합친 값은 좌표계제어입력값(4-2-Desired)으로 되어 백호작업기역기구학(4-IK)를 통하여 구동기제어입력값(4-3-Desired)로 바꿔 구동기제어기(4-3)로 들어가며, 실린더변위센서(4-DS1, 4-DS2, 4-DS3, 4-DS4)에서 측정된 구동기변위값(4-3-Actual)은 백호작업기순기구학(4-FK)를 통해서 좌표계측정값(4-2-Actual)로 변환되어 원통좌표계 기반제어기(4-2)의 피드백 제어 값으로 입력되는 것을 특징으로 한다.At this time, the output value of the rate controller 4-1 which generates coordinate system-based speed control according to the joystick input displacements (1-a, 1-b) and the work machine end initial value at the start of control (4-1-Initial) And a coordinate system command value (4-2-Command) is generated, the coordinate system command value (4-2-Command) enters an input value of the cylindrical coordinate system-based controller 4-2, and the coordinate system command value (4- The value combined with 2-command) and coordinate feedback control becomes the coordinate system control input value (4-2-desired) and changes to actuator control input value (4-3-desired) through backhoe working area kinematics (4-IK). The actuator displacement value (4-3-Actual) measured by the cylinder displacement sensors (4-DS1, 4-DS2, 4-DS3, 4-DS4) is entered into the controller (4-3). FK) is converted into a coordinate system measurement value (4-2-Actual) and is input as a feedback control value of the cylindrical coordinate system-based controller (4-2).

본 발명에 의하면, 본 발명에 따라 제안된 원통좌표계(Cylindrical Coordinate) 매칭을 통한 2개의 전자식 조이스틱을 통한 직관적 백호작업기 조작 방식의 구현을 통해, 기존 수동밸브 방식으로는 평탄화 작업과 같은 작업 시 동시에 여러 축의 작업을 수행해야만 작업이 가능했기 때문에 사용자에게 불편을 야기했던 문제점을 해결하여, 한 축의 조이스틱 조작만으로도 작업 수행이 가능하게 해 주는 큰 효과가 있다.According to the present invention, through the implementation of the intuitive backhoe operating method through the two electronic joysticks through the proposed cylindrical coordinate matching according to the present invention, the existing manual valve method at the same time during the operation such as flattening operation Solving the problem that caused inconvenience to the user because the operation was possible only by performing the operation of the axis, there is a great effect that can perform the operation only by joystick operation of one axis.

이와 같이 본 발명에 의하면, 조작성 증대로 사용자 편의성 증대 및 이로 인한 작업 효율성을 향상시킬 수 있고, 작업 조건의 개선 및 인건비 절감, 고능률화·고정밀도화로 생산의 안정성을 달성할 수 있으며, 효율적인 조작 인터페이스를 작업기에 부착하여 사용함으로써 사용자의 만족성을 배가시킬 수 있는 다양한 효과들이 있다.As described above, according to the present invention, it is possible to increase the user convenience and increase the work efficiency by increasing the operability, and to achieve the stability of the production by improving the working conditions and reducing the labor cost, high efficiency and high precision, and an efficient operation interface. There are various effects that can double the user's satisfaction by attaching to the work machine.

또한, 본 발명의 인터페이스는 기존 조작 방식과 유사하기 때문에, 기존 사용자에게 있어 친숙하기 때문에 적응 및 숙련이 매우 용이하다는 장점 또한 있다.In addition, since the interface of the present invention is similar to the existing operation method, it is also easy to adapt and skilled because it is familiar to existing users.

이하, 첨부된 도면을 참조하여 본 발명의 원통좌표계 연동 백호작업기 조작 인터페이스를 상세히 설명한다.Hereinafter, with reference to the accompanying drawings will be described in detail a cylindrical coordinate system interlocking backhoe working interface.

도 1은 본 발명에 따른 원통좌표계 연동 백호작업기 조작 인터페이스 방법의 구성도이고, 도 2는 본 발명에 따른 직교좌표계 및 원통좌표계 작동도이고, 도 3은 본 발명에 따른 백호작업기 원통좌표계 변수 구성도이고, 도 4는 본 발명에 따른 조이스틱과 백호작업기 원통좌표계 매칭 구성도이고, 도 5는 본 발명에 따른 원통 좌표계 변환제어기 하드웨어 구성도이고, 도 6은 본 발명에 따른 조이스틱 연동 원통 좌표계 제어기 구성도이고, 도 7은 본 발명에 따른 유압 제어기 구성도이다. 1 is a configuration diagram of a cylindrical coordinate system interlocking backhoe working interface method according to the present invention, Figure 2 is an operation of the Cartesian coordinate system and the cylindrical coordinate system according to the present invention, Figure 3 is a configuration diagram of the backhoe working cylinder coordinate system according to the present invention 4 is a configuration diagram of a joystick and a backhoe working cylindrical coordinate system according to the present invention, FIG. 5 is a configuration diagram of a hardware controller for converting a cylindrical coordinate system according to the present invention, and FIG. 6 is a configuration diagram of a joystick interlocking cylindrical coordinate system controller according to the present invention. 7 is a configuration diagram of a hydraulic controller according to the present invention.

본 발명의 원통좌표계 연동 백호작업기 조작 인터페이스는 도 1 및 도 5를 참조하면 크게 좌측 전자식 조이스틱(1a), 우측 전자식 조이스틱(1b), 좌표계 변환제어기 인터페이스(4), 붐, 암, 버켓, 선회 실린더밸브들(3-1, 3-2, 3-3, 3-4) 및 유압식 실린더의 구동기 및 붐, 암, 버켓, 선회동작 베이스의 본체로 구성된 백호작업기로 구성된다. Referring to FIGS. 1 and 5, the cylindrical coordinate system interlocking backhoe working interface of the present invention is largely referred to as a left electronic joystick 1a, a right electronic joystick 1b, a coordinate conversion controller interface 4, a boom, an arm, a bucket, and a turning cylinder. It consists of valves 3-1, 3-2, 3-3, 3-4 and a backhoe work consisting of the actuator of the hydraulic cylinder and the main body of the boom, arm, bucket and pivoting base.

좌측 조이스틱 좌우방향(1-1)은 원통좌표계 회전방향(2-1)을, 좌측 조이스틱 전후방향(1-2)은 백호작업기 원통좌표계 반경방향(2-2)을, 우측 조이스틱 좌우방향(1-3)은 백호작업기 버켓 회전방향(2-3)을, 우측 조이스틱 전후방향(1-4)은 백호작업기 원통좌표계 높이방향(2-4)을 각각 제어하도록 매칭되고, 작업자의 전자식 조이스틱 입력 전기신호에 따라 백호작업기의 끝단(2-End-Effector)이 원통좌표계 상에서 작동하도록 좌표계 변환제어기 인터페이스(4)에서 조이스틱의 변위를 입력 받고 변위에 비례해서 백호작업기 끝단 원통좌표계 속도지령을 발생시켜 이에 대응하는 백호작업기 각각의 유압 실린더가 구동되도록 붐, 암, 버켓, 선회 실린더밸브(3-1, 3-2, 3-3, 3-4)를 제어하는 방식으로 전자식 조이스틱을 이용한 백호작업기의 원통좌표계 연동 제어기를 구현하였다. Left joystick left and right direction (1-1) is the cylindrical coordinate system rotation direction (2-1), left joystick forward and backward direction (1-2) is the backhoe working cylinder coordinate system radial direction (2-2), right joystick left and right direction (1) -3) is matched to control the backhoe worker bucket rotation direction (2-3), the right joystick front and rear direction (1-4) respectively control the backhoe worker cylindrical coordinate system height direction (2-4), the operator's electronic joystick input electrical In response to the signal, the joystick's displacement is input from the coordinate conversion controller interface 4 so that the 2-End-Effector operates on the cylindrical coordinate system and generates and responds to the cylindrical coordinate system speed command in proportion to the displacement. Cylindrical coordinate system of backhoe work machine using electronic joystick by controlling boom, arm, bucket, swing cylinder valve (3-1, 3-2, 3-3, 3-4) to drive hydraulic cylinder of each backhoe work machine Implement interlocked controller The.

이를 위해 좌표계 변환제어기 인터페이스(4)는 두 개의 전자식 조이스틱으로부터 변위 신호들(1-1, 1-2, 1-3, 1-4)을 아날로그/디지털(A/D) 변환보드를 통해 입력받고, 입력된 조이스틱 변위에 비례해서 작업기 끝단의 속도지령 값을 발생시 키는 레이트제어기(4-1), 변위에 비례해서 원통좌표계 각 축에 대한 속도의 크기를 결정할 수 있는 원통좌표계 속도게인들(4-1a, 4-1b, 4-1c, 4-d), 레이트제어기(4-1)에서 발생된 끝단(2-End-Effector) 이동 지령 값을 피드백 제어하는 원통좌표계 기반제어기(4-2), 원통좌표계 기반제어를 유압 실린더 제어모드로 변환하는 구동기제어기(4-3), 구동기 피드백제어를 위한 각 실린더 변위센서값들(4-DS1, 4-DS2, 4-DS3, 4-DS4)의 입력, 구동기제어기(4-3)의 결과 값을 이용해 전자식 유압비례제어밸브들(3-1, 3-2, 3-3, 3-4)을 구동하기 위한 디지털/아날로그(D/A) 변환기로 구성된다. To this end, the coordinate conversion controller interface 4 receives the displacement signals (1-1, 1-2, 1-3, 1-4) from two electronic joysticks through an analog / digital (A / D) conversion board. The speed controller (4-1) generates the speed command value of the work end in proportion to the input joystick displacement, and the cylindrical coordinate system speed gains (4) that can determine the magnitude of the speed for each axis in the cylindrical coordinate system in proportion to the displacement. -1a, 4-1b, 4-1c, 4-d), Cylindrical Coordinate System-Based Controller (4-2) for Feedback Control of the 2-End-Effector Movement Command Value Generated by the Rate Controller 4-1 , The actuator controller 4-3 for converting the cylindrical coordinate system-based control to the hydraulic cylinder control mode, and the values of the respective cylinder displacement sensor values 4-4-DS1, 4-DS2, 4-DS3, 4-DS4 for actuator feedback control. Digital, analog for driving the electronic hydraulic proportional control valves 3-1, 3-2, 3-3, 3-4 using the input, the result of the actuator controller 4-3. It consists of the (D / A) converter.

도 2에 나타난 것과 같이 트랙터/로더 등에 부착되는 백호작업기는 자석과 굴삭작업기가 일체로 되어 선회동작이 동시에 발생하는 경우와는 다르게 백호작업기 선회 동작시 좌석은 고정되어 있고 작업기만 선회동작으로 회전하기 때문에 한 축을 중심으로 대칭해서 움직이는 동작을 발생시키는 원통좌표계(A)가 적합하다. 백호작업기의 경우 직교좌표계(B)를 사용할 경우 선회동작 이후에 굴삭작업을 위해 작업기 팔이 굽는 형태가 아니라 굴삭작업에서는 거의 사용이 되지 않는 직교좌표 이동을 도 2(B)와 같이 하게 되어 굴삭작업에는 적합하지 않게 된다. As shown in FIG. 2, the backhoe work attached to the tractor / loader has a magnet and an excavator work unit, and the seat is fixed at the time of the backhoe work turning operation unlike the case where the turning motion occurs at the same time. For this reason, a cylindrical coordinate system A that generates a symmetrical movement around one axis is suitable. In the case of the backhoe working machine, when the Cartesian coordinate system (B) is used, the movement of the Cartesian coordinates, which are rarely used in the excavation work, is not carried out for the excavation work after the pivoting operation, as shown in FIG. It is not suitable for.

따라서, 도 3과 같이 백호작업기 끝단 운동을 원통좌표계 변수들로 표현하고 하나의 실시예로서 4와 같이 원통좌표계 백호작업기 끝단 변수 방향과 조이스틱 방향을 일치시켰다. 도 3에서 원통좌표계 원점(2-0)을 중심으로 원통좌표계 회전방향(2-1), 원통좌표계 반경방향(2-2), 원통좌표계 높이방향(2-4)은 원통좌표계구성 변수(r, θ, z)를 나타내고 있다. 이때 도 4에 나타난 것 같이 원통좌표계 반경전 진방향(2-2F)은 좌측 조이스틱 전진방향으로, 원통좌표계 반경후진방향(2-2B)은 좌측 조이스틱 후진방향으로, 원통좌표계 우측회전방향(2-1R) 은 좌측 조이스틱 우측방향으로, 원통좌표계 좌측회전방향(2-1L)은 좌측 조이스틱 좌측방향으로, 원통좌표계 높이상측방향(2-4U)은 우측 조이스틱 후진방향으로, 원통좌표계 높이하측방향(2-4D)은 우측 조이스틱 전진방향으로 매칭할 수 있다. 또한, 버켓의 열림(2-3O)은 우측 조이스틱 좌측방향으로, 버켓의 닫힘(2-3C)은 우측 조이스틱 우측방향으로 매칭할 수 있다. 여기서 주의할 점으로 버켓은 상대적으로 선회동작에 비해서 많이 사용됨으로 보다 능숙하게 작업기를 효율적으로 사용하기 위해서 우측 조이스틱에 배치되었다. Therefore, as shown in FIG. 3, the end movement of the backhoe working machine is represented by the cylindrical coordinate system variables, and as an example, the direction of the end coordinate variable of the cylindrical coordinate system backhoe working machine is matched with the joystick direction. 3, the cylindrical coordinate system rotation direction (2-1), the cylindrical coordinate system radial direction (2-2), and the cylindrical coordinate system height direction (2-4) with respect to the cylindrical coordinate system origin (2-0) are the cylindrical coordinate system configuration parameters ( r). , θ, z ). At this time, as shown in FIG. 4, the radial forward direction (2-2F) of the cylindrical coordinate system is in the forward direction of the left joystick, and the radial forward direction (2-2B) of the cylindrical coordinate system is in the backward direction of the left joystick, and the right direction of rotation of the cylindrical coordinate system ( 1R) is to the left joystick to the right, the cylindrical coordinate system rotates to the left (2-1L) to the left joystick to the left, and the cylindrical coordinate system is above the height (2-4U) to the right joystick backwards, and the cylindrical coordinate system is below the height (2 -4D) can match in the right joystick forward direction. In addition, the opening 2-3 of the bucket can be matched to the left of the right joystick, and the closing of the bucket 2-3C can be matched to the right of the right joystick. It should be noted here that the bucket is relatively more used than the turning motion, so it is arranged on the right joystick to be more proficient in using the work machine.

도 6은 조이스틱 입력변위에 따른 백호작업기 끝단의 원통좌표계 연동 속도제어를 구현하기 위한 제어기 블록선도를 나타내고 있다. 조이스틱 입력변위(1-a, 1-b)에 따라 좌표계 기반 속도제어를 발생시키는 레이트제어기(4-1)의 출력값과 제어를 시작할 때의 작업기끝단초기값(4-1-Initial)과 합해져서 좌표계명령값(4-2-Command)이 발생되고 이 값은 원통좌표계 기반제어기(4-2) 입력 값으로 들어간다. 좌표계명령값(4-2-Command)과 좌표계피드백제어와 합친 값은 실제 좌표계제어입력값(4-2-Desired)로 되어 백호작업기역기구학(4-IK)를 통하여 구동기제어입력값(4-3-Desired)로 바꿔 구동기제어기(4-3)로 들어간다. 이때 실린더변위센서(4-DS1, 4-DS2, 4-DS3, 4-DS4)에서 측정된 구동기변위값(4-3-Actual)은 백호작업기순기구학(4-FK)를 통해서 좌표계측정값(4-2-Actual)로 변환되어 원통좌표계 기반제어기(4-2)의 피드백제어값으로 입력된다. 유의할 점으로 끝단의 움직임을 작업자가 시각적으로 피드백해서 조이스틱을 통한 입력 값을 재생함으로 유압시스템의 제어 오차를 충분히 극복하면서 직관적으로 원통좌표계 끝단 작업을 수행 할 수가 있다.6 is a controller block diagram for implementing a cylindrical coordinate system interlocking speed control at the end of a backhoe machine according to the joystick input displacement. The output value of the rate controller 4-1, which generates coordinate system-based speed control according to the joystick input displacements (1-a, 1-b), and the work machine end initial value (4-1-Initial) at the start of control, Coordinate system command value (4-2-Command) is generated and this value is entered into the cylindrical coordinate system based controller (4-2) input value. The combined value of the coordinate system command value (4-2-Command) and the coordinate system feedback control becomes the actual coordinate system control input value (4-2-Desired), and the driver control input value (4-IK) is performed through the backhoe working area kinematics (4-IK). Switch to 3-Desired) and enter the driver controller (4-3). At this time, the actuator displacement value (4-3-Actual) measured by the cylinder displacement sensors (4-DS1, 4-DS2, 4-DS3, 4-DS4) is measured by the coordinate system measurement value (4-FK) through the backhoe working forward kinematics (4-FK). 4-2-Actual) is inputted as a feedback control value of the cylindrical coordinate system-based controller 4-2. It is important to note that the operator can visually feed back the end movement and replay the input value through the joystick to overcome the control error of the hydraulic system and to intuitively perform the end of the cylindrical coordinate system.

여기서 레이트제어기(4-1)는 구체적으로 다음과 같이 구현된다. Here, the rate controller 4-1 is specifically implemented as follows.

(1)

(One)

(2)

여기서,

은 입력값,

은 출력값이고,

는 샘플링시간,

는 속도게인이다. here,

Is the input value,

Is the output,

Is the sampling time,

Is the speed gain.

도 7은 제안된 원통좌표계 연동 유압식 백호작업기를 제어하기 위한 유압제어구성도를 나타내고 있다. 엔진과 펌프 및 컨트롤 밸브는 기존의 백호작업기 유압식 구조를 그대로 유지하면서 컨트롤 밸브의 스풀을 제어하는 방식에서 전기식 구조의 컨트롤 밸브의 스풀을 제어하는 방식을 구현하였다. 파일롯 펌프로부터의 유량 비례제어 밸브(3)로 입력되고, 좌표계 변환 제어인터페이스(4) 및 조이스틱을 포함하는 백호작업기 조작 인터페이스장치가 비례밸브를 제어함으로써 컨트롤 밸브의 스풀을 조절하는 파일롯 유량을 제어하게 됨에 따라 원하는 액츄에이터 위치를 얻을 수 있다. 제안된 유압제어방식은 기존의 유압시스템의 변경 없이 추가적인 유량비례밸브제어의 삽입으로 제안된 백호작업기 끝단 원통좌표계제어용 조작 인터페이스장치를 구현할 수 있다.Figure 7 shows the hydraulic control configuration for controlling the proposed cylindrical coordinate system hydraulic backhoe work. The engine, the pump and the control valve implement the method of controlling the spool of the electric control valve in the manner of controlling the spool of the control valve while maintaining the hydraulic structure of the existing backhoe worker. A backhoe machine operation interface device, which is input from the pilot pump to the flow proportional control valve 3 and includes a coordinate system conversion control interface 4 and a joystick, controls the pilot flow rate to control the spool of the control valve by controlling the proportional valve. As a result, the desired actuator position can be obtained. The proposed hydraulic control method can implement the operation interface device for the cylindrical coordinate system control at the end of the backhoe work machine by inserting additional flow proportional valve control without changing the existing hydraulic system.

본 발명은 상기한 실시예에 한정되지 아니하며, 적용범위가 다양함은 물론이 고, 청구범위에서 청구하는 본 발명의 요지를 벗어남이 없이 당해 본 발명이 속하는 분야에서 통상의 지식을 가진 자라면 누구든지 다양한 변형 실시가 가능한 것은 물론이다.The present invention is not limited to the above-described embodiments, and the scope of application of the present invention is not limited to those of ordinary skill in the art to which the present invention pertains without departing from the gist of the present invention. Of course, various modifications are possible.

도 1은 본 발명에 따른 원통좌표계 연동형 백호작업기 조작 인터페이스 방법.1 is a cylindrical coordinate system interlocking backhoe working interface method according to the present invention.

도 2는 본 발명에 따른 직교좌표계 및 원통좌표계 작동도.Figure 2 is an operation of the rectangular coordinate system and cylindrical coordinate system according to the present invention.

도 3은 본 발명에 따른 백호작업기 원통좌표계 변수 구성도.Figure 3 is a configuration diagram of the backhoe working cylinder coordinate system variable according to the present invention.

도 4은 본 발명에 따른 조이스틱과 백호작업기 원통좌표계 매칭 구성도.Figure 4 is a joystick and backhoe working cylinder coordinate system matching configuration in accordance with the present invention.

도 5는 본 발명에 따른 원통좌표계 변환제어기 하드웨어 구성도.5 is a hardware configuration diagram of a cylindrical coordinate system conversion controller according to the present invention.

도 6는 본 발명에 따른 조이스틱 연동 원통 좌표계 제어기 구성도.Figure 6 is a joystick interlocking cylindrical coordinate system controller configuration in accordance with the present invention.

도 7은 본 발명에 따른 유압 제어기 구성도 7 is a hydraulic controller configuration diagram according to the present invention

-도면의 주요부분에 대한 부호의 설명-Explanation of symbols on the main parts of the drawing

좌측 전자식 조이스틱(1a)Left electronic joystick (1a)

우측 전자식 조이스틱(1b)Right electronic joystick (1b)

좌측 조이스틱 좌우방향(1-1)Left joystick left / right direction (1-1)

좌측 조이스틱 전후방향(1-2)Left joystick forward and backward direction (1-2)

우측 조이스틱 좌우방향(1-3)Right Joystick Left / Right (1-3)

우측 조이스틱 전후방향(1-4)Right joystick forward and backward (1-4)

원통좌표계 원점(2-0)Cylindrical coordinate origin (2-0)

백호작업기의 끝단(2-End-Effector)2-End-Effector of backhoe work

원통좌표계 회전방향(2-1), 원통좌표계 우측회전방향(2-1R),Cylindrical coordinate system rotation direction (2-1), Cylindrical coordinate system right rotation direction (2-1R),

원통좌표계 좌측회전방향(2-1L)Left rotation direction of cylindrical coordinate system (2-1L)

원통좌표계 반경방향(2-2), 원통좌표계 반경전진방향(2-2F),Cylindrical coordinate system radial direction (2-2), cylindrical coordinate system radial direction (2-2F),

원통좌표계 반경후진방향(2-2B)Cylindrical Coordinate System Radius Reverse Direction (2-2B)

버켓 회전방향(2-3), 버켓 개방방향(2-3O), 버켓 닫힘방향(2-3C)Bucket rotation direction (2-3), bucket opening direction (2-3O), bucket closing direction (2-3C)

원통좌표계 높이방향(2-4),원통좌표계 높이상측방향(2-4U),Cylindrical coordinate system height direction (2-4), Cylindrical coordinate system height direction (2-4U),

원통좌표계 높이하측방향(2-4D)Cylindrical Coordinate System Height-Downward (2-4D)

붐 실린더밸브(3-1), 암 실린더밸브(3-2)Boom cylinder valve (3-1), female cylinder valve (3-2)

버켓 실린더밸브(3-3), 선회 실린더밸브(3-4)Bucket cylinder valve (3-3), swing cylinder valve (3-4)

좌표계 변환제어기 인터페이스(4)Coordinate System Conversion Controller Interface (4)

레이트제어기(rate control)(4-1)Rate control (4-1)

버켓 회전방향 속도게인(4-1a)Bucket Rotation Speed Gain (4-1a)

원통좌표계 반경방향 속도게인(4-1b), 원통좌표계 회전방향 속도게인(4-1c)Cylindrical coordinate system radial speed gain (4-1b), Cylindrical coordinate system rotation direction speed gain (4-1c)

원통좌표계 높이방향 속도게인(4-1d), 원통좌표계 기반제어기(4-2)Cylindrical Coordinate System Height Direction Speed Gain (4-1d), Cylindrical Coordinate System Based Controller (4-2)

작업기끝단초기값(4-1-Initial), 좌표계명령값(4-2-Command),Work Machine End Initial Value (4-1-Initial), Coordinate System Command Value (4-2-Command),

좌표계제어입력값(4-2-Desired), 구동기제어입력값(4-3-Desired),Coordinate system control input value (4-2-Desired), driver control input value (4-3-Desired),

구동기변위값(4-3-Actual), 좌표계측정값(4-2-Actual)Driver displacement value (4-3-Actual), coordinate system measured value (4-2-Actual)

구동기제어기(4-3), 작업기순기구학(4-FK), 작업기역기구학(4-IK),Actuator controller (4-3), work order kinematics (4-FK), work area kinematics (4-IK),

붐 실린더 변위센서(4-DS1), 암 실린더변위센서(4-DS2),Boom cylinder displacement sensor (4-DS1), female cylinder displacement sensor (4-DS2),

버켓 실린더변위센서(4-DS3), 선회 실린더변위센서(4-DS4)Bucket cylinder displacement sensor (4-DS3), swing cylinder displacement sensor (4-DS4)

전자식유량비례제어밸브(5)Electronic flow proportional control valve (5)

Claims

Left electronic joystick 1a;

Right electronic joystick 1b;

A conversion controller interface 4 for converting an electric signal according to the displacement input from the electronic joysticks 1a and 1b into a cylindrical coordinate system speed command;

Cylindrical coordinate system interlocking backhoe worker operation interface, characterized in that comprises a

According to claim 1, wherein the cylindrical coordinate system backhoe worker operation interface

It is included in the backhoe work composed of the actuator of the hydraulic cylinder and the main body of the boom, arm, bucket, swing operation base to operate the end of the backhoe work (2-End-Effector) of the backhoe work by the cylindrical coordinate system interlocking,

The end of the backhoe machine (2-End-Effector) is driven by a drive means comprising a boom, arm, bucket, swing cylinder valves (3-1, 3-2, 3-3, 3-4) ,

The electronic joysticks 1a and 1b at the coordinate system conversion controller interface 4 such that the backhoe work end 2-End-Effector operates on a cylindrical coordinate system in accordance with an electrical signal input from the electronic joysticks 1a and 1b. Boom, Arm, Bucket, and Slewing Cylinder Valve are generated to generate the speed command of the cylindrical coordinate system at the 2-End-Effector in proportion to the displacement. 3-1, 3-2, 3-3, 3-4) cylindrical coordinate system interlocking backhoe worker operation interface

The method of claim 2,

Left joystick left and right directions (1-1) indicate the backhoe machine cylindrical coordinate system rotation direction (2-1), left joystick forward and backward directions (1-2) the backhoe work machine cylindrical coordinate system radial direction (2-2), right joystick left and right directions (1-3) is a cylinder, characterized in that the backhoe working bucket rotation direction (2-3), the right joystick front and rear directions (1-4) are matched to control the backhoe working cylinder coordinate system height direction (2-4), respectively Coordinate System Interlocking Backhoe Operator Operation Interface

The method of claim 2,

The coordinate system conversion controller interface 4 converts displacement signals 1-1, 1-2, 1-3, 1-4 from two electronic joysticks 1a, 1b to analog / digital (A / D) conversion. Received through the board,

Rate controller 4-1, which generates the speed command value at the end of the work machine in proportion to the input joystick displacement, and cylindrical coordinate system speed gains 4-1a, which can determine the magnitude of the velocity for each axis in the cylindrical coordinate system in proportion to the displacement. , 4-1b, 4-1c, 4-d), Cylindrical coordinate system-based controller (4-2) for controlling the feedback value of 2-End-Effector movement command generated from the rate controller 4-1, cylinder Driver controller 4-3 for converting coordinate system based control to hydraulic cylinder control mode, input of respective cylinder displacement sensor values 4-DS1, 4-DS2, 4-DS3, 4-DS4 for driver feedback control, Composed of digital / analog (D / A) converter for driving the electronic hydraulic proportional control valves 3-1, 3-2, 3-3, 3-4 using the resultant value of the driver controller 4-3. Cylindrical coordinate system interlocking backhoe worker operation interface, characterized in that

The method of claim 4, wherein

The output value of the rate controller 4-1, which generates coordinate system-based speed control according to the joystick input displacements (1-a, 1-b), and the work machine end initial value (4-1-Initial) at the start of control, Coordinate system command value (4-2-Command) is generated,

The coordinate system command value (4-2-Command) enters the input value of the cylindrical coordinate system-based controller (4-2),

The combined value of the coordinate system command value (4-2-Command) and the coordinate system feedback control becomes the coordinate system control input value (4-2-desired), and the driver control input value (4-IK) is performed through the backhoe working area kinematics (4-IK). Switch to 3-Desired) and enter the driver controller (4-3),

The actuator displacement value (4-3-Actual) measured by the cylinder displacement sensors (4-DS1, 4-DS2, 4-DS3, 4-DS4) is measured using the coordinate system measurement value (4FK) through the backhoe working forward kinematics (4-FK). -2-Actual) is converted into a feedback control value of the cylindrical coordinate system-based controller (4-2), the cylindrical coordinate system interlocking backhoe working interface

In the cylindrical coordinate system interlocking backhoe worker operation control method according to claim 2 or 3,

a) input of the displacement of the electronic joystick (1a, 1b) via the coordinate system transformation interface (4);

b) generating, by the coordinate transformation interface 4, a cylindrical coordinate system speed command of the end of the backhoe machine in proportion to the displacement of the electronic joysticks 1a and 1b input in step a). ;

c) Boom, arm, bucket, swing cylinder valve (3-1, 3-2, 3-3, 3-4) to drive the hydraulic cylinder of each of the backhoe workers in accordance with the cylindrical coordinate system speed command generated in step b). Controlled;

Cylindrical coordinate system interlocking backhoe worker operation control method comprising a

In the cylindrical coordinate system interlocking backhoe worker operation control method according to claim 4 in the cylindrical coordinate system interlocking backhoe worker operation control method,

b1) The speed command of the cylindrical coordinate system of the 2-End-Effector is generated in proportion to the displacement of the electronic joysticks 1a and 1b input in step a) by the rate controller 4-1. step;

b2) feedback control by the cylindrical coordinate system-based controller (4-2) by the cylindrical command system speed command inputted at step b1) by the cylindrical coordinate system speed command;

b3) converting, by the driver controller 4-3, the cylindrical coordinate system-based control value calculated in step b2) into a hydraulic cylinder control value;

b4) The hydraulic cylinder control value converted in step b3) by the digital / analog converter is driven by the electronic hydraulic proportional control valves 3-1, 3-2, 3-3, 3-4. Converting to a value;

c) Boom, arm, bucket, swing cylinder valve (3-1, 3-2, 3-3, 3-4) to drive the hydraulic cylinder of each of the backhoe work machine according to the drive value converted in step b-4) Controlled;