KR20210123023A - Hydraulic control method and system - Google Patents

Hydraulic control method and system Download PDF

Info

Publication number
KR20210123023A
KR20210123023A KR1020200040188A KR20200040188A KR20210123023A KR 20210123023 A KR20210123023 A KR 20210123023A KR 1020200040188 A KR1020200040188 A KR 1020200040188A KR 20200040188 A KR20200040188 A KR 20200040188A KR 20210123023 A KR20210123023 A KR 20210123023A
Authority
KR
South Korea
Prior art keywords
signal
hydraulic
control
work equipment
work
Prior art date
Application number
KR1020200040188A
Other languages
Korean (ko)
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 두산인프라코어 주식회사
Priority to KR1020200040188A priority Critical patent/KR20210123023A/en
Publication of KR20210123023A publication Critical patent/KR20210123023A/en

Links

Images

Classifications

    • 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/2221Control of flow rate; Load sensing arrangements
    • 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/2025Particular purposes of control systems not otherwise provided for
    • E02F9/205Remotely operated machines, e.g. unmanned vehicles
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B13/00Details of servomotor systems ; Valves for servomotor systems
    • F15B13/02Fluid distribution or supply devices characterised by their adaptation to the control of servomotors
    • F15B13/04Fluid distribution or supply devices characterised by their adaptation to the control of servomotors for use with a single servomotor
    • F15B13/042Fluid distribution or supply devices characterised by their adaptation to the control of servomotors for use with a single servomotor operated by fluid pressure
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15BSYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B13/00Details of servomotor systems ; Valves for servomotor systems
    • F15B13/16Special measures for feedback, e.g. by a follow-up device

Landscapes

  • Engineering & Computer Science (AREA)
  • General Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Fluid Mechanics (AREA)
  • Mechanical Engineering (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • Structural Engineering (AREA)
  • Operation Control Of Excavators (AREA)

Abstract

The present invention relates to a hydraulic control method of work equipment. According to the present invention, in the hydraulic control method of work equipment, a target command signal for operating a hydraulic system of the work equipment is determined to perform an unmanned automation task. A sensor signal is received from a measurement unit installed in the hydraulic system. A feedback control signal is generated based on the target command signal and the sensor signal. A feedforward control signal is generated based on the target command signal. An operation of the hydraulic system is controlled according to a control signal generated by summing the feedback control signal and the feedforward control signal.

Description

유압 제어 방법 및 시스템{HYDRAULIC CONTROL METHOD AND SYSTEM} HYDRAULIC CONTROL METHOD AND SYSTEM

본 발명은 작업 장비의 유압 제어 방법 및 시스템에 관한 것이다. 보다 상세하게는, 무인 자동화 작업을 수행하기 위한 작업 장비의 유압 시스템을 제어하기 위한 방법 및 이를 수행하기 위한 작업 장비의 유압 제어 시스템에 관한 것이다.The present invention relates to a method and system for hydraulic control of work equipment. More particularly, it relates to a method for controlling a hydraulic system of a work equipment for performing an unmanned automated operation, and a hydraulic control system for a work equipment for performing the same.

자동화 작업 장비 시스템은 현장을 관제하는 모션 플래너와 같은 상위 제어부로부터 전달받은 작업 명령에 따라 무인 자동화 작업을 수행할 수 있다. 상기 상위 제어부로부터의 상기 작업 명령을 수신하기 때문에, 상기 작업 장비의 유압 시스템의 느린 동특성으로 인해 신호 지연이 발생하게 되고, 기존의 피드백 제어만으로부터 상기 유압 시스템의 반응성을 향상시키는 데 어려움이 있다.The automated work equipment system may perform unattended automated work according to a work command received from an upper control unit such as a motion planner that controls the site. Since the work command is received from the upper control unit, a signal delay occurs due to the slow dynamic characteristics of the hydraulic system of the work equipment, and it is difficult to improve the responsiveness of the hydraulic system only from the existing feedback control.

본 발명의 일 과제는 무인 자동화 작업 시에 유압 시스템의 동특성을 개선시킬 수 있는 작업 장비의 유압 제어 방법을 제공하는 데 있다.An object of the present invention is to provide a method for controlling a hydraulic pressure of work equipment capable of improving dynamic characteristics of a hydraulic system during unmanned automated work.

본 발명의 다른 과제는 상술한 유압 제어 방법을 수행하기 위한 작업 장비의 유압 제어 시스템을 제공하는 데 있다.Another object of the present invention is to provide a hydraulic control system of a work equipment for performing the above-described hydraulic control method.

상기 본 발명의 일 과제를 달성하기 위한 예시적인 실시예들에 따른 작업 장비의 유압 제어 방법에 있어서, 무인 자동화 작업을 수행하기 위하여 작업 장비의 유압 시스템을 동작시키기 위한 목표 명령 신호를 결정한다. 상기 유압 시스템에 설치된 측정부로부터 센서 신호를 수신한다. 상기 목표 명령 신호 및 상기 센서 신호에 기초하여 피드백 제어 신호를 생성한다. 상기 목표 명령 신호에 기초하여 피드포워드 제어 신호를 생성한다. 상기 피드백 제어 신호와 상기 피드포워드 제어 신호를 합산하여 생성된 제어 신호에 따라 상기 유압 시스템의 동작을 제어한다.In the hydraulic control method of the work equipment according to the exemplary embodiments for achieving the above object of the present invention, a target command signal for operating the hydraulic system of the work equipment is determined to perform an unmanned automation task. A sensor signal is received from a measurement unit installed in the hydraulic system. A feedback control signal is generated based on the target command signal and the sensor signal. A feedforward control signal is generated based on the target command signal. An operation of the hydraulic system is controlled according to a control signal generated by summing the feedback control signal and the feedforward control signal.

예시적인 실시예들에 있어서, 상기 피드백 제어 신호를 생성하는 것은 상기 목표 명령 신호와 상기 센서 신호의 차이값에 기초하여 상기 피드백 제어 신호를 생성하는 것을 포함할 수 있다.In example embodiments, generating the feedback control signal may include generating the feedback control signal based on a difference value between the target command signal and the sensor signal.

예시적인 실시예들에 있어서, 상기 목표 명령 신호를 결정하는 것은 상위 제어부로부터 제공된 작업 명령 정보로부터 상기 목표 명령 신호를 획득하는 것을 포함할 수 있다.In example embodiments, determining the target command signal may include acquiring the target command signal from work command information provided from an upper control unit.

예시적인 실시예들에 있어서, 상기 방법은, 상기 작업 장비의 무인 자동화 작업을 위해 필요한 주변 환경 인지 데이터를 획득하고, 그리고 상기 획득한 주변 환경 인지 데이터를 상기 상위 제어부로 송신하는 것을 더 포함할 수 있다.In example embodiments, the method may further include acquiring surrounding environment awareness data necessary for an unattended automated operation of the work equipment, and transmitting the acquired surrounding environment awareness data to the upper control unit. have.

예시적인 실시예들에 있어서, 상기 방법은, 상기 유압 시스템에 설치된 측정부로부터의 센서 신호를 상기 상위 제어부로 송신하는 것을 더 포함할 수 있다.In example embodiments, the method may further include transmitting a sensor signal from a measurement unit installed in the hydraulic system to the upper control unit.

예시적인 실시예들에 있어서, 상기 목표 명령 신호는 상기 유압 시스템의 자동 작업 동작을 위한 상태값들을 포함할 수 있다.In example embodiments, the target command signal may include state values for automatic operation of the hydraulic system.

예시적인 실시예들에 있어서, 상기 측정부로부터 상기 센서 신호를 수신하는 것은 상기 작업 장비의 작업 수행 시 실시간으로 상기 유압 시스템의 상태값들을 측정하는 것을 포함할 수 있다.In example embodiments, receiving the sensor signal from the measuring unit may include measuring state values of the hydraulic system in real time when the work equipment is performed.

예시적인 실시예들에 있어서, 상기 방법은, 선택부를 통해 무인 자동화 작업 모드 및 수동 작업 모드 중에서 어느 하나의 작업 모드를 선택하는 것을 더 포함할 수 있다.In example embodiments, the method may further include selecting any one operation mode from among an unattended automated operation mode and a manual operation mode through the selection unit.

예시적인 실시예들에 있어서, 상기 방법은, 상기 수동 작업 모드가 선택된 경우, 작업자의 수동 조작 신호를 수신하고, 그리고 상기 수동 조작 신호에 따라 상기 유압 시스템의 동작을 제어하는 것을 더 포함할 수 있다.In example embodiments, the method may further include receiving a manual operation signal from an operator when the manual operation mode is selected, and controlling an operation of the hydraulic system according to the manual operation signal. .

상기 본 발명의 다른 과제를 달성하기 위한 예시적인 실시예들에 따른 작업 장비의 유압 제어 시스템은, 작업 장비의 유압 시스템의 상태값들에 대한 센서 신호를 측정하기 위한 측정부, 무인 자동화 작업을 위한 목표 명령 신호 및 상기 측정부로부터 상기 센서 신호를 수신하고 상기 목표 명령 신호 및 상기 센서 신호에 기초하여 피드백 제어 신호를 생성하기 위한 피드백 제어기 및 상기 목표 명령 신호에 기초하여 피드포워드 제어 신호를 생성하기 위한 피드포워드 제어기를 포함하고 상기 피드백 제어 신호와 상기 피드포워드 제어 신호를 합산하여 생성된 제어 신호를 출력하기 위한 제어 장치, 및 상기 제어 신호에 따라 상기 유압 시스템의 동작을 제어하기 위한 유압 제어 장치를 포함한다.The hydraulic control system of the work equipment according to exemplary embodiments for achieving another object of the present invention is a measuring unit for measuring sensor signals for state values of the hydraulic system of the work equipment, for unmanned automation work A feedback controller for receiving the target command signal and the sensor signal from the measuring unit and generating a feedback control signal based on the target command signal and the sensor signal and for generating a feedforward control signal based on the target command signal A control device including a feedforward controller and outputting a control signal generated by summing the feedback control signal and the feedforward control signal, and a hydraulic control device for controlling an operation of the hydraulic system according to the control signal do.

예시적인 실시예들에 있어서, 상기 피드백 제어기는 상기 목표 명령 신호와 상기 센서 신호의 차이값에 기초하여 상기 피드백 제어 신호를 생성할 수 있다.In example embodiments, the feedback controller may generate the feedback control signal based on a difference value between the target command signal and the sensor signal.

예시적인 실시예들에 있어서, 상기 제어 장치는 상위 제어부로부터 제공된 작업 명령 정보로부터 상기 목표 명령 신호를 획득할 수 있다.In example embodiments, the control device may obtain the target command signal from work command information provided from the upper control unit.

예시적인 실시예들에 있어서, 상기 측정부는 상기 무인 자동화 작업을 위해 필요한 주변 환경 인지 데이터를 획득하고, 상기 제어 장치는 상기 획득한 주변 환경 인지 데이터를 상기 상위 제어부로 송신할 수 있다.In example embodiments, the measurement unit may acquire surrounding environment awareness data necessary for the unmanned automated operation, and the control device may transmit the acquired surrounding environment awareness data to the upper control unit.

예시적인 실시예들에 있어서, 상기 목표 명령 신호는 상기 유압 시스템의 자동 작업 동작을 위한 상태값들을 포함할 수 있다.In example embodiments, the target command signal may include state values for automatic operation of the hydraulic system.

예시적인 실시예들에 있어서, 상기 측정부는 상기 작업 장비의 작업 수행 시 실시간으로 상기 유압 시스템의 상태값들을 검출할 수 있다.In example embodiments, the measurement unit may detect the state values of the hydraulic system in real time when the work of the work equipment is performed.

예시적인 실시예들에 있어서, 상기 작업 장비의 유압 제어 시스템은 무인 자동화 작업 모드 및 수동 작업 모드 중에서 어느 하나의 작업 모드를 선택하기 위한 선택부를 더 포함할 수 있다.In exemplary embodiments, the hydraulic control system of the work equipment may further include a selection unit for selecting any one work mode from among an unmanned automated work mode and a manual work mode.

예시적인 실시예들에 있어서, 상기 제어 장치는, 상기 선택부를 통해 상기 수동 작업 모드가 선택된 경우, 작업자의 수동 조작 신호를 수신하고, 상기 수동 조작 신호에 따른 제어 신호를 상기 유압 제어 장치에 출력할 수 있다.In exemplary embodiments, when the manual operation mode is selected through the selection unit, the control device may receive a manual operation signal of an operator and output a control signal according to the manual operation signal to the hydraulic control device. can

예시적인 실시예들에 따르면, 상기 작업 장비의 유압 제어 시스템은, 무인 자동화 작업을 수행할 때 유압 시스템으로부터 획득한 센서 신호를 이용한 피드백 제어기 및 상위 제어부로부터 제공된 목표 명령 신호를 입력으로 하는 피드포워드 제어기를 통해 상기 상위 제어부로부터 전달받은 작업 명령 궤적과 상기 유압 시스템의 실제 작업 궤적 사이의 오차를 감소시킬 수 있다. 또한, 상기 작업 장비의 유압 제어 시스템은, 수동 조작 모드가 선택된 경우, 작업자의 수동 조작 신호에 따라 상기 유압 시스템을 제어할 수 있다.According to exemplary embodiments, the hydraulic control system of the work equipment includes a feedback controller using a sensor signal obtained from the hydraulic system when performing an unmanned automated operation, and a feedforward controller that receives a target command signal provided from an upper control unit as an input It is possible to reduce an error between the trajectory of the work command received from the upper control unit and the trajectory of the actual operation of the hydraulic system. In addition, when the manual operation mode is selected, the hydraulic control system of the work equipment may control the hydraulic system according to a manual operation signal of an operator.

따라서, 상기 피드백 제어기와 상기 피드포워드 제어기로 구성된 제어기를 사용함으로써, 상기 유압 시스템의 빠른 반응성을 확보하고, 작업을 진행할 때 발생하는 커다란 부하나 외란에 따른 변동을 최소화함으로써 개선된 제어 성능을 제공할 수 있다.Therefore, by using the controller composed of the feedback controller and the feed-forward controller, the hydraulic system can be quickly responsive, and it is possible to provide improved control performance by minimizing fluctuations due to large loads or disturbances occurring during operation. can

다만, 본 발명의 효과는 상기 언급한 효과에 한정되는 것이 아니며, 본 발명의 사상 및 영역으로부터 벗어나지 않는 범위에서 다양하게 확장될 수 있을 것이다.However, the effects of the present invention are not limited to the above-mentioned effects, and may be variously expanded without departing from the spirit and scope of the present invention.

도 1은 예시적인 실시예들에 따른 작업 장비를 나타내는 측면도이다.
도 2는 도 1의 작업 장비의 유압 시스템을 나타내는 블록도이다.
도 3은 예시적인 실시예들에 따른 작업 장비의 유압 제어 시스템을 나타내는 블록도이다.
도 4는 도 3의 제어 장치의 제어기를 나타내는 블록도이다.
도 5는 예시적인 실시예들에 따른 작업 장비의 유압 제어 방법을 나타내는 순서도이다.
1 is a side view showing work equipment according to exemplary embodiments;
FIG. 2 is a block diagram illustrating a hydraulic system of the working equipment of FIG. 1 .
Fig. 3 is a block diagram illustrating a hydraulic control system of a work equipment according to exemplary embodiments.
4 is a block diagram illustrating a controller of the control device of FIG. 3 .
5 is a flowchart illustrating a method for controlling hydraulic pressure of work equipment according to exemplary embodiments.

이하, 첨부한 도면을 참조하여 본 발명의 바람직한 실시예를 상세히 설명하고자 한다.Hereinafter, preferred embodiments of the present invention will be described in detail with reference to the accompanying drawings.

본 발명의 각 도면에 있어서, 구조물들의 치수는 본 발명의 명확성을 기하기 위하여 실제보다 확대하여 도시한 것이다.In each drawing of the present invention, the dimensions of the structures are enlarged than the actual size for clarity of the present invention.

본 발명에서, 제1, 제2 등의 용어는 다양한 구성요소들을 설명하는데 사용될 수 있지만, 상기 구성요소들은 상기 용어들에 의해 한정되어서는 안 된다. 상기 용어들은 하나의 구성요소를 다른 구성요소로부터 구별하는 목적으로만 사용된다.In the present invention, terms such as first, second, etc. may be used to describe various elements, but the elements should not be limited by the terms. The above terms are used only for the purpose of distinguishing one component from another.

본 발명에서 사용한 용어는 단지 특정한 실시예를 설명하기 위해 사용된 것으로, 본 발명을 한정하려는 의도가 아니다. 단수의 표현은 문맥상 명백하게 다르게 뜻하지 않는 한, 복수의 표현을 포함한다. 본 출원에서, "포함하다" 또는 "가지다" 등의 용어는 명세서 상에 기재된 특징, 숫자, 단계, 동작, 구성요소, 부품 또는 이들을 조합한 것이 존재함을 지정하려는 것이지, 하나 또는 그 이상의 다른 특징들이나 숫자, 단계, 동작, 구성요소, 부품 또는 이들을 조합한 것들의 존재 또는 부가 가능성을 미리 배제하지 않는 것으로 이해되어야 한다.The terms used in the present invention are only used to describe specific embodiments, and are not intended to limit the present invention. The singular expression includes the plural expression unless the context clearly dictates otherwise. In the present application, terms such as “comprise” or “have” are intended to designate that a feature, number, step, operation, component, part, or combination thereof described in the specification exists, but one or more other features It should be understood that this does not preclude the existence or addition of numbers, steps, operations, components, parts, or combinations thereof.

본문에 개시되어 있는 본 발명의 실시예들에 대해서, 특정한 구조적 내지 기능적 설명들은 단지 본 발명의 실시예를 설명하기 위한 목적으로 예시된 것으로, 본 발명의 실시예들은 다양한 형태로 실시될 수 있으며 본문에 설명된 실시예들에 한정되는 것으로 해석되어서는 안 된다.With respect to the embodiments of the present invention disclosed in the text, specific structural or functional descriptions are only exemplified for the purpose of describing the embodiments of the present invention, and the embodiments of the present invention may be embodied in various forms. It should not be construed as being limited to the embodiments described in

즉, 본 발명은 다양한 변경을 가할 수 있고 여러 가지 형태를 가질 수 있는 바, 특정 실시예들을 도면에 예시하고 본문에 상세하게 설명하고자 한다. 그러나 이는 본 발명을 특정한 개시 형태에 대해 한정하려는 것이 아니며, 본 발명의 사상 및 기술 범위에 포함되는 모든 변경, 균등물 내지 대체물을 포함하는 것으로 이해되어야 한다.That is, since the present invention can have various changes and can have various forms, specific embodiments are illustrated in the drawings and described in detail in the text. However, this is not intended to limit the present invention to the specific disclosed form, it should be understood to include all modifications, equivalents and substitutes included in the spirit and scope of the present invention.

도 1은 예시적인 실시예들에 따른 작업 장비를 나타내는 측면도이다. 도 2는 도 1의 작업 장비의 유압 시스템을 나타내는 블록도이다.1 is a side view showing work equipment according to exemplary embodiments; FIG. 2 is a block diagram illustrating a hydraulic system of the working equipment of FIG. 1 .

도 1 및 도 2를 참조하면, 상기 작업 장비는 굴삭기, 휠 로더, 지게차, 농기계, 광산 장비 등과 같이 유압 시스템을 이용하여 무인 자동화 작업을 수행할 수 있는 장비를 포함할 수 있다. 이하에서는 상기 작업 장비가 굴삭기인 경우에 대하여 설명하기로 한다. 다만, 이로 인하여 예시적인 실시예들에 따른 제어 시스템이 굴삭기를 제어하기 위한 것으로 한정되는 것은 아님을 이해할 수 있을 것이다.1 and 2 , the work equipment may include equipment capable of performing unmanned automation tasks using a hydraulic system, such as an excavator, a wheel loader, a forklift, an agricultural machine, a mining equipment, and the like. Hereinafter, a case in which the work equipment is an excavator will be described. However, it will be understood that the control system according to the exemplary embodiments is not limited thereto for controlling the excavator.

구체적으로, 작업 장비(10)는 하부 주행체(20), 하부 주행체(20) 상에 선회 가능하도록 탑재되는 상부 선회체(30), 및 상부 선회체(30)에 설치된 운전실(50)과 작업 장치(60)를 포함할 수 있다.Specifically, the work equipment 10 includes a lower traveling body 20 , an upper revolving body 30 mounted so as to be revolving on the lower traveling body 20 , and a cab 50 installed in the upper revolving body 30 , and It may include a working device 60 .

하부 주행체(20)는 상부 선회체(30)를 지지하고, 엔진(110)에서 발생한 동력을 이용하여 굴삭기와 같은 작업 장비(10)를 주행시킬 수 있다. 하부 주행체(20)는 무한궤도를 포함하는 무한궤도식 타입의 주행체일 수 있다. 이와 다르게, 하부 주행체(20)는 주행 휠들을 포함하는 휠 타입의 주행체일 수 있다. 상부 선회체(30)는 베이스로서의 상부 프레임(32)을 구비하고, 하부 주행체(20) 상에서 지면과 평행한 평면상에서 회전하여 작업 방향을 설정할 수 있다.The lower traveling body 20 supports the upper revolving body 30 and may drive the work equipment 10 such as an excavator by using the power generated from the engine 110 . The lower traveling body 20 may be a traveling body of a caterpillar type including a caterpillar. Alternatively, the undercarriage 20 may be a wheel-type traveling body including driving wheels. The upper revolving body 30 has an upper frame 32 as a base, and can be rotated on a lower traveling body 20 on a plane parallel to the ground to set a working direction.

작업 장치(60)는 붐(70), 암(80) 및 버켓(90)을 포함할 수 있다. 작업 장치(60)는 붐 실린더(72), 암 실린더(82) 및 버켓 실린더(92)와 같은 액추에이터(62)의 구동에 의해 작동될 수 있다. 붐 실린더(72), 암 실린더(82) 및 버켓 실린더(92)가 신장 또는 수축함에 따라 붐(70), 암(80) 및 버켓(90)은 다양한 움직임을 구현할 수 있고, 작업 장치(60)는 여러 가지 작업을 수행할 수 있다. 이 때, 붐 실린더(72), 암 실린더(82) 및 버켓 실린더(92)는 유압 펌프(120)로부터 공급되는 작동유에 의해 신장 또는 수축될 수 있다.The working device 60 may include a boom 70 , an arm 80 , and a bucket 90 . The working device 60 may be actuated by actuation of an actuator 62 , such as a boom cylinder 72 , an arm cylinder 82 , and a bucket cylinder 92 . As the boom cylinder 72 , the arm cylinder 82 and the bucket cylinder 92 extend or contract, the boom 70 , the arm 80 , and the bucket 90 may implement various movements, and the working device 60 . can perform several tasks. At this time, the boom cylinder 72 , the arm cylinder 82 , and the bucket cylinder 92 may be extended or contracted by the hydraulic oil supplied from the hydraulic pump 120 .

작업 장비(10)는 상부 선회체(30)를 회전시키기 위한 선회 장치를 포함할 수 있다. 상기 선회 장치는 선회 모터와 같은 액추에이터(62)의 구동에 의해 작동될 수 있다. 이 때, 상기 선회 모터는 유압 펌프(120)로부터 공급되는 작동유에 의해 시계 방향 또는 반시계 방향으로 회전할 수 있다.The work equipment 10 may include a turning device for rotating the upper pivot 30 . The turning device may be operated by driving an actuator 62 such as a turning motor. At this time, the turning motor may rotate clockwise or counterclockwise by the hydraulic oil supplied from the hydraulic pump 120 .

작업 장비(10)는 하부 주행체(20)의 우측 트랙(또는 우측 휠) 및 좌측 트랙(또는 좌측 휠)을 회전시키기 위한 주행 장치를 포함할 수 있다. 상기 주행 장치는 상기 우측 트랙(또는 우측 휠) 및 상기 좌측 트랙(또는 좌측 휠)을 각각 회전시키는 좌측 주행 모터 및 우측 주행 모터와 같은 액추에이터(62)를 포함할 수 있다. 이 때, 상기 좌측 주행 모터 및 상기 우측 주행 모터는 유압 펌프(120)로부터 공급되는 작동유에 의해 시계 방향 또는 반시계 방향으로 회전할 수 있다.The work equipment 10 may include a traveling device for rotating the right track (or right wheel) and the left track (or left wheel) of the undercarriage 20 . The traveling device may include an actuator 62 such as a left traveling motor and a right traveling motor for rotating the right track (or right wheel) and the left track (or left wheel), respectively. In this case, the left traveling motor and the right traveling motor may rotate clockwise or counterclockwise by the hydraulic oil supplied from the hydraulic pump 120 .

도 2에 도시된 바와 같이, 상기 작업 장비의 유압 시스템은 엔진(110), 엔진(110)에 의해 구동되는 유압 펌프(120), 유압 펌프(120)로부터 토출된 작동유에 의해 동작 가능한 적어도 하나의 액추에이터(62), 유압 펌프(120)와 액추에이터(62) 사이에 설치되며 내부에 구비된 스풀의 변위량에 따라 유압 펌프(120)로부터 액추에이터(62)로 공급되는 작동유의 유량을 제어하기 위한 적어도 하나의 제어 밸브를 포함하는 메인 컨트롤 밸브(130), 및 입력된 제어 신호에 비례하여 상기 제어 밸브의 스풀의 변위량을 제어하기 위한 파일럿 신호압을 상기 스풀에 공급하는 스풀 변위 조정 밸브를 포함하는 스풀 변위 조정부(140)를 포함할 수 있다.As shown in FIG. 2 , the hydraulic system of the working equipment includes an engine 110 , a hydraulic pump 120 driven by the engine 110 , and at least one operable by hydraulic oil discharged from the hydraulic pump 120 . At least one for controlling the flow rate of hydraulic oil installed between the actuator 62, the hydraulic pump 120 and the actuator 62 and supplied from the hydraulic pump 120 to the actuator 62 according to the displacement amount of the spool provided therein A spool displacement comprising a main control valve 130 including a control valve of It may include an adjustment unit 140 .

유압 펌프(120)는 기계식 구동부로서의 엔진(110)의 출력축에 연결될 수 있다. 예를 들면, 유압 펌프(120)는 압력제어형 전자 유압펌프를 포함할 수 있다. 유압 펌프(120)의 토출 유량은 사판 각도에 의해 결정될 수 있다. 유압 펌프(120)의 사판 각도는 펌프 레귤레이터(122)에 조절될 수 있다. 펌프 레귤레이터(122)는 제어 장치(200)로부터 입력된 펌프 제어 신호에 따라 유압 펌프(120)의 사판 각도를 조절할 수 있다. The hydraulic pump 120 may be connected to an output shaft of the engine 110 as a mechanical drive unit. For example, the hydraulic pump 120 may include a pressure-controlled electro-hydraulic pump. The discharge flow rate of the hydraulic pump 120 may be determined by the angle of the swash plate. The angle of the swash plate of the hydraulic pump 120 may be adjusted by the pump regulator 122 . The pump regulator 122 may adjust the angle of the swash plate of the hydraulic pump 120 according to a pump control signal input from the control device 200 .

유압 펌프(120)는 고압 유압 라인(124)을 통하여 메인 컨트롤 밸브(130)에 연결될 수 있다. 붐 실린더(72), 암 실린더(82), 버켓 실린더(92), 상기 선회 모터, 상기 좌측 주행 모터 및 상기 우측 주행 모터와 같은 액추에이터(62)는 고압 유압 라인을 통해 메인 컨트롤 밸브(130)에 연결될 수 있다.The hydraulic pump 120 may be connected to the main control valve 130 through a high pressure hydraulic line 124 . Actuators 62 such as the boom cylinder 72, the arm cylinder 82, the bucket cylinder 92, the swing motor, the left travel motor and the right travel motor are connected to the main control valve 130 through a high pressure hydraulic line. can be connected

파일럿 펌프(150)는 엔진(110)의 출력축에 연결되며, 상기 출력축이 회전함에 따라 구동되어 제어유를 토출할 수 있다. 예를 들면, 상기 파일럿 펌프는 기어펌프일 수 있다. 이 경우에 있어서, 상기 작동유 및 상기 제어유는 실질적으로 동일한 물질을 포함할 수 있다.The pilot pump 150 is connected to the output shaft of the engine 110 , and is driven as the output shaft rotates to discharge control oil. For example, the pilot pump may be a gear pump. In this case, the working oil and the control oil may include substantially the same material.

파일럿 펌프(150)로부터 토출된 제어유는 스풀 변위 조정부(140)의 상기 스풀 변위 조정 밸브를 거쳐 상기 제어 밸브의 스풀에 공급될 수 있다. 상기 스풀 변위 조정 밸브는 상기 입력된 제어 신호에 비례하여 상기 제어 밸브의 스풀의 변위량을 제어하기 위한 파일럿 신호압을 상기 제어 밸브의 스풀에 공급할 수 있다.The control oil discharged from the pilot pump 150 may be supplied to the spool of the control valve through the spool displacement adjustment valve of the spool displacement adjustment unit 140 . The spool displacement control valve may supply a pilot signal pressure for controlling a displacement amount of the spool of the control valve to the spool of the control valve in proportion to the input control signal.

예를 들면, 한 쌍의 스풀 변위 조정 밸브들이 대응하는 제어 밸브의 스풀의 양측에 각각 구비될 수 있다. 상기 스풀 변위 조정 밸브로부터 출력된 파일럿 신호압은 상기 대응하는 제어 밸브 내의 스풀의 양측에 선택적으로 공급됨으로써, 상기 제어 밸브)가 절환될 수 있다. 상기 스풀 변위 조정 밸브는 입력된 제어 신호에 비례하는 크기를 갖는 파일럿 신호를 공급할 수 있다. 상기 제어 밸브 내의 스풀의 이동은 상기 파일럿 신호압에 의해 제어될 수 있다. 즉, 상기 파일럿 신호압의 공급 방향에 따라 상기 스풀의 이동 방향이 결정되며, 상기 파일럿 신호압의 세기에 따라 상기 스풀의 변위량이 결정될 수 있다.For example, a pair of spool displacement adjustment valves may be provided respectively on both sides of the spool of the corresponding control valve. The pilot signal pressure output from the spool displacement control valve is selectively supplied to both sides of the spool in the corresponding control valve, so that the control valve can be switched. The spool displacement control valve may supply a pilot signal having a magnitude proportional to the input control signal. The movement of the spool in the control valve may be controlled by the pilot signal pressure. That is, the moving direction of the spool may be determined according to the supply direction of the pilot signal pressure, and the amount of displacement of the spool may be determined according to the strength of the pilot signal pressure.

예를 들면, 상기 제어 밸브를 갖는 조립체로서의 메인컨트롤밸브(130)는 전자유압식 메인컨트롤밸브일 수 있다. 상기 스풀 변위 조정 밸브는 입력되는 전기적 신호에 따라 제어 밸브 내의 스풀에 가해지는 파일럿 작동유를 제어하는 전자비례감암밸브(EPPRV)를 포함할 수 있다.For example, the main control valve 130 as an assembly having the control valve may be an electro-hydraulic main control valve. The spool displacement control valve may include an electronic proportional damping valve (EPPRV) that controls pilot hydraulic oil applied to the spool in the control valve according to an input electrical signal.

예시적인 실시예들에 있어서, 제어 장치(200)는 무인 자동화 작업을 위한 목표 명령 신호 또는 작업자의 수동 명령 신호에 따라 작업 장치(60)를 조작하기 위한 제어 신호로서 압력지령 신호를 상기 스풀 변위 조정 밸브로 출력할 수 있다. 상기 전자비례감압밸브는 상기 압력지령 신호에 비례하는 2차 압력을 대응하는 상기 스풀에 출력함으로써, 전기적 제어 신호로 상기 스풀을 제어할 수 있다.In exemplary embodiments, the control device 200 adjusts the spool displacement by using a pressure command signal as a control signal for operating the working device 60 according to a target command signal for an unattended automated operation or a manual command signal of an operator. It can be output with a valve. The electronic proportional pressure reducing valve may control the spool with an electrical control signal by outputting a secondary pressure proportional to the pressure command signal to the corresponding spool.

상술한 바와 같이, 상기 작업 장비의 유압 시스템은 메인 컨트롤 밸브(130) 및 스풀 변위 조정부(140)와 같은 유압 제어 장치를 포함하고, 상기 유압 제어 장치는 제어 장치(200)로부터 출력된 제어 신호에 따라 상기 작업 장비의 유압 시스템(상기 작업 장치, 상기 선회 장치 및 상기 주행 장치)의 동작을 제어할 수 있다.As described above, the hydraulic system of the working equipment includes a hydraulic control device such as a main control valve 130 and a spool displacement adjustment unit 140 , and the hydraulic control device responds to a control signal output from the control device 200 . Accordingly, it is possible to control the operation of the hydraulic system (the working device, the turning device, and the traveling device) of the work equipment.

이하에서는, 상기 작업 장비의 유압 제어 시스템에 대하여 설명하기로 한다.Hereinafter, a hydraulic control system of the work equipment will be described.

도 3은 예시적인 실시예들에 따른 작업 장비의 유압 제어 시스템을 나타내는 블록도이다. 도 4는 도 3의 제어 장치의 제어기를 나타내는 블록도이다.Fig. 3 is a block diagram illustrating a hydraulic control system of a work equipment according to exemplary embodiments. 4 is a block diagram illustrating a controller of the control device of FIG. 3 .

도 3 및 도 4를 참조하면, 작업 장비의 유압 제어 시스템은, 입력된 제어 신호에 따라 작업 장비의 유압 시스템(100)의 동작을 제어하기 위한 유압 제어 장치, 유압 시스템(100)의 상태값들에 대한 센서 신호를 측정하기 위한 측정부(300), 및 상기 작업 장비의 무인 자동화 작업을 수행하기 위하여 상기 제어 신호를 생성 및 출력하기 위한 제어 장치(200)를 포함할 수 있다. 또한, 상기 작업 장비의 유압 제어 시스템은 상기 작업 장비의 무인 자동화 작업을 위한 작업 지형의 지형 정보 및 작업 정보를 제공하기 위한 상위 제어부(400)를 더 포함할 수 있다.3 and 4 , the hydraulic control system of the working equipment includes a hydraulic control device for controlling the operation of the hydraulic system 100 of the working equipment according to an input control signal, and state values of the hydraulic system 100 . It may include a measurement unit 300 for measuring a sensor signal for , and a control device 200 for generating and outputting the control signal in order to perform an unattended automation operation of the work equipment. In addition, the hydraulic control system of the work equipment may further include an upper control unit 400 for providing topographic information and work information of the work terrain for the unmanned automated work of the work equipment.

예시적인 실시예들에 있어서, 측정부(300)는 유압 시스템(100)의 상태값들에 대한 센서 신호를 측정할 수 있다. 예들 들면, 측정부(300)는 상기 작업 장비의 작업 수행 시 유압 시스템(100)의 상태값들을 실시간으로 측정할 수 있다. 유압 시스템(100)의 상태값들은 자세 정보 센서 신호를 포함할 수 있다.In example embodiments, the measurement unit 300 may measure sensor signals for state values of the hydraulic system 100 . For example, the measurement unit 300 may measure the state values of the hydraulic system 100 in real time when the work equipment is performed. State values of the hydraulic system 100 may include an attitude information sensor signal.

예를 들면, 상기 자세 정보 센서 신호는 작업 장치(60)의 붐(70), 암(80) 및 버켓(90)의 조인트들 각각의 각도와 각속도를 포함할 수 있다. 각도 센서들 및 IMU 센서들은 붐(70), 암(80) 및 버켓(90)의 조인트들 각각의 각도, 각속도, 각가속도 값들을 측정할 수 있다.For example, the posture information sensor signal may include the angle and angular velocity of each of the joints of the boom 70 , the arm 80 , and the bucket 90 of the working device 60 . The angle sensors and the IMU sensors may measure the angle, angular velocity, and angular acceleration values of the joints of the boom 70 , the arm 80 , and the bucket 90 .

또한, 측정부(300)는 상기 작업 장비의 무인 자동화 작업을 위해 필요한 주변 환경 인지 데이터를 획득하기 위한 센서를 포함할 수 있다. 상기 센서는 작업 지형을 파악하고 주변 사물을 감지하기 위한 주변 환경 인지 데이터를 획득할 수 있다. 상기 센서는 전방의 지형 또는 물체를 스캐닝하여 전방 지면 정보 및 사물 정보를 획득할 수 있다.In addition, the measurement unit 300 may include a sensor for acquiring the surrounding environment recognition data required for the unmanned automated operation of the work equipment. The sensor may acquire surrounding environment recognition data for detecting a work terrain and detecting a surrounding object. The sensor may acquire front ground information and object information by scanning the terrain or object in front.

예를 들면, 상기 센서는 라이다(LiDAR) 센서, 스테레오 카메라 센서, 레이다(Radar) 센서, 초음파 센서 등을 포함할 수 있다.For example, the sensor may include a LiDAR sensor, a stereo camera sensor, a Radar sensor, an ultrasonic sensor, and the like.

예시적인 실시예들에 있어서, 작업 장비의 제어 장치(200)는 상기 주변 환경 인지 데이터를 상위 제어부(400)로 송신하고, 상위 제어부(400)로부터 상기 무인 자동화 작업을 위한 작업 지역의 지형 정보 및 작업 정보를 수신할 수 있다. 예를 들면, 상기 작업 지역은 굴삭기가 이동하고 작업하기 위한 구역으로 정의될 수 있다.In exemplary embodiments, the control device 200 of the work equipment transmits the surrounding environment recognition data to the upper control unit 400, and topographic information of the work area for the unmanned automated operation from the upper control unit 400 and You can receive job information. For example, the work area may be defined as an area for the excavator to move and work.

상위 제어부(400)는 상기 작업 장비 내의 서브 시스템 또는 별개의 시스템(예를 들면, 관제부)으로 제공될 수 있다. 상위 제어부(400)는 상기 작업 장비의 유압 시스템(100)의 구동에 직접 관여하지 않을 수 있다.The upper control unit 400 may be provided as a subsystem within the work equipment or as a separate system (eg, a control unit). The upper control unit 400 may not be directly involved in driving the hydraulic system 100 of the work equipment.

제어 장치(200)는 상위 제어부(400)와 무선 또는 유선으로 연결될 수 있다. 예를 들면, 상기 제어 장치는 상위 제어부(400)와의 무선 통신을 위한 무선 송수신부를 포함할 수 있다. 상기 무선 송수신부는 CDMA, GSM과 같은 셀룰러 통신, Wi-Fi, 라디오 통신과 같이 공지의 통신 규격을 이용할 수 있다. 상기 무선 송수신부는 TMS(Telematics Monitor System) 모듈을 포함할 수 있다.The control device 200 may be connected to the upper control unit 400 wirelessly or by wire. For example, the control device may include a wireless transceiver for wireless communication with the upper control unit 400 . The wireless transceiver may use known communication standards such as cellular communication such as CDMA and GSM, Wi-Fi, and radio communication. The wireless transceiver may include a Telematics Monitor System (TMS) module.

또한, 측정부(300)는 상위 제어부(400)와 무선으로 연결될 수 있다. 상위 제어부(400)는 측정부(300)로부터 직접 센서 신호를 수신할 수 있다. 예를 들면, 상기 작업 중에 큰 부하가 상기 작업 장비에 걸렸을 때와 같이 주변 환경과의 물리적 상호 작용 시, 상위 제어부(400)는 이러한 부하 조건을 고려하기 위하여 측정부(300)로부터의 상기 센서 신호를 피드백 받아 목표 명령 신호를 생성할 수 있다.Also, the measurement unit 300 may be wirelessly connected to the upper control unit 400 . The upper control unit 400 may receive a sensor signal directly from the measurement unit 300 . For example, during physical interaction with the surrounding environment, such as when a large load is applied to the work equipment during the work, the upper control unit 400 takes into account the load condition, the sensor signal from the measuring unit 300 can be fed back to generate a target command signal.

예시적인 실시예들에 있어서, 작업 장비의 제어 장치(200)는 유압 시스템(100)의 동작을 제어하기 위한 제어 신호를 출력할 수 있다. 제어 장치(200)는 마이크로컴퓨터 및 각종 인터페이스를 포함하고, 외부 메모리 또는 내부 메모리에 저장되는 프로그램 및 레시피 정보에 따라 상기 유압 시스템의 동작을 제어할 수 있다.In example embodiments, the control device 200 of the work equipment may output a control signal for controlling the operation of the hydraulic system 100 . The control device 200 includes a microcomputer and various interfaces, and may control the operation of the hydraulic system according to program and recipe information stored in an external memory or an internal memory.

상기 작업 장비의 유압 제어 시스템은 무인 자동화 작업 모드(가상 모드) 및 수동 작업 모드 중에서 어느 하나의 작업 모드를 선택하기 위한 선택부를 더 포함할 수 있다.The hydraulic control system of the work equipment may further include a selection unit for selecting any one work mode from among an unmanned automated work mode (virtual mode) and a manual work mode.

상기 무인 자동화 작업 모드(가상 모드)가 선택된 경우, 작업 장비의 제어 장치(200)는 상위 제어부(400)로부터 제공된 작업 명령 정보로부터 목표 명령 신호를 수신할 수 있다. 상기 목표 명령 신호는 상기 무인 자동화 작업 궤적을 위한 유압 시스템(100)의 상태값들에 대한 지령 신호들을 포함할 수 있다. 예를 들면, 상기 목표 명령 신호는 가상 속도 지령 신호 및 가상 위치 지령 신호를 포함할 수 있다.When the unattended automated operation mode (virtual mode) is selected, the control device 200 of the work equipment may receive a target command signal from the work command information provided from the upper control unit 400 . The target command signal may include command signals for state values of the hydraulic system 100 for the unmanned automated operation trajectory. For example, the target command signal may include a virtual speed command signal and a virtual position command signal.

작업 장비의 제어 장치(200)는 상위 제어부(400)로부터의 상기 작업 궤적과 유압 시스템(100)의 실제 작업 궤적 사이의 오차를 보상하기 위한 제어기를 포함할 수 있다.The control device 200 of the work equipment may include a controller for compensating for an error between the working trajectory from the upper control unit 400 and the actual working trajectory of the hydraulic system 100 .

도 4에 도시된 바와 같이, 작업 장비의 제어 장치(200)의 상기 제어기는 제1 합산기(212), 피드백 제어기(214), 피드포워드 제어기(220) 및 제2 합산기(216)를 포함할 수 있다. 또한, 작업 장비의 제어 장치(200)의 상기 제어기는 리미터(218) 및 플랜트 모델(222)을 더 포함할 수 있다.As shown in FIG. 4 , the controller of the control device 200 of the working equipment includes a first summer 212 , a feedback controller 214 , a feedforward controller 220 and a second summer 216 . can do. In addition, the controller of the control device 200 of the working equipment may further include a limiter 218 and a plant model 222 .

제1 합산부(212)는 설정점 신호로서의 상기 목표 명령 신호(예를 들면, 가상 위치 지령 신호)와 실제 검출 신호로서의 상기 센서 신호(예를 들면, 위치 센서 신호)를 비교할 수 있다. 상기 목표 명령 신호와 상기 센서 신호의 차이값은 에러 신호를 나타낼 수 있다. 상기 센서 신호는 상기 작업 장비의 작업 수행 시 실시간으로 측정부(300)에 의해 검출된 유압 시스템(100)의 상태값일 수 있다.The first summing unit 212 may compare the target command signal (eg, a virtual position command signal) as a set point signal and the sensor signal (eg, a position sensor signal) as an actual detection signal. A difference value between the target command signal and the sensor signal may represent an error signal. The sensor signal may be a state value of the hydraulic system 100 detected by the measurement unit 300 in real time when the work equipment is performed.

피드백 제어기(214)는 상기 에러 신호에 기초하여 피드백 제어 신호를 생성할 수 있다. 피드백 제어기(214)는 PID (proportional integral derivative) 제어기를 포함할 수 있다. 작업 장비의 제어 장치(200)는 피드백 제어기(214)의 제어 파라미터들을 산출하고 제공할 수 있다.The feedback controller 214 may generate a feedback control signal based on the error signal. The feedback controller 214 may include a proportional integral derivative (PID) controller. The control device 200 of the work equipment may calculate and provide the control parameters of the feedback controller 214 .

피드포워드 제어기(220)는 상기 목표 명령 신호(예를 들면, 가상 속도 지령 신호)에 기초하여 피드포워드 제어 신호를 생성할 수 있다. 작업 장비의 제어 장치(200)는 피드포워드 제어기(220)의 제어 파라미터들을 산출하고 제공할 수 있다.The feedforward controller 220 may generate a feedforward control signal based on the target command signal (eg, a virtual speed command signal). The control device 200 of the work equipment may calculate and provide control parameters of the feedforward controller 220 .

제2 합산기(216)는 피드백 제어기(214)에서 생성된 상기 피드백 제어 신호와 피드포워드 제어기(220)에서 생성된 상기 피드포워드 제어 신호를 합산하여 수정된 제어 신호를 제공할 수 있다. 유압 시스템(100)의 상기 유압 제어 장치는 상기 제어 신호에 기초하여 제어 또는 동작될 수 있다.The second summer 216 may provide a modified control signal by adding the feedback control signal generated by the feedback controller 214 and the feedforward control signal generated by the feedforward controller 220 . The hydraulic control device of the hydraulic system 100 may be controlled or operated based on the control signal.

리미터(218)는 실제 장비가 동작할 수 있는 동작 범위 내에서 동작하도록 상기 제어 신호의 출력 크기를 제한할 수 있다. 플랜트 모델(222)은 유압 시스템에 대한 모사이고, 룩업 데이블(look-up table) 또는 수학적으로 구현될 수 있다.The limiter 218 may limit the output magnitude of the control signal to operate within an operating range that the actual equipment can operate. The plant model 222 is a simulation of the hydraulic system and may be implemented mathematically or in a look-up table.

상기 무인 자동화 작업 모드가 선택된 경우, 가상 모드 선택 신호가 출력부(230)에 입력되고, 출력부(230)는 상기 피드백 제어 신호와 상기 피드포워드 제어 신호를 합산하여 생성된 제어 신호(목표 명령 신호)를 압력지령 신호로서 유압 시스템(100)의 스풀 변위 조정 밸브로 출력할 수 있다.When the unattended automation operation mode is selected, a virtual mode selection signal is input to the output unit 230 , and the output unit 230 generates a control signal (target command signal) generated by summing the feedback control signal and the feedforward control signal. ) may be output to the spool displacement adjustment valve of the hydraulic system 100 as a pressure command signal.

예시적인 실시예들에 있어서, 상기 수동 작업 모드가 선택된 경우, 수동 모드 선택 신호가 출력부(230)에 입력되고, 출력부(230)는 조작부(500)로부터 수신된 작업자의 수동 조작 신호(예를 들면, 수동 조이스틱/페달 지령 신호)를 압력지령 신호로서 유압 시스템(100)의 스풀 변위 조정 밸브로 출력할 수 있다.In exemplary embodiments, when the manual operation mode is selected, a manual mode selection signal is input to the output unit 230 , and the output unit 230 receives the operator's manual operation signal (eg, the operation unit 500 ) from the operation unit 500 . For example, a manual joystick/pedal command signal) may be output to the spool displacement adjustment valve of the hydraulic system 100 as a pressure command signal.

상술한 바와 같이, 상기 작업 장비의 유압 제어 시스템은, 무인 자동화 작업을 수행할 때 유압 시스템(100)으로부터 획득한 센서 신호를 이용한 피드백 제어기(214) 및 상위 제어부(400)로부터 제공된 목표 명령 신호를 입력으로 하는 피드포워드 제어기(220)를 통해 상위 제어부(400)로부터 전달받은 작업 명령 궤적과 유압 시스템(100)의 실제 작업 궤적 사이의 오차를 감소시킬 수 있다. 또한, 상기 작업 장비의 유압 제어 시스템은, 수동 조작 모드가 선택한 경우, 작업자의 조작 신호에 따라 유압 시스템(100)의 동작을 제어할 수 있다.As described above, the hydraulic control system of the work equipment receives the target command signal provided from the feedback controller 214 and the upper control unit 400 using the sensor signal obtained from the hydraulic system 100 when performing an unmanned automated operation. It is possible to reduce an error between the trajectory of the work command received from the upper control unit 400 through the input feed forward controller 220 and the actual trajectory of the hydraulic system 100 . In addition, when the manual operation mode is selected, the hydraulic control system of the work equipment may control the operation of the hydraulic system 100 according to an operator's operation signal.

따라서, 피드백 제어기(214)와 피드포워드 제어기(220)로 구성된 제어기를 사용함으로써, 유압 시스템(100)의 빠른 반응성을 확보하고, 작업을 진행할 때 발생하는 커다란 부하나 외란에 따른 변동을 최소화함으로써 개선된 제어 성능을 제공할 수 있다.Therefore, by using the controller composed of the feedback controller 214 and the feedforward controller 220, the rapid response of the hydraulic system 100 is ensured, and the change due to a large load or disturbance generated during operation is minimized. control performance can be provided.

이하에서는, 도 3의 작업 장비의 유압 제어 시스템을 이용하여 건설 기계의 유압 시스템을 제어하는 방법에 대하여 설명하기로 한다.Hereinafter, a method of controlling the hydraulic system of a construction machine using the hydraulic control system of the work equipment of FIG. 3 will be described.

도 5는 예시적인 실시예들에 따른 작업 장비의 유압 제어 방법을 나타내는 순서도이다.5 is a flowchart illustrating a method for controlling hydraulic pressure of work equipment according to exemplary embodiments.

도 1 내지 도 5를 참조하면, 먼저, 모드 선택 신호를 모니터링하고(S100), 무인 자동화 작업 모드가 선택되었는 지 여부를 판단할 수 있다(S110). 상기 무인 자동화 작업 모드가 선택된 경우, 목표 명령 신호 및 센서 신호를 수신할 수 있다(S120).1 to 5 , first, a mode selection signal may be monitored ( S100 ), and it may be determined whether an unattended automation operation mode is selected ( S110 ). When the unattended automation operation mode is selected, a target command signal and a sensor signal may be received (S120).

예시적인 실시예들에 있어서, 작업자는 선택부를 통해 무인 자동화 작업 모드 및 수동 작업 모드 중에서 어느 하나의 작업 모드를 선택할 수 있다.In example embodiments, the operator may select any one of the unmanned automated operation mode and the manual operation mode through the selection unit.

상기 무인 자동화 작업 모드가 선택된 경우, 상위 제어부(400)로부터 제공된 작업 명령 정보로부터 상기 목표 명령 신호를 수신할 수 있다. 상기 목표 명령 신호는 무인 자동화 작업 궤적을 위한 유압 시스템(100)의 상태값들에 대한 지령 신호들을 포함할 수 있다. 예를 들면, 상기 목표 명령 신호는 가상 속도 지령 신호 및 가상 위치 지령 신호를 포함할 수 있다.When the unattended automation work mode is selected, the target command signal may be received from work command information provided from the upper control unit 400 . The target command signal may include command signals for state values of the hydraulic system 100 for an unmanned automated operation trajectory. For example, the target command signal may include a virtual speed command signal and a virtual position command signal.

상기 센서 신호는 상기 작업 장비의 작업 수행 시 실시간으로 측정부(300)에 의해 검출된 유압 시스템(100)의 상태값일 수 있다. 예를 들면, 상기 센서 신호는 위치 센서 신호를 포함할 수 있다.The sensor signal may be a state value of the hydraulic system 100 detected by the measurement unit 300 in real time when the work equipment is performed. For example, the sensor signal may include a position sensor signal.

이어서, 피드백 제어 신호를 생성하고(S130), 피드포워드 제어 신호를 생성할 수 있다(S132).Subsequently, a feedback control signal may be generated (S130) and a feedforward control signal may be generated (S132).

예시적인 실시예들에 있어서, 상기 목표 명령 신호 및 상기 센서 신호에 기초하여 상기 피드백 제어 신호를 생성할 수 있다. 설정점 신호로서의 상기 목표 명령 신호(예를 들면, 목표 위치 지령 신호)와 실제 검출 신호로서의 상기 센서 신호(예를 들면, 위치 센서 신호)를 비교할 수 있다. 상기 목표 명령 신호와 상기 센서 신호의 차이값은 에러 신호를 나타낼 수 있다. 피드백 제어기(214)는 상기 에러 신호에 기초하여 피드백 제어 신호를 생성할 수 있다.In example embodiments, the feedback control signal may be generated based on the target command signal and the sensor signal. The target command signal (eg, target position command signal) as a set point signal may be compared with the sensor signal (eg, position sensor signal) as an actual detection signal. A difference value between the target command signal and the sensor signal may represent an error signal. The feedback controller 214 may generate a feedback control signal based on the error signal.

상기 목표 명령 신호에 기초하여 상기 피드포워드 제어 신호를 생성할 수 있다. 피드포워드 제어기(220)는 상기 목표 명령 신호(예를 들면, 목표 속도 지령 신호)에 기초하여 상기 피드포워드 제어 신호를 생성할 수 있다.The feedforward control signal may be generated based on the target command signal. The feedforward controller 220 may generate the feedforward control signal based on the target command signal (eg, a target speed command signal).

이후, 상기 피드백 제어 신호와 상기 피드포워드 제어 신호를 합산하여 생성된 제어 신호를 유압 시스템(100)의 유압 제어 장치에 출력할 수 있다(S140).Thereafter, a control signal generated by summing the feedback control signal and the feedforward control signal may be output to the hydraulic pressure control device of the hydraulic system 100 ( S140 ).

피드백 제어기(214)에서 생성된 상기 피드백 제어 신호와 피드포워드 제어기(220)에서 생성된 상기 피드포워드 제어 신호를 합산하여 수정된 제어 신호를 제공할 수 있다. 유압 시스템(100)의 상기 유압 제어 장치는 상기 제어 신호에 기초하여 제어 또는 동작될 수 있다.A modified control signal may be provided by summing the feedback control signal generated by the feedback controller 214 and the feedforward control signal generated by the feedforward controller 220 . The hydraulic control device of the hydraulic system 100 may be controlled or operated based on the control signal.

상기 피드백 제어 신호와 상기 피드포워드 제어 신호를 합산하여 생성된 제어 신호(목표 명령 신호)는 압력지령 신호로서 유압 시스템(100)의 스풀 변위 조정 밸브로 출력될 수 있다.A control signal (target command signal) generated by summing the feedback control signal and the feedforward control signal may be output as a pressure command signal to the spool displacement adjustment valve of the hydraulic system 100 .

상기 수동 작업 모드가 선택된 경우, 수동 조작 신호를 수신하고(S122), 상기 수동 조작 신호에 따른 제어 신호를 유압 시스템(100)의 상기 유압 제어 장치에 출력할 수 있다(S140).When the manual operation mode is selected, a manual operation signal may be received (S122), and a control signal according to the manual operation signal may be output to the hydraulic control device of the hydraulic system 100 (S140).

상기 수동 작업 모드가 선택된 경우, 수동 모드 선택 신호가 출력부(230)에 입력되고, 출력부(230)는 조작부(500)로부터 수신된 작업자의 수동 조작 신호(예를 들면, 수동 조이스틱/페달 지령 신호)를 압력지령 신호로서 유압 시스템(100)의 스풀 변위 조정 밸브로 출력할 수 있다.When the manual operation mode is selected, a manual mode selection signal is input to the output unit 230 , and the output unit 230 receives the operator's manual operation signal (eg, manual joystick/pedal command) received from the operation unit 500 . signal) may be output to the spool displacement adjustment valve of the hydraulic system 100 as a pressure command signal.

상술한 바와 같이, 상기 무인 자동화 작업 모드가 선택된 경우, 상위 제어부(400)로부터 작업 명령을 전달받고, 피드백 제어 신호와 피드포워드 제어 신호를 생성하여 합산된 제어 신호에 따라 유압 시스템(100)의 동작을 제어함으로써, 유압 시스템(100)의 빠른 응답성을 확보하고, 유사시에는 작업자가 직접 조작할 수 있도록 제어권을 전환할 수 있다.As described above, when the unmanned automation operation mode is selected, the operation command is received from the upper control unit 400, a feedback control signal and a feedforward control signal are generated, and the hydraulic system 100 is operated according to the summed control signal. By controlling the hydraulic system 100, it is possible to secure a quick responsiveness and switch the control right so that the operator can directly operate it in case of an emergency.

이상에서는 본 발명의 실시예들을 참조하여 설명하였지만, 해당 기술 분야의 숙련된 당업자는 하기의 특허 청구의 범위에 기재된 본 발명의 사상 및 영역으로부터 벗어나지 않는 범위 내에서 본 발명을 다양하게 수정 및 변경시킬 수 있음을 이해할 수 있을 것이다.Although the above has been described with reference to the embodiments of the present invention, those skilled in the art can variously modify and change the present invention within the scope without departing from the spirit and scope of the present invention described in the claims below. You will understand that you can.

10: 작업 장비 20: 하부 주행체
30: 상부 선회체 32: 상부 프레임
40: 카운터웨이트 50: 운전실
60: 작업 장치 62: 액추에이터
70: 붐 72: 붐 실린더
80: 암 82: 암 실린더
90: 버켓 92: 버켓 실린더
100: 유압 시스템 110: 엔진
120: 유압 펌프 122: 펌프 레귤레이터
124: 고압 유압 라인 130: 메인 컨트롤 밸브
140: 스풀 변위 조정부 150: 파일럿 펌프
200: 제어 장치 212: 제1 합산기
214: 피드백 제어기 216: 제2 합산기
218: 리미터 220: 피드포워드 제어기
222: 플랜트 모델 230: 출력부
300: 측정부 400: 상위 제어부
500: 조작부
10: work equipment 20: undercarriage
30: upper slewing body 32: upper frame
40: counterweight 50: cab
60: working device 62: actuator
70: boom 72: boom cylinder
80: female 82: female cylinder
90: bucket 92: bucket cylinder
100: hydraulic system 110: engine
120: hydraulic pump 122: pump regulator
124: high pressure hydraulic line 130: main control valve
140: spool displacement adjustment unit 150: pilot pump
200: control device 212: first summer
214: feedback controller 216: second summer
218: limiter 220: feedforward controller
222: plant model 230: output
300: measurement unit 400: upper control unit
500: control panel

Claims (17)

무인 자동화 작업을 수행하기 위하여 작업 장비의 유압 시스템을 동작시키기 위한 목표 명령 신호를 결정하고;
상기 유압 시스템에 설치된 측정부로부터 센서 신호를 수신하고;
상기 목표 명령 신호 및 상기 센서 신호에 기초하여 피드백 제어 신호를 생성하고;
상기 목표 명령 신호에 기초하여 피드포워드 제어 신호를 생성하고; 그리고
상기 피드백 제어 신호와 상기 피드포워드 제어 신호를 합산하여 생성된 제어 신호에 따라 상기 유압 시스템의 동작을 제어하는 것을 포함하는 작업 장비의 유압 제어 방법.
determine a target command signal for operating a hydraulic system of the work equipment to perform an unattended automated task;
receiving a sensor signal from a measurement unit installed in the hydraulic system;
generate a feedback control signal based on the target command signal and the sensor signal;
generate a feedforward control signal based on the target command signal; and
and controlling an operation of the hydraulic system according to a control signal generated by summing the feedback control signal and the feedforward control signal.
제 1 항에 있어서, 상기 피드백 제어 신호를 생성하는 것은 상기 목표 명령 신호와 상기 센서 신호의 차이값에 기초하여 상기 피드백 제어 신호를 생성하는 것을 포함하는 작업 장비의 유압 제어 방법.The method according to claim 1, wherein generating the feedback control signal includes generating the feedback control signal based on a difference value between the target command signal and the sensor signal. 제 1 항에 있어서, 상기 목표 명령 신호를 결정하는 것은 상위 제어부로부터 제공된 작업 명령 정보로부터 상기 목표 명령 신호를 획득하는 것을 포함하는 작업 장비의 유압 제어 방법.The method according to claim 1, wherein determining the target command signal includes obtaining the target command signal from work command information provided from an upper control unit. 제 3 항에 있어서, 상기 작업 장비의 무인 자동화 작업을 위해 필요한 주변 환경 인지 데이터를 획득하고; 그리고
상기 획득한 주변 환경 인지 데이터를 상기 상위 제어부로 송신하는 것을 더 포함하는 작업 장비의 유압 제어 방법.
The method according to claim 3, further comprising: acquiring environmental awareness data necessary for unmanned automated operation of the work equipment; and
The hydraulic control method of work equipment further comprising transmitting the acquired surrounding environment recognition data to the upper control unit.
제 3 항에 있어서,
상기 유압 시스템에 설치된 측정부로부터의 센서 신호를 상기 상위 제어부로 송신하는 것을 더 포함하는 작업 장비의 유압 제어 방법.
4. The method of claim 3,
The hydraulic control method of the working equipment further comprising transmitting a sensor signal from a measuring unit installed in the hydraulic system to the upper control unit.
제 1 항에 있어서, 상기 목표 명령 신호는 상기 유압 시스템의 자동 작업 동작을 위한 상태값들을 포함하는 작업 장비의 유압 제어 방법.The method according to claim 1, wherein the target command signal includes state values for automatic operation of the hydraulic system. 제 1 항에 있어서, 상기 측정부로부터 상기 센서 신호를 수신하는 것은 상기 작업 장비의 작업 수행 시 실시간으로 상기 유압 시스템의 상태값들을 측정하는 것을 포함하는 작업 장비의 유압 제어 방법.The method of claim 1 , wherein receiving the sensor signal from the measuring unit comprises measuring state values of the hydraulic system in real time when the work equipment is performed. 제 1 항에 있어서,
선택부를 통해 무인 자동화 작업 모드 및 수동 작업 모드 중에서 어느 하나의 작업 모드를 선택하는 것을 더 포함하는 작업 장비의 유압 제어 방법.
The method of claim 1,
The hydraulic control method of the work equipment further comprising selecting any one of the unmanned automated work mode and the manual work mode through the selection unit.
제 8 항에 있어서,
상기 수동 작업 모드가 선택된 경우, 작업자의 수동 조작 신호를 수신하고; 그리고
상기 수동 조작 신호에 따라 상기 유압 시스템의 동작을 제어하는 것을 더 포함하는 작업 장비의 유압 제어 방법.
9. The method of claim 8,
receiving a manual operation signal of an operator when the manual operation mode is selected; and
The hydraulic control method of the work equipment further comprising controlling the operation of the hydraulic system according to the manual operation signal.
작업 장비의 유압 시스템의 상태값들에 대한 센서 신호를 측정하기 위한 측정부;
무인 자동화 작업을 위한 목표 명령 신호 및 상기 측정부로부터 상기 센서 신호를 수신하고, 상기 목표 명령 신호 및 상기 센서 신호에 기초하여 피드백 제어 신호를 생성하기 위한 피드백 제어기 및 상기 목표 명령 신호에 기초하여 피드포워드 제어 신호를 생성하기 위한 피드포워드 제어기를 포함하고, 상기 피드백 제어 신호와 상기 피드포워드 제어 신호를 합산하여 생성된 제어 신호를 출력하기 위한 제어 장치; 및
상기 제어 신호에 따라 상기 유압 시스템의 동작을 제어하기 위한 유압 제어 장치를 포함하는 작업 장비의 유압 제어 시스템.
a measuring unit for measuring a sensor signal for state values of a hydraulic system of the work equipment;
A feedback controller for receiving a target command signal and the sensor signal from the measurement unit for an unattended automation operation, and generating a feedback control signal based on the target command signal and the sensor signal, and a feedforward based on the target command signal a control device comprising a feedforward controller for generating a control signal, and outputting a control signal generated by summing the feedback control signal and the feedforward control signal; and
and a hydraulic control device for controlling an operation of the hydraulic system according to the control signal.
제 10 항에 있어서, 상기 피드백 제어기는 상기 목표 명령 신호와 상기 센서 신호의 차이값에 기초하여 상기 피드백 제어 신호를 생성하는 작업 장비의 유압 제어 시스템.The hydraulic control system of a work equipment according to claim 10, wherein the feedback controller generates the feedback control signal based on a difference value between the target command signal and the sensor signal. 제 10 항에 있어서, 상기 제어 장치는 상위 제어부로부터 제공된 작업 명령 정보로부터 상기 목표 명령 신호를 획득하는 작업 장비의 유압 제어 시스템.The hydraulic control system of a work equipment according to claim 10, wherein the control device obtains the target command signal from work command information provided from an upper control unit. 제 12 항에 있어서, 상기 측정부는 상기 무인 자동화 작업을 위해 필요한 주변 환경 인지 데이터를 획득하고,
상기 제어 장치는 상기 획득한 주변 환경 인지 데이터를 상기 상위 제어부로 송신하는 작업 장비의 유압 제어 시스템.
The method of claim 12, wherein the measurement unit acquires surrounding environment recognition data necessary for the unmanned automation operation,
The control device is a hydraulic control system of the work equipment for transmitting the acquired surrounding environment recognition data to the upper control unit.
제 10 항에 있어서, 상기 목표 명령 신호는 상기 유압 시스템의 자동 작업 동작을 위한 상태값들을 포함하는 작업 장비의 유압 제어 시스템.The hydraulic control system of a working equipment according to claim 10, wherein the target command signal includes state values for automatic working operation of the hydraulic system. 제 10 항에 있어서, 상기 측정부는 상기 작업 장비의 작업 수행 시 실시간으로 상기 유압 시스템의 상태값들을 검출하는 작업 장비의 유압 제어 시스템.The hydraulic control system of claim 10, wherein the measuring unit detects state values of the hydraulic system in real time when the work of the work equipment is performed. 제 10 항에 있어서,
무인 자동화 작업 모드 및 수동 작업 모드 중에서 어느 하나의 작업 모드를 선택하기 위한 선택부를 더 포함하는 작업 장비의 유압 제어 시스템.
11. The method of claim 10,
The hydraulic control system of the work equipment further comprising a selection unit for selecting any one of the unmanned automated work mode and the manual work mode.
제 16 항에 있어서, 상기 제어 장치는, 상기 선택부를 통해 상기 수동 작업 모드가 선택된 경우, 작업자의 수동 조작 신호를 수신하고, 상기 수동 조작 신호에 따른 제어 신호를 상기 유압 제어 장치에 출력하는 작업 장비의 유압 제어 시스템.The work equipment according to claim 16, wherein the control device receives a manual operation signal of an operator and outputs a control signal according to the manual operation signal to the hydraulic control device when the manual operation mode is selected through the selection unit. of hydraulic control system.
KR1020200040188A 2020-04-02 2020-04-02 Hydraulic control method and system KR20210123023A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1020200040188A KR20210123023A (en) 2020-04-02 2020-04-02 Hydraulic control method and system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020200040188A KR20210123023A (en) 2020-04-02 2020-04-02 Hydraulic control method and system

Publications (1)

Publication Number Publication Date
KR20210123023A true KR20210123023A (en) 2021-10-13

Family

ID=78115130

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020200040188A KR20210123023A (en) 2020-04-02 2020-04-02 Hydraulic control method and system

Country Status (1)

Country Link
KR (1) KR20210123023A (en)

Similar Documents

Publication Publication Date Title
CN109101032B (en) System and method for controlling machine pose using sensor fusion
CN109115213B (en) System and method for determining machine state using sensor fusion
US11530920B2 (en) Controlling movement of a machine using sensor fusion
US6140787A (en) Method and apparatus for controlling a work implement
EP3128084B1 (en) Work vehicle with improved implement position control and self-leveling functionality
CN109099033B (en) Method and system for controlling fluid pressure in a machine using sensor fusion feedback
US10738439B2 (en) Open loop electrohydraulic bucket position control method and system
JPH1068145A (en) Method and device for controlling tool of earth-moving machine
JP2000327294A (en) Device and method for co-operatively controlling work tool
JP2009167673A (en) Work device
US11585071B2 (en) Hystat swing motion actuation, monitoring, and control system
US20140172246A1 (en) Automatic Swing and Radius Control System and Method for a Machine Implement
US11634887B2 (en) Method and system for controlling construction machinery
KR20210060966A (en) Method and system for controlling construction machinery
US6618967B2 (en) Work machine control for improving cycle time
KR20210123023A (en) Hydraulic control method and system
FI131037B1 (en) Controlling boom of work machine
US11702819B2 (en) Electrohydraulic implement control system and method
JP2023520994A (en) Electrical control of hydraulic systems of construction machinery
KR20230108154A (en) Hydraulic control methods and system for construction machinery
CN115151473B (en) Steering device and work machine
US20240209590A1 (en) Shovel
US20240254727A1 (en) Uninterrupted automatic position control of work implements during override of target settings
KR20160144707A (en) Control system for construction machinery