KR20240025671A - 작업 기계를 제어하기 위한 시스템, 방법 및 프로그램 - Google Patents

작업 기계를 제어하기 위한 시스템, 방법 및 프로그램 Download PDF

Info

Publication number
KR20240025671A
KR20240025671A KR1020247003068A KR20247003068A KR20240025671A KR 20240025671 A KR20240025671 A KR 20240025671A KR 1020247003068 A KR1020247003068 A KR 1020247003068A KR 20247003068 A KR20247003068 A KR 20247003068A KR 20240025671 A KR20240025671 A KR 20240025671A
Authority
KR
South Korea
Prior art keywords
tilt
bucket
axis
rotation
working machine
Prior art date
Application number
KR1020247003068A
Other languages
English (en)
Inventor
히카루 스즈키
쓰토무 이와무라
쇼 노자키
류지 간다
다이시 이와나가
도모카즈 히라오
유타 우치다
유키 시마노
준 사사키
진 기타지마
Original Assignee
가부시키가이샤 고마쓰 세이사쿠쇼
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 가부시키가이샤 고마쓰 세이사쿠쇼 filed Critical 가부시키가이샤 고마쓰 세이사쿠쇼
Publication of KR20240025671A publication Critical patent/KR20240025671A/ko

Links

Classifications

    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F3/00—Dredgers; Soil-shifting machines
    • E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36—Component parts
    • E02F3/3604—Devices to connect tools to arms, booms or the like
    • E02F3/3677—Devices to connect tools to arms, booms or the like allowing movement, e.g. rotation or translation, of the tool around or along another axis as the movement implied by the boom or arms, e.g. for tilting buckets
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F3/00—Dredgers; Soil-shifting machines
    • E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36—Component parts
    • E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F3/00—Dredgers; Soil-shifting machines
    • E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36—Component parts
    • E02F3/3604—Devices to connect tools to arms, booms or the like
    • E02F3/3677—Devices to connect tools to arms, booms or the like allowing movement, e.g. rotation or translation, of the tool around or along another axis as the movement implied by the boom or arms, e.g. for tilting buckets
    • E02F3/3681—Rotators
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F3/00—Dredgers; Soil-shifting machines
    • E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36—Component parts
    • E02F3/3604—Devices to connect tools to arms, booms or the like
    • E02F3/3686—Devices to connect tools to arms, booms or the like using adapters, i.e. additional element to mount between the coupler and the tool
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F3/00—Dredgers; Soil-shifting machines
    • E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36—Component parts
    • E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26—Indicating devices
    • E02F9/264—Sensors and their calibration for indicating the position of the work tool
    • E02F9/265—Sensors and their calibration for indicating the position of the work tool with follow-up actions (e.g. control signals sent to actuate the work tool)
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2200/00—Type of vehicle
    • B60Y2200/40—Special vehicles
    • B60Y2200/41—Construction vehicles, e.g. graders, excavators
    • B60Y2200/412—Excavators
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20—Drives; Control devices
    • E02F9/2004—Control mechanisms, e.g. control levers

Landscapes

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

Abstract

계측값 취득부는 복수의 센서로부터 계측값을 취득한다. 위치 자세 산출부는 계측값에 기초하여, 작업 기구의 현재의 자세를 산출한다. 목표 자세 결정부는 산출한 작업 기구의 현재의 자세에 기초하여, 가상 회전축을 결정한다. 회전량 산출부는 조작 장치로부터의 조작 신호에 기초하여, 작업 기구를 가상 회전축 주위에 회전시키기 위한 틸트 로테이터의 제어 신호를 생성한다. 제어 신호 출력부는, 생성한 제어 신호를 출력한다.

Description

작업 기계를 제어하기 위한 시스템, 방법 및 프로그램
본 개시는, 작업 기계를 제어하기 위한 시스템, 방법 및 프로그램에 관한 것이다.
본원은, 2021년 9월 30일에 일본에 출원된 특허출원 제2021-161745호에 대하여 우선권을 주장하고, 그 내용을 여기에 원용한다.
특허문헌 1에는, 틸트 회전 가능한 틸트 버킷을 구비한 건설 기계(작업 기계)의 제어 시스템이 개시되어 있다. 이와 같이, 서로 다른 축 주위에 회동(回動) 가능한 복수의 회동 기구(機構)를 탑재하고, 버킷 등의 작업 기구(器具)를 바라는 대로 회동 가능한 작업 기계가 알려져 있다.
일본공개특허 제2020-125599호 공보
그런데, 작업 기계의 어태치먼트를 서로 직교하는 3개의 축 주위에 회전 가능하게 지지하는 틸트 로테이터(tilt rotator)라는 부품이 알려져 있다. 작업 기계에 틸트 로테이터를 장착함으로써, 어태치먼트를 임의의 방향을 향하게 할 수 있다. 한편, 유압 셔블 등의 작업 기계에 있어서, 가장 빈번하게 행해지는 기본 조작의 하나로, 버킷을 그 개구 방향을 따라 회동시키는 조작(버킷 조작)이 있다. 버킷 조작이란, 굴삭이나 배토(排土)를 행할 때 등에 사용되는 조작이다. 통상의 유압 셔블이라면, 이와 같은 조작은 단순한 레버 조작으로 용이하게 실행 가능하다. 그러나, 틸트 로테이터를 탑재한 유압 셔블에 있어서, 버킷을 그 개구 방향을 따라 회동시키기 위해서는, 해당 버킷의 개구 방향에 따른 복합적인 조작이 요구된다.
본 개시의 목적은, 틸트 로테이터를 통하여 작업기에 지지된 작업 기구를 구비하는 작업 기계에 있어서, 작업 기구를 그 기준 방향(예를 들면, 버킷의 개구 방향)을 따라 회동시키는 조작을 간소화할 수 있는 시스템, 방법 및 프로그램을 제공하는 것에 있다.
본 개시의 일 태양(態樣)에 의하면, 시스템은, 작업기의 선단에 장착된 틸트 로테이터와, 틸트 로테이터를 통하여 작업기에 대하여 서로 다른 평면에서 교차하는 3개의 축 주위에 회전 가능하게 지지된 작업 기구를 구비하는 작업 기계를 제어하기 위한 시스템으로서, 프로세서를 구비한다. 프로세서는 복수의 센서로부터 계측값을 취득한다. 프로세서는 계측값에 기초하여, 작업 기구의 현재의 자세를 산출한다. 프로세서는 산출한 작업 기구의 현재의 자세에 기초하여, 가상 회전축을 결정한다. 프로세서는 조작 장치로부터의 조작 신호에 기초하여, 작업 기구를 가상 회전축 주위에 회전시키기 위한 상기 틸트 로테이터의 제어 신호를 생성한다. 프로세서는, 생성한 상기 제어 신호를 출력한다.
상기 태양에 의하면, 틸트 로테이터를 통하여 작업기에 지지된 작업 기구를 구비하는 작업 기계에 있어서, 작업 기구를 그 기준 방향(예를 들면, 버킷의 개구 방향)을 따라 회동시키는 조작을 간소화할 수 있다.
[도 1] 제1 실시형태에 관련된 작업 기계(100)의 구성을 나타내는 개략도이다.
[도 2] 제1 실시형태에 관련된 틸트 로테이터(163)의 구성을 나타내는 도면이다.
[도 3] 제1 실시형태에 관련된 작업 기계(100)의 구동계를 나타내는 도면이다.
[도 4] 제1 실시형태에 관련된 제어 장치(200)의 구성을 나타내는 개략 블록도이다.
[도 5] 제1 실시형태에서의 덤프 조작 어시스트 제어를 나타내는 플로차트다.
[도 6] 제1 실시형태에서의 조작 장치의 상세를 나타내는 도면이다.
[도 7] 제1 실시형태에서의 덤프 조작 어시스트 제어에 의한 작용 효과를 나타내는 도면이다.
[도 8] 제1 실시형태에서의 덤프 조작 어시스트 제어에 의한 작용 효과를 나타내는 도면이다.
<제1 실시형태>
《작업 기계의 구성》
이하, 도면을 참조하면서 실시형태에 대하여 상세하게 설명한다.
도 1은, 제1 실시형태에 관련된 작업 기계(100)의 구성을 나타내는 개략도이다. 제1 실시형태에 관련된 작업 기계(100)는 예를 들면 유압 셔블이다. 작업 기계(100)는 주행체(120), 선회체(旋回體)(140), 작업기(160), 운전실(180), 제어 장치(200)를 구비한다. 제1 실시형태에 관련된 작업 기계(100)는, 버킷(164)의 날끝(teeth)이 설계면을 넘지 않도록 제어한다.
주행체(120)는 작업 기계(100)를 주행 가능하게 지지한다. 주행체(120)는 예를 들면 좌우 한 쌍의 무한궤도이다.
선회체(140)는 주행체(120)에 선회 중심 주위에 선회 가능하게 지지된다.
작업기(160)는 선회체(140)에 동작 가능하게 지지된다. 작업기(160)는 유압에 의해 구동한다. 작업기(160)는 붐(161), 암(162), 틸트 로테이터(163), 및 작업 기구인 버킷(164)을 구비한다. 붐(161)의 기단부(基端部)는 선회체(140)에 회동 가능하게 장착된다. 암(162)의 기단부는 붐(161)의 선단부에 회동 가능하게 장착된다. 틸트 로테이터(163)는 암(162)의 선단부에 회동 가능하게 장착된다. 버킷(164)은 틸트 로테이터(163)에 장착된다. 버킷(164)은 틸트 로테이터(163)를 통하여 작업기(160)에 대하여 서로 다른 평면에서 교차하는 3개의 축 주위에 회전 가능하게 지지된다. 여기에서, 선회체(140) 중 작업기(160)가 장착되는 부분을 전부(前部)라고 한다. 또한, 선회체(140)에 대하여, 전부를 기준으로, 반대측의 부분을 후부, 좌측의 부분을 좌부, 우측의 부분을 우부라고 한다.
도 2는, 제1 실시형태에 관련된 틸트 로테이터(163)의 구성을 나타내는 도면이다. 틸트 로테이터(163)는 버킷(164)을 지지하도록 암(162)의 선단에 장착된다. 틸트 로테이터(163)는 장착부(1631), 틸트부(1632), 회전부(1633)를 구비한다. 장착부(1631)는, 도시 좌우 방향으로 연장되는 축 주위에 회전 가능하게 암(162)의 선단에 장착된다. 틸트부(1632)는, 도시 전후 방향으로 연장되는 축 주위에 회전 가능하게 장착부(1631)에 장착된다. 회전부(1633)는, 도시 상하 방향으로 연장되는 축 주위에 회전 가능하게 틸트부(1632)에 장착된다. 이상적으로는, 장착부(1631), 틸트부(1632), 회전부(1633)의 회전축은 서로 직교한다. 버킷(164)의 기단부는 회전부(1633)에 고정된다. 이로써, 버킷(164)은 암(162)에 대하여 서로 직교하는 3축을 중심으로 회전할 수 있다. 다만, 실제로는 장착부(1631), 틸트부(1632), 회전부(1633)의 회전축은 설계 오차를 포함하고, 반드시 직교하지 않을 가능성이 있다.
운전실(180)은 선회체(140)의 전부에 설치된다. 운전실(180) 내에는, 오퍼레이터가 작업 기계(100)를 조작하기 위한 조작 장치(271), 및 제어 장치(200)의 인간-기계 인터페이스인 모니터 장치(272)가 설치된다. 조작 장치(271)는, 오퍼레이터로부터의 주행 모터(304)의 조작량, 선회 모터(305)의 조작량, 붐 실린더(306)의 조작량, 암 실린더(307)의 조작량, 버킷 실린더(308)의 조작량, 틸트 실린더(309)의 조작량, 및 회전 모터(310)의 조작량의 입력을 접수한다. 모니터 장치(272)는 오퍼레이터로부터 버킷 자세 유지 모드의 설정 및 해제의 입력을 접수한다. 버킷 자세 유지 모드란, 제어 장치(200)가 자동적으로 글로벌 좌표계에서의 버킷(164)의 자세를 유지하기 위해 버킷 실린더(308), 틸트 실린더(309) 및 회전 모터(310)를 제어하는 모드이다. 모니터 장치(272)는 예를 들면 터치패널을 구비하는 컴퓨터에 의해 실현된다.
제어 장치(200)는 오퍼레이터에 의한 조작 장치(271)의 조작에 기초하여, 주행체(120), 선회체(140), 및 작업기(160)를 제어한다. 제어 장치(200)는 예를 들면 운전실(180)의 내부에 설치된다.
《작업 기계(100)의 구동계》
도 3은, 제1 실시형태에 관련된 작업 기계(100)의 구동계를 나타내는 도면이다.
작업 기계(100)는 작업 기계(100)를 구동시키기 위한 복수의 액추에이터를 구비한다. 구체적으로는, 작업 기계(100)는 엔진(301), 유압 펌프(302), 컨트롤 밸브(303), 한 쌍의 주행 모터(304), 선회 모터(305), 붐 실린더(306), 암 실린더(307), 버킷 실린더(308), 틸트 실린더(309), 회전 모터(310)를 구비한다.
엔진(301)은 유압 펌프(302)를 구동하는 원동기다.
유압 펌프(302)는 엔진(301)에 의해 구동되고, 컨트롤 밸브(303)를 통하여 주행 모터(304), 선회 모터(305), 붐 실린더(306), 암 실린더(307) 및 버킷 실린더(308)에 작동유를 공급한다.
컨트롤 밸브(303)는 유압 펌프(302)로부터 주행 모터(304), 선회 모터(305), 붐 실린더(306), 암 실린더(307) 및 버킷 실린더(308)에 공급되는 작동유의 유량을 제어한다.
주행 모터(304)는 유압 펌프(302)로부터 공급되는 작동유에 의해 구동되고, 주행체(120)를 구동한다.
선회 모터(305)는 유압 펌프(302)로부터 공급되는 작동유에 의해 구동되고, 주행체(120)에 대하여 선회체(140)를 선회시킨다.
붐 실린더(306)는 붐(161)을 구동시키기 위한 유압 실린더다. 붐 실린더(306)의 기단부는 선회체(140)에 장착된다. 붐 실린더(306)의 선단부는 붐(161)에 장착된다.
암 실린더(307)는 암(162)을 구동시키기 위한 유압 실린더다. 암 실린더(307)의 기단부는 붐(161)에 장착된다. 암 실린더(307)의 선단부는 암(162)에 장착된다.
버킷 실린더(308)는 틸트 로테이터(163) 및 버킷(164)을 구동시키기 위한 유압 실린더다. 버킷 실린더(308)의 기단부는 암(162)에 장착된다. 버킷 실린더(308)의 선단부는 링크 부재를 통하여 틸트 로테이터(163)에 장착된다.
틸트 실린더(309)는 틸트부(1632)를 구동시키기 위한 유압 실린더다. 틸트 실린더(309)의 기단부는 장착부(1631)에 장착된다. 틸트 실린더(309)의 로드의 선단부는 틸트부(1632)에 장착된다.
회전 모터(310)는 회전부(1633)를 구동시키기 위한 유압 모터이다. 회전 모터(310)의 브래킷 및 고정자는 틸트부(1632)에 고정된다. 회전 모터(310)의 회전축 및 회전자(rotor)는 도시 상하 방향으로 연장되도록 설치되고, 회전부(1633)에 고정된다.
《작업 기계(100)의 계측계》
작업 기계(100)는 작업 기계(100)의 자세 및 위치를 계측하기 위한 복수의 센서를 구비한다. 구체적으로는, 작업 기계(100)는 경사 계측기(401), 위치 방위 계측기(402), 붐각 센서(403), 암각 센서(404), 버킷각 센서(405), 틸트각 센서(406), 회전각 센서(407)를 구비한다.
경사 계측기(401)는 선회체(140)의 자세를 계측한다. 경사 계측기(401)는 수평면에 대한 선회체(140)의 경사(예를 들면, 롤각, 피치각 및 편주각)을 계측한다. 경사 계측기(401)의 예로서는, IMU(Inertial Measurement Unit: 관성 계측 장치)를 들 수 있다. 이 경우, 경사 계측기(401)는 선회체(140)의 가속도 및 각속도를 계측하고, 계측 결과에 기초하여 선회체(140)의 수평면에 대한 경사를 산출한다. 경사 계측기(401)는 예를 들면 운전실(180)의 하방에 설치된다. 경사 계측기(401)는 계측값인 선회체(140)의 자세 데이터를 제어 장치(200)에 출력한다.
위치 방위 계측기(402)는, GNSS(Global Navigation Satellite System)에 의해 선회체(140)의 대표점의 위치 및 선회체(140)가 향하는 방위를 계측한다. 위치 방위 계측기(402)는, 예를 들면 선회체(140)에 장착된 도시하지 않은 2개의 GNSS 안테나를 구비하고, 2개의 안테나의 위치를 연결하는 직선에 직교하는 방위를 작업 기계(100)가 향하는 방위로서 계측한다. 위치 방위 계측기(402)는, 계측값인 선회체(140)의 위치 데이터 및 방위 데이터를 제어 장치(200)에 출력한다.
붐각 센서(403)는 선회체(140)에 대한 붐(161)의 회전각인 붐각을 계측한다. 붐각 센서(403)는 붐(161)에 장착된 IMU이면 된다. 이 경우, 붐각 센서(403)는, 붐(161)의 수평면에 대한 경사와 경사 계측기(401)가 계측한 선회체의 경사에 기초하여, 붐각을 계측한다. 붐각 센서(403)의 계측값은, 예를 들면 붐(161)의 기단과 선단을 통과하는 직선의 방향이 선회체(140)의 전후 방향과 일치할 때 제로를 나타낸다. 그리고, 다른 실시형태 관련된 붐각 센서(403)는 붐 실린더(306)에 장착된 스트로크 센서라도 된다. 또한, 다른 실시형태에 관련된 붐각 센서(403)는, 선회체(140)와 붐(161)을 회전 가능하게 접속하는 관절축에 설치된 회전 센서라도 된다. 붐각 센서(403)는, 계측값인 붐각 데이터를 제어 장치(200)에 출력한다.
암각 센서(404)는 붐(161)에 대한 암(162)의 각도인 암각을 계측한다. 암각 센서(404)는 암(162)에 장착된 IMU이면 된다. 이 경우, 암각 센서(404)는, 암(162)의 수평면에 대한 경사와 붐각 센서(403)가 계측한 붐각에 기초하여, 암각을 계측한다. 암각 센서(404)의 계측값은, 예를 들면 암(162)의 기단과 선단을 통과하는 직선의 방향이 붐(161)의 기단과 선단을 통과하는 직선의 방향과 일치할 때 제로를 나타낸다. 그리고, 다른 실시형태에 관련된 암각 센서(404)는 암 실린더(307)에 스트로크 센서를 장착하여 각도의 산출을 행해도 된다. 또한, 다른 실시형태에 관련된 암각 센서(404)는 붐(161)과 암(162)을 회전 가능하게 접속하는 관절축에 설치된 회전 센서라도 된다. 암각 센서(404)는, 계측값인 암각 데이터를 제어 장치(200)에 출력한다.
버킷각 센서(405)는 암(162)에 대한 틸트 로테이터(163)의 각도인 버킷각을 계측한다. 버킷각 센서(405)는 버킷 실린더(308)에 설치된 스트로크 센서이면 된다. 이 경우, 버킷각 센서(405)는 버킷 실린더(308)의 스트로크량에 기초하여 버킷각을 계측한다. 버킷각 센서(405)의 계측값은, 예를 들면 버킷(164)의 기단과 날끝을 통과하는 직선의 방향이 암(162)의 기단과 선단을 통과하는 직선의 방향과 일치할 때 제로를 나타낸다. 그리고, 다른 실시형태에 관련된 버킷각 센서(405)는 암(162)과 틸트 로테이터(163)의 장착부(1631)를 회전 가능하게 접속하는 관절축에 설치된 회전 센서라도 된다. 또한, 다른 실시형태에 관련된 버킷각 센서(405)는 버킷(164)에 장착된 IMU라도 된다. 버킷각 센서(405)는, 계측값인 버킷각 데이터를 제어 장치(200)에 출력한다.
틸트각 센서(406)는 틸트 로테이터(163)의 장착부(1631)에 대한 틸트부(1632)의 각도인 틸트각을 계측한다. 틸트각 센서(406)는 장착부(1631)와 틸트부(1632)를 회전 가능하게 접속하는 관절축에 설치된 회전 센서이면 된다. 틸트각 센서(406)의 계측값은, 예를 들면 암(162)의 회전축과 회전부(1633)의 회전축이 직교할 때 제로를 나타낸다. 그리고, 다른 실시형태에 관련된 틸트각 센서(406)는 틸트 실린더(309)에 스트로크 센서를 장착하여 각도의 산출을 행해도 된다. 틸트각 센서(406)는, 계측값인 틸트각 데이터를 제어 장치(200)에 출력한다.
회전각 센서(407)는 틸트 로테이터(163)의 틸트부(1632)에 대한 회전부(1633)의 각도인 회전각을 계측한다. 회전각 센서(407)는 회전 모터(310)에 설치된 회전 센서이면 된다. 틸트각 센서(406)의 계측값은 예를 들면 버킷(164)의 날끝 방향과 작업기(160)의 동작 평면이 직교할 때 제로를 나타낸다. 회전각 센서(407)는, 계측값인 회전각 데이터를 제어 장치(200)에 출력한다.
《제어 장치(200)의 구성》
도 4는, 제1 실시형태에 관련된 제어 장치(200)의 구성을 나타내는 개략 블록도이다.
제어 장치(200)는 프로세서(210), 메인 메모리(230), 스토리지(250), 인터페이스(270)를 구비하는 컴퓨터이다. 제어 장치(200)는 제어 시스템의 일례이다. 제어 장치(200)는 경사 계측기(401), 위치 방위 계측기(402), 붐각 센서(403), 암각 센서(404), 버킷각 센서(405), 틸트각 센서(406) 및 회전각 센서(407)로부터 계측값을 수신한다.
스토리지(250)는 일시적이지 않은 유형의 기억 매체이다. 스토리지(250)의 예로서는, 자기 디스크, 광 디스크, 광자기 디스크, 반도체 메모리 등을 들 수 있다. 스토리지(250)는, 제어 장치(200)의 버스에 직접 접속된 내부 미디어라도 되고, 인터페이스(270) 또는 통신 회선을 통하여 제어 장치(200)에 접속되는 외부 미디어라도 된다. 조작 장치(271) 및 모니터 장치(272)는 인터페이스(270)를 통하여 프로세서(210)에 접속된다.
스토리지(250)는 작업 기계(100)를 제어하기 위한 제어 프로그램을 기억한다. 제어 프로그램은 제어 장치(200)에 발휘시키는 기능의 일부를 실현하기 위한 것이라도 된다. 예를 들면, 제어 프로그램은, 스토리지(250)에 이미 기억되어 있는 다른 프로그램과의 조합, 또는 다른 장치에 실장된 다른 프로그램과의 조합에 의해 기능을 발휘시키는 것이라도 된다. 그리고, 다른 실시형태에 있어서는, 제어 장치(200)는 상기 구성에 더하여, 또는 상기 구성 대신에 PLD(Progra㎜able Logic Device) 등의 커스텀 LSI(Large Scale Integrated Circuit)를 구비해도 된다. PLD의 예로서는, PAL(Progra㎜able Array Logic), GAL(Generic Array Logic), CPLD(Complex Progra㎜able Logic Device), FPGA(Field Progra㎜able Gate Array)를 들 수 있다. 이 경우, 프로세서에 의해 실현되는 기능의 일부 또는 전부가 해당 집적 회로에 의해 실현되면 된다.
스토리지(250)에는, 선회체(140), 붐(161), 암(162) 및 버킷(164)의 치수 및 무게중심 위치를 표시하는 기하학적 데이터(geometric data)가 기록된다. 기하학적 데이터는 소정의 좌표계에서의 물체의 위치를 표시하는 데이터다. 또한 스토리지(250)에는, 글로벌 좌표계에서의 시공 현장의 설계면의 형상을 표시하는 3차원 데이터인 설계면 데이터가 기록된다. 글로벌 좌표계는, 위선 방향으로 연장되는 Xg축, 경선 방향으로 연장되는 Yg축, 연직 방향으로 연장되는 Zg축으로 구성되는 좌표계다. 설계면 데이터는 예를 들면 TIN(Triangular Irregular Networks) 데이터에 의해 표시된다.
《소프트웨어 구성》
프로세서(210)는 제어 프로그램을 실행함으로써, 조작 신호 취득부(211), 입력부(212), 표시 제어부(213), 계측값 취득부(214), 위치 자세 산출부(215), 제어 신호 출력부(218), 목표 자세 결정부(219) 및 회전량 산출부(220)를 구비한다.
조작 신호 취득부(211)는 조작 장치(271)로부터 각 액추에이터의 조작량을 나타내는 조작 신호를 취득한다.
입력부(212)는 모니터 장치(272)로부터 오퍼레이터에 의한 조작 입력을 접수한다.
표시 제어부(213)는 모니터 장치(272)에 표시시키는 화면 데이터를 모니터 장치(272)에 출력한다.
계측값 취득부(214)는 경사 계측기(401), 위치 방위 계측기(402), 붐각 센서(403), 암각 센서(404), 버킷각 센서(405), 틸트각 센서(406) 및 회전각 센서(407)로부터 계측값을 취득한다.
위치 자세 산출부(215)는, 계측값 취득부(214)가 취득한 각종 계측값과 스토리지(250)에 기록된 기하학적 데이터에 기초하여, 글로벌 좌표계 및 차체 좌표계에서의 작업 기계(100)의 위치를 산출한다. 예를 들면 위치 자세 산출부(215)는 글로벌 좌표계 및 차체 좌표계에서의 버킷(164)의 날끝의 위치를 산출한다. 차체 좌표계란, 선회체(140)의 대표점(예를 들면, 선회 중심을 지나는 점)을 원점으로 하는 직교 좌표계다. 위치 자세 산출부(215)의 계산에 대해서는 후술한다.
제어 신호 출력부(218)는, 조작 신호 취득부(211)가 취득한 조작량, 또는 회전량 산출부(220)에 의해 산출된 목표값에 따른 각 액추에이터(버킷 실린더(308), 틸트 실린더(309) 및 회전 모터(310))의 제어 신호를 컨트롤 밸브(303)에 출력한다.
목표 자세 결정부(219) 및 회전량 산출부(220)의 기능에 대해서는, 후술하는 덤프 조작 어시스트 제어의 설명에서 상세하게 설명한다.
《위치 자세 산출부(215)의 계산》
여기에서, 위치 자세 산출부(215)에 의한 작업 기계(100)의 외각(外殼)의 점의 위치의 산출 방법을 설명한다. 위치 자세 산출부(215)는, 계측값 취득부(214)가 취득한 각종 계측값과 스토리지(250)에 기록된 기하학적 데이터에 기초하여 외각의 점의 위치를 산출한다. 스토리지(250)에는, 선회체(140), 붐(161), 암(162), 틸트 로테이터(163)(장착부(1631), 틸트부(1632) 및 회전부(1633)) 및 버킷(164)의 치수를 표시하는 기하학적 데이터가 기록된다.
선회체(140)의 기하학적 데이터는, 로컬 좌표계인 차체 좌표계에 있어서, 선회체(140)가 붐(161)을 지지하는 관절축의 중심 위치(xbm, ybm, zbm)를 나타낸다. 차체 좌표계는, 선회체(140)의 선회 중심을 기준으로 하여 전후 방향으로 연장되는 Xsb축, 좌우 방향으로 연장되는 Ysb축, 상하 방향으로 연장되는 Zsb축으로 구성되는 좌표계다. 그리고, 선회체(140)의 상하 방향은 반드시 연직 방향과 일치하지 않는다.
붐(161)의 기하학적 데이터는, 로컬 좌표계인 붐 좌표계에 있어서, 붐(161)이 암(162)을 지지하는 관절축의 위치(xam, yam, zam)를 나타낸다. 붐 좌표계는, 선회체(140)와 붐(161)을 접속하는 관절축의 중심 위치를 기준으로 하여, 길이 방향으로 연장되는 Xbm축, 관절축이 연장되는 방향으로 연장되는 Ybm축, Xbm축과 Ybm축에 직교하는 Zbm축으로 구성되는 좌표계다.
암(162)의 기하학적 데이터는, 로컬 좌표계인 암 좌표계에 있어서, 암(162)이 틸트 로테이터(163)의 장착부(1631)를 지지하는 관절축의 위치(xt1, yt1, zt1)를 나타낸다. 암 좌표계는, 붐(161)과 암(162)을 접속하는 관절축의 중심 위치를 기준으로 하여, 길이 방향으로 연장되는 Xam축, 관절축이 연장되는 방향으로 연장되는 Yam축, Xam축과 Yam축에 직교하는 Zam축으로 구성되는 좌표계다.
틸트 로테이터(163)의 장착부(1631)의 기하학적 데이터는, 로컬 좌표계인 제1 틸트 로테이트 좌표계에 있어서, 장착부(1631)가 틸트부(1632)를 지지하는 관절축의 위치(xt2, yt2, zt2)와 관절축의 경사(φt)를 나타낸다. 관절축의 경사(φt)는 틸트 로테이터(163)의 설계 오차에 관련된 각도이고, 틸트 로테이터(163)의 교정(calibration) 등에 의해 구해진다. 제1 틸트 로테이트 좌표계는, 암(162)과 장착부(1631)를 접속하는 관절축의 중심 위치를 기준으로 하여, 암(162)과 장착부(1631)를 접속하는 관절축이 연장되는 방향으로 연장되는 Yt1축, 장착부(1631)와 틸트부(1632)를 접속하는 관절축이 연장되는 방향으로 연장되는 Zt1축, 및 Yt1축과 Zt1축에 직교하는 Xt1축으로 구성되는 좌표계다.
틸트 로테이터(163)의 틸트부(1632)의 기하학적 데이터는, 로컬 좌표계인 제2 틸트 로테이트 좌표계에서의 회전 모터(310)의 회전축의 선단 위치(xt3, yt3, zt3)와 회전축의 경사(φr)를 나타낸다. 회전축의 경사 φr은 틸트 로테이터(163)의 설계 오차에 관련된 각도이며, 틸트 로테이터(163)의 교정 등에 의해 구해진다. 제2 틸트 로테이트 좌표계는, 장착부(1631)와 틸트부(1632)를 접속하는 관절축의 중심 위치를 기준으로 하여, 장착부(1631)와 틸트부(1632)를 접속하는 관절축이 연장되는 방향으로 연장되는 Xt2축, 회전 모터(310)의 회전축이 연장되는 방향으로 연장되는 Zt2축, 및 Xt2축과 Zt2축에 직교하는 Yt2축으로 구성되는 좌표계다.
틸트 로테이터(163)의 회전부(1633)의 기하학적 데이터는, 로컬 좌표계인 제3 틸트 로테이트 좌표계에서의 버킷(164)의 장착면의 중심 위치(xt4, yt4, zt4)를 나타낸다. 제3 틸트 로테이트 좌표계는 버킷(164)의 장착면의 중심 위치를 기준으로 하여, 회전 모터(310)의 회전축이 연장되는 방향으로 연장되는 Zt3축, 회전축에 직교하는 Xt3축 및 Yt3축으로 구성되는 좌표계다. 그리고, 버킷(164)은, 날끝이 Yt3축과 평행하게 되도록 회전부(1633)에 장착된다.
버킷(164)의 기하학적 데이터는, 제3 틸트 로테이트 좌표계에서의 버킷(164)의 복수의 윤곽점의 위치(xbk, ybk, zbk)를 나타낸다. 윤곽점의 예로서는, 버킷(164)의 날끝의 양단 및 중앙의 위치, 버킷(164)의 바닥부의 양단 및 중앙의 위치, 및 버킷(164)의 뒷부분(heel)의 양단 및 중앙의 위치를 들 수 있다.
위치 자세 산출부(215)는, 계측값 취득부(214)가 취득한 붐각 θbm의 계측값과, 선회체(140)의 기하학적 데이터에 기초하여, 하기 식(1)에 의해, 붐 좌표계로부터 차체 좌표계로 변환하기 위한 붐-차체 변환 행렬 Tbm sb를 생성한다. 붐-차체 변환 행렬 Tbm sb는, Ybm축 주위에 붐각 θbm만큼 회전시키고, 또한 차체 좌표계의 원점과 붐 좌표계의 원점의 편차(xbm, ybm, zbm)만큼 평행 이동시키는 행렬이다.
[수 1]
위치 자세 산출부(215)는, 계측값 취득부(214)가 취득한 암각 θam의 계측값과, 붐(161)의 기하학적 데이터에 기초하여, 하기 식(2)에 의해, 암 좌표계로부터 붐 좌표계로 변환하기 위한 암-붐 변환 행렬 Tam bm을 생성한다. 암-붐 변환 행렬 Tam bm은, Yam축 주위에 암각 θam만큼 회전시키고, 또한 붐 좌표계의 원점과 암 좌표계의 원점의 편차(xam, yam, zam)만큼 평행 이동시키는 행렬이다. 또한, 위치 자세 산출부(215)는, 붐-차체 변환 행렬 Tbm sb와 암-붐 변환 행렬 Tam bm의 곱을 구함으로써, 암 좌표계로부터 차체 좌표계로 변환하기 위한 암-차체 변환 행렬 Tam sb를 생성한다.
[수 2]
위치 자세 산출부(215)는, 계측값 취득부(214)가 취득한 버킷각 θbk의 계측값과, 암(162)의 기하학적 데이터에 기초하여, 하기 식(3)에 의해, 제1 틸트 로테이트 좌표계로부터 암 좌표계로 변환하기 위한 제1 틸트-암 변환 행렬 Tt1 am을 생성한다. 제1 틸트-암 변환 행렬 Tt1 am은 Yt1축 주위에 버킷각 θbk만큼 회전시키고, 또한 암 좌표계의 원점과 제1 틸트 로테이트 좌표계의 원점의 편차(xt1, yt1, zt1)만큼 평행 이동시키고, 틸트부(1632)의 관절축의 경사 φt만큼 더 기울게 하는 행렬이다. 또한, 위치 자세 산출부(215)는, 암-차체 변환 행렬 Tam sb와 제1 틸트-암 변환 행렬 Tt1 am의 곱을 구함으로써, 제1 틸트 로테이트 좌표계로부터 차체 좌표계로 변환하기 위한 제1 틸트-차체 변환 행렬 Tt1 sb를 생성한다.
[수 3]
위치 자세 산출부(215)는, 계측값 취득부(214)가 취득한 틸트각 θt의 계측값과, 틸트 로테이터(163)의 기하학적 데이터에 기초하여, 하기 식(4)에 의해, 제1 틸트 로테이트 좌표계로부터 제2 틸트 로테이트 좌표계로 변환하기 위한 제2 틸트-제1 틸트 변환 행렬 Tt2 t1을 생성한다. 제2 틸트-제1 틸트 변환 행렬 Tt2 t1은, Xt2축 주위에 틸트각 θt만큼 회전시키고, 또한 제1 틸트 로테이트 좌표계의 원점과 제2 틸트 로테이트 좌표계의 원점의 편차(xt2, yt2, zt2)만큼 평행 이동시키고, 회전부(1633)의 회전축의 경사 φr만큼 더 기울게 하는 행렬이다. 또한, 위치 자세 산출부(215)는 제1 틸트-차체 변환 행렬 Tt1 sb와 제2 틸트-제1 틸트 변환 행렬 Tt2 t1의 곱을 구함으로써, 제2 틸트 로테이트 좌표계로부터 차체 좌표계로 변환하기 위한 제2 틸트-차체 변환 행렬 Tt2 sb를 생성한다.
[수 4]
위치 자세 산출부(215)는, 계측값 취득부(214)가 취득한 로테이트각 θr의 계측값과, 틸트 로테이터(163)의 기하학적 데이터에 기초하여, 하기 식(5)에 의해, 제2 틸트 로테이트 좌표계로부터 제3 틸트 로테이트 좌표계로 변환하기 위한 제3 틸트-제2 틸트 변환 행렬 Tt3 t2를 생성한다. 제3 틸트-제2 틸트 변환 행렬 Tt3 t2는 Zt3축 주위에 회전각 θr만큼 회전시키고, 또한 제2 틸트 로테이트 좌표계의 원점과 제3 틸트 로테이트 좌표계의 원점의 편차(xt3, yt3, zt3)만큼 평행 이동시키는 행렬이다. 또한, 위치 자세 산출부(215)는, 제2 틸트-차체 변환 행렬 Tt2 sb와 제3 틸트-제2 틸트 변환 행렬 Tt3 t2의 곱을 구함으로써, 제3 틸트 로테이트 좌표계로부터 차체 좌표계로 변환하기 위한 제3 틸트-차체 변환 행렬 Tt3 sb를 생성한다.
[수 5]
위치 자세 산출부(215)는, 버킷(164)의 장착면의 중심 위치(xt4, yt4, zt4)와 버킷(164)의 기하학적 데이터가 나타내는 제3 틸트 로테이트 좌표계에서의 복수의 윤곽점의 위치(xbk, ybk, zbk)의 합과, 제3 틸트-차체 변환 행렬 Tbk sb의 곱을 구함으로써, 차체 좌표계에서의 버킷(164)의 복수의 윤곽점의 위치를 구할 수 있다.
그런데, 작업 기계(100)의 접지면에 대한 버킷(164)의 날끝의 각도, 즉 차체 좌표계의 Xsb-Ysb 평면과 제3 틸트 로테이트 좌표계의 Yt3축이 이루는 각은, 붐각 θbm, 암각 θam, 버킷각 θbk, 틸트각 θt 및 로테이트각 θr에 의해 정해진다. 그래서, 위치 자세 산출부(215)는 도 1에 나타낸 바와 같이, 버킷(164)의 기단부, 즉 틸트 로테이터(163)에서의 버킷(164)의 장착면의 중심 위치를 기점(起點)으로 하는 버킷 좌표계를 특정한다. 버킷 좌표계는, 버킷(164)의 날끝이 향하는 방향으로 연장되는 Xbk축, Xbk축에 직교하고 또한 버킷(164)의 날끝을 따라 연장되는 Ybk축, 및 Xbk축 및 Ybk축에 직교하는 Zbk축으로 구성되는 직교 좌표계다. 이하, Xbk축을 버킷 틸트축, Ybk축을 버킷 피치축, Zbk축을 버킷 회전축이라고도 한다. 버킷 틸트축 Xbk, 버킷 피치축 Ybk 및 버킷 회전축 Zbk는 가상적인 축이며, 틸트 로테이터(163)의 관절축과는 상이하다. 그리고, 회전 모터(310)의 회전축의 경사가 제로인 경우, 버킷 좌표계와 제3 틸트 로테이트 좌표계는 일치한다.
위치 자세 산출부(215)는, 틸트 로테이터(163)의 기하학적 데이터에 기초하여, 하기 식(6)에 의해, 제3 틸트 로테이트 좌표계로부터 버킷 좌표계로 변환하기 위한 버킷-제3 틸트 변환 행렬 Tbk t3을 생성한다. 버킷-제3 틸트 변환 행렬 Tbk t3은 Yt3축 주위에 회전축의 경사 φr만큼 회전시키는 행렬이다.
[수 6]
《덤프 조작 어시스트 제어》
이하, 도면을 참조하면서, 본 실시형태에 관련된 덤프 조작 어시스트 제어에 대하여 상세하게 설명한다. 덤프 조작이란, 굴삭 작업이나 배토 작업(덤프 작업)을 행할 때 사용되고, 버킷(164)을 버킷(164)의 개구 방향을 따라 회동시키는 제어이다. 본 실시형태에 있어서는, 버킷(164)은, 틸트 로테이터(163)를 통하여 작업기(160)에 대하여 서로 다른 평면에서 교차하는 3개의 축 주위에 회전 가능하게 지지되므로, 오퍼레이터는 복합적인 조작이 요구된다. 그러므로, 덤프 조작 어시스트 제어는 버킷(164)의 개구 방향을 기준 방향으로 하고, 기준 방향에 대응하여 정해진 가상 회전축 주위에 버킷(164)이 회전하도록 틸트 로테이터(163)를 제어한다. 본 실시형태에 있어서는, 버킷 틸트축 Xbk에 직교하고 또한 버킷(164)의 날끝을 따라 연장되는 버킷 피치축 Ybk를 가상 회전축으로서 결정하고, 버킷(164)이 가상 회전축 주위에 회전하도록, 적어도 버킷 실린더(308), 틸트 실린더(309) 및 회전 모터(310) 중 어느 하나를 제어한다. 덤프 조작 어시스트 제어는, 조작 장치로부터의 조작 신호가 나타내는 조작량에 따른 양만큼, 버킷(164)을 버킷 피치축 Ybk 주위에 회전시키도록, 3개의 축 주위의 회전량을 산출하고, 틸트 로테이터(163)를 제어한다.
먼저, 도 4에서의, 조작 신호 취득부(211), 제어 신호 출력부(218), 목표 자세 결정부(219) 및 회전량 산출부(220)에 대하여 상세하게 설명한다.
조작 신호 취득부(211)는 전술한 기능에 부가하여, 조작 장치(271)에서의, 덤프 조작 어시스트 제어를 사용하기 위한 전용의 조작 접수부(이하, 덤프 어시스트 조작 접수부라고도 표기함)로의 조작량을 취득한다.
목표 자세 결정부(219)는, 조작 신호 취득부(211)가 취득한 조작량에 따른 양만큼, 버킷(164)을 그 현재 자세로부터 가상 회전축 주위에 회전시킨 자세인 목표 자세를 결정한다. 가상 회전축이란, 버킷(164)의 개구 방향에 대응하여 정해진 회전축으로서, 보다 구체적으로는, 버킷(164)이, 그 개구 방향을 따라 회동하는 궤도를 그리도록 정해진 가상의 회전축이다. 본 실시형태에 있어서는, 전술한 버킷 좌표계에서의 버킷 피치축(Ybk축, 도 1 참조)을 가상 회전축으로서 결정한다.
회전량 산출부(220)는, 버킷(164)의 현재 자세를 목표 자세에 맞추기 위해 필요한, 복수의 회동 기구마다의 회전량을 산출한다. 여기에서, 본 실시형태에서의 복수의 회동 기구란, 버킷 실린더(308), 틸트 실린더(309) 및 회전 모터(310)이다. 도 1∼도 2에 나타낸 바와 같이, 버킷 실린더(308)는 버킷(164)을 Yt1축 주위에 회동시킨다. 틸트 실린더(309)는 버킷(164)을 Xt2축 주위에 회동시킨다. 또한, 회전 모터(310)는 버킷(164)을 Zt3축 주위에 회동시킨다.
다음으로, 도 5∼도 8을 참조하면서, 본 실시형태의 제어 장치(200)에 의한 덤프 조작 어시스트 제어의 처리의 흐름에 대하여 설명한다.
도 5는, 제1 실시형태에서의 덤프 조작 어시스트 제어를 나타내는 플로차트다. 작업 기계(100)의 오퍼레이터가 작업 기계(100)의 조작을 개시하면, 제어 장치(200)는, 이하에 나타내는 제어를 소정의 제어 주기(예를 들면, 1000밀리초)마다 실행한다.
먼저, 계측값 취득부(214)는 경사 계측기(401), 위치 방위 계측기(402), 붐각 센서(403), 암각 센서(404), 버킷각 센서(405), 틸트각 센서(406) 및 회전각 센서(407)의 계측값을 취득한다(스텝 S101).
위치 자세 산출부(215)는 스텝 S101에서 취득한 계측값에 기초하여 차체 좌표계에서의 버킷의 자세를 산출한다(스텝 S102). 차체 좌표계에서의 버킷의 자세는 차체 좌표계에서의 버킷 좌표계의 각 축(Xbk, Ybk, Zbk)의 방향을 나타내는 자세 행렬 Rcur에 의해 표시된다. 버킷(164)의 자세를 표시하는 자세 행렬 Rcur의 평행 이동 성분은 모두 제로로 한다.
조작 신호 취득부(211)는, 오퍼레이터에 의한 덤프 어시스트 조작 접수부로의 조작량을 취득한다(스텝 S103).
본 실시형태에 있어서, 조작 장치(271)는 예를 들면 도 6에 나타낸 바와 같은 2개의 레버(2710, 2711)를 구비하고 있다. 본 실시형태에 관련된 작업 기계(100)는 통상의 작업 기계와 마찬가지로, 오퍼레이터는 2개의 레버(2710, 2711)를 전후 방향, 좌우 방향으로 경도(傾倒)시킴으로써, 선회체(140)의 선회 조작이나, 붐각 θbm, 암각 θam 및 버킷각 θbk를 개별로 조작할 수 있다. 또한, 오퍼레이터는, 각 레버(2710, 2711)의 상면부에 설치된 조작 접수부(버튼, 슬라이드 스위치, 다이얼, 프로포셔널 롤러식(proportional roller type) 스위치 등)을 조작함으로써, 틸트 로테이터(163)를 통한 틸트각 θt 및 회전각 θr을 개별로 제어할 수 있다.
또한, 본 실시형태에 관련된 조작 장치(271)는 레버(2710)에 덤프 어시스트 조작 접수부(2710a)를 가진다. 덤프 어시스트 조작 접수부(2710a)는, 예를 들면 중앙 위치에 돌아오도록 스프링으로 가압되고 있는 프로포셔널 롤러식 스위치다. 오퍼레이터는 덤프 어시스트 조작 접수부(2710a)의 조작 방향 및 조작량에 의해, 버킷(164)의 개구 방향을 따른 회동 방향 및 회동 속도(각속도)를 조정할 수 있다.
도 5로 되돌아가, 다음으로, 목표 자세 결정부(219)는 버킷 피치축 Ybk를 가상 회전축으로서 결정하고, 스텝 S103에서 취득한 조작량에 따른, 버킷 피치축 Ybk 주위의 각속도의 목표값 θbk_p_tgt를 특정한다(스텝 S104). 예를 들면, 목표 자세 결정부(219)는, 조작량이 클수록 버킷 피치축 Ybk 주위의 각속도의 목표값 θbk_p_tgt의 값이 커지도록 특정한다. 그리고, 버킷 피치축 Ybk 주위의 각속도의 목표값 θbk_p_tgt를 특정하는 것은, 현시점으로부터 단위시간 경과 후에 있어야 할 버킷(164)의 목표 자세를 결정하는 것과 동일한 의미이다.
다음으로, 회전량 산출부(220)는, 목표 자세 결정부(219)가 특정한 목표값 θbk_p_tgt에 기초하여, 버킷(164)의 현재 자세를 목표 자세에 맞추기 위해 필요한 복수의 회동 기구마다의 회전량의 목표값을 산출한다(스텝 S105).
구체적으로는, 회전량 산출부(220)는, 하기 식(7)에 각속도의 목표값 θbk_p_tgt를 대입함으로써, 버킷 좌표계에서의 버킷 피치축 Ybk 주위의 회전을 표시하는 회전 행렬 Rbk_p bk를 작성한다.
[수 7]
회전량 산출부(220)는, 현재의 버킷(164)의 자세를 표시하는 행렬 Rcur에, 식(7)의 회전 행렬 Rbk_p bk를 곱셈함으로써, 단위시간 후의 버킷(164)의 목표 자세 Rtgt를 산출한다. 그리고, 회전량 산출부(220)는, 버킷(164)의 현재의 자세 Rcur과 단위시간 후의 버킷(164)의 목표 자세 Rtgt에 기초하여, 하기 식(8), 식(9), 식(10)에서 의해 버킷각 θbk, 틸트각 θt 및 회전각 θr의 각각의 목표값(θbk_tgt, θt_tgt, θr_tgt)을 구한다.
[수 8]
[수 9]
[수 10]
이상과 같이 하여, 행렬 변환에 의해, 하나의 가상 회전축 주위의 각속도의 목표값(θbk_p_tgt)이, 3개의 기계축 주위의 각속도의 목표값(θbk_tgt, θt_tgt, θr_tgt)으로 변환된다.
다음으로, 제어 신호 출력부(218)는 버킷각 θbk, 틸트각 θt 및 회전각 θr의 각각의 목표값(θbk_tgt, θt_tgt, θr_tgt)에 따른 각 액추에이터(버킷 실린더(308), 틸트 실린더(309) 및 회전 모터(310))의 제어 신호를 생성하고, 해당 각 액추에이터의 제어 신호를 컨트롤 밸브(303)에 출력한다(스텝 S106).
《작용·효과》
다음으로, 도 7, 도 8을 참조하면서, 제1 실시형태에서의 덤프 조작 어시스트 제어의 작용 효과에 대하여 설명한다.
도 7, 도 8은, 작업 기계(100)를 동일한 각도로부터 본 모양을 나타내고 있다.
여기에서, 도 7에서는, 버킷(164)의 개구 방향이 지면(紙面) 정면을 향하고 있고, 가상 회전축인 버킷 피치축 Ybk는 지면에 대하여 평행한 자세로 되어 있다. 이 경우, 오퍼레이터가 덤프 어시스트 조작 접수부(2710a)(도 6 참조)를 조작하면, 버킷(164)이, 지면에 대하여 평행하게 있는 버킷 피치축 Ybk 주위에 회동하는 결과, 지면 앞방향 또는 지면 안방향으로 회동하게 된다.
마찬가지로, 도 8에서는, 버킷(164)의 개구 방향이 지면 우측을 향하고 있고, 가상 회전축인 버킷 피치축 Ybk는 지면에 대하여 수직한 자세로 되어 있다. 그 이외의 각도에 대해서는 도 7과 동일하다. 이 경우, 오퍼레이터가 덤프 어시스트 조작 접수부(2710a)(도 6 참조)를 조작하면, 버킷(164)이, 지면에 대하여 수직으로 있는 버킷 피치축 Ybk 주위에 회동하는 결과, 지면 좌방향 또는 지면 우방향으로 회동하게 된다.
이상과 같이, 본 실시형태에 관련된 작업 기계(100)의 제어 장치(200)에 의하면, 버킷(164)의 개구 방향이 차체 본체(선회체(140))에 대하여 어떠한 방위를 향하고 있어도, 오퍼레이터는, 소정의 조작 접수부(2710a)에 대한 조작을 행하는 것만으로, 버킷(164)을 그 개구 방향을 따라 회동시킬 수 있다. 즉, 오퍼레이터는, 종래, 버킷(164)을 그 개구 방향으로 조작하기 위해 각 기계축(θbk, θt, θr)에 대한 복잡한 3축 조작이 요구되고 있었던 바, 본 실시형태에 관련된 작업 기계(100)에 있어서는, 소정의 조작 접수부(2710a)에 대한 1축 조작으로 행할 수 있다. 이로써, 덤프(배토), 굴삭의 조작을 간편하게 실시할 수 있다.
이상, 제1 실시형태에 관련된 제어 장치(200)에 의하면, 복수의 회동 기구(버킷 실린더(308), 틸트 실린더(309) 및 회전 모터(310)) 및 버킷(164)이 연결되어 이루어지는 작업기(160)를 구비하는 작업 기계(100)에 있어서, 버킷(164)을 그 기준 방향(개구 방향)을 따라 회동시키는 조작을 간소화할 수 있다.
<다른 실시형태>
이상, 도면을 참조하여 일 실시형태에 대하여 상세하게 설명했으나, 구체적인 구성은 전술한 것에 한정되는 것은 아니며, 다양한 설계 변경 등을 할 수 있다. 즉, 다른 실시형태에 있어서는, 전술한 처리의 순서가 적절히 변경되어도 된다. 또한, 일부의 처리가 병렬로 실행되어도 된다.
전술한 실시형태에 관련된 제어 장치(200)는 단독의 컴퓨터에 의해 구성되는 것이라도 되고, 제어 장치(200)의 구성을 복수의 컴퓨터에 나누어 배치하고, 복수의 컴퓨터가 서로 협동함으로써 제어 장치(200)로서 기능하는 것이라도 된다. 이 때, 제어 장치(200)를 구성하는 일부의 컴퓨터가 작업 기계의 내부에 탑재되고, 다른 컴퓨터가 작업 기계의 외부에 설치되어도 된다. 예를 들면, 다른 실시형태에 있어서는 조작 장치(271) 및 모니터 장치(272)가 작업 기계(100)로부터 원격으로 설치되고, 제어 장치(200) 중 계측값 취득부(214) 및 제어 신호 출력부(218) 이외의 구성이 원격의 서버에 설치되어도 된다.
또한 전술한 실시형태에 관련된 작업 기계(100)는 유압 셔블이지만, 이것에 한정되지 않는다. 예를 들면, 다른 실시형태에 관련된 작업 기계(100)는 지상에 고정 설치된 자주하지 않는 작업 기계라도 된다. 또한 다른 실시형태에 관련된 작업 기계(100)는 선회체를 가지고 있지 않은 작업 기계라도 된다.
전술한 실시형태에 관련된 작업 기계(100)는, 작업기(160)의 어태치먼트로서 버킷(164)을 구비하지만, 이것에 한정되지 않는다. 예를 들면, 다른 실시형태에 관련된 작업 기계(100)는, 어태치먼트로서 브레이커, 포크, 그래플 등을 구비해도 된다. 이 경우도, 제어 장치(200)는 버킷 좌표계와 마찬가지로 어태치먼트의 날끝이 향하는 방향으로 연장되는 Xbk축과, 날끝을 따르는 방향으로 연장되는 Ybk축과, Xbk축 및 Ybk축에 직교하는 Zbk축으로 이루어지는 로컬 좌표계에 의해 틸트 로테이터(163)를 제어한다.
또한 다른 실시형태에 있어서, 틸트 로테이터(163)의 각 축은 서로 다른 평면에서 교차하는 것이라면, 직교하고 있지 않아도 된다. 구체적으로는, 암(162)과 장착부(1631)를 접속하는 관절축에 관련된 축 AX1, 장착부(1631)과 틸트부(1632)를 접속하는 관절축에 관련된 축 AX2, 및 회전 모터(310)의 회전축 AX3에 대하여, 틸트 로테이터(163)의 틸트각 및 회전각이 제로일 때, 축 AX1 및 축 AX2에 평행한 면과, 축 AX2및 축 AX3에 평행한 면과, 축 AX3 및 축 AX1에 평행한 면이 각각 상이한 것이면 된다.
또한, 다른 실시형태에 관련된 제어 장치(200)는 설계면의 설정 기능을 가지고 있지 않은 것이라도 된다. 이 경우에도, 제어 장치(200)는 버킷 자세 유지 제어를 행함으로써 틸트 로테이터(163)를 자동제어할 수 있다. 예를 들면, 오퍼레이터는 설계면을 설정하지 않고 간이적인 정지 작업을 실시할 수 있다.
상기 태양에 의하면, 틸트 로테이터를 통하여 작업기에 지지된 작업 기구를 구비하는 작업 기계에 있어서, 작업 기구를 그 기준 방향(예를 들면, 버킷의 개구 방향)을 따라 회동시키는 조작을 간소화할 수 있다.
100: 작업 기계, 120: 주행체, 140: 선회체, 160: 작업기, 161: 붐, 162: 암, 163: 틸트 로테이터, 1631: 장착부, 1632: 틸트부, 1633: 회전부, 164: 버킷, 180: 운전실, 200: 제어 장치, 210: 프로세서, 211: 조작 신호 취득부, 212: 입력부, 213: 표시 제어부, 214: 계측값 취득부, 215: 위치 자세 산출부, 218: 제어 신호 출력부, 219: 목표 자세 결정부, 220: 회전량 산출부, 230: 메인 메모리, 250: 스토리지, 270: 인터페이스, 271: 조작 장치, 272…모니터 장치, 301: 엔진, 302: 유압 펌프, 303: 컨트롤 밸브, 304: 주행 모터, 305: 선회 모터, 306: 붐 실린더, 307: 암 실린더, 308: 버킷 실린더, 309: 틸트 실린더, 310: 회전 모터, 401: 경사 계측기, 402: 위치 방위 계측기, 403: 붐각 센서, 404: 암각 센서, 405: 버킷각 센서, 406: 틸트각 센서, 407: 회전각 센서

Claims (6)

  1. 작업기의 선단에 장착된 틸트 로테이터(tilt rotator)와, 상기 틸트 로테이터를 통하여 상기 작업기에 대하여 서로 다른 평면에서 교차하는 3개의 축 주위에 회전 가능하게 지지된 작업 기구(器具)를 구비하는 작업 기계를 제어하기 위한 시스템으로서,
    프로세서를 구비하고,
    상기 프로세서는,
    복수의 센서로부터 계측값을 취득하고,
    상기 계측값에 기초하여, 상기 작업 기구의 현재의 자세를 산출하고,
    산출한 상기 작업 기구의 상기 현재의 자세에 기초하여, 가상 회전축을 결정하고,
    조작 장치로부터의 조작 신호에 기초하여, 상기 작업 기구를 상기 가상 회전축 주위에 회전시키기 위한 상기 틸트 로테이터의 제어 신호를 생성하고,
    생성한 상기 제어 신호를 출력하는,
    시스템.
  2. 제1항에 있어서,
    상기 프로세서는,
    상기 작업 기구가 상기 조작 신호가 나타내는 조작량에 따른 양만큼, 상기 작업 기구를 상기 가상 회전축 주위에 회전시키도록, 상기 3개의 축 주위의 회전량을 산출하고,
    상기 3개의 축 주위의 상기 회전량에 기초하여, 상기 틸트 로테이터의 제어 신호를 생성하는, 시스템.
  3. 제1항 또는 제2항에 있어서,
    상기 작업 기구는 날끝(teeth)을 가지고,
    상기 가상 회전축은, 상기 작업 기구의 상기 날끝이 향하는 방향에 직교하고, 또한, 상기 작업 기구의 상기 날끝을 따라 연장되는 축인, 시스템.
  4. 제1항 내지 제3항 중 어느 한 항에 있어서,
    상기 가상 회전축은, 상기 틸트 로테이터의 관절축과는 상이한, 시스템.
  5. 작업기의 선단에 장착된 틸트 로테이터와, 상기 틸트 로테이터를 통하여 상기 작업기에 대하여 서로 다른 평면에서 교차하는 3개의 축 주위에 회전 가능하게 지지된 작업 기구를 구비하는 작업 기계를 제어하기 위한 방법으로서,
    복수의 센서로부터 계측값을 취득하는 단계;
    상기 계측값에 기초하여, 상기 작업기의 현재의 자세를 결정하는 단계;
    결정한 상기 현재의 자세에 기초하여, 상기 작업 기구의 기준 방향에 대응하여 정해진 가상 회전축을 결정하는 단계;
    조작 장치로부터의 조작 신호에 기초하여, 상기 작업 기구를 상기 가상 회전축 주위에 회전시키기 위한 상기 틸트 로테이터의 제어 신호를 생성하는 단계; 및
    생성한 상기 제어 신호를 출력하는 단계;
    를 포함하는 방법.
  6. 작업기의 선단에 장착된 틸트 로테이터와, 상기 틸트 로테이터를 통하여 상기 작업기에 대하여 서로 다른 평면에서 교차하는 3개의 축 주위에 회전 가능하게 지지된 작업 기구를 구비하는 작업 기계의 제어 시스템의 컴퓨터에,
    복수의 센서로부터 계측값을 취득하는 단계;
    상기 계측값에 기초하여, 상기 작업기의 현재의 자세를 결정하는 단계;
    결정한 상기 현재의 자세에 기초하여, 상기 작업 기구의 기준 방향에 대응하여 정해진 가상 회전축을 결정하는 단계;
    조작 장치로부터의 조작 신호에 기초하여, 상기 작업 기구를 상기 가상 회전축 주위에 회전시키기 위한 상기 틸트 로테이터의 제어 신호를 생성하는 단계; 및
    생성한 상기 제어 신호를 출력하는 단계;
    를 실행시키는 프로그램.
KR1020247003068A 2021-09-30 2022-09-29 작업 기계를 제어하기 위한 시스템, 방법 및 프로그램 KR20240025671A (ko)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2021161745A JP2023051204A (ja) 2021-09-30 2021-09-30 作業機械を制御するためのシステム、方法およびプログラム
JPJP-P-2021-161745 2021-09-30
PCT/JP2022/036540 WO2023054623A1 (ja) 2021-09-30 2022-09-29 作業機械を制御するためのシステム、方法およびプログラム

Publications (1)

Publication Number Publication Date
KR20240025671A true KR20240025671A (ko) 2024-02-27

Family

ID=85782893

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020247003068A KR20240025671A (ko) 2021-09-30 2022-09-29 작업 기계를 제어하기 위한 시스템, 방법 및 프로그램

Country Status (5)

Country Link
JP (1) JP2023051204A (ko)
KR (1) KR20240025671A (ko)
CN (1) CN117881849A (ko)
DE (1) DE112022003046T5 (ko)
WO (1) WO2023054623A1 (ko)

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2020125599A (ja) 2019-02-01 2020-08-20 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015193546A2 (en) * 2014-06-18 2015-12-23 Rotyx Oy Tiltrotator device for a tool to be attached to the end of a utility machine's boom for rotating the tool around a rotational axis and for tilting the tool within a desired angular range
KR102488448B1 (ko) * 2015-03-27 2023-01-12 스미토모 겐키 가부시키가이샤 쇼벨

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2020125599A (ja) 2019-02-01 2020-08-20 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法

Also Published As

Publication number Publication date
DE112022003046T5 (de) 2024-05-08
JP2023051204A (ja) 2023-04-11
CN117881849A (zh) 2024-04-12
WO2023054623A1 (ja) 2023-04-06

Similar Documents

Publication Publication Date Title
KR101833603B1 (ko) 작업 기계의 제어 시스템 및 작업 기계
JP6068730B2 (ja) 作業機械、及び作業機械の作業機パラメータ補正方法
JP6728286B2 (ja) ショベル及びショベルの制御方法
WO2018179596A1 (ja) 建設機械
KR102479701B1 (ko) 작업 기계
KR20240025671A (ko) 작업 기계를 제어하기 위한 시스템, 방법 및 프로그램
KR20240033070A (ko) 작업 기계를 제어하기 위한 시스템 및 방법
KR20240029558A (ko) 작업 기계를 제어하기 위한 시스템, 방법 및 프로그램
WO2023054610A1 (ja) 作業機械を制御するためのシステムおよび方法
WO2023054608A1 (ja) 作業機械を制御するためのシステムおよび方法
WO2023032949A1 (ja) 制御システム、制御方法および制御プログラム
CN114787455B (zh) 作业机械的控制系统、作业机械以及作业机械的控制方法
WO2023032970A1 (ja) 制御システム、制御方法および制御プログラム
JP7324100B2 (ja) 作業機械
JP2023122748A (ja) 作業位置指示システム
JP2022026596A (ja) 作業機械および施工支援システム