JPH1030248A - 建設機械の作業機直線制御方法及びその制御装置 - Google Patents
建設機械の作業機直線制御方法及びその制御装置Info
- Publication number
- JPH1030248A JPH1030248A JP8206372A JP20637296A JPH1030248A JP H1030248 A JPH1030248 A JP H1030248A JP 8206372 A JP8206372 A JP 8206372A JP 20637296 A JP20637296 A JP 20637296A JP H1030248 A JPH1030248 A JP H1030248A
- Authority
- JP
- Japan
- Prior art keywords
- boom
- arm
- machine
- tip
- work
- Prior art date
- Legal status (The legal status 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 status listed.)
- Pending
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/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
- E02F3/437—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like providing automatic sequences of movements, e.g. linear excavation, keeping dipper angle constant
-
- 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/2025—Particular purposes of control systems not otherwise provided for
- E02F9/2037—Coordinating the movements of the implement and of the frame
Landscapes
- Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Mechanical Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Paleontology (AREA)
- Operation Control Of Excavators (AREA)
Abstract
(57)【要約】
【課題】 建設機械の作業機の横方向の直線制御を自動
的に行うようにして、作業性の向上、運転性の向上を図
る。 【解決手段】 アーム先端の横方向速度よりオフセット
ブームの角速度を算出し、このオフセットブームの角速
度に対応してオフセットブームを作動させて作業機先端
を横方向に直線制御し、この作業機先端の上下、横方向
が所定値に対して誤差が生じたときはブーム及び/或い
はアームを駆動して補正し、作業機先端を横方向に移動
して作業対象物に対して直線制御するようにしたもので
ある。
的に行うようにして、作業性の向上、運転性の向上を図
る。 【解決手段】 アーム先端の横方向速度よりオフセット
ブームの角速度を算出し、このオフセットブームの角速
度に対応してオフセットブームを作動させて作業機先端
を横方向に直線制御し、この作業機先端の上下、横方向
が所定値に対して誤差が生じたときはブーム及び/或い
はアームを駆動して補正し、作業機先端を横方向に移動
して作業対象物に対して直線制御するようにしたもので
ある。
Description
【0001】
【発明の属する技術分野】本発明は油圧ショベル等の建
設機械に装着する作業機部材の関節部の角度と車体の旋
回角を演算して、作業機の先端を横方向に移動して作業
対象物に対して直線制御を自動的に行う建設機械の作業
機直線制御方法及びその制御装置に係り、特にオフセッ
トブーム式作業機を備えた建設機械の作業機直線制御方
法及びその制御装置に関する。
設機械に装着する作業機部材の関節部の角度と車体の旋
回角を演算して、作業機の先端を横方向に移動して作業
対象物に対して直線制御を自動的に行う建設機械の作業
機直線制御方法及びその制御装置に係り、特にオフセッ
トブーム式作業機を備えた建設機械の作業機直線制御方
法及びその制御装置に関する。
【0002】
【従来の技術】従来の油圧ショベルの作業機は、車体か
ら順次連結されるブーム、アーム及びバケットの3つの
関節形となっている。このバケットの先端を作業対象物
に位置決めするときは、ブームを上げ方向または下げ方
向、アームの掘削方向またはダンプ方向及びバケットの
掘削方向またはダンプ方向を複合操作を行う必要があ
り、その操作には熟練を要する。現在の都市土木作業に
おいては、各種のアタッチメントを備えた油圧ショベル
が用いられている。この都市土木作業には、道路を作る
ための掘削作業、掘削した土砂のダンプトラックへの積
込み作業、転石やコンクリートを破砕するブレーカ作
業、道路に側溝を作るための側溝堀り作業、側溝にヒュ
ーム管を埋設する吊り作業等の多くの作業がある。最
近、これらの多くの作業が1台の油圧ショベルで行える
ようにした、オフセットブーム式作業機が用いられてい
る。このオフセットブーム式作業機はブーム、アーム及
びバケットの3つの関節形に加えて、ブームを横方向へ
オフセットする機能が追加となっている。
ら順次連結されるブーム、アーム及びバケットの3つの
関節形となっている。このバケットの先端を作業対象物
に位置決めするときは、ブームを上げ方向または下げ方
向、アームの掘削方向またはダンプ方向及びバケットの
掘削方向またはダンプ方向を複合操作を行う必要があ
り、その操作には熟練を要する。現在の都市土木作業に
おいては、各種のアタッチメントを備えた油圧ショベル
が用いられている。この都市土木作業には、道路を作る
ための掘削作業、掘削した土砂のダンプトラックへの積
込み作業、転石やコンクリートを破砕するブレーカ作
業、道路に側溝を作るための側溝堀り作業、側溝にヒュ
ーム管を埋設する吊り作業等の多くの作業がある。最
近、これらの多くの作業が1台の油圧ショベルで行える
ようにした、オフセットブーム式作業機が用いられてい
る。このオフセットブーム式作業機はブーム、アーム及
びバケットの3つの関節形に加えて、ブームを横方向へ
オフセットする機能が追加となっている。
【0003】油圧ショベルの直線制御に関する先行技術
に、例えば特公昭58−36135号が出願されてい
る。この出願内容は地面からのバケットの高さを一定に
制御して車体の前後方向に直線制御するものである。即
ち、図18に示す作業機を上下方向に制御してバケット
の高さを一定にするものである。これにより、作業機を
車体の前後方向に駆動して整地作業が容易に行えるもの
である。
に、例えば特公昭58−36135号が出願されてい
る。この出願内容は地面からのバケットの高さを一定に
制御して車体の前後方向に直線制御するものである。即
ち、図18に示す作業機を上下方向に制御してバケット
の高さを一定にするものである。これにより、作業機を
車体の前後方向に駆動して整地作業が容易に行えるもの
である。
【0004】また、都市土木作業で用いられるオフセッ
トブーム式作業機を備えた油圧ショベルは、作業現場が
市街地であるため通行人や電柱、建物の壁等の障害物に
接触しないようにするために作業機を車幅内に折り畳め
るようにしているので、作業機を車幅内に折り畳むとき
に車体や運転室に干渉しないようにするための、作業機
の軌跡制御、減速制御や危険領域に入ったときの警告灯
(音)等に関する先行技術(例えば、実公平3−727
67号、実開平3−5751号、特開平4−25462
5号)が多数出願されている。
トブーム式作業機を備えた油圧ショベルは、作業現場が
市街地であるため通行人や電柱、建物の壁等の障害物に
接触しないようにするために作業機を車幅内に折り畳め
るようにしているので、作業機を車幅内に折り畳むとき
に車体や運転室に干渉しないようにするための、作業機
の軌跡制御、減速制御や危険領域に入ったときの警告灯
(音)等に関する先行技術(例えば、実公平3−727
67号、実開平3−5751号、特開平4−25462
5号)が多数出願されている。
【0005】
【発明が解決しようとする課題】しかしながら、従来の
オフセットブーム式作業機を備えた油圧ショベルにおい
ては、ブームの上げ方向または下げ方向、アームの掘削
方向またはダンプ方向及びバケットの掘削方向またはダ
ンプ方向の操作に加えてブームを横方向にオフセットす
る4方向の複合操作が必要となり、さらに操作が難しく
なり熟練オペレータでないと運転ができないとの問題が
ある。特に、従来のオフセットブーム式作業機において
は、作業機を最大リーチ付近で横方向に直線制御して、
側溝にヒューム管を埋設する吊り作業や転石等を小割り
するブレーカ作業を行うと、作業機先端の横方向に直線
制御する操作が難しいとの問題がある。オフセットブー
ム式作業機を未熟練のオペレータでも簡単に操作できる
ようにする必要がある。また、前述のように特公昭58
−36135号では作業機を横方向に直線制御すること
はできない。さらに、オフセットブーム式作業機に関す
る先行技術が多数出願されているが、本発明の作業機を
横方向の直線制御を自動的に行えるようにしたものは出
願されていない。
オフセットブーム式作業機を備えた油圧ショベルにおい
ては、ブームの上げ方向または下げ方向、アームの掘削
方向またはダンプ方向及びバケットの掘削方向またはダ
ンプ方向の操作に加えてブームを横方向にオフセットす
る4方向の複合操作が必要となり、さらに操作が難しく
なり熟練オペレータでないと運転ができないとの問題が
ある。特に、従来のオフセットブーム式作業機において
は、作業機を最大リーチ付近で横方向に直線制御して、
側溝にヒューム管を埋設する吊り作業や転石等を小割り
するブレーカ作業を行うと、作業機先端の横方向に直線
制御する操作が難しいとの問題がある。オフセットブー
ム式作業機を未熟練のオペレータでも簡単に操作できる
ようにする必要がある。また、前述のように特公昭58
−36135号では作業機を横方向に直線制御すること
はできない。さらに、オフセットブーム式作業機に関す
る先行技術が多数出願されているが、本発明の作業機を
横方向の直線制御を自動的に行えるようにしたものは出
願されていない。
【0006】本発明は上記従来の問題点に着目し、建設
機械の作業機を横方向の直線制御を自動的に行うように
して、作業性を向上すると共に、未熟練のオペレータで
も運転操作が容易となるようにした建設機械の作業機直
線制御方法及びその制御装置を提供することを目的とす
る。
機械の作業機を横方向の直線制御を自動的に行うように
して、作業性を向上すると共に、未熟練のオペレータで
も運転操作が容易となるようにした建設機械の作業機直
線制御方法及びその制御装置を提供することを目的とす
る。
【0007】
【課題を解決するための手段及び作用効果】上記目的を
達成するために、本発明に係る建設機械の作業機直線制
御方法の第1発明は、車体より順次連結されるブーム、
オフセットブーム、アーム等の作業機部材と、アームに
取着されたバケット或いはブレーカ等の作業機と、この
作業機部材を揺動させる各アクチュエータとを備え、前
記作業機の先端を横方向に移動して作業対象物に対して
直線制御する建設機械の作業機直線制御方法であって、
前記作業機先端の横方向速度よりオフセットブームの角
速度を算出し、このオフセットブームの算出した角速度
に対応してオフセットブームを作動させて作業機先端を
横方向に直線制御し、この作業機先端の上下、横方向が
所定値に対して誤差が生じたときはブーム及び/或いは
アームを駆動して補正し、作業機先端を横方向に移動し
て作業対象物に対して直線制御することを特徴とする。
上記制御方法によれば、オフセット用アクチュエータを
駆動して、自動的に作業機先端を横方向に移動して作業
対象物に対して直線制御を開始した後に、ブーム用アク
チュエータ及び/或いはアーム用アクチュエータを駆動
して、作業機先端を横方向に移動して作業対象物に対し
て直線制御が自動的に行われ、側溝にヒューム管を埋設
する吊り作業や転石等を小割りするブレーカ作業を行う
ときは作業機先端を横方向に直線制御が精度よくでき
る。したがって、作業性が向上すると共に、未熟練のオ
ペレータでも容易に運転操作が可能となり運転性が向上
する。
達成するために、本発明に係る建設機械の作業機直線制
御方法の第1発明は、車体より順次連結されるブーム、
オフセットブーム、アーム等の作業機部材と、アームに
取着されたバケット或いはブレーカ等の作業機と、この
作業機部材を揺動させる各アクチュエータとを備え、前
記作業機の先端を横方向に移動して作業対象物に対して
直線制御する建設機械の作業機直線制御方法であって、
前記作業機先端の横方向速度よりオフセットブームの角
速度を算出し、このオフセットブームの算出した角速度
に対応してオフセットブームを作動させて作業機先端を
横方向に直線制御し、この作業機先端の上下、横方向が
所定値に対して誤差が生じたときはブーム及び/或いは
アームを駆動して補正し、作業機先端を横方向に移動し
て作業対象物に対して直線制御することを特徴とする。
上記制御方法によれば、オフセット用アクチュエータを
駆動して、自動的に作業機先端を横方向に移動して作業
対象物に対して直線制御を開始した後に、ブーム用アク
チュエータ及び/或いはアーム用アクチュエータを駆動
して、作業機先端を横方向に移動して作業対象物に対し
て直線制御が自動的に行われ、側溝にヒューム管を埋設
する吊り作業や転石等を小割りするブレーカ作業を行う
ときは作業機先端を横方向に直線制御が精度よくでき
る。したがって、作業性が向上すると共に、未熟練のオ
ペレータでも容易に運転操作が可能となり運転性が向上
する。
【0008】第2発明は、第1発明の制御方法におい
て、アームの対地角が所定値に対して誤差が生じたとき
はブーム及び/或いはアームを駆動して補正し、作業機
先端を横方向に移動して作業対象物に対して直線制御す
ることを特徴とする。上記制御方法によれば、アーム対
地角を一定に保つことができるので、作業性が向上す
る。
て、アームの対地角が所定値に対して誤差が生じたとき
はブーム及び/或いはアームを駆動して補正し、作業機
先端を横方向に移動して作業対象物に対して直線制御す
ることを特徴とする。上記制御方法によれば、アーム対
地角を一定に保つことができるので、作業性が向上す
る。
【0009】第3発明は、車体より順次連結されるブー
ム、オフセットブーム、アーム等の作業機部材と、アー
ムに取着されたバケット或いはブレーカ等の作業機と、
旋回可能な車体と、この作業機部材の揺動、及び車体を
旋回させる各アクチュエータとを備え、前記作業機の先
端を横方向に移動して作業対象物に対して直線制御する
建設機械の作業機直線制御方法であって、車体の旋回中
心から作業機の先端までの基準座標を求めて、この基準
座標に対応して車体を旋回させて作業機先端を横方向に
直線制御し、この作業機先端の上下、横方向が所定値に
対して誤差が生じたときはブーム及び/或いはアームを
駆動して補正し、作業機先端を横方向に移動して作業対
象物に対して直線制御することを特徴とする。上記制御
方法によれば、旋回用アクチュエータの旋回駆動により
作業機先端を横方向に移動して作業対象物に対して直線
制御が自動的に行われ、しかも作業機先端の上下、横方
向が所定値に対して誤差が生じても補正するようにした
ので、作業姿勢が一定となる。したがって、作業性が向
上すると共に、未熟練のオペレータでも容易に運転操作
が可能となり運転性が向上する。
ム、オフセットブーム、アーム等の作業機部材と、アー
ムに取着されたバケット或いはブレーカ等の作業機と、
旋回可能な車体と、この作業機部材の揺動、及び車体を
旋回させる各アクチュエータとを備え、前記作業機の先
端を横方向に移動して作業対象物に対して直線制御する
建設機械の作業機直線制御方法であって、車体の旋回中
心から作業機の先端までの基準座標を求めて、この基準
座標に対応して車体を旋回させて作業機先端を横方向に
直線制御し、この作業機先端の上下、横方向が所定値に
対して誤差が生じたときはブーム及び/或いはアームを
駆動して補正し、作業機先端を横方向に移動して作業対
象物に対して直線制御することを特徴とする。上記制御
方法によれば、旋回用アクチュエータの旋回駆動により
作業機先端を横方向に移動して作業対象物に対して直線
制御が自動的に行われ、しかも作業機先端の上下、横方
向が所定値に対して誤差が生じても補正するようにした
ので、作業姿勢が一定となる。したがって、作業性が向
上すると共に、未熟練のオペレータでも容易に運転操作
が可能となり運転性が向上する。
【0010】第4発明は、車体より順次連結されるブー
ム、オフセットブーム、アーム等の作業機部材と、アー
ムに取着されたバケット或いはブレーカ等の作業機と、
旋回可能な車体と、この作業機部材の揺動、及び車体を
旋回させる各アクチュエータとを備え、前記作業機の先
端を横方向に移動して作業対象物に対して直線制御する
建設機械の作業機直線制御方法であって、作業機先端の
位置をオフセットブームにより横方向に移動し、移動
中、或いは、オフセットブームによる移動が限界値近傍
で旋回中心から横方向の移動距離を求め、その後に車体
を旋回させて作業機先端を横方向に移動して作業対象物
に対して直線制御することを特徴とする。上記制御方法
によれば、オフセットブームを作動させて作業機先端を
横方向に直線制御し、更に車体を旋回させて作業機先端
を横方向に直線制御するようにしたので、側溝にヒュー
ム管を埋設する吊り作業や転石等を小割りするブレーカ
作業を行うときは、作業機先端を横方向に直線制御量が
さらに大きくできる。したがって、作業性が向上すると
共に、未熟練のオペレータでも容易に運転操作が可能と
なり運転性が向上する。
ム、オフセットブーム、アーム等の作業機部材と、アー
ムに取着されたバケット或いはブレーカ等の作業機と、
旋回可能な車体と、この作業機部材の揺動、及び車体を
旋回させる各アクチュエータとを備え、前記作業機の先
端を横方向に移動して作業対象物に対して直線制御する
建設機械の作業機直線制御方法であって、作業機先端の
位置をオフセットブームにより横方向に移動し、移動
中、或いは、オフセットブームによる移動が限界値近傍
で旋回中心から横方向の移動距離を求め、その後に車体
を旋回させて作業機先端を横方向に移動して作業対象物
に対して直線制御することを特徴とする。上記制御方法
によれば、オフセットブームを作動させて作業機先端を
横方向に直線制御し、更に車体を旋回させて作業機先端
を横方向に直線制御するようにしたので、側溝にヒュー
ム管を埋設する吊り作業や転石等を小割りするブレーカ
作業を行うときは、作業機先端を横方向に直線制御量が
さらに大きくできる。したがって、作業性が向上すると
共に、未熟練のオペレータでも容易に運転操作が可能と
なり運転性が向上する。
【0011】第5発明は、車体より順次連結されるブー
ム、オフセットブーム、アーム等の作業機部材と、アー
ムに取着されたバケット或いはブレーカ等の作業機と、
旋回可能な車体と、この作業機部材の揺動、及び車体を
旋回させる各アクチュエータとを備え、前記作業機の先
端を横方向に移動して作業対象物に対して直線制御する
建設機械の作業機直線制御方法であって、初めに作業対
象物に対する作業機先端位置を求めて、オフセットブー
ムにより横方向に移動し、オフセットブームが作動限界
値近傍に到達したら車体を旋回させて作業機先端を横方
向に移動して作業対象物に対して直線制御することを特
徴とする。上記制御方法によれば、オフセットブームの
作動から車体の旋回駆動を連続的に行って、作業機先端
を横方向に直線制御するようにしたので、側溝にヒュー
ム管を埋設する吊り作業や転石等を小割りするブレーカ
作業を行うときは、アーム先端を横方向に直線制御量が
さらに大きくできる。したがって、作業性が向上すると
共に、未熟練のオペレータでも容易に運転操作が可能と
なり運転性が向上する。
ム、オフセットブーム、アーム等の作業機部材と、アー
ムに取着されたバケット或いはブレーカ等の作業機と、
旋回可能な車体と、この作業機部材の揺動、及び車体を
旋回させる各アクチュエータとを備え、前記作業機の先
端を横方向に移動して作業対象物に対して直線制御する
建設機械の作業機直線制御方法であって、初めに作業対
象物に対する作業機先端位置を求めて、オフセットブー
ムにより横方向に移動し、オフセットブームが作動限界
値近傍に到達したら車体を旋回させて作業機先端を横方
向に移動して作業対象物に対して直線制御することを特
徴とする。上記制御方法によれば、オフセットブームの
作動から車体の旋回駆動を連続的に行って、作業機先端
を横方向に直線制御するようにしたので、側溝にヒュー
ム管を埋設する吊り作業や転石等を小割りするブレーカ
作業を行うときは、アーム先端を横方向に直線制御量が
さらに大きくできる。したがって、作業性が向上すると
共に、未熟練のオペレータでも容易に運転操作が可能と
なり運転性が向上する。
【0012】第6発明は、車体より順次連結される第1
ブーム、第2ブーム、オフセットブーム、アーム等の作
業機部材と、アームに取着されたバケット或いはブレー
カ等の作業機と、この作業機部材を揺動させる各アクチ
ュエータへ圧油を供給する各方向切換弁とを備え、前記
作業機の先端を横方向に移動して作業対象物に対して直
線制御する建設機械の作業機直線制御装置において、ア
ーム対地角γ、アーム制御ポイントe及び作業機先端を
横方向の直線Z1 或いはZ2 方向を設定する設定器32
と、前記作業機部材及び作業機を自動制御に切換える自
動切換スイッチ31と、前記第1ブーム角θ1 を検出す
る第1検出手段17と、前記第2ブーム角θ2 を検出す
る第2検出手段18と、オフセットブームのオフセット
角θ3 を検知する第3検出手段16と、前記アーム角θ
4 を検出する第4検出手段19とを有し、前記自動切換
スイッチ31をオン操作した後に、前記第1〜第4検出
手段16,17,18,19からの信号を受けて、前記
作業機先端の横方向速度よりオフセットブームの角速度
を算出し、このオフセットブームの角速度に対応してオ
フセットブームを作動させて作業機先端を横方向に直線
制御し、この作業機先端の上下、横方向が所定値に対し
て誤差が生じたときはブーム及び/或いはアームを作動
して補正し、作業機先端を横方向に移動して作業対象物
に対して直線制御するために各アクチュエータ6,8,
10,13を駆動するように各方向切換弁23,24,
25,26へ指令出力する制御装置30を備えた構成と
したものである。上記構成によれば、各アクチュエータ
を駆動して、自動的に作業機先端を横方向に移動して作
業対象物に対して直線制御することができる。したがっ
て、作業機先端を横方向への直線制御が自動的に行わ
れ、作業性が向上すると共に、未熟練のオペレータでも
容易に運転操作が可能となり運転性が向上する。
ブーム、第2ブーム、オフセットブーム、アーム等の作
業機部材と、アームに取着されたバケット或いはブレー
カ等の作業機と、この作業機部材を揺動させる各アクチ
ュエータへ圧油を供給する各方向切換弁とを備え、前記
作業機の先端を横方向に移動して作業対象物に対して直
線制御する建設機械の作業機直線制御装置において、ア
ーム対地角γ、アーム制御ポイントe及び作業機先端を
横方向の直線Z1 或いはZ2 方向を設定する設定器32
と、前記作業機部材及び作業機を自動制御に切換える自
動切換スイッチ31と、前記第1ブーム角θ1 を検出す
る第1検出手段17と、前記第2ブーム角θ2 を検出す
る第2検出手段18と、オフセットブームのオフセット
角θ3 を検知する第3検出手段16と、前記アーム角θ
4 を検出する第4検出手段19とを有し、前記自動切換
スイッチ31をオン操作した後に、前記第1〜第4検出
手段16,17,18,19からの信号を受けて、前記
作業機先端の横方向速度よりオフセットブームの角速度
を算出し、このオフセットブームの角速度に対応してオ
フセットブームを作動させて作業機先端を横方向に直線
制御し、この作業機先端の上下、横方向が所定値に対し
て誤差が生じたときはブーム及び/或いはアームを作動
して補正し、作業機先端を横方向に移動して作業対象物
に対して直線制御するために各アクチュエータ6,8,
10,13を駆動するように各方向切換弁23,24,
25,26へ指令出力する制御装置30を備えた構成と
したものである。上記構成によれば、各アクチュエータ
を駆動して、自動的に作業機先端を横方向に移動して作
業対象物に対して直線制御することができる。したがっ
て、作業機先端を横方向への直線制御が自動的に行わ
れ、作業性が向上すると共に、未熟練のオペレータでも
容易に運転操作が可能となり運転性が向上する。
【0013】第7発明は、車体より順次連結される第1
ブーム、第2ブーム、オフセットブーム、アーム等の作
業機部材と、アームに取着されたバケット或いはブレー
カ等の作業機と、旋回可能な車体と、この作業機部材の
揺動、及び車体を旋回させる各アクチュエータとを備
え、前記作業機の先端を横方向に移動して作業対象物に
対して直線制御する建設機械の作業機直線制御装置にお
いて、アーム対地角γ、アーム制御ポイントe及び作業
機先端を横方向の直線Z1 或いはZ2 方向を設定する設
定器32と、前記作業機部材及び作業機を自動制御に切
換える自動切換スイッチ31と、前記第1ブーム角θ1
を検出する第1検出手段17と、前記第2ブーム角θ2
を検出する第2検出手段18と、オフセットブームのオ
フセット角θ3 を検知する第3検出手段16と、前記ア
ーム角θ4 を検出する第4検出手段19とを有し、前記
自動切換スイッチ31をオン操作した後に、前記第1〜
第4検出手段16,17,18,19からの信号を受け
て、車体の旋回中心から作業機の先端までの基準座標X
0 を求めて、この基準座標X0 に対応して車体を旋回さ
せて作業機先端を横方向に直線制御し、この作業機先端
の上下、横方向が所定値に対して誤差が生じたときはブ
ーム及び/或いはアームを駆動して補正し、作業機先端
を横方向に移動して作業対象物に対して直線制御するた
めに作業機部材の各アクチュエータ6,8,10,13
と旋回用アクチュエータ40を駆動するように各方向切
換弁23,24,25,26,28へ指令出力する制御
装置30を備えた構成としたものである。上記構成によ
れば、作業機部材の各アクチュエータと旋回用アクチュ
エータを駆動して、自動的に作業機先端を横方向に移動
して作業対象物に対して直線制御することができる。し
たがって、作業機先端を横方向への直線制御量を大きく
することができるので、作業性が向上すると共に、未熟
練のオペレータでも容易に運転操作が可能となり運転性
が向上する。
ブーム、第2ブーム、オフセットブーム、アーム等の作
業機部材と、アームに取着されたバケット或いはブレー
カ等の作業機と、旋回可能な車体と、この作業機部材の
揺動、及び車体を旋回させる各アクチュエータとを備
え、前記作業機の先端を横方向に移動して作業対象物に
対して直線制御する建設機械の作業機直線制御装置にお
いて、アーム対地角γ、アーム制御ポイントe及び作業
機先端を横方向の直線Z1 或いはZ2 方向を設定する設
定器32と、前記作業機部材及び作業機を自動制御に切
換える自動切換スイッチ31と、前記第1ブーム角θ1
を検出する第1検出手段17と、前記第2ブーム角θ2
を検出する第2検出手段18と、オフセットブームのオ
フセット角θ3 を検知する第3検出手段16と、前記ア
ーム角θ4 を検出する第4検出手段19とを有し、前記
自動切換スイッチ31をオン操作した後に、前記第1〜
第4検出手段16,17,18,19からの信号を受け
て、車体の旋回中心から作業機の先端までの基準座標X
0 を求めて、この基準座標X0 に対応して車体を旋回さ
せて作業機先端を横方向に直線制御し、この作業機先端
の上下、横方向が所定値に対して誤差が生じたときはブ
ーム及び/或いはアームを駆動して補正し、作業機先端
を横方向に移動して作業対象物に対して直線制御するた
めに作業機部材の各アクチュエータ6,8,10,13
と旋回用アクチュエータ40を駆動するように各方向切
換弁23,24,25,26,28へ指令出力する制御
装置30を備えた構成としたものである。上記構成によ
れば、作業機部材の各アクチュエータと旋回用アクチュ
エータを駆動して、自動的に作業機先端を横方向に移動
して作業対象物に対して直線制御することができる。し
たがって、作業機先端を横方向への直線制御量を大きく
することができるので、作業性が向上すると共に、未熟
練のオペレータでも容易に運転操作が可能となり運転性
が向上する。
【0014】
【発明の実施の形態】以下に、本発明に係る建設機械の
作業機直線制御方法及びその制御装置について一実施例
を図1乃至図20を参照して説明する。先ず、オフセッ
ト式作業機を備えた油圧ショベルについて、図19,図
20により説明する。図19に示す油圧ショベル1の下
部走行体2は図示しない走行モータにより走行自在とな
っている。この下部走行体2の上部にはスイングサーク
ル4を介して図示しない旋回モータにより旋回可能な上
部旋回体3(以下、車体3と言う。)を装着している。
次に、オフセットブーム式作業機について説明する。第
1ブーム5のブームフート5aは車体3に取着されてい
る。この第1ブーム5はブームフート5aを支点として
揺動するようになっている。この第1ブーム5を駆動す
る第1ブームシリンダ6(以下、第1アクチュエータ6
と言う。)のボトム側は車体3に取着し、ロッド側は第
1ブーム5の上端部に取着している。第1ブーム5は第
1アクチュエータ6の伸縮駆動により上下揺動自在とな
っている。第1ブーム5は第2ブーム7と連結してい
る。この第2ブーム7を駆動する第2ブームシリンダ8
(以下、第2アクチュエータ8と言う。)のボトム側は
第1ブーム5に取着し、ロッド側は第2ブーム7の端部
に取着している。第2ブーム7は第2アクチュエータ8
の伸縮駆動により上下揺動自在となっている。
作業機直線制御方法及びその制御装置について一実施例
を図1乃至図20を参照して説明する。先ず、オフセッ
ト式作業機を備えた油圧ショベルについて、図19,図
20により説明する。図19に示す油圧ショベル1の下
部走行体2は図示しない走行モータにより走行自在とな
っている。この下部走行体2の上部にはスイングサーク
ル4を介して図示しない旋回モータにより旋回可能な上
部旋回体3(以下、車体3と言う。)を装着している。
次に、オフセットブーム式作業機について説明する。第
1ブーム5のブームフート5aは車体3に取着されてい
る。この第1ブーム5はブームフート5aを支点として
揺動するようになっている。この第1ブーム5を駆動す
る第1ブームシリンダ6(以下、第1アクチュエータ6
と言う。)のボトム側は車体3に取着し、ロッド側は第
1ブーム5の上端部に取着している。第1ブーム5は第
1アクチュエータ6の伸縮駆動により上下揺動自在とな
っている。第1ブーム5は第2ブーム7と連結してい
る。この第2ブーム7を駆動する第2ブームシリンダ8
(以下、第2アクチュエータ8と言う。)のボトム側は
第1ブーム5に取着し、ロッド側は第2ブーム7の端部
に取着している。第2ブーム7は第2アクチュエータ8
の伸縮駆動により上下揺動自在となっている。
【0015】図19のA視図を図20により説明する。
オフセットブーム11の一端は第2ブーム7と連結し、
他端はブラケット9と連結している。このオフセットブ
ーム11を駆動するオフセットシリンダ10(以下、オ
フセット用アクチュエータ10と言う。)のボトム側は
第2ブームに取着し、ロッド側はブラケット9に取着し
ている。オフセットブーム11はオフセット用アクチュ
エータ10の伸縮駆動により横方向に揺動自在となって
いる。ロッド11aの一端は第2ブーム7に取着し、他
端はブラケット9に取着している。このロッド11aは
第2ブーム7に対してブラケット9が回転、揺動させな
いために配設しているものである。ブラケット9はアー
ム12と連結している。このアーム12を駆動するアー
ムシリンダ13(以下、アーム用アクチュエータ13と
言う。)はブラケット9に支承され、ロッドはアーム1
2に取着している。図19に示すアーム12はアーム用
アクチュエータ13の伸縮駆動により掘削・ダンプ方向
に揺動自在となっている。前記オフセットブーム11が
オフセットしないとき、或いは、横方向に揺動してオフ
セット角(θ3 )が0°以上となっても、前記ロッド1
1aによりブラケット9に連結されるアーム12の作業
姿勢は変わらないようにしてある。これにより、オフセ
ットブーム11がオフセットしたとき、或いは、オフセ
ットしないときでもアーム12は掘削・ダンプ方向に揺
動自在となっている。このアーム12はバケット14と
連結している。バケット14を駆動するバケットシリン
ダ15(以下、バケット用アクチュエータ15と言
う。)のボトム側はアーム12に取着し、ロッド側はリ
ンク15a,リンク15bを介してバケット14と連結
している。バケット14はバケット用アクチュエータ1
5の伸縮駆動により掘削・ダンプ方向に揺動自在となっ
ている。図19に示す17は第1ブーム角センサ(以
下、第1検出手段17と言う。)、18は第2ブーム角
センサ(以下、第2検出手段18と言う。)、19はア
ーム角センサ、(以下、第4検出手段19と言う。)、
図19に示す16はオフセット角センサ(以下、第3検
出手段16と言う。)である。オフセット式作業機は図
19,図20に示すようにX,Y,Z方向に揺動自在と
なっている。
オフセットブーム11の一端は第2ブーム7と連結し、
他端はブラケット9と連結している。このオフセットブ
ーム11を駆動するオフセットシリンダ10(以下、オ
フセット用アクチュエータ10と言う。)のボトム側は
第2ブームに取着し、ロッド側はブラケット9に取着し
ている。オフセットブーム11はオフセット用アクチュ
エータ10の伸縮駆動により横方向に揺動自在となって
いる。ロッド11aの一端は第2ブーム7に取着し、他
端はブラケット9に取着している。このロッド11aは
第2ブーム7に対してブラケット9が回転、揺動させな
いために配設しているものである。ブラケット9はアー
ム12と連結している。このアーム12を駆動するアー
ムシリンダ13(以下、アーム用アクチュエータ13と
言う。)はブラケット9に支承され、ロッドはアーム1
2に取着している。図19に示すアーム12はアーム用
アクチュエータ13の伸縮駆動により掘削・ダンプ方向
に揺動自在となっている。前記オフセットブーム11が
オフセットしないとき、或いは、横方向に揺動してオフ
セット角(θ3 )が0°以上となっても、前記ロッド1
1aによりブラケット9に連結されるアーム12の作業
姿勢は変わらないようにしてある。これにより、オフセ
ットブーム11がオフセットしたとき、或いは、オフセ
ットしないときでもアーム12は掘削・ダンプ方向に揺
動自在となっている。このアーム12はバケット14と
連結している。バケット14を駆動するバケットシリン
ダ15(以下、バケット用アクチュエータ15と言
う。)のボトム側はアーム12に取着し、ロッド側はリ
ンク15a,リンク15bを介してバケット14と連結
している。バケット14はバケット用アクチュエータ1
5の伸縮駆動により掘削・ダンプ方向に揺動自在となっ
ている。図19に示す17は第1ブーム角センサ(以
下、第1検出手段17と言う。)、18は第2ブーム角
センサ(以下、第2検出手段18と言う。)、19はア
ーム角センサ、(以下、第4検出手段19と言う。)、
図19に示す16はオフセット角センサ(以下、第3検
出手段16と言う。)である。オフセット式作業機は図
19,図20に示すようにX,Y,Z方向に揺動自在と
なっている。
【0016】次に、本発明のオフセット式作業機の各軸
X,Y,Z方向の座標図について図1により説明する。
第1ブーム5は原点0を中心としてX−Y方向に揺動す
る。その揺動角はθ1であり、原点0とa点を結ぶ距離
L1 が第1ブーム5の長さである。第2ブーム7はa点
を中心としてX−Y方向に揺動する。この第2ブーム7
は距離L22, L21によりa点とb点を結んでおり、a点
から延長するa1 点との線分a,a1 と線分a1 ,bと
のなす角θ2 が揺動角である。オフセットブーム11は
b点を中心としてZ方向に揺動する。その揺動角はθ3
であり、b点とc点を結ぶ距離L3 がオフセットブーム
11の長さである。ブラケット9はc点とd点を結ぶ距
離L4 を有する。アーム12はブラケット9を介してc
点を中心としてX−Y方向に揺動する。その揺動角はθ
4(角cde)であり、d点とe点を結ぶ距離L5 がア
ーム12の長さである。このd点から垂直におろした線f
と線分deとのなす角γ(以下、アーム対地角γと言
う。)がアーム12の作業姿勢である。このように3軸
に揺動するオフセットブーム式作業機は原点0から第1
ブーム5,第2ブーム7,オフセットブーム11及びア
ーム12を順次作動させて、アーム12の先端e点(以
下、アーム制御ポイントeと言う。)を位置決めするも
のである。この座標図にはバケット或いはブレーカ等の
作業機は固定状態にあるものとして表していない。この
アーム制御ポイントeの位置を横方向に直線制御するこ
とは、即ち、作業機の先端を横方向に直線制御すること
になる。
X,Y,Z方向の座標図について図1により説明する。
第1ブーム5は原点0を中心としてX−Y方向に揺動す
る。その揺動角はθ1であり、原点0とa点を結ぶ距離
L1 が第1ブーム5の長さである。第2ブーム7はa点
を中心としてX−Y方向に揺動する。この第2ブーム7
は距離L22, L21によりa点とb点を結んでおり、a点
から延長するa1 点との線分a,a1 と線分a1 ,bと
のなす角θ2 が揺動角である。オフセットブーム11は
b点を中心としてZ方向に揺動する。その揺動角はθ3
であり、b点とc点を結ぶ距離L3 がオフセットブーム
11の長さである。ブラケット9はc点とd点を結ぶ距
離L4 を有する。アーム12はブラケット9を介してc
点を中心としてX−Y方向に揺動する。その揺動角はθ
4(角cde)であり、d点とe点を結ぶ距離L5 がア
ーム12の長さである。このd点から垂直におろした線f
と線分deとのなす角γ(以下、アーム対地角γと言
う。)がアーム12の作業姿勢である。このように3軸
に揺動するオフセットブーム式作業機は原点0から第1
ブーム5,第2ブーム7,オフセットブーム11及びア
ーム12を順次作動させて、アーム12の先端e点(以
下、アーム制御ポイントeと言う。)を位置決めするも
のである。この座標図にはバケット或いはブレーカ等の
作業機は固定状態にあるものとして表していない。この
アーム制御ポイントeの位置を横方向に直線制御するこ
とは、即ち、作業機の先端を横方向に直線制御すること
になる。
【0017】次に、オフセットブーム11をb点を中心
としてオフセット作動させたときは破線で示すようにな
る。このオフセットブーム11の先端c点がc1 点にオ
フセット作動し、ブラケット9のd点がd1 点に、及
び、アーム12の先端e点がe1 点に、それぞれZ方向
に移動する。このオフセット機構によりブラケット9と
アーム12は常にX軸に対して平行になる。このオフセ
ットブーム式作業機の作動によりアーム12の先端e点
をe1 点に直線制御するようになっている。以下、アー
ム制御ポイントeを横方向に直線制御する制御方法及び
装置を説明する。
としてオフセット作動させたときは破線で示すようにな
る。このオフセットブーム11の先端c点がc1 点にオ
フセット作動し、ブラケット9のd点がd1 点に、及
び、アーム12の先端e点がe1 点に、それぞれZ方向
に移動する。このオフセット機構によりブラケット9と
アーム12は常にX軸に対して平行になる。このオフセ
ットブーム式作業機の作動によりアーム12の先端e点
をe1 点に直線制御するようになっている。以下、アー
ム制御ポイントeを横方向に直線制御する制御方法及び
装置を説明する。
【0018】図1のオフセットブーム式作業機の各軸
X,Y,Z方向の各ポイントの座標、アーム対地角γの
関数式について、図1,図7により説明する。第1ブー
ム5フート(原点0)はX0 =0,Y0 =0,Z0 =0
である。 (1) 第1ブーム5のトップ(a点)の各軸X,Y,Z方
向の座標は、 X1 =L1×cos θ1 ……(1) Y1 =L1×sin θ1 ……(2) Z1 =0 (2) 第2ブーム7のトップ(b点)の各軸X,Y,Z方
向の座標は、 X2 =X1+L22 ×sin(θ1+θ2)−L21 ×cos(θ1+θ2)……(3) Y2 =X1−L22 ×cos(θ1+θ2)−L21 ×sin(θ1+θ2)……(4) Z2 =0 (3) オフセットブーム11のトップ(c点)各軸X,
Y,Z方向の座標は、 X3 =X2−L3 cosθ3 ×cos(θ1+θ2)……(5) Y3 =Y2−L3 cosθ3 ×sin(θ1+θ2)……(6) Z3 =L3×sin θ3 ……(7) (4) ブラケット9のトップ(d点)各軸X,Y,Z方向
の座標は、 X4 =X3−L4×cos(θ1+θ2) ……(8) Y4 =Y3−L4×sin(θ1+θ2) ……(9) Z4 =Z3 (5) アーム12のトップ(e点)各軸X,Y,Z方向の
座標は、 X5 =X4+L5×cos(θ1+θ2+θ4)) ……(10) Y5 =Y4+L5×sin(θ1+θ2+θ4)) ……(11) Z5 =Z3 (6) アーム対地角γは、 γ=θ1 +θ2 +θ4 −270° ……(12) 上記の(1)〜(12)式によりオフセットブーム式作
業機の各軸X,Y,Z方向の各ポイントの座標、アーム
対地角γが求められる。前記各軸X,Y,Z方向の各ポ
イントの座標及びアーム対地角γの関数式は図5に示す
制御装置30に記憶されている。
X,Y,Z方向の各ポイントの座標、アーム対地角γの
関数式について、図1,図7により説明する。第1ブー
ム5フート(原点0)はX0 =0,Y0 =0,Z0 =0
である。 (1) 第1ブーム5のトップ(a点)の各軸X,Y,Z方
向の座標は、 X1 =L1×cos θ1 ……(1) Y1 =L1×sin θ1 ……(2) Z1 =0 (2) 第2ブーム7のトップ(b点)の各軸X,Y,Z方
向の座標は、 X2 =X1+L22 ×sin(θ1+θ2)−L21 ×cos(θ1+θ2)……(3) Y2 =X1−L22 ×cos(θ1+θ2)−L21 ×sin(θ1+θ2)……(4) Z2 =0 (3) オフセットブーム11のトップ(c点)各軸X,
Y,Z方向の座標は、 X3 =X2−L3 cosθ3 ×cos(θ1+θ2)……(5) Y3 =Y2−L3 cosθ3 ×sin(θ1+θ2)……(6) Z3 =L3×sin θ3 ……(7) (4) ブラケット9のトップ(d点)各軸X,Y,Z方向
の座標は、 X4 =X3−L4×cos(θ1+θ2) ……(8) Y4 =Y3−L4×sin(θ1+θ2) ……(9) Z4 =Z3 (5) アーム12のトップ(e点)各軸X,Y,Z方向の
座標は、 X5 =X4+L5×cos(θ1+θ2+θ4)) ……(10) Y5 =Y4+L5×sin(θ1+θ2+θ4)) ……(11) Z5 =Z3 (6) アーム対地角γは、 γ=θ1 +θ2 +θ4 −270° ……(12) 上記の(1)〜(12)式によりオフセットブーム式作
業機の各軸X,Y,Z方向の各ポイントの座標、アーム
対地角γが求められる。前記各軸X,Y,Z方向の各ポ
イントの座標及びアーム対地角γの関数式は図5に示す
制御装置30に記憶されている。
【0019】図2に示す、オフセットブーム式作業機を
備えた油圧ショベルの平面図により本発明の作業機直線
制御について概略説明する。上部旋回体3(以下、車体
3と言う。)の旋回中心R0 に対して第1ブーム5のブ
ームフート5aは離間して配設されている。オフセット
ブーム11のオフセット作動によりアーム12の先端を
e点からe1 点への直線移動量Laの制御が可能となっ
ている。この作業機により直線移動が限界となるe1 点
から、車体3を旋回駆動及び作業機駆動をすることによ
り、アーム12の先端を更にe2 点への直線移動量La
1 の制御が可能となっている。この逆に、車体3を旋回
駆動によるアーム12を直線移動が限界となったときに
作業機のオフセット作動により、アーム12の先端を更
に直線移動することが可能となっている。即ち、本発明
によれば、作業機のオフセット作動、または車体の旋回
駆動により、アーム12の先端を横方向に直線移動させ
ることが可能としたものである。また、直線制御はZ1
またはZ2 方向のいずれかを選択するようになってお
り、後述する図5の設定器32により設定するようにな
っている。
備えた油圧ショベルの平面図により本発明の作業機直線
制御について概略説明する。上部旋回体3(以下、車体
3と言う。)の旋回中心R0 に対して第1ブーム5のブ
ームフート5aは離間して配設されている。オフセット
ブーム11のオフセット作動によりアーム12の先端を
e点からe1 点への直線移動量Laの制御が可能となっ
ている。この作業機により直線移動が限界となるe1 点
から、車体3を旋回駆動及び作業機駆動をすることによ
り、アーム12の先端を更にe2 点への直線移動量La
1 の制御が可能となっている。この逆に、車体3を旋回
駆動によるアーム12を直線移動が限界となったときに
作業機のオフセット作動により、アーム12の先端を更
に直線移動することが可能となっている。即ち、本発明
によれば、作業機のオフセット作動、または車体の旋回
駆動により、アーム12の先端を横方向に直線移動させ
ることが可能としたものである。また、直線制御はZ1
またはZ2 方向のいずれかを選択するようになってお
り、後述する図5の設定器32により設定するようにな
っている。
【0020】次に、本発明に係る建設機械の作業機直線
制御回路について、図5,図6により説明する。先ず、
図6に示すエンジン20により駆動される可変容量型油
圧ポンプ21(以下、油圧ポンプ21と言う。)を備え
ている。この油圧ポンプ21は管路22から分岐する管
路22aを介して第1方向切換弁23と接続している。
この油圧ポンプ21は管路22から分岐する管路22b
を介して第2方向切換弁24と接続している。また、油
圧ポンプ21は管路22から分岐する管路22cを介し
て第3方向切換弁25と接続している。さらに油圧ポン
プ21は管路22から分岐する管路22dを介して第4
方向切換弁26と接続している。そして、油圧ポンプ2
1は管路22を介して第5方向切換弁27と接続してい
る。前記第1方向切換弁23は管路23c,23dを介
して第1アクチュエータ6と接続している。前記第2方
向切換弁24は管路24c,24dを介して第2アクチ
ュエータ8と接続している。前記第3方向切換弁25は
管路25c,25dを介してオフセット用アクチュエー
タ10と接続している。前記第4方向切換弁26は管路
26c,26dを介してアーム用アクチュエータ13と
接続している。前記第5方向切換弁27は管路27c,
27dを介してバケット用アクチュエータ15と接続し
ている。
制御回路について、図5,図6により説明する。先ず、
図6に示すエンジン20により駆動される可変容量型油
圧ポンプ21(以下、油圧ポンプ21と言う。)を備え
ている。この油圧ポンプ21は管路22から分岐する管
路22aを介して第1方向切換弁23と接続している。
この油圧ポンプ21は管路22から分岐する管路22b
を介して第2方向切換弁24と接続している。また、油
圧ポンプ21は管路22から分岐する管路22cを介し
て第3方向切換弁25と接続している。さらに油圧ポン
プ21は管路22から分岐する管路22dを介して第4
方向切換弁26と接続している。そして、油圧ポンプ2
1は管路22を介して第5方向切換弁27と接続してい
る。前記第1方向切換弁23は管路23c,23dを介
して第1アクチュエータ6と接続している。前記第2方
向切換弁24は管路24c,24dを介して第2アクチ
ュエータ8と接続している。前記第3方向切換弁25は
管路25c,25dを介してオフセット用アクチュエー
タ10と接続している。前記第4方向切換弁26は管路
26c,26dを介してアーム用アクチュエータ13と
接続している。前記第5方向切換弁27は管路27c,
27dを介してバケット用アクチュエータ15と接続し
ている。
【0021】図5に示す、前述の第1ブーム5の揺動角
を検出する第1ブーム角センサ17(以下、第1検出手
段17と言う。),第2ブーム7の揺動角を検出する第
2ブーム角センサ18(以下、第2検出手段18と言
う。),アーム12の揺動角を検出するアーム角センサ
19(以下、第3検出手段19と言う。),図3に示す
オフセット角センサ16(以下、第4検出手段と言
う。),車体3の旋回角を検出する旋回角センサ41
(以下、第5検出手段と言う。)で検出された信号は制
御装置30に入力している。前記オフセットブーム式作
業機、または旋回によるアーム12の先端を直線制御を
自動に切換えるームの自動切換スイッチ31は制御装置
30と接続している。後述するアーム対地角γ、作業対
象物に対する直線制御開始となるアーム制御ポイント
e、直線移動制御Z1 またはZ2 方向を設定する設定器
32は制御装置30と接続している。次に、手動による
操作手段について説明する。ポテンショメータ36は電
気式操作手段35の操作変位に対応する電圧信号V1 を
発生し、この電圧信号V1 は制御装置30に出力する。
この制御装置30はポテンショメータ36から入力され
る信号V1 に基づき第1〜第5方向切換弁23,24,
25,26,27,旋回用方向切換弁28のうちのいず
れかを作動するための指令信号i01〜i12を演算し、こ
れらの信号i01〜i12は制御装置30内の増幅器によっ
て増幅された後、指令信号i01〜i12が第1〜第5方向
切換弁23,24,25,26,27,旋回用方向切換
弁28の各操作部23a,23b,24a,24b,2
5a,25b,26a,26b,27a,27b,28
a,28bに入力される。
を検出する第1ブーム角センサ17(以下、第1検出手
段17と言う。),第2ブーム7の揺動角を検出する第
2ブーム角センサ18(以下、第2検出手段18と言
う。),アーム12の揺動角を検出するアーム角センサ
19(以下、第3検出手段19と言う。),図3に示す
オフセット角センサ16(以下、第4検出手段と言
う。),車体3の旋回角を検出する旋回角センサ41
(以下、第5検出手段と言う。)で検出された信号は制
御装置30に入力している。前記オフセットブーム式作
業機、または旋回によるアーム12の先端を直線制御を
自動に切換えるームの自動切換スイッチ31は制御装置
30と接続している。後述するアーム対地角γ、作業対
象物に対する直線制御開始となるアーム制御ポイント
e、直線移動制御Z1 またはZ2 方向を設定する設定器
32は制御装置30と接続している。次に、手動による
操作手段について説明する。ポテンショメータ36は電
気式操作手段35の操作変位に対応する電圧信号V1 を
発生し、この電圧信号V1 は制御装置30に出力する。
この制御装置30はポテンショメータ36から入力され
る信号V1 に基づき第1〜第5方向切換弁23,24,
25,26,27,旋回用方向切換弁28のうちのいず
れかを作動するための指令信号i01〜i12を演算し、こ
れらの信号i01〜i12は制御装置30内の増幅器によっ
て増幅された後、指令信号i01〜i12が第1〜第5方向
切換弁23,24,25,26,27,旋回用方向切換
弁28の各操作部23a,23b,24a,24b,2
5a,25b,26a,26b,27a,27b,28
a,28bに入力される。
【0022】前記制御装置30から出力される指令信号
について説明する。指令信号i01は第1方向切換弁23
の操作部23aに入力し、指令信号i02は同弁23の操
作部23bに入力している。指令信号i03は第2方向切
換弁24の操作部24aに入力し、指令信号i04は同弁
24の操作部24bに入力している。指令信号i05は第
3方向切換弁25の操作部25aに入力し、指令信号i
06は同弁25の操作部25bに入力している。指令信号
i07は第4方向切換弁26の操作部26aに入力し、指
令信号i08は同弁26の操作部26bに入力している。
指令信号i09は第5方向切換弁27の操作部27aに入
力し、指令信号i10は同弁27の操作部27bに入力し
ている。指令信号i11は旋回用方向切換弁28の操作部
28aに入力し、指令信号i12は同弁28の操作部28
bに入力している。
について説明する。指令信号i01は第1方向切換弁23
の操作部23aに入力し、指令信号i02は同弁23の操
作部23bに入力している。指令信号i03は第2方向切
換弁24の操作部24aに入力し、指令信号i04は同弁
24の操作部24bに入力している。指令信号i05は第
3方向切換弁25の操作部25aに入力し、指令信号i
06は同弁25の操作部25bに入力している。指令信号
i07は第4方向切換弁26の操作部26aに入力し、指
令信号i08は同弁26の操作部26bに入力している。
指令信号i09は第5方向切換弁27の操作部27aに入
力し、指令信号i10は同弁27の操作部27bに入力し
ている。指令信号i11は旋回用方向切換弁28の操作部
28aに入力し、指令信号i12は同弁28の操作部28
bに入力している。
【0023】図5に示す、制御装置30には、オフセッ
トブーム式作業機の第1ブーム5の長さL1 ,第2ブー
ム7の長さL21, L22, オフセットブーム11の長さL
3 ,ブラケット9の長さL4 ,アーム12の長さL5 が
記憶されている。これらのL1 〜L5 と、図5に示す第
1,第2ブーム角センサ17,18,アーム角センサ1
9,オフセット角センサ16,旋回角センサ41で検出
される角度θ1,θ2,θ3,θ4,θR とから各軸X,Y,Z
方向の各ポイントの座標が演算されると共に、アーム目
標対地角速度dγ/dtが演算されるようになってい
る。これにより第1ブーム5,第2ブーム7,アーム1
2及び車体3の旋回の目標角速度dθ1 /dt,dθ2 /
dt,dθ4 /dt,dθR /dt が設定される。
トブーム式作業機の第1ブーム5の長さL1 ,第2ブー
ム7の長さL21, L22, オフセットブーム11の長さL
3 ,ブラケット9の長さL4 ,アーム12の長さL5 が
記憶されている。これらのL1 〜L5 と、図5に示す第
1,第2ブーム角センサ17,18,アーム角センサ1
9,オフセット角センサ16,旋回角センサ41で検出
される角度θ1,θ2,θ3,θ4,θR とから各軸X,Y,Z
方向の各ポイントの座標が演算されると共に、アーム目
標対地角速度dγ/dtが演算されるようになってい
る。これにより第1ブーム5,第2ブーム7,アーム1
2及び車体3の旋回の目標角速度dθ1 /dt,dθ2 /
dt,dθ4 /dt,dθR /dt が設定される。
【0024】次に、旋回モータ駆動による横方向の直線
制御について図3(a),(b)により説明する。図3
(a)は、オフセットブーム式作業機による横方向の直
線制御が限界となるアーム12の制御ポイントe1 を示
している。この状態から車体3を旋回開始(時計周りの
RX 方向に旋回) して図3(b)に示すアーム12の制
御ポイントe2 の位置に直線移動したときは、以下の式
により計算される。ここで、図3(a)に示す、旋回中
心R0 とアーム12の制御ポイントe1 とを結ぶ半径R
org ,旋回中心R0 から延長するX軸と線分R0,e1 と
のなす角θorg ,旋回中心R0 から延長するZ軸とブー
ムフート5aまでの距離LxB0 ,旋回中心R0 から延長
するX軸とブームフート5aまでの距離LzB0 ,ブーム
フート5aからアーム12の制御ポイントe1 までの距
離Xa0,オフセットブーム11のオフセット量Za0とし
たときの基準座標X0 は、 Rorg ={(LxB0 +Xa0)2 +(LzB0 +Za0)2 }0.5 θorg =tan -1(LzB0 +Za0/LxB0 +Xa0) よって、 X0 =Rorg ×cosθorg ……………(13) により求められる。この基準座標X0 に対応して第1ブ
ーム、第2ブーム、アーム及び旋回用アクチュエータを
駆動すれば横方向の直線制御が可能である。
制御について図3(a),(b)により説明する。図3
(a)は、オフセットブーム式作業機による横方向の直
線制御が限界となるアーム12の制御ポイントe1 を示
している。この状態から車体3を旋回開始(時計周りの
RX 方向に旋回) して図3(b)に示すアーム12の制
御ポイントe2 の位置に直線移動したときは、以下の式
により計算される。ここで、図3(a)に示す、旋回中
心R0 とアーム12の制御ポイントe1 とを結ぶ半径R
org ,旋回中心R0 から延長するX軸と線分R0,e1 と
のなす角θorg ,旋回中心R0 から延長するZ軸とブー
ムフート5aまでの距離LxB0 ,旋回中心R0 から延長
するX軸とブームフート5aまでの距離LzB0 ,ブーム
フート5aからアーム12の制御ポイントe1 までの距
離Xa0,オフセットブーム11のオフセット量Za0とし
たときの基準座標X0 は、 Rorg ={(LxB0 +Xa0)2 +(LzB0 +Za0)2 }0.5 θorg =tan -1(LzB0 +Za0/LxB0 +Xa0) よって、 X0 =Rorg ×cosθorg ……………(13) により求められる。この基準座標X0 に対応して第1ブ
ーム、第2ブーム、アーム及び旋回用アクチュエータを
駆動すれば横方向の直線制御が可能である。
【0025】ここで、旋回中心R0 からブームフート5
aまでの距離LB0,線分R0,5aと旋回中心R0 から延
長するX軸とのなす角θB0,旋回角の初期値θR0,旋回
角θR としたときの、X軸とアーム12の制御ポイント
e2 までの距離Z(θR ),旋回中心R0 からブームフ
ートまでの距離LzB0 (θR ),ブームフート5aから
アーム12の制御ポイントe2 までのXb 軸方向の距離
Xa ,旋回中心R0 から延長するZ軸とブームフート5
aまでの距離LxB0 (θR ),ブームフート5aからア
ーム12の制御ポイントe2 までのZb 軸方向の距離Z
a ,旋回中心R0 から延長するZ軸とアーム12の制御
ポイントe2 までの距離X (θR)は、 LzB0(θR)=LB0×cos{θB0−(θR −θR0) } LXB0(θR)=LB0×sin{θB0−(θR −θR0) } Z (θR)=Xa ×sin(θR −θR0)+Za ×cos
(θR −θR0) X (θR)=Xa ×cos(θR −θR0)−Za ×sin
(θR −θR0) R (θR)=〔{LXB0(θR)+X (θR)}2 +{LzB0(θ
R)+Z (θR)}2 〕0.5 θ(θR)=tan -1〔{LzB0 (θR )+Z(θR )}/
{LxB0 (θR )+X(θR )}〕 よって、 X (θR)=R (θR)×cos{θ(θR)} ……………(14) により求められる。この基準座標X (θR)に対応して第
1ブーム、第2ブーム、アーム及び旋回用アクチュエー
タを駆動すれば横方向の直線制御が可能である。
aまでの距離LB0,線分R0,5aと旋回中心R0 から延
長するX軸とのなす角θB0,旋回角の初期値θR0,旋回
角θR としたときの、X軸とアーム12の制御ポイント
e2 までの距離Z(θR ),旋回中心R0 からブームフ
ートまでの距離LzB0 (θR ),ブームフート5aから
アーム12の制御ポイントe2 までのXb 軸方向の距離
Xa ,旋回中心R0 から延長するZ軸とブームフート5
aまでの距離LxB0 (θR ),ブームフート5aからア
ーム12の制御ポイントe2 までのZb 軸方向の距離Z
a ,旋回中心R0 から延長するZ軸とアーム12の制御
ポイントe2 までの距離X (θR)は、 LzB0(θR)=LB0×cos{θB0−(θR −θR0) } LXB0(θR)=LB0×sin{θB0−(θR −θR0) } Z (θR)=Xa ×sin(θR −θR0)+Za ×cos
(θR −θR0) X (θR)=Xa ×cos(θR −θR0)−Za ×sin
(θR −θR0) R (θR)=〔{LXB0(θR)+X (θR)}2 +{LzB0(θ
R)+Z (θR)}2 〕0.5 θ(θR)=tan -1〔{LzB0 (θR )+Z(θR )}/
{LxB0 (θR )+X(θR )}〕 よって、 X (θR)=R (θR)×cos{θ(θR)} ……………(14) により求められる。この基準座標X (θR)に対応して第
1ブーム、第2ブーム、アーム及び旋回用アクチュエー
タを駆動すれば横方向の直線制御が可能である。
【0026】他の実施例の旋回モータ駆動による横方向
の直線制御について図4により説明する。オフセットブ
ーム式作業機による直線制御中に、アーム制御ポイント
eがX軸上に達したときは旋回駆動及び作業機駆動によ
る直線制御に切換えて、アーム制御ポイントe3 まで直
線制御するものである。ここで、旋回中心R0 から延長
するZ軸とブームフート5aまでの距離LxB0,ブーム
フート5aからアーム12の制御ポイントe3 までの距
離Xa0,旋回中心R0 から延長するZ軸とアーム12の
制御ポイントe2 までの距離X0 は、 X0 =LxB0 +Xa0 により求められる。この基準座標X0 に対応して第1ブ
ーム、第2ブーム、アーム及び旋回用アクチュエータを
駆動すれば横方向の直線制御が可能である。
の直線制御について図4により説明する。オフセットブ
ーム式作業機による直線制御中に、アーム制御ポイント
eがX軸上に達したときは旋回駆動及び作業機駆動によ
る直線制御に切換えて、アーム制御ポイントe3 まで直
線制御するものである。ここで、旋回中心R0 から延長
するZ軸とブームフート5aまでの距離LxB0,ブーム
フート5aからアーム12の制御ポイントe3 までの距
離Xa0,旋回中心R0 から延長するZ軸とアーム12の
制御ポイントe2 までの距離X0 は、 X0 =LxB0 +Xa0 により求められる。この基準座標X0 に対応して第1ブ
ーム、第2ブーム、アーム及び旋回用アクチュエータを
駆動すれば横方向の直線制御が可能である。
【0027】次に、図1乃至図7に示す作動について説
明する。先ず、オフセットブーム式作業機によるアーム
制御ポイントeを横方向(Z軸方向)に直線制御する場
合は、アーム対地角γ、アーム制御ポイントe及び直線
制御のZ1 或いはZ2 方向を設定器32により設定す
る。次いで、自動切換スイッチ31をオン操作した後
に、第1〜第4検出手段16,17,18,19からの
信号を受けて複数の作業機部材5,7,9,11,12
の長さL1 〜L5 により算出されるアーム制御ポイント
eの各軸の座標Xa0 ,Ya0 ,Za0 ,及びアーム対
地角γa0 の計算をする。このアーム制御ポイントeの
Z方向の速度dz/dtを算出してオフセットブームの
目標角速度dθ3 /dtを設定する。このオフセットブ
ームの目標角速度dθ3 /dtから演算し、その演算結
果に基づいてオフセットブーム用アクチュエータ10を
駆動して、自動的に作業機部材の先端を横方向に移動し
て作業対象物に対して直線制御するために第1〜第4方
向切換弁23,24,25,26を所定の開口量とする
ように制御装置30から指令出力される。これにより、
オフセットブーム式作業機を横方向の直線制御が自動的
に行われ、未熟練のオペレータでも容易に運転操作が可
能となる。
明する。先ず、オフセットブーム式作業機によるアーム
制御ポイントeを横方向(Z軸方向)に直線制御する場
合は、アーム対地角γ、アーム制御ポイントe及び直線
制御のZ1 或いはZ2 方向を設定器32により設定す
る。次いで、自動切換スイッチ31をオン操作した後
に、第1〜第4検出手段16,17,18,19からの
信号を受けて複数の作業機部材5,7,9,11,12
の長さL1 〜L5 により算出されるアーム制御ポイント
eの各軸の座標Xa0 ,Ya0 ,Za0 ,及びアーム対
地角γa0 の計算をする。このアーム制御ポイントeの
Z方向の速度dz/dtを算出してオフセットブームの
目標角速度dθ3 /dtを設定する。このオフセットブ
ームの目標角速度dθ3 /dtから演算し、その演算結
果に基づいてオフセットブーム用アクチュエータ10を
駆動して、自動的に作業機部材の先端を横方向に移動し
て作業対象物に対して直線制御するために第1〜第4方
向切換弁23,24,25,26を所定の開口量とする
ように制御装置30から指令出力される。これにより、
オフセットブーム式作業機を横方向の直線制御が自動的
に行われ、未熟練のオペレータでも容易に運転操作が可
能となる。
【0028】次に、旋回駆動によるアーム制御ポイント
eを横方向(Z軸方向)に直線制御する場合は、アーム
対地角γ、アーム制御ポイントe及び直線制御のZ1 或
いはZ2 方向を設定器32により設定する。次いで、自
動切換スイッチ31をオン操作した後に、第1〜第5検
出手段16,17,18,19,41からの信号を受け
て複数の作業機部材5,7,9,11,12の長さL1
〜L5 により算出されるアーム制御ポイントeの各軸の
座標Xa0 ,Ya0 ,Za0 ,及びアーム対地角γa0
の計算をする。このアーム制御ポイントeのZ方向の旋
回速度dθR /dtを算出し、前記各軸Xa0 ,YaO
,Za0 の座標に基づいて旋回中心R0 からアーム制
御ポイントe1 までの基準座標X0 計算する。この基準
座標X0 から演算し、その演算結果に基づいて作業機及
び旋回用アクチュエータ6,8,13,40を駆動し
て、自動的に作業機部材の先端を横方向に移動して作業
対象物に対して直線制御するために第1,第2,第4及
び旋回用方向切換弁23,24,26,28を所定の開
口量とするように制御装置30から指令出力される。こ
れにより、作業機及び旋回用アクチュエータの旋回駆動
によりオフセットブーム式作業機の先端を横方向に移動
して作業対象物に対して直線制御が自動的に行われ、未
熟練のオペレータでも容易に運転操作が可能となる。以
上の説明では、アーム対地角γを予め設定するようにし
てあるのはアームの作業姿勢を一定にするためのもので
あり、アームの作業姿勢を特に固定する必要がないとき
は、このアーム対地角γは設定しないでフリーの状態に
しても、前述のオフセットブームの目標角速度dθ3 /
dtから演算し、その演算結果に基づいて第1ブーム、
第2ブーム、オフセットブーム及びアームの各アクチュ
エータ6,8,10,13を駆動して、自動的に作業機
部材の先端を横方向に移動して作業対象物に対して直線
制御することは可能である。また、前述の基準座標X0
から演算し、その演算結果に基づいて第1ブーム、第2
ブーム、アーム及び旋回用の各アクチュエータ6,8,
13,40を駆動して、自動的に作業機部材の先端を横
方向に移動して作業対象物に対して直線制御することは
可能である。
eを横方向(Z軸方向)に直線制御する場合は、アーム
対地角γ、アーム制御ポイントe及び直線制御のZ1 或
いはZ2 方向を設定器32により設定する。次いで、自
動切換スイッチ31をオン操作した後に、第1〜第5検
出手段16,17,18,19,41からの信号を受け
て複数の作業機部材5,7,9,11,12の長さL1
〜L5 により算出されるアーム制御ポイントeの各軸の
座標Xa0 ,Ya0 ,Za0 ,及びアーム対地角γa0
の計算をする。このアーム制御ポイントeのZ方向の旋
回速度dθR /dtを算出し、前記各軸Xa0 ,YaO
,Za0 の座標に基づいて旋回中心R0 からアーム制
御ポイントe1 までの基準座標X0 計算する。この基準
座標X0 から演算し、その演算結果に基づいて作業機及
び旋回用アクチュエータ6,8,13,40を駆動し
て、自動的に作業機部材の先端を横方向に移動して作業
対象物に対して直線制御するために第1,第2,第4及
び旋回用方向切換弁23,24,26,28を所定の開
口量とするように制御装置30から指令出力される。こ
れにより、作業機及び旋回用アクチュエータの旋回駆動
によりオフセットブーム式作業機の先端を横方向に移動
して作業対象物に対して直線制御が自動的に行われ、未
熟練のオペレータでも容易に運転操作が可能となる。以
上の説明では、アーム対地角γを予め設定するようにし
てあるのはアームの作業姿勢を一定にするためのもので
あり、アームの作業姿勢を特に固定する必要がないとき
は、このアーム対地角γは設定しないでフリーの状態に
しても、前述のオフセットブームの目標角速度dθ3 /
dtから演算し、その演算結果に基づいて第1ブーム、
第2ブーム、オフセットブーム及びアームの各アクチュ
エータ6,8,10,13を駆動して、自動的に作業機
部材の先端を横方向に移動して作業対象物に対して直線
制御することは可能である。また、前述の基準座標X0
から演算し、その演算結果に基づいて第1ブーム、第2
ブーム、アーム及び旋回用の各アクチュエータ6,8,
13,40を駆動して、自動的に作業機部材の先端を横
方向に移動して作業対象物に対して直線制御することは
可能である。
【0029】前記の図5,図6の制御回路の作動につい
て説明する。前述のオフセットブーム式作業機による、
または車体3の旋回駆動によるアーム制御ポイントeを
横方向(Z軸方向)に直線制御するために制御装置30
で演算し、その演算結果に基づいて指令信号i01〜i12
が出力される。指令信号i01が第1方向切換弁23の操
作部23aに入力されたときは、同弁23がa位置に切
換わり、油圧ポンプ21から吐出される圧油は管路22
から分岐管路22aを介して管路23dを通って第1ア
クチュエータ6のヘッド室6aに流入する。これによ
り、同アクチュエータ6は短縮駆動する。指令信号i02
が第1方向切換弁23の操作部23bに入力されたとき
は、同弁23がb位置に切換わり、油圧ポンプ21から
吐出される圧油は管路22から分岐管路22aを介して
管路23cを通って第1アクチュエータ6のボトム室6
bに流入する。これにより、同アクチュエータ6は伸長
駆動する。指令信号i03が第2方向切換弁24の操作部
24aに入力されたときは、同弁24がa位置に切換わ
り、油圧ポンプ21から吐出される圧油は管路22から
分岐管路22bを介して管路24dを通って第2アクチ
ュエータ8のヘッド室8aに流入する。これにより、同
アクチュエータ8は短縮駆動する。指令信号i04が第2
方向切換弁24の操作部24bに入力されたときは、同
弁24がb位置に切換わり、油圧ポンプ21から吐出さ
れる圧油は管路22から分岐管路22bを介して管路2
4cを通って第2アクチュエータ8のボトム室8bに流
入する。これにより、同アクチュエータ8は伸長駆動す
る。指令信号i07が第4方向切換弁26の操作部26a
に入力されたときは、同弁26がa位置に切換わり、油
圧ポンプ21から吐出される圧油は管路22から分岐管
路22dを介して管路26dを通って第4アクチュエー
タ13のヘッド室13aに流入する。これにより、同ア
クチュエータ13は短縮駆動する。指令信号i08が第4
方向切換弁26の操作部26bに入力されたときは、同
弁26がb位置に切換わり、油圧ポンプ21から吐出さ
れる圧油は管路22から分岐管路22dを介して管路2
6cを通って第4アクチュエータ13のボトム室13b
に流入する。これにより、同アクチュエータ13は伸長
駆動する。指令信号i11が旋回用方向切換弁28の操作
部28aに入力されたときは、同弁28がa位置に切換
わり、油圧ポンプ21から吐出される圧油は管路22か
ら分岐管路22eを介して管路28dを通って旋回用ア
クチュエータ40に流入する。これにより、同アクチュ
エータ40は左旋回駆動する。指令信号i12が旋回用方
向切換弁28の操作部28bに入力されたときは、同弁
28がb位置に切換わり、油圧ポンプ21から吐出され
る圧油は管路22から分岐管路22eを介して管路28
cを通って旋回用アクチュエータ40に流入する。これ
により、同アクチュエータ40は右旋回駆動する。この
ように、第1,第2,第3及び第4アクチュエータ6,
8,10,13を短縮または伸長駆動して、アーム12
の制御ポイントeを横方向に直線制御することが可能と
なっている。
て説明する。前述のオフセットブーム式作業機による、
または車体3の旋回駆動によるアーム制御ポイントeを
横方向(Z軸方向)に直線制御するために制御装置30
で演算し、その演算結果に基づいて指令信号i01〜i12
が出力される。指令信号i01が第1方向切換弁23の操
作部23aに入力されたときは、同弁23がa位置に切
換わり、油圧ポンプ21から吐出される圧油は管路22
から分岐管路22aを介して管路23dを通って第1ア
クチュエータ6のヘッド室6aに流入する。これによ
り、同アクチュエータ6は短縮駆動する。指令信号i02
が第1方向切換弁23の操作部23bに入力されたとき
は、同弁23がb位置に切換わり、油圧ポンプ21から
吐出される圧油は管路22から分岐管路22aを介して
管路23cを通って第1アクチュエータ6のボトム室6
bに流入する。これにより、同アクチュエータ6は伸長
駆動する。指令信号i03が第2方向切換弁24の操作部
24aに入力されたときは、同弁24がa位置に切換わ
り、油圧ポンプ21から吐出される圧油は管路22から
分岐管路22bを介して管路24dを通って第2アクチ
ュエータ8のヘッド室8aに流入する。これにより、同
アクチュエータ8は短縮駆動する。指令信号i04が第2
方向切換弁24の操作部24bに入力されたときは、同
弁24がb位置に切換わり、油圧ポンプ21から吐出さ
れる圧油は管路22から分岐管路22bを介して管路2
4cを通って第2アクチュエータ8のボトム室8bに流
入する。これにより、同アクチュエータ8は伸長駆動す
る。指令信号i07が第4方向切換弁26の操作部26a
に入力されたときは、同弁26がa位置に切換わり、油
圧ポンプ21から吐出される圧油は管路22から分岐管
路22dを介して管路26dを通って第4アクチュエー
タ13のヘッド室13aに流入する。これにより、同ア
クチュエータ13は短縮駆動する。指令信号i08が第4
方向切換弁26の操作部26bに入力されたときは、同
弁26がb位置に切換わり、油圧ポンプ21から吐出さ
れる圧油は管路22から分岐管路22dを介して管路2
6cを通って第4アクチュエータ13のボトム室13b
に流入する。これにより、同アクチュエータ13は伸長
駆動する。指令信号i11が旋回用方向切換弁28の操作
部28aに入力されたときは、同弁28がa位置に切換
わり、油圧ポンプ21から吐出される圧油は管路22か
ら分岐管路22eを介して管路28dを通って旋回用ア
クチュエータ40に流入する。これにより、同アクチュ
エータ40は左旋回駆動する。指令信号i12が旋回用方
向切換弁28の操作部28bに入力されたときは、同弁
28がb位置に切換わり、油圧ポンプ21から吐出され
る圧油は管路22から分岐管路22eを介して管路28
cを通って旋回用アクチュエータ40に流入する。これ
により、同アクチュエータ40は右旋回駆動する。この
ように、第1,第2,第3及び第4アクチュエータ6,
8,10,13を短縮または伸長駆動して、アーム12
の制御ポイントeを横方向に直線制御することが可能と
なっている。
【0030】前記自動切換スイッチ31がオフのとき
は、手動による電気式操作手段35の操作により各方向
切換弁23,24,25,26,27の切換えが可能と
なっている。ポテンショメータ36は電気式操作手段3
5の操作変位に対応する電圧信号V1 を発生し、この電
圧信号V1 は制御装置30に出力する。この制御装置3
0はポテンショメータ36から入力される信号V1 に基
づき第1〜第5方向切換弁23,24,25,26,2
7のうちのいずれかを作動するための指令信号i01〜i
12を演算し、これらの信号i01〜i12は制御装置30内
の増幅器によって増幅された後、指令信号i01〜i12が
第1〜第5方向切換弁23,24,25,26,27及
び旋回用方向切換弁28の各操作部23a,23b,2
4a,24b,25a,25b,26a,26b,27
a,27b,28a,28bに入力される。指令信号i
01〜i12により第1〜第5方向切換弁23,24,2
5,26,27,及び旋回用方向切換弁28の各開口量
が制御されて第1〜第5及び旋回用アクチュエータ6,
8,10,13,40の駆動は前述と同一であり、ここ
では説明を省略する。
は、手動による電気式操作手段35の操作により各方向
切換弁23,24,25,26,27の切換えが可能と
なっている。ポテンショメータ36は電気式操作手段3
5の操作変位に対応する電圧信号V1 を発生し、この電
圧信号V1 は制御装置30に出力する。この制御装置3
0はポテンショメータ36から入力される信号V1 に基
づき第1〜第5方向切換弁23,24,25,26,2
7のうちのいずれかを作動するための指令信号i01〜i
12を演算し、これらの信号i01〜i12は制御装置30内
の増幅器によって増幅された後、指令信号i01〜i12が
第1〜第5方向切換弁23,24,25,26,27及
び旋回用方向切換弁28の各操作部23a,23b,2
4a,24b,25a,25b,26a,26b,27
a,27b,28a,28bに入力される。指令信号i
01〜i12により第1〜第5方向切換弁23,24,2
5,26,27,及び旋回用方向切換弁28の各開口量
が制御されて第1〜第5及び旋回用アクチュエータ6,
8,10,13,40の駆動は前述と同一であり、ここ
では説明を省略する。
【0031】本発明に係る建設機械の作業機直線制御装
置における第1乃至第4制御フローチャートを図8乃至
図18に基づいて説明する。尚、第1乃至第4制御フロ
ーチャートのいずれもアーム対地角γを設定するように
しているが、アーム対地角は設定しないでフリーの状態
にしても良い。このアーム対地角γを設定することはア
ームの作業姿勢を一定に保って横方向に直線制御するも
のであり、アーム対地角を設定しないときでも横方向に
直線制御することは可能である。先ず、第1制御フロー
チャートを図8,図9に基づいて説明する。S1にてア
ーム対地角γ,作業対象物に対して作業開始となるアー
ム制御ポイントe,直線移動Z1 またはZ2 制御方向を
図5に示す設定器32により入力する。S2にて図5に
示す自動切換スイッチ31のオンかを判定しており、N
OのときはS1に戻り、YESのときは、S3にて第1
ブーム角θ1,第2ブーム角θ2,オフセット角θ3,アーム
角θ4 を検出する。S4にてアーム制御ポイントeの各
軸Xa0, Ya0, Za0, γa0の初期値の座標を計算する。
S5にて直線移動Z1 またはZ2 制御方向の速度dz/
dtを算出する。S6にてオフセットブームの目標角速
度dθ3 /dtを設定する。S7にて第3方向切換弁2
5の開口量C1 は、目標角速度dθ3 /dt, 制御装置
30に記憶されている所定関数f1 により、 C1 =f1 (dθ1 /dt) を求める。次に、S8にて第3方向切換弁25の制御電
流値i1 は、制御装置30に記憶されている所定関数f
A により、 i1 =fA (C1 ) を求める。制御電流値i1 は図5,図6に示す制御装置
30から第3方向切換弁25の操作部25a及び操作部
25bへの指令信号i05,i06に相当する。この演算さ
れた制御電流値i1 により、S9にて第3方向切換弁2
5に指令出力する。この第3方向切換弁25に指令出力
された後に、S10にて第1ブーム角θ1,第2ブーム角
θ2,オフセット角θ3,アーム角θ4 を検出する。S11
にて図1に示す、アーム制御ポイントe〜e1 に直線移
動中の各軸Xa1, Ya1, Za1, γa の座標を計算する。
S12にてアーム制御ポイントe〜e1 の直線移動中の
各軸Xa1, Ya1, Za1, γa1の座標と各軸Xa0, Ya0,
γa0の初期値との偏差ΔX,ΔY,Δγを求める。ΔX
=Xa1−Xa0,ΔY=Ya1−Ya0,Δγ=γa−γa0 S13にて偏差値ΔXは限界誤差ΔXe に対して|ΔX
|≦ΔXe か判定し、また偏差値ΔYは限界誤差ΔYe
に対して|ΔY|≦ΔYe か判定し、さらに偏差値Δγ
は限界誤差Δγe に対して|Δγ|≦Δγe か判定して
おり、この3つの判定結果がYESのときはS10に戻
り、この3つの判定結果のうち1つでもNOのときはS
14にて各目標速度dX /dt,dY /dt,dγ/d
tを算出する。S15にて各目標角速度dθ1 /dt,
dθ4 /dt,dθ2 /dt=一定、を算出する。S1
6にて第1,第2及び第4方向切換弁23,24,26
の開口量C1 ,C2 ,C3 は、目標角速度dθ1 /d
t,dθ4 /dt,dθ2 /dt, 制御装置30に記憶
されている所定関数f1 により、C1 =f1 (dθ1 /
dt),C2 =f1 (dθ4 /dt),C3 =f1 (d
θ2 /dt)を求める。次に、S17にて第1,第2及
び第4方向切換弁23,24,26の制御電流値i2,i
3,i4 は、制御装置30に記憶されている所定関数fA
により、i2 =fA (C1 ),i3 =fA (C2 ),i
4 =fA (C3 )を求める。制御電流値i2 は図5,図
6に示す制御装置30から第1方向切換弁23の操作部
23a及び操作部23bへの指令信号i01,i02に相当
する。制御電流値i3 は図5,図6に示す制御装置30
から第4方向切換弁26の操作部26a及び操作部26
bへの指令信号i07,i08に相当する。制御電流値i4
は図5,図6に示す制御装置30から第2方向切換弁2
4の操作部24a及び操作部24bへの指令信号i03,
i04に相当する。この演算された制御電流値i2,i3,i
4 により、S18にて第1,第4及び第2方向切換弁2
3,24,26に指令出力する。S19にて自動切換ス
イッチ31のオンかを判定しており、YESのときはS
10に戻り、NOのときはエンドとなる。このように第
1制御フローチヤートは、先に第3方向切換弁25に指
令出力してオフセット用の第3アクチュエータ10を駆
動してアーム12の制御ポイントeを横方向に直線移動
を開始し、次いで第1,第4及び第2方向切換弁23,
24,26に指令出力して第1,第4及び第2アクチュ
エータ6,8,13を同時操作して図1に示すようにア
ーム12の制御ポイントeからe1 点に横方向に直線移
動することができる。
置における第1乃至第4制御フローチャートを図8乃至
図18に基づいて説明する。尚、第1乃至第4制御フロ
ーチャートのいずれもアーム対地角γを設定するように
しているが、アーム対地角は設定しないでフリーの状態
にしても良い。このアーム対地角γを設定することはア
ームの作業姿勢を一定に保って横方向に直線制御するも
のであり、アーム対地角を設定しないときでも横方向に
直線制御することは可能である。先ず、第1制御フロー
チャートを図8,図9に基づいて説明する。S1にてア
ーム対地角γ,作業対象物に対して作業開始となるアー
ム制御ポイントe,直線移動Z1 またはZ2 制御方向を
図5に示す設定器32により入力する。S2にて図5に
示す自動切換スイッチ31のオンかを判定しており、N
OのときはS1に戻り、YESのときは、S3にて第1
ブーム角θ1,第2ブーム角θ2,オフセット角θ3,アーム
角θ4 を検出する。S4にてアーム制御ポイントeの各
軸Xa0, Ya0, Za0, γa0の初期値の座標を計算する。
S5にて直線移動Z1 またはZ2 制御方向の速度dz/
dtを算出する。S6にてオフセットブームの目標角速
度dθ3 /dtを設定する。S7にて第3方向切換弁2
5の開口量C1 は、目標角速度dθ3 /dt, 制御装置
30に記憶されている所定関数f1 により、 C1 =f1 (dθ1 /dt) を求める。次に、S8にて第3方向切換弁25の制御電
流値i1 は、制御装置30に記憶されている所定関数f
A により、 i1 =fA (C1 ) を求める。制御電流値i1 は図5,図6に示す制御装置
30から第3方向切換弁25の操作部25a及び操作部
25bへの指令信号i05,i06に相当する。この演算さ
れた制御電流値i1 により、S9にて第3方向切換弁2
5に指令出力する。この第3方向切換弁25に指令出力
された後に、S10にて第1ブーム角θ1,第2ブーム角
θ2,オフセット角θ3,アーム角θ4 を検出する。S11
にて図1に示す、アーム制御ポイントe〜e1 に直線移
動中の各軸Xa1, Ya1, Za1, γa の座標を計算する。
S12にてアーム制御ポイントe〜e1 の直線移動中の
各軸Xa1, Ya1, Za1, γa1の座標と各軸Xa0, Ya0,
γa0の初期値との偏差ΔX,ΔY,Δγを求める。ΔX
=Xa1−Xa0,ΔY=Ya1−Ya0,Δγ=γa−γa0 S13にて偏差値ΔXは限界誤差ΔXe に対して|ΔX
|≦ΔXe か判定し、また偏差値ΔYは限界誤差ΔYe
に対して|ΔY|≦ΔYe か判定し、さらに偏差値Δγ
は限界誤差Δγe に対して|Δγ|≦Δγe か判定して
おり、この3つの判定結果がYESのときはS10に戻
り、この3つの判定結果のうち1つでもNOのときはS
14にて各目標速度dX /dt,dY /dt,dγ/d
tを算出する。S15にて各目標角速度dθ1 /dt,
dθ4 /dt,dθ2 /dt=一定、を算出する。S1
6にて第1,第2及び第4方向切換弁23,24,26
の開口量C1 ,C2 ,C3 は、目標角速度dθ1 /d
t,dθ4 /dt,dθ2 /dt, 制御装置30に記憶
されている所定関数f1 により、C1 =f1 (dθ1 /
dt),C2 =f1 (dθ4 /dt),C3 =f1 (d
θ2 /dt)を求める。次に、S17にて第1,第2及
び第4方向切換弁23,24,26の制御電流値i2,i
3,i4 は、制御装置30に記憶されている所定関数fA
により、i2 =fA (C1 ),i3 =fA (C2 ),i
4 =fA (C3 )を求める。制御電流値i2 は図5,図
6に示す制御装置30から第1方向切換弁23の操作部
23a及び操作部23bへの指令信号i01,i02に相当
する。制御電流値i3 は図5,図6に示す制御装置30
から第4方向切換弁26の操作部26a及び操作部26
bへの指令信号i07,i08に相当する。制御電流値i4
は図5,図6に示す制御装置30から第2方向切換弁2
4の操作部24a及び操作部24bへの指令信号i03,
i04に相当する。この演算された制御電流値i2,i3,i
4 により、S18にて第1,第4及び第2方向切換弁2
3,24,26に指令出力する。S19にて自動切換ス
イッチ31のオンかを判定しており、YESのときはS
10に戻り、NOのときはエンドとなる。このように第
1制御フローチヤートは、先に第3方向切換弁25に指
令出力してオフセット用の第3アクチュエータ10を駆
動してアーム12の制御ポイントeを横方向に直線移動
を開始し、次いで第1,第4及び第2方向切換弁23,
24,26に指令出力して第1,第4及び第2アクチュ
エータ6,8,13を同時操作して図1に示すようにア
ーム12の制御ポイントeからe1 点に横方向に直線移
動することができる。
【0032】本発明に係る建設機械の作業機直線制御装
置における第2の制御フローチャートを図10,図11
に基づいて説明する。S30にてアーム対地角γ,作業
対象物に対して作業開始となるアーム制御ポイントe,
直線移動Z1 またはZ2 制御方向を図5に示す設定器3
2により入力する。S31にて図5に示す自動切換スイ
ッチ31のオンかを判定しており、NOのときはS30
に戻り、YESのときは、S32にて第1ブーム角θ1,
第2ブーム角θ2,オフセット角θ3,アーム角θ4,旋回角
θR を検出する。S33にてアーム制御ポイントeの各
軸Xa0, Ya0, Za0, γa0の初期値の座標を計算する。
S34にて直線移動Z1 またはZ2 制御方向の旋回速度
dθR /dtを算出する。S35にて図3(a)に示す
基準座標X0 を前記(13)式により、 X0 =Rorg ×cosθorg を算出する。S36にて旋回用方向切換弁28の開口量
C4 は、基準座標X0 、制御装置30に記憶されている
所定関数f1 により、C4 =f1 (X0 )を求める。こ
の旋回用方向切換弁28の制御電流値i5 は、制御装置
30に記憶されている所定関数fA により、 i5 =fA (C1 ) を求める。制御電流値i5 は図5,図6に示す制御装置
30から旋回用方向切換弁28の操作部28a及び操作
部28bへの指令信号i11,i12に相当する。この演算
された制御電流値i5 により、S37にて旋回用方向切
換弁28に指令出力する。この旋回用方向切換弁28に
指令出力された後に、S38にて第1ブーム角θ1,第2
ブーム角θ2,オフセット角θ3,アーム角θ4 を検出す
る。S39にて図1に示す、アーム制御ポイントe〜e
1 に直線移動中の各軸Xa1, Ya1, Za1, γa の座標を
計算する。S40にて旋回中心R0 とアーム制御ポイン
トe2 との距離X0(θR)を前記(14)式により、 X0(θR)=R (θR)×cos{θ(θR)} を算出する。S41にてアーム制御ポイントe〜e1 の
直線移動中の前記距離X0(θR),各軸Ya1, γa1の座標
と基準座標X0,各軸Ya0, γa0の初期値との偏差ΔX,
ΔY,Δγを求める。 ΔX=X0(θR)−X0 ,ΔY=Ya1−Ya0,Δγ=γa
−γa0 S42にて偏差値ΔXは限界誤差ΔXe に対して|ΔX
|≦ΔXe か判定し、また偏差値ΔYは限界誤差ΔYe
に対して|ΔY|≦ΔYe か判定し、さらに偏差値Δγ
は限界誤差Δγe に対して|Δγ|≦Δγe か判定して
おり、この3つの判定結果がYESのときはS38に戻
り、この3つの判定結果のうち1つでもNOのときはS
43にて各目標速度dX /dt,dY /dt,dγ/d
tを算出する。S44にて各目標角速度dθ1 /dt,
dθ2 /dt,dθ4 /dtを算出する。S45にて第
1,第2及び第4方向切換弁23,24,26の開口量
C1 ,C2 ,C3 は、目標角速度dθ1 /dt,dθ2
/dt,dθ4 /dt, 制御装置30に記憶されている
所定関数f1 により、C1 =f1 (dθ1 /dt),C
2 =f1 (dθ2 /dt),C3 =f1 (dθ4 /d
t)を求める。次に、S45にて第1,第2及び第4方
向切換弁23,24,26の制御電流値i2,i3,i4
は、制御装置30に記憶されている所定関数fA によ
り、i2 =fA (C1 ),i3 =fA (C2 ),i4 =
fA (C3 )を求める。制御電流値i2 は図5,図6に
示す制御装置30から第1方向切換弁23の操作部23
a及び操作部23bへの指令信号i01,i02に相当す
る。制御電流値i3 は図5,図6に示す制御装置30か
ら第2方向切換弁24の操作部24a及び操作部24b
への指令信号i03,i04に相当する。制御電流値i4 は
図5,図6に示す制御装置30から第4方向切換弁26
の操作部26a及び操作部26bへの指令信号i07,i
08に相当する。この演算された制御電流値i2,i3,i4
により、S47にて第1,第2及び第4方向切換弁2
3,24,26に指令出力する。S48にて自動切換ス
イッチ31のオンかを判定しており、YESのときはS
38に戻り、NOのときはエンドとなる。
置における第2の制御フローチャートを図10,図11
に基づいて説明する。S30にてアーム対地角γ,作業
対象物に対して作業開始となるアーム制御ポイントe,
直線移動Z1 またはZ2 制御方向を図5に示す設定器3
2により入力する。S31にて図5に示す自動切換スイ
ッチ31のオンかを判定しており、NOのときはS30
に戻り、YESのときは、S32にて第1ブーム角θ1,
第2ブーム角θ2,オフセット角θ3,アーム角θ4,旋回角
θR を検出する。S33にてアーム制御ポイントeの各
軸Xa0, Ya0, Za0, γa0の初期値の座標を計算する。
S34にて直線移動Z1 またはZ2 制御方向の旋回速度
dθR /dtを算出する。S35にて図3(a)に示す
基準座標X0 を前記(13)式により、 X0 =Rorg ×cosθorg を算出する。S36にて旋回用方向切換弁28の開口量
C4 は、基準座標X0 、制御装置30に記憶されている
所定関数f1 により、C4 =f1 (X0 )を求める。こ
の旋回用方向切換弁28の制御電流値i5 は、制御装置
30に記憶されている所定関数fA により、 i5 =fA (C1 ) を求める。制御電流値i5 は図5,図6に示す制御装置
30から旋回用方向切換弁28の操作部28a及び操作
部28bへの指令信号i11,i12に相当する。この演算
された制御電流値i5 により、S37にて旋回用方向切
換弁28に指令出力する。この旋回用方向切換弁28に
指令出力された後に、S38にて第1ブーム角θ1,第2
ブーム角θ2,オフセット角θ3,アーム角θ4 を検出す
る。S39にて図1に示す、アーム制御ポイントe〜e
1 に直線移動中の各軸Xa1, Ya1, Za1, γa の座標を
計算する。S40にて旋回中心R0 とアーム制御ポイン
トe2 との距離X0(θR)を前記(14)式により、 X0(θR)=R (θR)×cos{θ(θR)} を算出する。S41にてアーム制御ポイントe〜e1 の
直線移動中の前記距離X0(θR),各軸Ya1, γa1の座標
と基準座標X0,各軸Ya0, γa0の初期値との偏差ΔX,
ΔY,Δγを求める。 ΔX=X0(θR)−X0 ,ΔY=Ya1−Ya0,Δγ=γa
−γa0 S42にて偏差値ΔXは限界誤差ΔXe に対して|ΔX
|≦ΔXe か判定し、また偏差値ΔYは限界誤差ΔYe
に対して|ΔY|≦ΔYe か判定し、さらに偏差値Δγ
は限界誤差Δγe に対して|Δγ|≦Δγe か判定して
おり、この3つの判定結果がYESのときはS38に戻
り、この3つの判定結果のうち1つでもNOのときはS
43にて各目標速度dX /dt,dY /dt,dγ/d
tを算出する。S44にて各目標角速度dθ1 /dt,
dθ2 /dt,dθ4 /dtを算出する。S45にて第
1,第2及び第4方向切換弁23,24,26の開口量
C1 ,C2 ,C3 は、目標角速度dθ1 /dt,dθ2
/dt,dθ4 /dt, 制御装置30に記憶されている
所定関数f1 により、C1 =f1 (dθ1 /dt),C
2 =f1 (dθ2 /dt),C3 =f1 (dθ4 /d
t)を求める。次に、S45にて第1,第2及び第4方
向切換弁23,24,26の制御電流値i2,i3,i4
は、制御装置30に記憶されている所定関数fA によ
り、i2 =fA (C1 ),i3 =fA (C2 ),i4 =
fA (C3 )を求める。制御電流値i2 は図5,図6に
示す制御装置30から第1方向切換弁23の操作部23
a及び操作部23bへの指令信号i01,i02に相当す
る。制御電流値i3 は図5,図6に示す制御装置30か
ら第2方向切換弁24の操作部24a及び操作部24b
への指令信号i03,i04に相当する。制御電流値i4 は
図5,図6に示す制御装置30から第4方向切換弁26
の操作部26a及び操作部26bへの指令信号i07,i
08に相当する。この演算された制御電流値i2,i3,i4
により、S47にて第1,第2及び第4方向切換弁2
3,24,26に指令出力する。S48にて自動切換ス
イッチ31のオンかを判定しており、YESのときはS
38に戻り、NOのときはエンドとなる。
【0033】本発明に係る建設機械の作業機直線制御装
置における第3の制御フローチャートを図12乃至図1
5に基づいて説明する。S60にてアーム対地角γ,作
業対象物に対して作業開始となるアーム制御ポイント
e,直線移動Z1 またはZ2 制御方向を図5に示す設定
器32により入力する。S61にて図5に示す自動切換
スイッチ31のオンかを判定しており、NOのときはS
60に戻り、YESのときは、S62にて第1ブーム角
θ1,第2ブーム角θ2,オフセット角θ3,アーム角θ4,旋
回角θR を検出する。S63にてアーム制御ポイントe
の各軸Xa0, Ya0, Za0, γa0の初期値の座標を計算す
る。S64にて直線移動Z1 またはZ2 制御方向の速度
dz/dtを算出する。S65にてオフセットブームの
角速度dθ3 /dtを算出する。S66にて第3方向切
換弁の開口量C1 ,角速度dθ3 /dt, 制御装置30
に記憶されている所定関数f1 により、 C1 =f1 (dθ1 /dt) を求める。次に、S67にて第3方向切換弁25の制御
電流値i1 は、制御装置30に記憶されている所定関数
fA により、 i1 =fA (C1 ) を求める。制御電流値i1 は図5,図6に示す制御装置
30から第3方向切換弁25の操作部25a及び操作部
25bへの指令信号i05,i06に相当する。この演算さ
れた制御電流値i1 により、S68にて第3方向切換弁
25に指令出力する。この第3方向切換弁25に指令出
力された後に、S69にて第1ブーム角θ1,第2ブーム
角θ2,オフセット角θ3,アーム角θ4 を検出する。S7
0にて図1に示す、アーム制御ポイントe〜e1 に直線
移動中の各軸Xa1, Ya1, Za1, γa の座標を計算す
る。S71にてアーム制御ポイントe〜e1 の直線移動
中の各軸Xa1, Ya1, Za1, γa1の座標と各軸Xa0, Y
a0, γa0の初期値との偏差ΔX,ΔY,Δγを求める。
ΔX=Xa1−Xa0,ΔY=Ya1−Ya0,Δγ=γa−γ
a0 S72にて偏差値ΔXは限界誤差ΔXe に対して|ΔX
|≦ΔXe か判定し、また偏差値ΔYは限界誤差ΔYe
に対して|ΔY|≦ΔYe か判定し、さらに偏差値Δγ
は限界誤差Δγe に対して|Δγ|≦Δγe か判定して
おり、この3つの判定結果がYESのときはS69に戻
り、この3つの判定結果のうち1つでもNOのときはS
73にて各目標速度dX /dt,dY /dt,dγ/d
tを算出する。S74にて各目標角速度dθ1 /dt,
dθ4 /dt,dθ2 /dt=一定、を算出する。S7
5にて第1,第2及び第4方向切換弁23,24,26
の開口量C1 ,C2 ,C3 は、目標角速度dθ1 /d
t,dθ4 /dt,dθ2 /dt, 制御装置30に記憶
されている所定関数f1 により、C1 =f1 (dθ1 /
dt),C2 =f1 (dθ4 /dt),C3 =f1 (d
θ2 /dt)を求める。次に、S76にて第1,第2及
び第4方向切換弁23,24,26の制御電流値i2,i
3,i4 は、制御装置30に記憶されている所定関数fA
により、i2 =fA (C1 ),i3 =fA (C2 ),i
4 =fA (C3 )を求める。制御電流値i2 は図5,図
6に示す制御装置30から第1方向切換弁23の操作部
23a及び操作部23bへの指令信号i01,i02に相当
する。制御電流値i3 は図5,図6に示す制御装置30
から第4方向切換弁26の操作部26a及び操作部26
bへの指令信号i07,i08に相当する。制御電流値i4
は図5,図6に示す制御装置30から第2方向切換弁2
4の操作部24a及び操作部24bへの指令信号i03,
i04に相当する。この演算された制御電流値i2,i3,i
4 により、S77にて第1,第4及び第2方向切換弁2
3,24,26に指令出力する。S78にて第1ブーム
角θ1,第2ブーム角θ2,オフセット角θ3,アーム角θ4,
旋回角θR を検出する。S79にてオフセットブーム作
動限界かを判定しており、NOのときはS69に戻り、
YESのときはS80に移り、S80にてアーム制御ポ
イントeの各軸Xa0, Ya0, γa0の初期値の座標計算、
旋回角θR の初期値をメモリーする。S81にて直線移
動Z1 またはZ2 制御方向の旋回速度dθR /dtを算
出する。S82にて図3に示す基準座標X0 を前記(1
3)式により、 X0 =Rorg ×cosθorg を算出する。S83にて旋回用方向切換弁の開口量C4
,基準座標X0,制御装置30に記憶されている所定関
数f1 により、C4 =f1 (X0 )を求めて、旋回用方
向切換弁28の制御電流値i5 は、制御装置30に記憶
されている所定関数fA により、i5 =fA (C4 )を
求める。制御電流値i4 は図5,図6に示す制御装置3
0から旋回用方向切換弁28の操作部28a及び操作部
28bへの指令信号i11,i12に相当する。この演算さ
れた制御電流値i5 により、S84にて旋回用方向切換
弁28に指令出力する。S85にて第1ブーム角θ1,第
2ブーム角θ2,オフセット角θ3,アーム角θ4,旋回角θ
R を検出する。S86にて図1に示す、アーム制御ポイ
ントe〜e1 に直線移動中の各軸Xa1, Ya1, Za1, γ
a の座標を計算する。S87にて旋回中心R0 とアーム
制御ポイントe2 との距離X0(θR)を前記(14)式に
より、 X0(θR)=R (θR)×cos{θ(θR)} を算出する。S88にてアーム制御ポイントe〜e1 の
直線移動中の前記距離X0(θR),各軸Ya1, γa1の座標
と基準座標X0,各軸Ya0, γa0の初期値との偏差ΔX,
ΔY,Δγを求める。 ΔX=X0(θR)−X0 ,ΔY=Ya1−Ya0,Δγ=γa
−γa0 S89にて偏差値ΔXは限界誤差ΔXe に対して|ΔX
|≦ΔXe か判定し、また偏差値ΔYは限界誤差ΔYe
に対して|ΔY|≦ΔYe か判定し、さらに偏差値Δγ
は限界誤差Δγe に対して|Δγ|≦Δγe か判定して
おり、この3つの判定結果がYESのときはS85に戻
り、この3つの判定結果のうち1つでもNOのときはS
90にて各目標速度dX /dt,dY /dt,dγ/d
tを算出する。S91にて各目標角速度dθ1 /dt,
dθ2 /dt,dθ4 /dtを算出する。S92にて第
1,第2及び第4方向切換弁23,24,26の開口量
C1 ,C2 ,C3 は、目標角速度dθ1 /dt,dθ2
/dt,dθ4 /dt, 制御装置30に記憶されている
所定関数f1 により、C1 =f1 (dθ1 /dt),C
2 =f1 (dθ2 /dt),C3 =f1 (dθ4 /d
t)を求める。次に、S93にて第1,第2及び第4方
向切換弁23,24,26の制御電流値i2,i3,i4
は、制御装置30に記憶されている所定関数fA によ
り、i2 =fA (C1 ),i3 =fA (C2 ),i4 =
fA (C3 )を求める。制御電流値i2 は図5,図6に
示す制御装置30から第1方向切換弁23の操作部23
a及び操作部23bへの指令信号i01,i02に相当す
る。制御電流値i3 は図5,図6に示す制御装置30か
ら第2方向切換弁24の操作部24a及び操作部24b
への指令信号i03,i04に相当する。制御電流値i4 は
図5、図6に示す制御装置30から第4方向切換弁26
の操作部26a及び操作部26bへの指令信号i07,i
08に相当する。この演算された制御電流値i2,i3,i4
により、S94にて第1,第2及び第4方向切換弁2
3,24,26に指令出力する。S95にて自動切換ス
イッチ31のオンかを判定しており、YESのときはS
85に戻り、NOのときはエンドとなる。
置における第3の制御フローチャートを図12乃至図1
5に基づいて説明する。S60にてアーム対地角γ,作
業対象物に対して作業開始となるアーム制御ポイント
e,直線移動Z1 またはZ2 制御方向を図5に示す設定
器32により入力する。S61にて図5に示す自動切換
スイッチ31のオンかを判定しており、NOのときはS
60に戻り、YESのときは、S62にて第1ブーム角
θ1,第2ブーム角θ2,オフセット角θ3,アーム角θ4,旋
回角θR を検出する。S63にてアーム制御ポイントe
の各軸Xa0, Ya0, Za0, γa0の初期値の座標を計算す
る。S64にて直線移動Z1 またはZ2 制御方向の速度
dz/dtを算出する。S65にてオフセットブームの
角速度dθ3 /dtを算出する。S66にて第3方向切
換弁の開口量C1 ,角速度dθ3 /dt, 制御装置30
に記憶されている所定関数f1 により、 C1 =f1 (dθ1 /dt) を求める。次に、S67にて第3方向切換弁25の制御
電流値i1 は、制御装置30に記憶されている所定関数
fA により、 i1 =fA (C1 ) を求める。制御電流値i1 は図5,図6に示す制御装置
30から第3方向切換弁25の操作部25a及び操作部
25bへの指令信号i05,i06に相当する。この演算さ
れた制御電流値i1 により、S68にて第3方向切換弁
25に指令出力する。この第3方向切換弁25に指令出
力された後に、S69にて第1ブーム角θ1,第2ブーム
角θ2,オフセット角θ3,アーム角θ4 を検出する。S7
0にて図1に示す、アーム制御ポイントe〜e1 に直線
移動中の各軸Xa1, Ya1, Za1, γa の座標を計算す
る。S71にてアーム制御ポイントe〜e1 の直線移動
中の各軸Xa1, Ya1, Za1, γa1の座標と各軸Xa0, Y
a0, γa0の初期値との偏差ΔX,ΔY,Δγを求める。
ΔX=Xa1−Xa0,ΔY=Ya1−Ya0,Δγ=γa−γ
a0 S72にて偏差値ΔXは限界誤差ΔXe に対して|ΔX
|≦ΔXe か判定し、また偏差値ΔYは限界誤差ΔYe
に対して|ΔY|≦ΔYe か判定し、さらに偏差値Δγ
は限界誤差Δγe に対して|Δγ|≦Δγe か判定して
おり、この3つの判定結果がYESのときはS69に戻
り、この3つの判定結果のうち1つでもNOのときはS
73にて各目標速度dX /dt,dY /dt,dγ/d
tを算出する。S74にて各目標角速度dθ1 /dt,
dθ4 /dt,dθ2 /dt=一定、を算出する。S7
5にて第1,第2及び第4方向切換弁23,24,26
の開口量C1 ,C2 ,C3 は、目標角速度dθ1 /d
t,dθ4 /dt,dθ2 /dt, 制御装置30に記憶
されている所定関数f1 により、C1 =f1 (dθ1 /
dt),C2 =f1 (dθ4 /dt),C3 =f1 (d
θ2 /dt)を求める。次に、S76にて第1,第2及
び第4方向切換弁23,24,26の制御電流値i2,i
3,i4 は、制御装置30に記憶されている所定関数fA
により、i2 =fA (C1 ),i3 =fA (C2 ),i
4 =fA (C3 )を求める。制御電流値i2 は図5,図
6に示す制御装置30から第1方向切換弁23の操作部
23a及び操作部23bへの指令信号i01,i02に相当
する。制御電流値i3 は図5,図6に示す制御装置30
から第4方向切換弁26の操作部26a及び操作部26
bへの指令信号i07,i08に相当する。制御電流値i4
は図5,図6に示す制御装置30から第2方向切換弁2
4の操作部24a及び操作部24bへの指令信号i03,
i04に相当する。この演算された制御電流値i2,i3,i
4 により、S77にて第1,第4及び第2方向切換弁2
3,24,26に指令出力する。S78にて第1ブーム
角θ1,第2ブーム角θ2,オフセット角θ3,アーム角θ4,
旋回角θR を検出する。S79にてオフセットブーム作
動限界かを判定しており、NOのときはS69に戻り、
YESのときはS80に移り、S80にてアーム制御ポ
イントeの各軸Xa0, Ya0, γa0の初期値の座標計算、
旋回角θR の初期値をメモリーする。S81にて直線移
動Z1 またはZ2 制御方向の旋回速度dθR /dtを算
出する。S82にて図3に示す基準座標X0 を前記(1
3)式により、 X0 =Rorg ×cosθorg を算出する。S83にて旋回用方向切換弁の開口量C4
,基準座標X0,制御装置30に記憶されている所定関
数f1 により、C4 =f1 (X0 )を求めて、旋回用方
向切換弁28の制御電流値i5 は、制御装置30に記憶
されている所定関数fA により、i5 =fA (C4 )を
求める。制御電流値i4 は図5,図6に示す制御装置3
0から旋回用方向切換弁28の操作部28a及び操作部
28bへの指令信号i11,i12に相当する。この演算さ
れた制御電流値i5 により、S84にて旋回用方向切換
弁28に指令出力する。S85にて第1ブーム角θ1,第
2ブーム角θ2,オフセット角θ3,アーム角θ4,旋回角θ
R を検出する。S86にて図1に示す、アーム制御ポイ
ントe〜e1 に直線移動中の各軸Xa1, Ya1, Za1, γ
a の座標を計算する。S87にて旋回中心R0 とアーム
制御ポイントe2 との距離X0(θR)を前記(14)式に
より、 X0(θR)=R (θR)×cos{θ(θR)} を算出する。S88にてアーム制御ポイントe〜e1 の
直線移動中の前記距離X0(θR),各軸Ya1, γa1の座標
と基準座標X0,各軸Ya0, γa0の初期値との偏差ΔX,
ΔY,Δγを求める。 ΔX=X0(θR)−X0 ,ΔY=Ya1−Ya0,Δγ=γa
−γa0 S89にて偏差値ΔXは限界誤差ΔXe に対して|ΔX
|≦ΔXe か判定し、また偏差値ΔYは限界誤差ΔYe
に対して|ΔY|≦ΔYe か判定し、さらに偏差値Δγ
は限界誤差Δγe に対して|Δγ|≦Δγe か判定して
おり、この3つの判定結果がYESのときはS85に戻
り、この3つの判定結果のうち1つでもNOのときはS
90にて各目標速度dX /dt,dY /dt,dγ/d
tを算出する。S91にて各目標角速度dθ1 /dt,
dθ2 /dt,dθ4 /dtを算出する。S92にて第
1,第2及び第4方向切換弁23,24,26の開口量
C1 ,C2 ,C3 は、目標角速度dθ1 /dt,dθ2
/dt,dθ4 /dt, 制御装置30に記憶されている
所定関数f1 により、C1 =f1 (dθ1 /dt),C
2 =f1 (dθ2 /dt),C3 =f1 (dθ4 /d
t)を求める。次に、S93にて第1,第2及び第4方
向切換弁23,24,26の制御電流値i2,i3,i4
は、制御装置30に記憶されている所定関数fA によ
り、i2 =fA (C1 ),i3 =fA (C2 ),i4 =
fA (C3 )を求める。制御電流値i2 は図5,図6に
示す制御装置30から第1方向切換弁23の操作部23
a及び操作部23bへの指令信号i01,i02に相当す
る。制御電流値i3 は図5,図6に示す制御装置30か
ら第2方向切換弁24の操作部24a及び操作部24b
への指令信号i03,i04に相当する。制御電流値i4 は
図5、図6に示す制御装置30から第4方向切換弁26
の操作部26a及び操作部26bへの指令信号i07,i
08に相当する。この演算された制御電流値i2,i3,i4
により、S94にて第1,第2及び第4方向切換弁2
3,24,26に指令出力する。S95にて自動切換ス
イッチ31のオンかを判定しており、YESのときはS
85に戻り、NOのときはエンドとなる。
【0034】本発明に係る建設機械の作業機直線制御装
置における第4の制御フローチャートを図16乃至図1
8に基づいて説明する。S100にてアーム対地角γ,
作業対象物に対して作業開始となるアーム制御ポイント
e,直線移動Z1 またはZ2 制御方向を図5に示す設定
器32により入力する。S101にて図5に示す自動切
換スイッチ31のオンかを判定しており、NOのときは
S100に戻り、YESのときは、S102にて第1ブ
ーム角θ1,第2ブーム角θ2,オフセット角θ3,アーム角
θ4,旋回角θR を検出する。S103にてアーム制御ポ
イントeの各軸Xa0, Ya0, Za0, γa0の初期値の座標
を計算する。S104にて直線移動Z1 またはZ2 制御
方向の速度dz/dtを算出する。S105にてオフセ
ットブームの角速度dθ3 /dtを算出する。S106
にて第3方向切換弁の開口量C1 ,角速度dθ3 /d
t, 制御装置30に記憶されている所定関数f1 によ
り、C1 =f1 (dθ1 /dt)を求める。次に、S1
07にて第3方向切換弁25の制御電流値i1 は、制御
装置30に記憶されている所定関数fA により、i1 =
fA (C1 )を求める。制御電流値i1 は図5,図6に
示す制御装置30から第3方向切換弁25の操作部25
a及び操作部25bへの指令信号i05,i06に相当す
る。この演算された制御電流値i1 により、S108に
て第3方向切換弁25に指令出力する。S109にて第
1ブーム角θ1,第2ブーム角θ2,オフセット角θ3,アー
ム角θ4,旋回角θR を検出する。S110にて図3
(b)に示すZ方向の距離Za1を算出する。S111に
てZa1,旋回中心R0 からブームフート5aまでの距離
LZB0 ,限界誤差LZ が、|Za1−LZB0 |≦ΔLZ か
判定しており、|Za1−LZB0 |がΔLZ より大きいと
きはS112に移り、S112にてアーム制御ポイント
e〜e1 の直線移動中の各軸Xa1, Ya1, Za1, γa の
座標計算する。S113にて各軸Xa1, Ya1, Za1, γ
a1と各軸Xa0, Ya0, γa0の初期値との偏差ΔX,Δ
Y,Δγを求める。 ΔX=Xa1−Xa0,ΔY=Ya1−Ya0,Δγ=γa−γ
a0 S114にて偏差値ΔXは限界誤差ΔXe に対して|Δ
X|≦ΔXe か判定し、また偏差値ΔYは限界誤差ΔY
e に対して|ΔY|≦ΔYe か判定し、さらに偏差値Δ
γは限界誤差Δγe に対して|Δγ|≦Δγe か判定し
ており、この3つの判定結果がYESのときはS109
に戻り、この3つの判定結果のうち1つでもNOのとき
はS115にて各目標速度dX /dt,dY /dt,d
γ/dtを算出する。S116にて各目標角速度dθ1
/dt,dθ4 /dt,dθ2 /dt=一定、を算出す
る。S117にて第1,第2及び第4方向切換弁23,
24,26の開口量C1 ,C2 ,C3 は、目標角速度d
θ1 /dt,dθ4 /dt,dθ2 /dt, 制御装置3
0に記憶されている所定関数f1 により、C1 =f1
(dθ1 /dt),C2 =f1 (dθ4 /dt),C3
=f1 (dθ2 /dt)を求める。次に、S118にて
第1,第2及び第4方向切換弁23,24,26の制御
電流値i2,i3,i4 は、制御装置30に記憶されている
所定関数fA により、i2 =fA (C1 ),i3 =fA
(C2 ),i4 =fA (C3 )を求める。制御電流値i
2 は図5,図6に示す制御装置30から第1方向切換弁
23の操作部23a及び操作部23bへの指令信号i0
1,i02に相当する。制御電流値i3 は図5,図6に示
す制御装置30から第4方向切換弁26の操作部26a
及び操作部26bへの指令信号i07,i08に相当する。
制御電流値i4 は図5,図6に示す制御装置30から第
2方向切換弁24の操作部24a及び操作部24bへの
指令信号i03,i04に相当する。この演算された制御電
流値i2,i3,i4 により、S119にて第1,第4及び
第2方向切換弁23,24,26に指令出力する。S1
20にて自動切換スイッチ31のオンかを判定してお
り、YESのときはS109に戻り、NOのときはエン
ドとなる。前記S111にて|Za1−LZB0 |がΔLZ
より小さいか又は同一のときはS121にてアーム制御
ポイントeの各軸Xa0, Ya0, Za0, γa0の初期値の座
標を計算する。S122にて旋回速度dθR /dtを算
出する。S123にて図4に示す基準座標X0 を求め
る。ROrg =LXB0 +Xa0,θOrg =0,X0 =Rorg
を算出する。S124にて旋回用方向切換弁28の開口
量C4 は、基準座標X0 、制御装置30に記憶されてい
る所定関数f1 により、C4 =f1 (X0 )を求めて、
この旋回用方向切換弁28の制御電流値i5は、制御装
置30に記憶されている所定関数fA により、i5 =f
A (C1 )を求める。制御電流値i5 は図5,図6に示
す制御装置30から旋回用方向切換弁28の操作部28
a及び操作部28bへの指令信号i11,i12に相当す
る。この演算された制御電流値i5 により、S125に
て旋回用方向切換弁28に指令出力する。この旋回用方
向切換弁28に指令出力された後に、S126にて第1
ブーム角θ1,第2ブーム角θ2,オフセット角θ3,アーム
角θ4,旋回角θR を検出する。S127にてアーム制御
ポイントe1 の直線移動中の各軸Xa1, Ya1,γa の座
標計算する。S128にて図3(b)に示す旋回中心R
0 とアーム制御ポイントe1 との距離R(θR ), R
(θR )=Xa +LXB0 を計算し、旋回後の基準座標X
1(θR),X1(θR)=R(θR )×cos(θR −θR0)
を算出する。S129アーム制御ポイントe1 の直線移
動中の前記距離X1(θR),各軸Ya1, γa の座標と基準
座標X0,各軸Ya0, γa0の初期値との偏差ΔX,ΔY,
Δγを求める。 ΔXA =X1(θR)−X0 ,ΔYA =Ya1−Ya0,Δγ=
γa −γa0 S130にて偏差値ΔXは限界誤差ΔXe に対して|Δ
X|≦ΔXe か判定し、また偏差値ΔYは限界誤差ΔY
e に対して|ΔY|≦ΔYe か判定し、さらに偏差値Δ
γは限界誤差Δγe に対して|Δγ|≦Δγe か判定し
ており、この3つの判定結果がYESのときはS125
に戻り、この3つの判定結果のうち1つでもNOのとき
はS131にて各目標速度dXA/dt,dYA/dt,d
γ/dtを算出する。S132にて各目標角速度dθ1
/dt,dθ2 /dt,dθ4 /dtを算出する。S1
33にて第1,第2及び第4方向切換弁23,24,2
6の開口量C1 ,C2 ,C3 は、目標角速度dθ1 /d
t,dθ2 /dt,dθ4 /dt, 制御装置30に記憶
されている所定関数f1 により、C1 =f1 (dθ1 /
dt),C2 =f1 (dθ2 /dt),C3 =f1 (d
θ4 /dt)を求める。次に、S134にて第1,第2
及び第4方向切換弁23,24,26の制御電流値i2,
i3,i4 は、制御装置30に記憶されている所定関数f
A により、i2 =fA (C1 ),i3 =fA (C2 ),
i4 =fA (C3 )を求める。制御電流値i2 は図5,
図6に示す制御装置30から第1方向切換弁23の操作
部23a及び操作部23bへの指令信号i01,i02に相
当する。制御電流値i3 は図5,図6に示す制御装置3
0から第2方向切換弁24の操作部24a及び操作部2
4bへの指令信号i03,i04に相当する。制御電流値i
4 は図5,図6に示す制御装置30から第4方向切換弁
26の操作部26a及び操作部26bへの指令信号i0
7,i08に相当する。この演算された制御電流値i2,i
3,i4 により、S135にて第1,第2及び第4方向切
換弁23,24,26に指令出力する。S136にて自
動切換スイッチ31のオンかを判定しており、YESの
ときはS125に戻り、NOのときはエンドとなる。
置における第4の制御フローチャートを図16乃至図1
8に基づいて説明する。S100にてアーム対地角γ,
作業対象物に対して作業開始となるアーム制御ポイント
e,直線移動Z1 またはZ2 制御方向を図5に示す設定
器32により入力する。S101にて図5に示す自動切
換スイッチ31のオンかを判定しており、NOのときは
S100に戻り、YESのときは、S102にて第1ブ
ーム角θ1,第2ブーム角θ2,オフセット角θ3,アーム角
θ4,旋回角θR を検出する。S103にてアーム制御ポ
イントeの各軸Xa0, Ya0, Za0, γa0の初期値の座標
を計算する。S104にて直線移動Z1 またはZ2 制御
方向の速度dz/dtを算出する。S105にてオフセ
ットブームの角速度dθ3 /dtを算出する。S106
にて第3方向切換弁の開口量C1 ,角速度dθ3 /d
t, 制御装置30に記憶されている所定関数f1 によ
り、C1 =f1 (dθ1 /dt)を求める。次に、S1
07にて第3方向切換弁25の制御電流値i1 は、制御
装置30に記憶されている所定関数fA により、i1 =
fA (C1 )を求める。制御電流値i1 は図5,図6に
示す制御装置30から第3方向切換弁25の操作部25
a及び操作部25bへの指令信号i05,i06に相当す
る。この演算された制御電流値i1 により、S108に
て第3方向切換弁25に指令出力する。S109にて第
1ブーム角θ1,第2ブーム角θ2,オフセット角θ3,アー
ム角θ4,旋回角θR を検出する。S110にて図3
(b)に示すZ方向の距離Za1を算出する。S111に
てZa1,旋回中心R0 からブームフート5aまでの距離
LZB0 ,限界誤差LZ が、|Za1−LZB0 |≦ΔLZ か
判定しており、|Za1−LZB0 |がΔLZ より大きいと
きはS112に移り、S112にてアーム制御ポイント
e〜e1 の直線移動中の各軸Xa1, Ya1, Za1, γa の
座標計算する。S113にて各軸Xa1, Ya1, Za1, γ
a1と各軸Xa0, Ya0, γa0の初期値との偏差ΔX,Δ
Y,Δγを求める。 ΔX=Xa1−Xa0,ΔY=Ya1−Ya0,Δγ=γa−γ
a0 S114にて偏差値ΔXは限界誤差ΔXe に対して|Δ
X|≦ΔXe か判定し、また偏差値ΔYは限界誤差ΔY
e に対して|ΔY|≦ΔYe か判定し、さらに偏差値Δ
γは限界誤差Δγe に対して|Δγ|≦Δγe か判定し
ており、この3つの判定結果がYESのときはS109
に戻り、この3つの判定結果のうち1つでもNOのとき
はS115にて各目標速度dX /dt,dY /dt,d
γ/dtを算出する。S116にて各目標角速度dθ1
/dt,dθ4 /dt,dθ2 /dt=一定、を算出す
る。S117にて第1,第2及び第4方向切換弁23,
24,26の開口量C1 ,C2 ,C3 は、目標角速度d
θ1 /dt,dθ4 /dt,dθ2 /dt, 制御装置3
0に記憶されている所定関数f1 により、C1 =f1
(dθ1 /dt),C2 =f1 (dθ4 /dt),C3
=f1 (dθ2 /dt)を求める。次に、S118にて
第1,第2及び第4方向切換弁23,24,26の制御
電流値i2,i3,i4 は、制御装置30に記憶されている
所定関数fA により、i2 =fA (C1 ),i3 =fA
(C2 ),i4 =fA (C3 )を求める。制御電流値i
2 は図5,図6に示す制御装置30から第1方向切換弁
23の操作部23a及び操作部23bへの指令信号i0
1,i02に相当する。制御電流値i3 は図5,図6に示
す制御装置30から第4方向切換弁26の操作部26a
及び操作部26bへの指令信号i07,i08に相当する。
制御電流値i4 は図5,図6に示す制御装置30から第
2方向切換弁24の操作部24a及び操作部24bへの
指令信号i03,i04に相当する。この演算された制御電
流値i2,i3,i4 により、S119にて第1,第4及び
第2方向切換弁23,24,26に指令出力する。S1
20にて自動切換スイッチ31のオンかを判定してお
り、YESのときはS109に戻り、NOのときはエン
ドとなる。前記S111にて|Za1−LZB0 |がΔLZ
より小さいか又は同一のときはS121にてアーム制御
ポイントeの各軸Xa0, Ya0, Za0, γa0の初期値の座
標を計算する。S122にて旋回速度dθR /dtを算
出する。S123にて図4に示す基準座標X0 を求め
る。ROrg =LXB0 +Xa0,θOrg =0,X0 =Rorg
を算出する。S124にて旋回用方向切換弁28の開口
量C4 は、基準座標X0 、制御装置30に記憶されてい
る所定関数f1 により、C4 =f1 (X0 )を求めて、
この旋回用方向切換弁28の制御電流値i5は、制御装
置30に記憶されている所定関数fA により、i5 =f
A (C1 )を求める。制御電流値i5 は図5,図6に示
す制御装置30から旋回用方向切換弁28の操作部28
a及び操作部28bへの指令信号i11,i12に相当す
る。この演算された制御電流値i5 により、S125に
て旋回用方向切換弁28に指令出力する。この旋回用方
向切換弁28に指令出力された後に、S126にて第1
ブーム角θ1,第2ブーム角θ2,オフセット角θ3,アーム
角θ4,旋回角θR を検出する。S127にてアーム制御
ポイントe1 の直線移動中の各軸Xa1, Ya1,γa の座
標計算する。S128にて図3(b)に示す旋回中心R
0 とアーム制御ポイントe1 との距離R(θR ), R
(θR )=Xa +LXB0 を計算し、旋回後の基準座標X
1(θR),X1(θR)=R(θR )×cos(θR −θR0)
を算出する。S129アーム制御ポイントe1 の直線移
動中の前記距離X1(θR),各軸Ya1, γa の座標と基準
座標X0,各軸Ya0, γa0の初期値との偏差ΔX,ΔY,
Δγを求める。 ΔXA =X1(θR)−X0 ,ΔYA =Ya1−Ya0,Δγ=
γa −γa0 S130にて偏差値ΔXは限界誤差ΔXe に対して|Δ
X|≦ΔXe か判定し、また偏差値ΔYは限界誤差ΔY
e に対して|ΔY|≦ΔYe か判定し、さらに偏差値Δ
γは限界誤差Δγe に対して|Δγ|≦Δγe か判定し
ており、この3つの判定結果がYESのときはS125
に戻り、この3つの判定結果のうち1つでもNOのとき
はS131にて各目標速度dXA/dt,dYA/dt,d
γ/dtを算出する。S132にて各目標角速度dθ1
/dt,dθ2 /dt,dθ4 /dtを算出する。S1
33にて第1,第2及び第4方向切換弁23,24,2
6の開口量C1 ,C2 ,C3 は、目標角速度dθ1 /d
t,dθ2 /dt,dθ4 /dt, 制御装置30に記憶
されている所定関数f1 により、C1 =f1 (dθ1 /
dt),C2 =f1 (dθ2 /dt),C3 =f1 (d
θ4 /dt)を求める。次に、S134にて第1,第2
及び第4方向切換弁23,24,26の制御電流値i2,
i3,i4 は、制御装置30に記憶されている所定関数f
A により、i2 =fA (C1 ),i3 =fA (C2 ),
i4 =fA (C3 )を求める。制御電流値i2 は図5,
図6に示す制御装置30から第1方向切換弁23の操作
部23a及び操作部23bへの指令信号i01,i02に相
当する。制御電流値i3 は図5,図6に示す制御装置3
0から第2方向切換弁24の操作部24a及び操作部2
4bへの指令信号i03,i04に相当する。制御電流値i
4 は図5,図6に示す制御装置30から第4方向切換弁
26の操作部26a及び操作部26bへの指令信号i0
7,i08に相当する。この演算された制御電流値i2,i
3,i4 により、S135にて第1,第2及び第4方向切
換弁23,24,26に指令出力する。S136にて自
動切換スイッチ31のオンかを判定しており、YESの
ときはS125に戻り、NOのときはエンドとなる。
【0035】本願発明は建設機械の作業機を横方向の直
線制御を自動的に制御することにより作業性が向上し、
未熟練オペレータでも運転操作が容易となり、建設機械
として有用である。尚、一実施例としてオフセット式作
業機として説明したが、標準仕様のブーム、アーム及び
バケットを装着する作業機に適用できることは言うまで
もない。
線制御を自動的に制御することにより作業性が向上し、
未熟練オペレータでも運転操作が容易となり、建設機械
として有用である。尚、一実施例としてオフセット式作
業機として説明したが、標準仕様のブーム、アーム及び
バケットを装着する作業機に適用できることは言うまで
もない。
【図1】本発明の作業機の各軸X,Y,Z方向の座標図
である。
である。
【図2】同、作業機の横方向の直線制御を説明する図で
ある。
ある。
【図3】同、(a)は旋回開始による作業機の横方向の
直線制御を説明する図である。(b)は旋回後の作業機
の横方向の直線制御を説明する図である。
直線制御を説明する図である。(b)は旋回後の作業機
の横方向の直線制御を説明する図である。
【図4】同、旋回中心上のX軸上から作業機の横方向の
直線制御を開始させる説明図である。
直線制御を開始させる説明図である。
【図5】同、各センサと制御装置の説明図である。
【図6】同、制御回路の説明図である。
【図7】同、作業機の各ポイントの座標、アームの対地
角γの関数式の説明図である。
角γの関数式の説明図である。
【図8】同、第1制御フローチャートの説明図である。
【図9】同、図8の第1制御フローチャートのつづきの
説明図である。
説明図である。
【図10】同、第2制御フローチャートの説明図であ
る。
る。
【図11】同、図10の第2制御フローチャートのつづ
きの説明図である。
きの説明図である。
【図12】同、第3制御フローチャートの説明図であ
る。
る。
【図13】同、図12の第3制御フローチャートのつづ
きの説明図である。
きの説明図である。
【図14】同、図13の第3制御フローチャートのつづ
きの説明図である。
きの説明図である。
【図15】同、図14の第3制御フローチャートのつづ
きの説明図である。
きの説明図である。
【図16】同、第4制御フローチャートの説明図であ
る。
る。
【図17】同、図16の第4制御フローチャートのつづ
きの説明図である。
きの説明図である。
【図18】同、図17の第4制御フローチャートのつづ
きの説明図である。
きの説明図である。
【図19】オフセットブーム式作業機を備えた油圧ショ
ベルの側面図である。
ベルの側面図である。
【図20】図18のA視図である。
1…油圧ショベル、3…上部旋回体(車体)、5…第1
ブーム、6…第1アクチュエータ、7…第2ブーム、8
…第2アクチュエータ、9…ブラケット、10…オフセ
ット用アクチュエータ、11…オフセットブーム、12
…アーム、13…アーム用アクチュエータ、14…バケ
ット、17…第1検出手段、18…第2検出手段、16
…第3検出手段、19…第4検出手段、23…第1方向
切換弁、24…第2方向切換弁、25…第3方向切換
弁、26…第4方向切換弁、27…第5方向切換弁、3
0…制御装置、31…自動切換スイッチ、32…設定
器、40…旋回用アクチュエータ、41…旋回角セン
サ。
ブーム、6…第1アクチュエータ、7…第2ブーム、8
…第2アクチュエータ、9…ブラケット、10…オフセ
ット用アクチュエータ、11…オフセットブーム、12
…アーム、13…アーム用アクチュエータ、14…バケ
ット、17…第1検出手段、18…第2検出手段、16
…第3検出手段、19…第4検出手段、23…第1方向
切換弁、24…第2方向切換弁、25…第3方向切換
弁、26…第4方向切換弁、27…第5方向切換弁、3
0…制御装置、31…自動切換スイッチ、32…設定
器、40…旋回用アクチュエータ、41…旋回角セン
サ。
───────────────────────────────────────────────────── フロントページの続き (72)発明者 西村 和則 大阪府枚方市上野3−1−1 株式会社小 松製作所大阪工場内 (72)発明者 三宅 利彦 東京都港区赤坂2−3−6 株式会社小松 製作所本社内
Claims (7)
- 【請求項1】 車体より順次連結されるブーム、オフセ
ットブーム、アーム等の作業機部材と、アームに取着さ
れたバケット或いはブレーカ等の作業機と、この作業機
部材を揺動させる各アクチュエータとを備え、前記作業
機の先端を横方向に移動して作業対象物に対して直線制
御する建設機械の作業機直線制御方法であって、前記作
業機先端の横方向速度よりオフセットブームの角速度を
算出し、このオフセットブームの算出した角速度に対応
してオフセットブームを作動させて作業機先端を横方向
に直線制御し、この作業機先端の上下、横方向が所定値
に対して誤差が生じたときはブーム及び/或いはアーム
を駆動して補正し、作業機先端を横方向に移動して作業
対象物に対して直線制御することを特徴とする建設機械
の作業機直線制御方法。 - 【請求項2】 請求項1記載の建設機械の作業機直線制
御方法において、前記アームの対地角が所定値に対して
誤差が生じたときはブーム及び/或いはアームを駆動し
て補正し、作業機先端を横方向に移動して作業対象物に
対して直線制御することを特徴とする建設機械の作業機
直線制御方法。 - 【請求項3】 車体より順次連結されるブーム、オフセ
ットブーム、アーム等の作業機部材と、アームに取着さ
れたバケット或いはブレーカ等の作業機と、旋回可能な
車体と、この作業機部材の揺動、及び車体を旋回させる
各アクチュエータとを備え、前記作業機の先端を横方向
に移動して作業対象物に対して直線制御する建設機械の
作業機直線制御方法であって、車体の旋回中心から作業
機の先端までの基準座標を求めて、この基準座標に対応
して車体を旋回させて作業機先端を横方向に直線制御
し、この作業機先端の上下、横方向が所定値に対して誤
差が生じたときはブーム及び/或いはアームを駆動して
補正し、作業機先端を横方向に移動して作業対象物に対
して直線制御することを特徴とする建設機械の作業機直
線制御方法。 - 【請求項4】 車体より順次連結されるブーム、オフセ
ットブーム、アーム等の作業機部材と、アームに取着さ
れたバケット或いはブレーカ等の作業機と、旋回可能な
車体と、この作業機部材の揺動、及び車体を旋回させる
各アクチュエータとを備え、前記作業機の先端を横方向
に移動して作業対象物に対して直線制御する建設機械の
作業機直線制御方法であって、作業機先端の位置をオフ
セットブームにより横方向に移動し、移動中、或いは、
オフセットブームによる移動が限界値近傍で旋回中心か
ら横方向の移動距離を求め、その後に車体を旋回させて
作業機先端を横方向に移動して作業対象物に対して直線
制御することを特徴とする建設機械の作業機直線制御方
法。 - 【請求項5】 車体より順次連結されるブーム、オフセ
ットブーム、アーム等の作業機部材と、アームに取着さ
れたバケット或いはブレーカ等の作業機と、旋回可能な
車体と、この作業機部材の揺動、及び車体を旋回させる
各アクチュエータとを備え、前記作業機の先端を横方向
に移動して作業対象物に対して直線制御する建設機械の
作業機直線制御方法であって、初めに作業対象物に対す
る作業機先端位置を求めて、オフセットブームにより横
方向に移動し、オフセットブームが作動限界値近傍に到
達したら車体を旋回させて作業機先端を横方向に移動し
て作業対象物に対して直線制御することを特徴とする建
設機械の作業機直線制御方法。 - 【請求項6】 車体より順次連結される第1ブーム、第
2ブーム、オフセットブーム、アーム等の作業機部材
と、アームに取着されたバケット或いはブレーカ等の作
業機と、この作業機部材を揺動させる各アクチュエータ
へ圧油を供給する各方向切換弁とを備え、前記作業機の
先端を横方向に移動して作業対象物に対して直線制御す
る建設機械の作業機直線制御装置において、アーム対地
角γ、アーム制御ポイントe及び作業機先端を横方向の
直線Z1 或いはZ2 方向を設定する設定器(32)と、前記
作業機部材及び作業機を自動制御に切換える自動切換ス
イッチ(31)と、前記第1ブーム角θ1 を検出する第1検
出手段(17)と、前記第2ブーム角θ2 を検出する第2検
出手段(18)と、オフセットブームのオフセット角θ3 を
検知する第3検出手段(16)と、前記アーム角θ4 を検出
する第4検出手段(19)とを有し、前記自動切換スイッチ
(31)をオン操作した後に、前記第1〜第4検出手段(16,
17,18,19) からの信号を受けて、前記作業機先端の横方
向速度よりオフセットブームの角速度を算出し、このオ
フセットブームの角速度に対応してオフセットブームを
作動させて作業機先端を横方向に直線制御し、この作業
機先端の上下、横方向が所定値に対して誤差が生じたと
きはブーム及び/或いはアームを作動して補正し、作業
機先端を横方向に移動して作業対象物に対して直線制御
するために各アクチュエータ(6,8,10,13) を駆動するよ
うに各方向切換弁(23,24,25,26) へ指令出力する制御装
置(30)を備えたことを特徴とする建設機械の作業機直線
制御装置。 - 【請求項7】 車体より順次連結される第1ブーム、第
2ブーム、オフセットブーム、アーム等の作業機部材
と、アームに取着されたバケット或いはブレーカ等の作
業機と、旋回可能な車体と、この作業機部材の揺動、及
び車体を旋回させる各アクチュエータとを備え、前記作
業機の先端を横方向に移動して作業対象物に対して直線
制御する建設機械の作業機直線制御装置において、アー
ム対地角γ、アーム制御ポイントe及び作業機先端を横
方向の直線Z1 或いはZ2 方向を設定する設定器(32)
と、前記作業機部材及び作業機を自動制御に切換える自
動切換スイッチ(31)と、前記第1ブーム角θ1 を検出す
る第1検出手段(17)と、前記第2ブーム角θ2 を検出す
る第2検出手段(18)と、オフセットブームのオフセット
角θ3 を検知する第3検出手段(16)と、前記アーム角θ
4 を検出する第4検出手段(19)とを有し、前記自動切換
スイッチ(31)をオン操作した後に、前記第1〜第4検出
手段(16,17,18,19) からの信号を受けて、車体の旋回中
心から作業機の先端までの基準座標を求めて、この基準
座標に対応して車体を旋回させて作業機先端を横方向に
直線制御し、この作業機先端の上下、横方向が所定値に
対して誤差が生じたときはブーム及び/或いはアームを
駆動して補正し、作業機先端を横方向に移動して作業対
象物に対して直線制御するために作業機部材の各アクチ
ュエータ(6,8,10,13) と旋回用アクチュエータ(40)を駆
動するように各方向切換弁(23,24,25,26,28)へ指令出力
する制御装置(30)を備えたことを特徴とする建設機械の
作業機直線制御装置。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP8206372A JPH1030248A (ja) | 1996-07-18 | 1996-07-18 | 建設機械の作業機直線制御方法及びその制御装置 |
| PCT/JP1997/002457 WO1998003738A1 (fr) | 1996-07-18 | 1997-07-15 | Procede et appareil pour la commande lineaire d'une machine de chantier |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP8206372A JPH1030248A (ja) | 1996-07-18 | 1996-07-18 | 建設機械の作業機直線制御方法及びその制御装置 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JPH1030248A true JPH1030248A (ja) | 1998-02-03 |
Family
ID=16522242
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP8206372A Pending JPH1030248A (ja) | 1996-07-18 | 1996-07-18 | 建設機械の作業機直線制御方法及びその制御装置 |
Country Status (2)
| Country | Link |
|---|---|
| JP (1) | JPH1030248A (ja) |
| WO (1) | WO1998003738A1 (ja) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2006033399A1 (ja) * | 2004-09-24 | 2006-03-30 | Komatsu Ltd. | 旋回制御装置、旋回制御方法、および建設機械 |
| CN110945187A (zh) * | 2017-09-08 | 2020-03-31 | 住友重机械工业株式会社 | 挖土机 |
| JP2024057970A (ja) * | 2022-10-13 | 2024-04-25 | 住友重機械工業株式会社 | ショベル及びショベルの制御装置 |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6618967B2 (en) * | 2001-12-26 | 2003-09-16 | Caterpillar Inc | Work machine control for improving cycle time |
| JP7404170B2 (ja) * | 2020-06-25 | 2023-12-25 | 株式会社小松製作所 | 作業機械の方位を較正するためのシステムおよび方法 |
| US12208834B2 (en) | 2022-03-31 | 2025-01-28 | Caterpillar Inc. | Systems and methods for machine steering |
| CN115387426B (zh) * | 2022-08-29 | 2023-11-28 | 三一重机有限公司 | 作业机械的控制方法、装置、设备及作业机械 |
Family Cites Families (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH01268923A (ja) * | 1988-04-19 | 1989-10-26 | Mitsubishi Heavy Ind Ltd | 移動体の水平垂直移動制御方法 |
| JP2793952B2 (ja) * | 1993-10-12 | 1998-09-03 | 日立建機株式会社 | 作業機の干渉防止制御装置 |
| JPH084046A (ja) * | 1994-06-16 | 1996-01-09 | Hitachi Constr Mach Co Ltd | 作業機の干渉防止装置 |
-
1996
- 1996-07-18 JP JP8206372A patent/JPH1030248A/ja active Pending
-
1997
- 1997-07-15 WO PCT/JP1997/002457 patent/WO1998003738A1/ja not_active Ceased
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2006033399A1 (ja) * | 2004-09-24 | 2006-03-30 | Komatsu Ltd. | 旋回制御装置、旋回制御方法、および建設機械 |
| US7869923B2 (en) | 2004-09-24 | 2011-01-11 | Komatsu Ltd. | Slewing controller, slewing control method, and construction machine |
| CN110945187A (zh) * | 2017-09-08 | 2020-03-31 | 住友重机械工业株式会社 | 挖土机 |
| KR20200051572A (ko) * | 2017-09-08 | 2020-05-13 | 스미도모쥬기가이고교 가부시키가이샤 | 쇼벨 |
| EP3680394A4 (en) * | 2017-09-08 | 2020-11-25 | Sumitomo Heavy Industries, Ltd. | SHOVEL |
| CN110945187B (zh) * | 2017-09-08 | 2022-08-16 | 住友重机械工业株式会社 | 挖土机 |
| JP2024057970A (ja) * | 2022-10-13 | 2024-04-25 | 住友重機械工業株式会社 | ショベル及びショベルの制御装置 |
Also Published As
| Publication number | Publication date |
|---|---|
| WO1998003738A1 (fr) | 1998-01-29 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3145027B2 (ja) | 油圧ショベルの自動制御装置 | |
| EP0902131A1 (en) | Slope excavation controller of hydraulic shovel, target slope setting device and slope excavation forming method | |
| JPH1088608A (ja) | 掘削機の制御方法 | |
| JP2001098585A (ja) | 建設機械の掘削作業ガイダンス装置および掘削制御装置 | |
| JP2002235341A (ja) | 作業機械の位置及び方向を求める方法 | |
| JP2001159518A (ja) | 建設機械のツール位置計測装置、ヨー角検出装置、作業機自動制御装置及び校正装置 | |
| EP1298255A1 (en) | Method and apparatus for controlling an extendable stick on a work machine | |
| US6618967B2 (en) | Work machine control for improving cycle time | |
| WO2022201623A1 (ja) | 作業機械 | |
| JPH1030248A (ja) | 建設機械の作業機直線制御方法及びその制御装置 | |
| JP3794771B2 (ja) | 油圧ショベルの作業機制御装置 | |
| JPH1018339A (ja) | 建設機械のアーム位置制御方法及びその制御装置 | |
| US12338602B2 (en) | System for handling the seamless transition of breaklines during an excavation task | |
| JPH0617445A (ja) | 掘削装置 | |
| JP3573369B2 (ja) | 油圧ショベルのブレード取付装置 | |
| JP2000328606A (ja) | 建設機械の作業機制御装置 | |
| JP2019100111A (ja) | 建設機械の制御システム | |
| EP4455409A1 (en) | Work area setting system | |
| WO2026048165A1 (ja) | 作業機械制御装置、作業機械および作業機械制御方法 | |
| WO2026053689A1 (ja) | 制御装置 | |
| JP2026060701A (ja) | 自動走行システム | |
| JP2026043530A (ja) | 作業機械の制御装置 | |
| KR20250168309A (ko) | 작업 기계를 제어하기 위한 시스템 및 방법 | |
| JPH1060947A (ja) | 油圧ショベルの操作装置 | |
| WO2025022923A1 (ja) | 積込機械の制御装置、積込機械の制御方法および遠隔操作システム |