JP2002167794A - 油圧ショベルのフロント制御装置 - Google Patents
油圧ショベルのフロント制御装置Info
- Publication number
- JP2002167794A JP2002167794A JP2000369086A JP2000369086A JP2002167794A JP 2002167794 A JP2002167794 A JP 2002167794A JP 2000369086 A JP2000369086 A JP 2000369086A JP 2000369086 A JP2000369086 A JP 2000369086A JP 2002167794 A JP2002167794 A JP 2002167794A
- Authority
- JP
- Japan
- Prior art keywords
- bucket
- vector
- area
- boom
- control
- 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.)
- Granted
Links
Landscapes
- Operation Control Of Excavators (AREA)
Abstract
(57)【要約】
【課題】フロント作業機の動き得る領域を制限した掘削
制御を行う領域制限掘削制御に際して、掘削時の負荷に
よる影響を極力押さえるとともに、領域制限掘削制御の
演算部分に干渉することなく、バケットの姿勢を一定に
保持する制御を容易に組み込むことができるようにす
る。 【解決手段】アーム１ｂ、バケット１ｃの実際の角速度
を元にしてバケット先端の速度ベクトルＶｃを演算し、
これから減速ベクトルＶRを演算してブーム１ａを制御
することで、バケット先端が設定領域に沿って動作する
領域制限掘削制御を行う。また、設定領域の境界とバケ
ット先端との距離が制限掘削制御を開始する距離Ｙa1よ
り小さいＹa2以下になると、当該距離が０であると仮定
して演算した修正減速ベクトルＶARからブーム１ａの目
標角速度ωａを演算し、これとアームの実測角速度ωｂ
からバケット１ｃの目標角速度ωｃを演算し、バケット
角一定保持制御を行う。
制御を行う領域制限掘削制御に際して、掘削時の負荷に
よる影響を極力押さえるとともに、領域制限掘削制御の
演算部分に干渉することなく、バケットの姿勢を一定に
保持する制御を容易に組み込むことができるようにす
る。 【解決手段】アーム１ｂ、バケット１ｃの実際の角速度
を元にしてバケット先端の速度ベクトルＶｃを演算し、
これから減速ベクトルＶRを演算してブーム１ａを制御
することで、バケット先端が設定領域に沿って動作する
領域制限掘削制御を行う。また、設定領域の境界とバケ
ット先端との距離が制限掘削制御を開始する距離Ｙa1よ
り小さいＹa2以下になると、当該距離が０であると仮定
して演算した修正減速ベクトルＶARからブーム１ａの目
標角速度ωａを演算し、これとアームの実測角速度ωｂ
からバケット１ｃの目標角速度ωｃを演算し、バケット
角一定保持制御を行う。
Description
【０００１】
【発明の属する技術分野】本発明は油圧ショベルのフロ
ント制御装置に係わり、特に、領域制限掘削制御により
フロント作業機の動き得る領域を制限した掘削を行う油
圧ショベルのフロント制御装置に関する。
ント制御装置に係わり、特に、領域制限掘削制御により
フロント作業機の動き得る領域を制限した掘削を行う油
圧ショベルのフロント制御装置に関する。
【０００２】
【従来の技術】油圧ショベルで掘削面の仕上げ作業や法
面の成型作業を行うには、ブーム、アーム等の複数のフ
ロント部材を同時に複合操作してバケット先端を直線状
に動作させる必要がある。しかし、これらフロント部材
はそれぞれが関節部によって連結され回動運動を行うも
のであるため、これらフロント部材を操作してフロント
作業機のバケット先端を直線状に移動させることは、熟
練を伴う非常に困難な作業である。また、上記のような
作業ではバケットの姿勢を一定に保持しながらそのよう
な動作を行わせることも望まれており、この作業は一層
熟練を要する高度な作業となる。
面の成型作業を行うには、ブーム、アーム等の複数のフ
ロント部材を同時に複合操作してバケット先端を直線状
に動作させる必要がある。しかし、これらフロント部材
はそれぞれが関節部によって連結され回動運動を行うも
のであるため、これらフロント部材を操作してフロント
作業機のバケット先端を直線状に移動させることは、熟
練を伴う非常に困難な作業である。また、上記のような
作業ではバケットの姿勢を一定に保持しながらそのよう
な動作を行わせることも望まれており、この作業は一層
熟練を要する高度な作業となる。
【０００３】そこで、このような作業を容易にするた
め、各種のフロント制御装置が従来提案されており、そ
の種の技術を開示する公知例として例えば特開平８−３
１１９１８号公報、特開昭６３−２３６８２７号公報、
特許第１９７６６４７号公報等がある。
め、各種のフロント制御装置が従来提案されており、そ
の種の技術を開示する公知例として例えば特開平８−３
１１９１８号公報、特開昭６３−２３６８２７号公報、
特許第１９７６６４７号公報等がある。
【０００４】特開平８−３１１９１８号公報は領域制限
掘削制御と称する、掘削領域の境界に沿ってフロント作
業機のバケット先端を動かせるフロント制御装置を提案
している。このフロント制御装置は、検出信号からの信
号によりフロント作業機の位置を演算する手段と、フロ
ント作業機の動き得る掘削領域を設定する手段と、フロ
ント作業機の速度ベクトルを演算する手段とを有し、フ
ロント作業機のバケット先端と掘削領域の境界との間の
距離に応じて速度ベクトルのうち当該境界に垂直な成分
を減じるよう速度ベクトルを補正し、この補正した速度
ベクトルが得られるようフロント作業機を駆動すること
により、掘削領域の境界に沿ってフロント作業機のバケ
ット先端を動かすようにしたものである。
掘削制御と称する、掘削領域の境界に沿ってフロント作
業機のバケット先端を動かせるフロント制御装置を提案
している。このフロント制御装置は、検出信号からの信
号によりフロント作業機の位置を演算する手段と、フロ
ント作業機の動き得る掘削領域を設定する手段と、フロ
ント作業機の速度ベクトルを演算する手段とを有し、フ
ロント作業機のバケット先端と掘削領域の境界との間の
距離に応じて速度ベクトルのうち当該境界に垂直な成分
を減じるよう速度ベクトルを補正し、この補正した速度
ベクトルが得られるようフロント作業機を駆動すること
により、掘削領域の境界に沿ってフロント作業機のバケ
ット先端を動かすようにしたものである。
【０００５】特開昭６３−２３６８２７号公報は、バケ
ット角度を元にしたフィードバック制御とアームの操作
量を元にしたフィードフォワード制御を組み合わせるこ
とにより、制御開始時の応答遅れによる偏差を少なくし
てバケット角の制御精度を向上させる技術を提案してい
る。
ット角度を元にしたフィードバック制御とアームの操作
量を元にしたフィードフォワード制御を組み合わせるこ
とにより、制御開始時の応答遅れによる偏差を少なくし
てバケット角の制御精度を向上させる技術を提案してい
る。
【０００６】特許第１９７６６４７号公報は、バケット
先端を直接制御点とし、ブーム・アーム・バケット回動
速度の指令による速度フィードフォワード制御と目標角
速度に関するフィードバック制御を行い、バケット爪先
を直線状に動作させかつバケット対地角度を制御する技
術を提案している。
先端を直接制御点とし、ブーム・アーム・バケット回動
速度の指令による速度フィードフォワード制御と目標角
速度に関するフィードバック制御を行い、バケット爪先
を直線状に動作させかつバケット対地角度を制御する技
術を提案している。
【０００７】
【発明が解決しようとする課題】しかしながら、上記従
来技術には以下の間題点がある。
来技術には以下の間題点がある。
【０００８】特開平８−３１１９１８号公報に記載の領
域制限掘削制御では、上記のようにフロント作業機のバ
ケット先端の速度ベクトルを補正することにより、掘削
領域の境界に沿ってフロント作業機のバケット先端を動
かすことができ、バケット先端を直線状に動作させるこ
とができる。しかし、この制御ではバケットの姿勢を一
定に保持することはできない。領域制限掘削制御でバケ
ットの姿勢を一定に保持しながらバケット先端を直線状
に動かすことが望まれている。
域制限掘削制御では、上記のようにフロント作業機のバ
ケット先端の速度ベクトルを補正することにより、掘削
領域の境界に沿ってフロント作業機のバケット先端を動
かすことができ、バケット先端を直線状に動作させるこ
とができる。しかし、この制御ではバケットの姿勢を一
定に保持することはできない。領域制限掘削制御でバケ
ットの姿勢を一定に保持しながらバケット先端を直線状
に動かすことが望まれている。
【０００９】特開昭６３−２３６８２７号公報や特許第
１９７６６４７号公報に記載の制御装置では、バケット
の姿勢を一定に保持しながらバケット先端を直線状に動
作させるようとしている。しかし、特開昭６３−２３６
８２７号公報に記載の制御装置では、アーム先端を直線
的に動作させ、バケット角度はその制御とは独立に制御
する方法であり、それぞれの制御による偏差が重なると
バケット先端の偏差が大きくなる恐れがある。特許第１
９７６６４７号公報に記載の制御装置では、バケット先
端を制御点とし、バケット爪先を直線状に動作させかつ
バケット対地角度を制御しているため、そのような問題
は無いと考えられる。しかし、この従来技術は、負荷外
乱等による影響について補償する手段については言及し
ておらず、幾何学的な原理原則の内容にとどまってお
り、実際にこの制御を行う場合は、外乱等の補償方法に
ついて考慮する必要がある。また、ブーム・アーム・バ
ケット回動速度の指令による速度フィードフォワード制
御と目標角速度に関するフィードバック制御を行い、バ
ケット爪先を直線状に動作させかつバケット対地角度を
制御する技術であるため、そのバケット爪先を直線状に
動作させる制御とバケット対地角度の制御が一体不可分
となっており、バケット対地角度の制御部分だけを分離
し特開平８−３１１９１８号公報に記載のような領域制
限掘削制御に適用することは困難である。
１９７６６４７号公報に記載の制御装置では、バケット
の姿勢を一定に保持しながらバケット先端を直線状に動
作させるようとしている。しかし、特開昭６３−２３６
８２７号公報に記載の制御装置では、アーム先端を直線
的に動作させ、バケット角度はその制御とは独立に制御
する方法であり、それぞれの制御による偏差が重なると
バケット先端の偏差が大きくなる恐れがある。特許第１
９７６６４７号公報に記載の制御装置では、バケット先
端を制御点とし、バケット爪先を直線状に動作させかつ
バケット対地角度を制御しているため、そのような問題
は無いと考えられる。しかし、この従来技術は、負荷外
乱等による影響について補償する手段については言及し
ておらず、幾何学的な原理原則の内容にとどまってお
り、実際にこの制御を行う場合は、外乱等の補償方法に
ついて考慮する必要がある。また、ブーム・アーム・バ
ケット回動速度の指令による速度フィードフォワード制
御と目標角速度に関するフィードバック制御を行い、バ
ケット爪先を直線状に動作させかつバケット対地角度を
制御する技術であるため、そのバケット爪先を直線状に
動作させる制御とバケット対地角度の制御が一体不可分
となっており、バケット対地角度の制御部分だけを分離
し特開平８−３１１９１８号公報に記載のような領域制
限掘削制御に適用することは困難である。
【００１０】本発明の目的は、フロント作業機の動き得
る領域を制限した掘削制御を行う領域制限掘削制御に際
して、掘削時の負荷による影響を極力押さえるととも
に、領域制限掘削制御の演算部分に干渉することなく、
バケットの姿勢を一定に保持する制御を容易に組み込む
ことができる油圧ショベルのフロント制御装置を提供す
ることである。
る領域を制限した掘削制御を行う領域制限掘削制御に際
して、掘削時の負荷による影響を極力押さえるととも
に、領域制限掘削制御の演算部分に干渉することなく、
バケットの姿勢を一定に保持する制御を容易に組み込む
ことができる油圧ショベルのフロント制御装置を提供す
ることである。
【００１１】
【課題を解決するための手段】（１）上記目的を達成す
るために、本発明は、多関節型のフロント作業機を構成
する上下方向に回動可能なブーム、アーム、バケットを
含む複数のフロント部材と、前記複数のフロント部材を
それぞれ駆動する複数の油圧アクチュエータと、前記複
数のフロント部材の動作を指示する複数の操作手段と、
前記複数の操作手段の操作信号に応じて駆動され、前記
複数の油圧アクチュエータに供給される圧油の流量を制
御する複数の油圧制御弁とを備える油圧ショベルに備え
られ、前記フロント作業機に領域を制限した掘削を連続
して行わせる油圧ショベルのフロント制御装置におい
て、（ａ）前記フロント作業機の位置と姿勢に関する状
態量を検出する検出手段と、（ｂ）前記検出手段からの
信号に基づき前記フロント作業機の位置と姿勢を演算す
る第１演算手段と、（ｃ）前記検出手段からの信号に基
づき前記アーム及びバケットの実動作速度を演算し、こ
の動作速度から前記フロント作業機のバケット先端の速
度ベクトルを演算する第２演算手段と、（ｄ）前記フロ
ント作業機のバケット先端が予め設定した領域内でその
設定領域の境界の近傍にあるとき、前記第１及び第２演
算手段の演算値に基づき、前記第２演算手段で演算した
前記速度ベクトルの前記設定領域の境界に接近する方向
のベクトル成分を減じる減速ベクトルを演算する第３演
算手段と、（ｅ）前記第３演算手段で演算した前記減速
ベクトルに対応する前記ブームの操作信号を演算しこれ
を対応する油圧制御弁に出力する第４演算手段と、
（ｆ）前記第３演算手段で演算した減速ベクトルに対応
する前記ブームの目標動作速度を演算し、このブームの
目標動作速度と前記検出手段で検出した前記フロント作
業機の位置と姿勢に関する状態量とから前記バケットの
姿勢を一定に保持するための前記バケットの操作信号を
演算し、このバケットの操作信号を対応する油圧制御弁
に出力する第４演算手段とを備えるものとする。
るために、本発明は、多関節型のフロント作業機を構成
する上下方向に回動可能なブーム、アーム、バケットを
含む複数のフロント部材と、前記複数のフロント部材を
それぞれ駆動する複数の油圧アクチュエータと、前記複
数のフロント部材の動作を指示する複数の操作手段と、
前記複数の操作手段の操作信号に応じて駆動され、前記
複数の油圧アクチュエータに供給される圧油の流量を制
御する複数の油圧制御弁とを備える油圧ショベルに備え
られ、前記フロント作業機に領域を制限した掘削を連続
して行わせる油圧ショベルのフロント制御装置におい
て、（ａ）前記フロント作業機の位置と姿勢に関する状
態量を検出する検出手段と、（ｂ）前記検出手段からの
信号に基づき前記フロント作業機の位置と姿勢を演算す
る第１演算手段と、（ｃ）前記検出手段からの信号に基
づき前記アーム及びバケットの実動作速度を演算し、こ
の動作速度から前記フロント作業機のバケット先端の速
度ベクトルを演算する第２演算手段と、（ｄ）前記フロ
ント作業機のバケット先端が予め設定した領域内でその
設定領域の境界の近傍にあるとき、前記第１及び第２演
算手段の演算値に基づき、前記第２演算手段で演算した
前記速度ベクトルの前記設定領域の境界に接近する方向
のベクトル成分を減じる減速ベクトルを演算する第３演
算手段と、（ｅ）前記第３演算手段で演算した前記減速
ベクトルに対応する前記ブームの操作信号を演算しこれ
を対応する油圧制御弁に出力する第４演算手段と、
（ｆ）前記第３演算手段で演算した減速ベクトルに対応
する前記ブームの目標動作速度を演算し、このブームの
目標動作速度と前記検出手段で検出した前記フロント作
業機の位置と姿勢に関する状態量とから前記バケットの
姿勢を一定に保持するための前記バケットの操作信号を
演算し、このバケットの操作信号を対応する油圧制御弁
に出力する第４演算手段とを備えるものとする。
【００１２】このように第２演算手段でアーム及びバケ
ットの実動作速度を演算し、この動作速度からフロント
作業機のバケット先端の速度ベクトルを演算し、第３演
算手段でその速度ベクトルに対する減速ベクトルを演算
し、第４演算手段でその減速ベクトルに対応するブーム
の操作信号を演算し対応する油圧制御弁に出力すること
により、バケット先端が設定領域を越えないフロント作
業機の制御（領域制限掘削制御）を行うことができる。
また、このとき、掘削時の負荷によってアーム及びバケ
ットのアクチュエータ速度が操作信号の目標値と異なっ
ていても、第２演算手段で演算される速度ベクトルは実
動作速度に基づく実際の速度ベクトルであるため、第３
演算手段で演算した減速ベクトルも実測値を反映した値
となっており、掘削時の負荷に係わらず精度良く領域制
限掘削制御を行うことができる。
ットの実動作速度を演算し、この動作速度からフロント
作業機のバケット先端の速度ベクトルを演算し、第３演
算手段でその速度ベクトルに対する減速ベクトルを演算
し、第４演算手段でその減速ベクトルに対応するブーム
の操作信号を演算し対応する油圧制御弁に出力すること
により、バケット先端が設定領域を越えないフロント作
業機の制御（領域制限掘削制御）を行うことができる。
また、このとき、掘削時の負荷によってアーム及びバケ
ットのアクチュエータ速度が操作信号の目標値と異なっ
ていても、第２演算手段で演算される速度ベクトルは実
動作速度に基づく実際の速度ベクトルであるため、第３
演算手段で演算した減速ベクトルも実測値を反映した値
となっており、掘削時の負荷に係わらず精度良く領域制
限掘削制御を行うことができる。
【００１３】また、第５演算手段で第３演算手段で演算
した減速ベクトルに対応するブームの目標動作速度を演
算し、このブームの目標動作速度と検出手段で検出した
フロント作業機の位置と姿勢に関する状態量とからバケ
ットの姿勢を一定に保持するバケットの操作信号を演算
し対応する油圧制御弁に出力することにより、バケット
が一定の姿勢を保持するようフロント作業機を制御する
ことができる。また、このとき、領域制限掘削制御の演
算に用いたのと同じ演算値或いは状態量を用いてバケッ
トの姿勢を一定に保持する制御の演算を行うので、領域
制限掘削制御の演算部分に干渉することなく、簡単なソ
フトの追加でバケットの姿勢を一定に保持する制御を容
易に組み込むことができ、制御プログラムのデバッグを
容易に行うことができる。
した減速ベクトルに対応するブームの目標動作速度を演
算し、このブームの目標動作速度と検出手段で検出した
フロント作業機の位置と姿勢に関する状態量とからバケ
ットの姿勢を一定に保持するバケットの操作信号を演算
し対応する油圧制御弁に出力することにより、バケット
が一定の姿勢を保持するようフロント作業機を制御する
ことができる。また、このとき、領域制限掘削制御の演
算に用いたのと同じ演算値或いは状態量を用いてバケッ
トの姿勢を一定に保持する制御の演算を行うので、領域
制限掘削制御の演算部分に干渉することなく、簡単なソ
フトの追加でバケットの姿勢を一定に保持する制御を容
易に組み込むことができ、制御プログラムのデバッグを
容易に行うことができる。
【００１４】（２）上記（１）において、好ましくは、
前記第３演算手段は、前記減速ベクトルとして、そのと
きの設定領域の境界とバケット先端との距離に対応する
第１減速ベクトルと、前記設定領域の境界と前記バケッ
ト先端との距離が０であると仮定した第２減速ベクトル
とを演算し、前記第４演算手段は前記第１減速ベクトル
を用いて前記ブームの操作信号を演算し、前記第５演算
手段は前記第２減速ベクトルを用いて前記ブームの目標
動作速度を演算する。
前記第３演算手段は、前記減速ベクトルとして、そのと
きの設定領域の境界とバケット先端との距離に対応する
第１減速ベクトルと、前記設定領域の境界と前記バケッ
ト先端との距離が０であると仮定した第２減速ベクトル
とを演算し、前記第４演算手段は前記第１減速ベクトル
を用いて前記ブームの操作信号を演算し、前記第５演算
手段は前記第２減速ベクトルを用いて前記ブームの目標
動作速度を演算する。
【００１５】これにより第１減速ベクトルを用いてバケ
ット先端が設定領域を越えないよう制御できるととも
に、第２減速ベクトルを用いて設定領域の境界の手前か
ら、バケット先端が設定領域の境界状に到達したときの
角度と同じ角度でバケットの姿勢を一定にする制御を行
える。
ット先端が設定領域を越えないよう制御できるととも
に、第２減速ベクトルを用いて設定領域の境界の手前か
ら、バケット先端が設定領域の境界状に到達したときの
角度と同じ角度でバケットの姿勢を一定にする制御を行
える。
【００１６】（３）上記（２）において、好ましくは、
前記第３演算手段は、設定領域の境界とバケット先端と
の距離の関数として減速係数を予め設定しておき、この
予め設定した関数から前記設定領域の境界とバケット先
端との距離に対応する減速係数を求め、前記第１及び第
２減速ベクトルを演算する。
前記第３演算手段は、設定領域の境界とバケット先端と
の距離の関数として減速係数を予め設定しておき、この
予め設定した関数から前記設定領域の境界とバケット先
端との距離に対応する減速係数を求め、前記第１及び第
２減速ベクトルを演算する。
【００１７】これにより同じ関数を用いて第１及び第２
減速ベクトルを演算でき、ソフトを簡素化できる。
減速ベクトルを演算でき、ソフトを簡素化できる。
【００１８】（４）また、上記（２）において、好まし
くは、前記第３演算手段は、前記設定領域の境界と前記
バケット先端との距離が第１の値以下になると前記第１
減速ベクトルの演算を開始し、前記設定領域の境界と前
記バケット先端との距離が前記第１の値より小さい第２
の値以下になると前記第２減速ベクトルの演算を開始す
る。
くは、前記第３演算手段は、前記設定領域の境界と前記
バケット先端との距離が第１の値以下になると前記第１
減速ベクトルの演算を開始し、前記設定領域の境界と前
記バケット先端との距離が前記第１の値より小さい第２
の値以下になると前記第２減速ベクトルの演算を開始す
る。
【００１９】これにより設定領域の境界の手前からバケ
ットの姿勢を一定にする制御を行うとき、設定領域の境
界に近い位置からバケット姿勢が一定となるよう制御さ
れ、操作性が良好となる。
ットの姿勢を一定にする制御を行うとき、設定領域の境
界に近い位置からバケット姿勢が一定となるよう制御さ
れ、操作性が良好となる。
【００２０】（５）更に、上記（１）において、前記第
２演算手段は、前記検出手段からの信号に基づき前記ア
ーム及びバケットの実動作速度としてアーム及びバケッ
トの実角速度を演算し、前記第５演算手段は、前記ブー
ムの目標動作速度としてブームの目標角速度を演算し、
このブームの目標角速度と前記第２演算手段で演算した
アームの実角速度とから、バケットが一定の角度を保つ
動作をするときブームの角速度とアームの角速度とバケ
ットの角速度との和が０になる関係を用いて前記バケッ
トの目標角速度を演算し、このバケットの目標角速度か
ら前記バケットの操作信号を演算する。
２演算手段は、前記検出手段からの信号に基づき前記ア
ーム及びバケットの実動作速度としてアーム及びバケッ
トの実角速度を演算し、前記第５演算手段は、前記ブー
ムの目標動作速度としてブームの目標角速度を演算し、
このブームの目標角速度と前記第２演算手段で演算した
アームの実角速度とから、バケットが一定の角度を保つ
動作をするときブームの角速度とアームの角速度とバケ
ットの角速度との和が０になる関係を用いて前記バケッ
トの目標角速度を演算し、このバケットの目標角速度か
ら前記バケットの操作信号を演算する。
【００２１】これによりバケットの姿勢を一定とする操
作信号を演算できる。
作信号を演算できる。
【００２２】
【発明の実施の形態】以下、本発明の実施の形態を図面
を用いて説明する。
を用いて説明する。
【００２３】図１は本発明の一実施の形態に係わるフロ
ント制御装置を油圧ショベルに搭載される油圧駆動装置
とともに示す図である。
ント制御装置を油圧ショベルに搭載される油圧駆動装置
とともに示す図である。
【００２４】図１において、本発明が適用される油圧シ
ョベルは、油圧ポンプ２と、この油圧ポンプ２から吐出
される圧油により駆動されるブームシリンダ３ａ、アー
ムシリンダ３ｂ、バケットシリンダ３ｃ、旋回モータ３
ｄ及び左右の走行モータ３ｅ，３ｆを含む複数の油圧ア
クチュエータと、これら油圧アクチュエータ３ａ〜３ｆ
のそれぞれに対応して設けられた複数の操作レバー装置
４ａ〜４ｆと、油圧アクチュエータ３ａ〜３ｆに供給さ
れる圧油の流量を制御する複数の流量制御弁５ａ〜５ｆ
と、油圧ポンプ２と流量制御弁５ａ〜５ｆの間の圧力が
設定値以上になった場合に開くリリーフ弁６とを有し、
これらは油圧ショベルの被駆動部材を駆動する油圧駆動
装置を構成している。
ョベルは、油圧ポンプ２と、この油圧ポンプ２から吐出
される圧油により駆動されるブームシリンダ３ａ、アー
ムシリンダ３ｂ、バケットシリンダ３ｃ、旋回モータ３
ｄ及び左右の走行モータ３ｅ，３ｆを含む複数の油圧ア
クチュエータと、これら油圧アクチュエータ３ａ〜３ｆ
のそれぞれに対応して設けられた複数の操作レバー装置
４ａ〜４ｆと、油圧アクチュエータ３ａ〜３ｆに供給さ
れる圧油の流量を制御する複数の流量制御弁５ａ〜５ｆ
と、油圧ポンプ２と流量制御弁５ａ〜５ｆの間の圧力が
設定値以上になった場合に開くリリーフ弁６とを有し、
これらは油圧ショベルの被駆動部材を駆動する油圧駆動
装置を構成している。
【００２５】本実施の形態では、操作レバー装置４ａ〜
４ｆは操作信号として電気信号を出力する電気レバー装
置であり、流量制御弁５ａ〜５ｆは電気信号をパイロッ
ト圧に変換する電気油圧変換手段、例えば比例電磁弁を
両端に備えた電気・油圧操作方式である。
４ｆは操作信号として電気信号を出力する電気レバー装
置であり、流量制御弁５ａ〜５ｆは電気信号をパイロッ
ト圧に変換する電気油圧変換手段、例えば比例電磁弁を
両端に備えた電気・油圧操作方式である。
【００２６】図２に油圧ショベルの外観を示す。油圧シ
ョベルは、垂直方向にそれぞれ回動するブーム１ａ、ア
ーム１ｂ及びバケット１ｃからなる多関節型のフロント
作業機１Ａと、上部旋回体１ｄ及び下部走行体１ｅから
なる車体１Ｂとで構成され、フロント作業機１Ａのブー
ム１ａの基端は上部旋回体１ｄの前部に指示されてい
る。ブーム１ａ、アーム１ｂ、バケット１ｃ、上部旋回
体１ｄ及び下部走行体１ｅはそれぞれブームシリンダ３
ａ、アームシリンダ３ｂ、バケットシリンダ３ｃ、旋回
モータ３ｄ及び左右の走行モータ３ｅ，３ｆによりそれ
ぞれ駆動され、それらの動作は上記操作レバー装置４ａ
〜４ｆにより指示される。
ョベルは、垂直方向にそれぞれ回動するブーム１ａ、ア
ーム１ｂ及びバケット１ｃからなる多関節型のフロント
作業機１Ａと、上部旋回体１ｄ及び下部走行体１ｅから
なる車体１Ｂとで構成され、フロント作業機１Ａのブー
ム１ａの基端は上部旋回体１ｄの前部に指示されてい
る。ブーム１ａ、アーム１ｂ、バケット１ｃ、上部旋回
体１ｄ及び下部走行体１ｅはそれぞれブームシリンダ３
ａ、アームシリンダ３ｂ、バケットシリンダ３ｃ、旋回
モータ３ｄ及び左右の走行モータ３ｅ，３ｆによりそれ
ぞれ駆動され、それらの動作は上記操作レバー装置４ａ
〜４ｆにより指示される。
【００２７】以上のような油圧ショベルに本実施の形態
に係わるフロント制御装置が設けられている。この制御
装置は、予め作業に応じてフロント作業機の所定部位、
例えばバケット１ｃの先端が動き得る掘削領域の設定を
指示するとともに、領域制限掘削制御の開始やバケット
角一定保持制御の開始を指示する設定器７と、ブーム１
ａ、アーム１ｂ及びバケット１ｃのそれぞれの回動支点
に設けられ、フロント作業機１Ａの位置と姿勢に関する
状態量としてそれぞれの回動角を検出する角度検出器８
ａ，８ｂ，８ｃと、設定器７の設定信号、操作レバー装
置４ａ〜４ｆの操作信号を入力し、バケット１ｃの先端
が動き得る掘削領域を設定すると共に操作信号の補正を
行う制御ユニット９から構成されている。
に係わるフロント制御装置が設けられている。この制御
装置は、予め作業に応じてフロント作業機の所定部位、
例えばバケット１ｃの先端が動き得る掘削領域の設定を
指示するとともに、領域制限掘削制御の開始やバケット
角一定保持制御の開始を指示する設定器７と、ブーム１
ａ、アーム１ｂ及びバケット１ｃのそれぞれの回動支点
に設けられ、フロント作業機１Ａの位置と姿勢に関する
状態量としてそれぞれの回動角を検出する角度検出器８
ａ，８ｂ，８ｃと、設定器７の設定信号、操作レバー装
置４ａ〜４ｆの操作信号を入力し、バケット１ｃの先端
が動き得る掘削領域を設定すると共に操作信号の補正を
行う制御ユニット９から構成されている。
【００２８】設定器７は、操作パネルあるいは操作レバ
ーのグリップ上に設けられたスイッチ等の入力手段によ
り、制御の開始や設定の信号を制御ユニット９に出力
し、制御の開始や掘削制限領域の設定を指示するもので
ある。操作パネル上には表示装置等、他の補助手段があ
ってもよい。図１に示す例では、設定器７に領域制限開
始スイッチ７ａ、バケット角一定保持スイッチ７ｂ、ダ
イレクトティーチスイッチ７ｃが設けられている。
ーのグリップ上に設けられたスイッチ等の入力手段によ
り、制御の開始や設定の信号を制御ユニット９に出力
し、制御の開始や掘削制限領域の設定を指示するもので
ある。操作パネル上には表示装置等、他の補助手段があ
ってもよい。図１に示す例では、設定器７に領域制限開
始スイッチ７ａ、バケット角一定保持スイッチ７ｂ、ダ
イレクトティーチスイッチ７ｃが設けられている。
【００２９】制御ユニット９は領域設定部と領域制限掘
削制御部とを有し、領域設定部では、設定器７からの指
示でバケット１ｃの先端が動き得る掘削領域の設定演算
を行う。その一例を図３を用いて説明する。
削制御部とを有し、領域設定部では、設定器７からの指
示でバケット１ｃの先端が動き得る掘削領域の設定演算
を行う。その一例を図３を用いて説明する。
【００３０】まず初めに、掘削領域の初期値として、フ
ロント作業機１Ａが届かない位深い値をセットしてお
く。なぜならば、設定器７の制御開始スイッチ７ａをＯ
Ｎにした時から領域制限掘削制御が有効になるとすれ
ば、その後フロント作業機１Ａが動作し得る範囲で自由
に動き、動作範囲内で掘削領域を自由に設定できるよう
にするためには、掘削領域の初期値は油圧ショベルのあ
る位置からはるか下方に設定しておかなければならない
からである。ここでは一例として、掘削領域の初期値は
直線式でＹ＝−２０ｍとしておく。
ロント作業機１Ａが届かない位深い値をセットしてお
く。なぜならば、設定器７の制御開始スイッチ７ａをＯ
Ｎにした時から領域制限掘削制御が有効になるとすれ
ば、その後フロント作業機１Ａが動作し得る範囲で自由
に動き、動作範囲内で掘削領域を自由に設定できるよう
にするためには、掘削領域の初期値は油圧ショベルのあ
る位置からはるか下方に設定しておかなければならない
からである。ここでは一例として、掘削領域の初期値は
直線式でＹ＝−２０ｍとしておく。
【００３１】次に、図３において、オペレータによる操
作レバー装置の操作でバケット１ｃの先端を点Ｐ1の位
置に動かした後、設定器７のダイレクトティーチスイッ
チ７ｃを押してそのときのバケット１ｃの先端位置を計
算する。
作レバー装置の操作でバケット１ｃの先端を点Ｐ1の位
置に動かした後、設定器７のダイレクトティーチスイッ
チ７ｃを押してそのときのバケット１ｃの先端位置を計
算する。
【００３２】制御ユニット９のＲＯＭ等の記憶部にはフ
ロント作業機１Ａ及び車体１Ｂの各部寸法が記憶されて
おり、領域設定部はこれらのデータと、角度検出器８
ａ，８ｂ，８ｃで検出した回動角α，β，γの値を用い
てＰ1の位置を計算する。このときＰ1の位置は例えばブ
ーム１ａの回動支点を原点としたＸＹ座標系の座標値
（Ｘ1，Ｙ1）として求める。ＸＹ座標系は本体１Ｂに固
定した直交座標系であり、垂直面内にあるとする。回動
角α，β，γからＸＹ座標系の座標値（Ｘ1，Ｙ1）は、
ブーム１ａの回動支点とアーム１ｂの回動支点との距離
をＬ1、アーム１ｂの回動支点とバケット１ｃの回動支
点の距離をＬ2、バケット１ｃの回動支点とバケット１
ｃの先端との距離をＬ3とすれぱ、下記の式より求ま
る。
ロント作業機１Ａ及び車体１Ｂの各部寸法が記憶されて
おり、領域設定部はこれらのデータと、角度検出器８
ａ，８ｂ，８ｃで検出した回動角α，β，γの値を用い
てＰ1の位置を計算する。このときＰ1の位置は例えばブ
ーム１ａの回動支点を原点としたＸＹ座標系の座標値
（Ｘ1，Ｙ1）として求める。ＸＹ座標系は本体１Ｂに固
定した直交座標系であり、垂直面内にあるとする。回動
角α，β，γからＸＹ座標系の座標値（Ｘ1，Ｙ1）は、
ブーム１ａの回動支点とアーム１ｂの回動支点との距離
をＬ1、アーム１ｂの回動支点とバケット１ｃの回動支
点の距離をＬ2、バケット１ｃの回動支点とバケット１
ｃの先端との距離をＬ3とすれぱ、下記の式より求ま
る。
【００３３】 Ｘ1＝Ｌ1sinα＋Ｌ2sin（α＋β）＋Ｌ3sin（α＋β＋γ） Ｙ1＝Ｌ1cosα＋Ｌ2cos（α＋β）＋Ｌ3cos（α＋β＋γ） 制御ユニット９の領域設定部では、Ｐ1のＹ座標値よ
り、掘削領域の直線式を下記の式を用いて計算する。
り、掘削領域の直線式を下記の式を用いて計算する。
【００３４】Ｙ＝Ｙ1 このように計算した値は掘削領域の設定値として制御ユ
ニット９のＲＡＭ等の記憶部に記憶される。
ニット９のＲＡＭ等の記憶部に記憶される。
【００３５】以上のように設定した掘削領域に関して、
制御ユニット９の領域制限掘削制御部では、図４にフロ
ーチャートで示す処理手順によりフロント作業機１Ａの
動き得る領域を制限する制御を行う。以下、その内容を
図４に示すフローチャートにより説明する。
制御ユニット９の領域制限掘削制御部では、図４にフロ
ーチャートで示す処理手順によりフロント作業機１Ａの
動き得る領域を制限する制御を行う。以下、その内容を
図４に示すフローチャートにより説明する。
【００３６】まず、手順１１０において、設定器７の領
域制限開始スイッチ７ａがＯＮかどうかを判断する。設
定器７の領域制限開始スイッチ７ａがＯＮであれば手順
１２０に進む。
域制限開始スイッチ７ａがＯＮかどうかを判断する。設
定器７の領域制限開始スイッチ７ａがＯＮであれば手順
１２０に進む。
【００３７】次に、手順１２０において、操作レバー装
置４ａ〜４ｆの操作信号を入力し、手順１３０におい
て、角度検出器８ａ，８ｂ，８ｃにより検出したブーム
１ａ、アーム１ｂ及びバケット１ｃの回動角を入力す
る。
置４ａ〜４ｆの操作信号を入力し、手順１３０におい
て、角度検出器８ａ，８ｂ，８ｃにより検出したブーム
１ａ、アーム１ｂ及びバケット１ｃの回動角を入力す
る。
【００３８】次に手順１４０において、検出した回動角
α，β，γと予め入力してあるフロント作業機１Ａの各
部寸法とに基づきフロント作業機１Ａの位置と姿勢の計
算を行い、フロント作業機１Ａのバケット１ｃの先端位
置を計算する。この時の計算は、先の領域設定部におけ
るバケット先端位置の計算と同じであり、この場合も、
バケット先端の位置はＸＹ座標系の値として求める。
α，β，γと予め入力してあるフロント作業機１Ａの各
部寸法とに基づきフロント作業機１Ａの位置と姿勢の計
算を行い、フロント作業機１Ａのバケット１ｃの先端位
置を計算する。この時の計算は、先の領域設定部におけ
るバケット先端位置の計算と同じであり、この場合も、
バケット先端の位置はＸＹ座標系の値として求める。
【００３９】次に、手順１８０において、アーム角度検
出器８ｂ及びバケット角度検出器８ｃの信号を微分して
アーム１ｂ及びバケット１ｃの実際の角速度ωｂ，ωｃ
を求め、この角速度から油圧シリンダ３ｂ，３ｃの駆動
速度を求め、この駆動速度とフロント作業機１Ａの各部
寸法を用いてバケット先端の速度ベクトルＶｃを演算す
る。そして、速度ベクトルＶｃの設定領域の境界に平行
な方向のベクトル成分Ｖｃｘと垂直な方向のベクトル成
分Ｖｃｙを求める。ここで、速度ベクトルＶｃのＸ座標
成分Ｖｃｘは速度ベクトルＶｃの設定領域の境界に平行
な方向のベクトル成分となり、Ｙ座標成分Ｖｃｙは速度
ベクトルＶｃの設定領域の境界に垂直な方向のベクトル
成分となる。
出器８ｂ及びバケット角度検出器８ｃの信号を微分して
アーム１ｂ及びバケット１ｃの実際の角速度ωｂ，ωｃ
を求め、この角速度から油圧シリンダ３ｂ，３ｃの駆動
速度を求め、この駆動速度とフロント作業機１Ａの各部
寸法を用いてバケット先端の速度ベクトルＶｃを演算す
る。そして、速度ベクトルＶｃの設定領域の境界に平行
な方向のベクトル成分Ｖｃｘと垂直な方向のベクトル成
分Ｖｃｙを求める。ここで、速度ベクトルＶｃのＸ座標
成分Ｖｃｘは速度ベクトルＶｃの設定領域の境界に平行
な方向のベクトル成分となり、Ｙ座標成分Ｖｃｙは速度
ベクトルＶｃの設定領域の境界に垂直な方向のベクトル
成分となる。
【００４０】次に手順１９０において、バケット１ｃの
先端が、上記のように設定した図５に示すような設定領
域内の境界近傍の領域である減速領域にある場合か否か
を判定し、減速領域にある場合には手順２００に進み、
フロント作業機１Ａの減速制御演算を行い、減速領域に
ない時には手順２１０に進む。手順２００の減速制御演
算では、アーム用操作レバー装置４ｂの操作信号自体を
減速する（操作指令値を小さくする）処理（アーム減速
制御処理）と、手順１８０で計算したフロント作業機１
Ａのバケット１ｃの先端の速度ベクトルＶｃの設定領域
の境界に接近する方向のベクトル成分（Ｖｃｙ）を減じ
る処理（減速方向変換処理；後述）とを行う。
先端が、上記のように設定した図５に示すような設定領
域内の境界近傍の領域である減速領域にある場合か否か
を判定し、減速領域にある場合には手順２００に進み、
フロント作業機１Ａの減速制御演算を行い、減速領域に
ない時には手順２１０に進む。手順２００の減速制御演
算では、アーム用操作レバー装置４ｂの操作信号自体を
減速する（操作指令値を小さくする）処理（アーム減速
制御処理）と、手順１８０で計算したフロント作業機１
Ａのバケット１ｃの先端の速度ベクトルＶｃの設定領域
の境界に接近する方向のベクトル成分（Ｖｃｙ）を減じ
る処理（減速方向変換処理；後述）とを行う。
【００４１】次に手順２１０において、バケット１ｃの
先端が上記のように設定した図５に示すような設定領域
外にある場合か否かを判定し、設定領域外にある場合に
は手順２２０に進み、フロント作業機１Ａの復元制御演
算を行い、設定領域外にないときには手順２３０に進
む。手順２２０の復元制御演算では、アーム用操作レバ
ー装置４ｂの操作信号自体を減速する（操作指令値を小
さくする）処理（アーム減速処理）と、手順１８０で計
算したフロント作業機１Ａのバケット１ｃの先端の速度
ベクトルＶｃの設定領域の境界に接近する方向のベクト
ル成分（Ｖｃｙ）を設定領域の協会に向かう方向の成分
に変換する処理（復元方向変換処理；後述）とを行う。
先端が上記のように設定した図５に示すような設定領域
外にある場合か否かを判定し、設定領域外にある場合に
は手順２２０に進み、フロント作業機１Ａの復元制御演
算を行い、設定領域外にないときには手順２３０に進
む。手順２２０の復元制御演算では、アーム用操作レバ
ー装置４ｂの操作信号自体を減速する（操作指令値を小
さくする）処理（アーム減速処理）と、手順１８０で計
算したフロント作業機１Ａのバケット１ｃの先端の速度
ベクトルＶｃの設定領域の境界に接近する方向のベクト
ル成分（Ｖｃｙ）を設定領域の協会に向かう方向の成分
に変換する処理（復元方向変換処理；後述）とを行う。
【００４２】ここで、手順１９０における減速領域にあ
るか否かの判定及び手順２００における減速方向変換処
理、手順２１０における設定領域外に侵入したか否かの
判定について、図５〜図７を用いて説明する。
るか否かの判定及び手順２００における減速方向変換処
理、手順２１０における設定領域外に侵入したか否かの
判定について、図５〜図７を用いて説明する。
【００４３】制御ユニット９の記憶装置には、図６に示
すような設定領域の境界とバケット１ｃの先端との距離
Ｄ1と減速ベクトル係数ｈとの関係が演算・記憶されて
いる。この距離Ｄ1と係数ｈとの関係は、距離Ｄ1が距離
Ｙa1よりも大きいときはｈ＝０であり、Ｄ1がＹa1より
も小さくなると、距離Ｄ1が減少するにしたがって減速
ベクトル係数ｈが増大し、距離Ｄ1＝０でｈ＝１となる
ように設定されている。
すような設定領域の境界とバケット１ｃの先端との距離
Ｄ1と減速ベクトル係数ｈとの関係が演算・記憶されて
いる。この距離Ｄ1と係数ｈとの関係は、距離Ｄ1が距離
Ｙa1よりも大きいときはｈ＝０であり、Ｄ1がＹa1より
も小さくなると、距離Ｄ1が減少するにしたがって減速
ベクトル係数ｈが増大し、距離Ｄ1＝０でｈ＝１となる
ように設定されている。
【００４４】手順１９０では、手順１４０で演算された
バケット１ｃの先端位置と上記のように領域設定部９ａ
に設定された掘削領域の設定値とからバケット１ｃの先
端位置と設定領域の境界との距離Ｄ1を計算し、この距
離Ｄ1が距離Ｙa1より小さくなると減速領域に侵入した
と判定する。また、手順２１０では、距離Ｄ1が負の値
になったら設定領域外に侵入したと判断する。
バケット１ｃの先端位置と上記のように領域設定部９ａ
に設定された掘削領域の設定値とからバケット１ｃの先
端位置と設定領域の境界との距離Ｄ1を計算し、この距
離Ｄ1が距離Ｙa1より小さくなると減速領域に侵入した
と判定する。また、手順２１０では、距離Ｄ1が負の値
になったら設定領域外に侵入したと判断する。
【００４５】また、手順２００では、手順１８０で計算
したバケット１ｃの先端の速度ベクトルＶｃの設定領域
の境界に接近する方向のベクトル成分である設定領域の
境界に対し垂直方向のベクトル成分、すなわちＸＹ座標
系におけるＹ座標の成分Ｖｃｙを減じるための減速ベク
トルＶRを求める。具体的には、記憶装置に記憶した図
６に示す関係からそのときの設定領域の境界とバケット
１ｃの先端との距離Ｄ 1に対応する減速ベクトル係数ｈ
を計算し、この減速ベクトル係数ｈを速度ベクトルＶｃ
のＹ座標の成分（垂直方向のベクトル成分）Ｖｃｙに乗
じ、更に−１を乗じて滅速ベクトルＶR（＝−ｈＶｃ
ｙ）を求める。ここで、減速ベクトルＶRはバケット１
ｃの先端と設定領域の境界との距離Ｄ1がＹa1より小さ
くなるにしたがって大きくなり、Ｄ1＝０でＶR＝−Ｖｃ
ｙとなるＶｃｙの逆方向の速度ベクトルである。このた
め、減速ベクトルＶRを速度ベクトルＶｃの垂直方向の
ベクトル成分Ｖｃｙに加算することにより（後述）、距
離Ｄ1がＹa1より小さくなるにしたがって垂直方向のベ
クトル成分Ｖｃｙの減少量が大きくなるようベクトル成
分Ｖｃｙが減じられ、速度ベクトルＶｃは速度ベクトル
Ｖｃａに補正される。
したバケット１ｃの先端の速度ベクトルＶｃの設定領域
の境界に接近する方向のベクトル成分である設定領域の
境界に対し垂直方向のベクトル成分、すなわちＸＹ座標
系におけるＹ座標の成分Ｖｃｙを減じるための減速ベク
トルＶRを求める。具体的には、記憶装置に記憶した図
６に示す関係からそのときの設定領域の境界とバケット
１ｃの先端との距離Ｄ 1に対応する減速ベクトル係数ｈ
を計算し、この減速ベクトル係数ｈを速度ベクトルＶｃ
のＹ座標の成分（垂直方向のベクトル成分）Ｖｃｙに乗
じ、更に−１を乗じて滅速ベクトルＶR（＝−ｈＶｃ
ｙ）を求める。ここで、減速ベクトルＶRはバケット１
ｃの先端と設定領域の境界との距離Ｄ1がＹa1より小さ
くなるにしたがって大きくなり、Ｄ1＝０でＶR＝−Ｖｃ
ｙとなるＶｃｙの逆方向の速度ベクトルである。このた
め、減速ベクトルＶRを速度ベクトルＶｃの垂直方向の
ベクトル成分Ｖｃｙに加算することにより（後述）、距
離Ｄ1がＹa1より小さくなるにしたがって垂直方向のベ
クトル成分Ｖｃｙの減少量が大きくなるようベクトル成
分Ｖｃｙが減じられ、速度ベクトルＶｃは速度ベクトル
Ｖｃａに補正される。
【００４６】バケット１ｃの先端が上記のように補正さ
れた速度ベクトルＶｃａの通りに減速制御されたときの
軌跡の一例を図７に示す。速度ベクトルＶｃが斜め下方
に一定であるときには、その平行成分Ｖｃｘは一定とな
り、垂直成分Ｖｃｙはバケット１ｃの先端が設定領域の
境界に近づくにしたがって（距離Ｄ1がＹa1より小さく
なるにしたがって）小さくなる。補正後の速度ベクトル
Ｖｃａはその合成であるので、軌跡は図７のように設定
領域の境界に近づくにつれて平行となる曲線状となる。
また、Ｄ1＝０でｈ＝１、ＶR＝−Ｖｃｙとなるので、設
定領域の境界上での補正後の速度ベクトルＶｃａは平行
成分Ｖｃｘに一致する。
れた速度ベクトルＶｃａの通りに減速制御されたときの
軌跡の一例を図７に示す。速度ベクトルＶｃが斜め下方
に一定であるときには、その平行成分Ｖｃｘは一定とな
り、垂直成分Ｖｃｙはバケット１ｃの先端が設定領域の
境界に近づくにしたがって（距離Ｄ1がＹa1より小さく
なるにしたがって）小さくなる。補正後の速度ベクトル
Ｖｃａはその合成であるので、軌跡は図７のように設定
領域の境界に近づくにつれて平行となる曲線状となる。
また、Ｄ1＝０でｈ＝１、ＶR＝−Ｖｃｙとなるので、設
定領域の境界上での補正後の速度ベクトルＶｃａは平行
成分Ｖｃｘに一致する。
【００４７】手順２２０における復元方向変換処理につ
いて、図８及び図９を用いて説明する。前述したように
この処理はバケット１ｃの先端位置と設定領域の境界と
の距離Ｄ1が負の値になったときのものであり、便宜上
Ｄ1の絶対値をＤ2に置き換えて説明する。
いて、図８及び図９を用いて説明する。前述したように
この処理はバケット１ｃの先端位置と設定領域の境界と
の距離Ｄ1が負の値になったときのものであり、便宜上
Ｄ1の絶対値をＤ2に置き換えて説明する。
【００４８】手順２２０では、手順１８０で計算したバ
ケット１ｃの先端の速度ベクトルＶｃの設定領域の境界
に対し垂直方向のベクトル成分、すなわちＸＹ座標系の
Ｙ座標の成分Ｖｃｙを設定領域の境界に接近する方向の
垂直成分に変えるための復元ベクトルＶR2を求める。具
体的には、垂直方向のベクトル成分Ｖｃｙをキャンセル
するためのＶｃｙの逆方向ベクトルＡｃｙを求める。そ
して次に、記憶装置に記憶した図８に示す関係からその
ときの設定領域の境界とバケット１ｃの先端との距離Ｄ
2の絶対値に相当する加算用復元ベクトルＡRを計算し、
Ｖｃｙの逆方向ベクトルＡｃｙと加算用復元ベクトルＡ
Rの和を復元ベクトルＶR2とする（ＶR2＝Ａｃｙ＋
ＡR）。ここで、加算用復元ベクトルＡRはバケット１ｃ
の先端と設定領域の境界との距離Ｄ2が小さくなるにし
たがつて小さくなるよう設定されている。このため、復
元ベクトルＶR2（＝Ａｃｙ＋ＡR）を速度ベクトルＶｃ
の垂直方向のベクトル成分Ｖｃｙに加算することにより
（後述）、距離Ｄ2が小さくなるにしたがって垂直方向
のベクトル成分Ｖｃｙが小さくなるよう、速度ベクトル
Ｖｃは速度ベクトルＶｃａに補正される。
ケット１ｃの先端の速度ベクトルＶｃの設定領域の境界
に対し垂直方向のベクトル成分、すなわちＸＹ座標系の
Ｙ座標の成分Ｖｃｙを設定領域の境界に接近する方向の
垂直成分に変えるための復元ベクトルＶR2を求める。具
体的には、垂直方向のベクトル成分Ｖｃｙをキャンセル
するためのＶｃｙの逆方向ベクトルＡｃｙを求める。そ
して次に、記憶装置に記憶した図８に示す関係からその
ときの設定領域の境界とバケット１ｃの先端との距離Ｄ
2の絶対値に相当する加算用復元ベクトルＡRを計算し、
Ｖｃｙの逆方向ベクトルＡｃｙと加算用復元ベクトルＡ
Rの和を復元ベクトルＶR2とする（ＶR2＝Ａｃｙ＋
ＡR）。ここで、加算用復元ベクトルＡRはバケット１ｃ
の先端と設定領域の境界との距離Ｄ2が小さくなるにし
たがつて小さくなるよう設定されている。このため、復
元ベクトルＶR2（＝Ａｃｙ＋ＡR）を速度ベクトルＶｃ
の垂直方向のベクトル成分Ｖｃｙに加算することにより
（後述）、距離Ｄ2が小さくなるにしたがって垂直方向
のベクトル成分Ｖｃｙが小さくなるよう、速度ベクトル
Ｖｃは速度ベクトルＶｃａに補正される。
【００４９】バケット１ｃの先端が上記のように補正し
た速度ベクトルＶｃａの通りに復元制御されたときの軌
跡の一例を図９に示す。速度ベクトルＶｃが斜め下方に
一定であるときには、その平行成分Ｖｃｘは一定とな
り、また復元ベクトルＡRは距離Ｄ2に比例するので垂直
成分Ｖｃｙはバケット１ｃの先端が設定領域の境界に近
づくにしたがって（距離Ｄ2が小さくなるにしたがっ
て）小さくなる。補正後の速度ベクトルＶｃａはその合
成であるので、軌跡は図９のように設定領域の境界に近
づくにつれて平行となる曲線状となる。
た速度ベクトルＶｃａの通りに復元制御されたときの軌
跡の一例を図９に示す。速度ベクトルＶｃが斜め下方に
一定であるときには、その平行成分Ｖｃｘは一定とな
り、また復元ベクトルＡRは距離Ｄ2に比例するので垂直
成分Ｖｃｙはバケット１ｃの先端が設定領域の境界に近
づくにしたがって（距離Ｄ2が小さくなるにしたがっ
て）小さくなる。補正後の速度ベクトルＶｃａはその合
成であるので、軌跡は図９のように設定領域の境界に近
づくにつれて平行となる曲線状となる。
【００５０】図４に戻り、次に手順２３０において、手
順２００又は２２０で得た滅速ベクトルＶRあるいは復
元ベクトルＶR2（＝Ａｃｙ＋ＡR）に対応するブーム用
流量制御弁５ａの操作信号を演算する。具体的には、ま
ず、滅速ベクトルＶRあるいは復元ベクトルＶR2に対応
するブーム１ａの角速度の目標値を演算し、それにリン
ク変換を行い、ブーム角速度の目標値に相当するブーム
１ａの操作信号を演算する。
順２００又は２２０で得た滅速ベクトルＶRあるいは復
元ベクトルＶR2（＝Ａｃｙ＋ＡR）に対応するブーム用
流量制御弁５ａの操作信号を演算する。具体的には、ま
ず、滅速ベクトルＶRあるいは復元ベクトルＶR2に対応
するブーム１ａの角速度の目標値を演算し、それにリン
ク変換を行い、ブーム角速度の目標値に相当するブーム
１ａの操作信号を演算する。
【００５１】ここで、この操作信号を流量制御弁５ａに
出力しブーム１ａを操作することは、滅速ベクトルＶR
あるいは復元ベクトルＶR2が得られるようブーム上げを
行うことであり、減速制御では、減速ベクトルＶRを速
度ベクトルＶｃの垂直方向のベクトル成分Ｖｃｙに加算
することに相当し、復元制御では、復元ベクトルＶR2を
速度ベクトルＶｃの垂直方向のベクトル成分Ｖｃｙに加
算することに相当する。
出力しブーム１ａを操作することは、滅速ベクトルＶR
あるいは復元ベクトルＶR2が得られるようブーム上げを
行うことであり、減速制御では、減速ベクトルＶRを速
度ベクトルＶｃの垂直方向のベクトル成分Ｖｃｙに加算
することに相当し、復元制御では、復元ベクトルＶR2を
速度ベクトルＶｃの垂直方向のベクトル成分Ｖｃｙに加
算することに相当する。
【００５２】次に手順３００では、設定器７のバケット
角一定保持スイッチ７ｂがＯＮかどうかを判断し、更に
手順３１０で、上記のように手順１９０で計算されたバ
ケット１ｃの先端位置と設定領域の境界との距離Ｄ1が
距離Ｙa2より小さくなったかどうかを判断する。ここ
で、距離Ｙa2は図６に示すようにＹa2＜Ｙa1であり、設
定領域の境界近傍に設定する。なお、バケット角一定保
持スイッチ７ｂを設けずに、フロント作業機１Ａの姿勢
（例えばバケット１ｃの角度）でバケット角一定保持制
御がＯＮかどうかを判断し、自動でバケット角一定保持
制御を開始するようにしてもよい。
角一定保持スイッチ７ｂがＯＮかどうかを判断し、更に
手順３１０で、上記のように手順１９０で計算されたバ
ケット１ｃの先端位置と設定領域の境界との距離Ｄ1が
距離Ｙa2より小さくなったかどうかを判断する。ここ
で、距離Ｙa2は図６に示すようにＹa2＜Ｙa1であり、設
定領域の境界近傍に設定する。なお、バケット角一定保
持スイッチ７ｂを設けずに、フロント作業機１Ａの姿勢
（例えばバケット１ｃの角度）でバケット角一定保持制
御がＯＮかどうかを判断し、自動でバケット角一定保持
制御を開始するようにしてもよい。
【００５３】そして手順３００，３１０の両方で肯定さ
れれば手順３２０に進み、バケット角一定保持制御のた
めのバケットに対する操作信号を演算する。
れれば手順３２０に進み、バケット角一定保持制御のた
めのバケットに対する操作信号を演算する。
【００５４】手順３２０の詳細を図１０に示す。
【００５５】まず、手順３２２では手順２００で行った
ように、図６に示すような設定領域の境界とバケット１
ｃの先端との距離Ｄ1と減速ベクトル係数ｈとの関係を
用い、減速制御における減速ベクトルＶRを演算する
が、ここでは領域制限掘削制御によりバケット１ｃの先
端は常に設定領域の境界上を移動していると仮定し、バ
ケットと先端と設定領域の境界との距離Ｄ1は０として
減速制御演算を行い、修正減速ベクトルＶARを演算す
る。
ように、図６に示すような設定領域の境界とバケット１
ｃの先端との距離Ｄ1と減速ベクトル係数ｈとの関係を
用い、減速制御における減速ベクトルＶRを演算する
が、ここでは領域制限掘削制御によりバケット１ｃの先
端は常に設定領域の境界上を移動していると仮定し、バ
ケットと先端と設定領域の境界との距離Ｄ1は０として
減速制御演算を行い、修正減速ベクトルＶARを演算す
る。
【００５６】次に手順３２３において、修正減速ベクト
ルＶARに対応するブーム１ａの角速度の目標値（目標角
速度）ωａを演算する。
ルＶARに対応するブーム１ａの角速度の目標値（目標角
速度）ωａを演算する。
【００５７】次に手順３２４では、手順１８０でアーム
角度検出器８ｂの信号を微分して求めたアーム１ｂの実
際の角速度（アーム角速度の実測値）ωｂと、手順３２
３で求めたブームの目標角速度ωａとからバケット１ｃ
の目標角速度ωｃを演算する。ここで、バケットと１ｃ
が車体１Ｂに対して一定の角度（姿勢）、つまり一定の
対地角度を保つ動作をする場合、ωａ＋ωｂ＋ωｃ＝０
の関係が成り立つ。手順３２４ではその関係を用いて以
下の式よりバケット１ｃの目標角速度ωｃを演算する。
角度検出器８ｂの信号を微分して求めたアーム１ｂの実
際の角速度（アーム角速度の実測値）ωｂと、手順３２
３で求めたブームの目標角速度ωａとからバケット１ｃ
の目標角速度ωｃを演算する。ここで、バケットと１ｃ
が車体１Ｂに対して一定の角度（姿勢）、つまり一定の
対地角度を保つ動作をする場合、ωａ＋ωｂ＋ωｃ＝０
の関係が成り立つ。手順３２４ではその関係を用いて以
下の式よりバケット１ｃの目標角速度ωｃを演算する。
【００５８】ωｃ＝−ωａ−ωｂ 手順３２５では、手順３２４で得たバケット１ｃの目標
角速度ωｃにリンク変換を行い、ωｃに相当するバケッ
ト１ｃの操作信号を演算する。
角速度ωｃにリンク変換を行い、ωｃに相当するバケッ
ト１ｃの操作信号を演算する。
【００５９】図４に戻り、次に手順２４０では手順１１
０，３００，３１０での判断結果に応じて操作信号を出
力する。まず、手順１１０，３００，３１０の全て肯定
された場合は、手順１２０で入力した旋回及び走行用操
作レバー装置４ｄ〜４ｆの操作信号と、手順２００又は
２２０で計算したアーム減速処理の操作信号と、手順２
３０で計算したブームの操作信号と、手順３１０で計算
したバケットの操作信号を出力する。手順１１０で肯定
され、手順３００，３１０の少なくとも一方で否定され
た場合は、手順１２０で入力したバケット、旋回及び走
行の操作信号と、手順２００又は２２０で計算したアー
ム減速処理の操作信号と、手順２３０で計算したブーム
の操作信号を出力する。更に、手順１１０で否定された
場合は、手順２５０で操作レバー装置４ａ〜４ｆの操作
信号を入力し、手順２４０では、それらの操作信号を出
力する。
０，３００，３１０での判断結果に応じて操作信号を出
力する。まず、手順１１０，３００，３１０の全て肯定
された場合は、手順１２０で入力した旋回及び走行用操
作レバー装置４ｄ〜４ｆの操作信号と、手順２００又は
２２０で計算したアーム減速処理の操作信号と、手順２
３０で計算したブームの操作信号と、手順３１０で計算
したバケットの操作信号を出力する。手順１１０で肯定
され、手順３００，３１０の少なくとも一方で否定され
た場合は、手順１２０で入力したバケット、旋回及び走
行の操作信号と、手順２００又は２２０で計算したアー
ム減速処理の操作信号と、手順２３０で計算したブーム
の操作信号を出力する。更に、手順１１０で否定された
場合は、手順２５０で操作レバー装置４ａ〜４ｆの操作
信号を入力し、手順２４０では、それらの操作信号を出
力する。
【００６０】領域制限掘削制御を終了させる場合は、設
定器７の領域制限開始スイッチ７ａをもう一度押して、
０ＦＦにする。この時、それまで設定されていた掘削領
域の設定値（掘削領域の直線式）は初期値のＹ＝−２０
ｍにリセットされる。
定器７の領域制限開始スイッチ７ａをもう一度押して、
０ＦＦにする。この時、それまで設定されていた掘削領
域の設定値（掘削領域の直線式）は初期値のＹ＝−２０
ｍにリセットされる。
【００６１】以上によりバケット１ｃの先端を設定領域
の境界に沿って移動させる領域制限掘削制御を行いなが
ら、アーム１ｂの動作及びブーム１ａの制御目標値を元
にしてバケット１ｃを制御することにより、バケットの
対地角度が一定に保持されるバケット角一定保持制御を
行うことができる。
の境界に沿って移動させる領域制限掘削制御を行いなが
ら、アーム１ｂの動作及びブーム１ａの制御目標値を元
にしてバケット１ｃを制御することにより、バケットの
対地角度が一定に保持されるバケット角一定保持制御を
行うことができる。
【００６２】図１１に本実施の形態に係わる領域制限掘
削制御とバケット角一定保持制御の関係を機能ブロック
図で示す。図中、実線は領域制限掘削制御に係わる部分
を示し、破線はバケット角一定保持制御に係わる部分を
示している。
削制御とバケット角一定保持制御の関係を機能ブロック
図で示す。図中、実線は領域制限掘削制御に係わる部分
を示し、破線はバケット角一定保持制御に係わる部分を
示している。
【００６３】図１１において、本実施の形態のフロント
制御装置は、アーム速度指令値の演算部５０、アーム減
速制御演算部５１、アーム出力指令値演算部５２、アー
ム各速度の実測値演算部５３、ブーム速度指令値の演算
部５９、フロント姿勢演算部６０、速度ベクトル演算部
６１、減速ベクトル演算部６２、ブーム角速度の目標値
演算部６３、リンク変換部６４、ブーム出力指令値演算
部６５、偏差を０と改定した修正減速ベクトル演算部７
０、ブーム角速度の目標値演算部７１、バケット速度指
令値演算部７２、バケット角速度の目標値演算部７３、
リンク変換部７４、バケット出力指令値演算部７５、バ
ケット角速度の実測値演算部７６を有している。これら
各演算部と図４及び図１０に示したフローチャートの手
順との対応は次のようである。
制御装置は、アーム速度指令値の演算部５０、アーム減
速制御演算部５１、アーム出力指令値演算部５２、アー
ム各速度の実測値演算部５３、ブーム速度指令値の演算
部５９、フロント姿勢演算部６０、速度ベクトル演算部
６１、減速ベクトル演算部６２、ブーム角速度の目標値
演算部６３、リンク変換部６４、ブーム出力指令値演算
部６５、偏差を０と改定した修正減速ベクトル演算部７
０、ブーム角速度の目標値演算部７１、バケット速度指
令値演算部７２、バケット角速度の目標値演算部７３、
リンク変換部７４、バケット出力指令値演算部７５、バ
ケット角速度の実測値演算部７６を有している。これら
各演算部と図４及び図１０に示したフローチャートの手
順との対応は次のようである。
【００６４】アーム速度指令値の演算部５０：手順１２
０ アーム減速制御演算部５１：手順２００，２２０ アーム出力指令値演算部５２：手順２００，２２０，２
４０ アーム各速度の実測値演算部５３：手順１８０，３２０
（３２１） ブーム速度指令値の演算部５９：手順１２０ フロント姿勢演算部６０：手順１４０ 速度ベクトル演算部６１：手順１８０ 減速ベクトル演算部６２：手順２００，２２０ ブーム角速度の目標値演算部６３：手順２３０ リンク変換部６４：手順２３０ ブーム出力指令値演算部６５：手順２３０，２４０ 偏差を０と改定した修正減速ベクトル演算部７０：手順
３２０（３２２） ブーム角速度の目標値演算部７１：手順３２０（３２
３） バケット速度指令値演算部７２：手順１２０ バケット角速度の目標値演算部７３：手順３２０（３２
４） リンク変換部７４：手順３２０（３２５） バケット出力指令値演算部７５：手順３２０（３２
５），２４０ バケット角速度の実測値演算部７６：手順１８０ 以上のように構成した本実施の形態によれば、アーム１
ｂ、バケット１ｃの実際の角速度を元にしてバケット先
端の速度ベクトルＶｃを演算し、これから減速ベクトル
ＶRを演算してブーム１ａを制御することで、バケット
先端が設定領域に沿って動作する領域制限掘削制御を行
うので、掘削時の負荷などによりアーム、バケットが操
作レバー装置４ｂ，４ｃの操作信号が指令する目標速度
通りに動作しなくても、ブーム１ａはアーム１ｂ、バケ
ット１ｃの実際の動作速度に応じて動作するため、バケ
ット先端が設定領域外に侵入しないよう精度よく制御で
きる。
０ アーム減速制御演算部５１：手順２００，２２０ アーム出力指令値演算部５２：手順２００，２２０，２
４０ アーム各速度の実測値演算部５３：手順１８０，３２０
（３２１） ブーム速度指令値の演算部５９：手順１２０ フロント姿勢演算部６０：手順１４０ 速度ベクトル演算部６１：手順１８０ 減速ベクトル演算部６２：手順２００，２２０ ブーム角速度の目標値演算部６３：手順２３０ リンク変換部６４：手順２３０ ブーム出力指令値演算部６５：手順２３０，２４０ 偏差を０と改定した修正減速ベクトル演算部７０：手順
３２０（３２２） ブーム角速度の目標値演算部７１：手順３２０（３２
３） バケット速度指令値演算部７２：手順１２０ バケット角速度の目標値演算部７３：手順３２０（３２
４） リンク変換部７４：手順３２０（３２５） バケット出力指令値演算部７５：手順３２０（３２
５），２４０ バケット角速度の実測値演算部７６：手順１８０ 以上のように構成した本実施の形態によれば、アーム１
ｂ、バケット１ｃの実際の角速度を元にしてバケット先
端の速度ベクトルＶｃを演算し、これから減速ベクトル
ＶRを演算してブーム１ａを制御することで、バケット
先端が設定領域に沿って動作する領域制限掘削制御を行
うので、掘削時の負荷などによりアーム、バケットが操
作レバー装置４ｂ，４ｃの操作信号が指令する目標速度
通りに動作しなくても、ブーム１ａはアーム１ｂ、バケ
ット１ｃの実際の動作速度に応じて動作するため、バケ
ット先端が設定領域外に侵入しないよう精度よく制御で
きる。
【００６５】また、バケット１ｃの対地角度を一定に保
持しながら領域制限掘削制御を行う際、バケットの目標
角速度ωｃの演算には、領域制限掘削制御の演算で用い
たのと同じ速度ベクトルＶｃや図６に示す関係を用いて
演算したブームの目標角速度ωａと、やはり領域制限掘
削制御の演算で用いたのと同じアームの実角速度ωｂと
を用いているので、領域制限掘削制御の演算部分に干渉
することなく、簡単なソフトの追加でバケットの姿勢を
一定に保持する制御を容易に組み込むことができ、制御
プログラムのデバッグが容易となり、プログラミングの
ミスを予防できる。
持しながら領域制限掘削制御を行う際、バケットの目標
角速度ωｃの演算には、領域制限掘削制御の演算で用い
たのと同じ速度ベクトルＶｃや図６に示す関係を用いて
演算したブームの目標角速度ωａと、やはり領域制限掘
削制御の演算で用いたのと同じアームの実角速度ωｂと
を用いているので、領域制限掘削制御の演算部分に干渉
することなく、簡単なソフトの追加でバケットの姿勢を
一定に保持する制御を容易に組み込むことができ、制御
プログラムのデバッグが容易となり、プログラミングの
ミスを予防できる。
【００６６】また、バケツト角一定保持制御の演算で
は、設定領域の境界とバケット先端との距離が０である
と仮定して演算した修正減速ベクトルＶARからブーム１
ａの目標角速度ωａを演算し、バケット１ｃの目標角速
度ωｃを演算するので、設定領域の境界とバケット先端
との距離がＹa2以下になればバケット先端が設定領域の
境界に到達していなくても、設定領域の境界の手前か
ら、バケット先端が設定領域の境界状に到達したときの
角度と同じ角度でバケット１ｃの姿勢が一定となるよう
制御されるとともに、この制御を開始する距離Ｙa2を領
域制限掘削制御を開始する距離Ｙa1より小さい、設定領
域の境界近傍の値に設定してあるので、設定領域の境界
に近い位置からバケット姿勢が一定となるよう制御され
る。このため、バケツト角一定保持制御をスムーズに行
うことができ、操作性を大幅に向上できる。
は、設定領域の境界とバケット先端との距離が０である
と仮定して演算した修正減速ベクトルＶARからブーム１
ａの目標角速度ωａを演算し、バケット１ｃの目標角速
度ωｃを演算するので、設定領域の境界とバケット先端
との距離がＹa2以下になればバケット先端が設定領域の
境界に到達していなくても、設定領域の境界の手前か
ら、バケット先端が設定領域の境界状に到達したときの
角度と同じ角度でバケット１ｃの姿勢が一定となるよう
制御されるとともに、この制御を開始する距離Ｙa2を領
域制限掘削制御を開始する距離Ｙa1より小さい、設定領
域の境界近傍の値に設定してあるので、設定領域の境界
に近い位置からバケット姿勢が一定となるよう制御され
る。このため、バケツト角一定保持制御をスムーズに行
うことができ、操作性を大幅に向上できる。
【００６７】以上、本発明のいくつかの実施の形態を説
明したが、本発明は上述の実施の形態に限定されず、種
々の変形が可能である。例えば、上記の実施の形態で
は、バケツト角一定保持制御において、アームの実際の
角速度ωｂとブームの目標角速度ωａに基づいて計算し
たバケットの目標角速度ωｃより直接バケット１ｃの操
作信号を演算したが、バケットの目標対地角度と実際の
バケット対地角度の偏差に応じたフィードバック制御を
組み込み、ωｃの値を補正するような制御演算を加えて
もよい。
明したが、本発明は上述の実施の形態に限定されず、種
々の変形が可能である。例えば、上記の実施の形態で
は、バケツト角一定保持制御において、アームの実際の
角速度ωｂとブームの目標角速度ωａに基づいて計算し
たバケットの目標角速度ωｃより直接バケット１ｃの操
作信号を演算したが、バケットの目標対地角度と実際の
バケット対地角度の偏差に応じたフィードバック制御を
組み込み、ωｃの値を補正するような制御演算を加えて
もよい。
【００６８】また、上記の実施の形態では、バケツト角
一定保持制御で、設定領域の境界とバケット先端との距
離が０であると仮定して修正減速ベクトルＶAR演算し、
この値を基にしてブーム１ａの目標角速度ωａを演算し
バケット１ｃの目標角速度ωｃを演算したが、領域制限
掘削制御で演算した減速ベクトルＶRをそのまま用いて
もよく、この場合は距離Ｙa2でバケツト角一定保持制御
を開始したときの角度でバケット１ｃの姿勢が一定とな
るよう制御することができる。また、上記の実施の形態
では、バケット角一定保持制御を開始する距離Ｙa2を領
域制限掘削制御を開始する距離Ｙa1より小さい値に設定
したが、領域制限掘削制御と同じ距離に設定してもよ
く、この場合は、領域制限掘削制御と同時にバケツト角
一定保持制御を行うことができるとともに、修正減速ベ
クトルＶARを演算する必要がないので、制御演算を簡素
化できる。
一定保持制御で、設定領域の境界とバケット先端との距
離が０であると仮定して修正減速ベクトルＶAR演算し、
この値を基にしてブーム１ａの目標角速度ωａを演算し
バケット１ｃの目標角速度ωｃを演算したが、領域制限
掘削制御で演算した減速ベクトルＶRをそのまま用いて
もよく、この場合は距離Ｙa2でバケツト角一定保持制御
を開始したときの角度でバケット１ｃの姿勢が一定とな
るよう制御することができる。また、上記の実施の形態
では、バケット角一定保持制御を開始する距離Ｙa2を領
域制限掘削制御を開始する距離Ｙa1より小さい値に設定
したが、領域制限掘削制御と同じ距離に設定してもよ
く、この場合は、領域制限掘削制御と同時にバケツト角
一定保持制御を行うことができるとともに、修正減速ベ
クトルＶARを演算する必要がないので、制御演算を簡素
化できる。
【００６９】更に、上記の実施の形態では、フロント作
業機がブーム、アーム、バケットの３つのフロント部材
を有する油圧ショベルに本発明を適用した場合について
説明したが、ブームが第１ブームと第２ブームとからな
る２ピースブーム式或いはオフセット式のフロント作業
機を有する油圧ショベルに本発明を適用してもよく、こ
の場合は、例えば車体に最も近い第１ブームを上記の実
施の形態でのブームとして扱えばよい。
業機がブーム、アーム、バケットの３つのフロント部材
を有する油圧ショベルに本発明を適用した場合について
説明したが、ブームが第１ブームと第２ブームとからな
る２ピースブーム式或いはオフセット式のフロント作業
機を有する油圧ショベルに本発明を適用してもよく、こ
の場合は、例えば車体に最も近い第１ブームを上記の実
施の形態でのブームとして扱えばよい。
【００７０】また、上記実施の形態では、操作レバー装
置は電気レバー方式としたが、油圧パイロット方式であ
ってもよい。また、フロント作業機の位置と姿勢に関す
る状態量を検出する手段として回動角を検出する角度検
出器を用いたが、シリンダのストロークを検出してもよ
い。
置は電気レバー方式としたが、油圧パイロット方式であ
ってもよい。また、フロント作業機の位置と姿勢に関す
る状態量を検出する手段として回動角を検出する角度検
出器を用いたが、シリンダのストロークを検出してもよ
い。
【００７１】
【発明の効果】本発明によれば、掘削時の負荷に係わら
ず精度良く領域制限掘削制御を行うことができるととも
に、領域制限掘削制御の演算部分に干渉することなく、
簡単なソフトの追加でバケットの姿勢を一定に保持する
制御を容易に組み込むことができ、制御プログラムのデ
バッグが容易となり、プログラミングのミスを予防でき
る。
ず精度良く領域制限掘削制御を行うことができるととも
に、領域制限掘削制御の演算部分に干渉することなく、
簡単なソフトの追加でバケットの姿勢を一定に保持する
制御を容易に組み込むことができ、制御プログラムのデ
バッグが容易となり、プログラミングのミスを予防でき
る。
【００７２】また、設定領域の境界の手前から、バケッ
ト先端が設定領域の境界状に到達したときの角度と同じ
角度でバケット角一定保持制御を行え、操作性を向上で
きる。 更に、設定領域の境界に近い位置からバケット
角一定保持制御を行え、この点でも操作性を向上でき
る。
ト先端が設定領域の境界状に到達したときの角度と同じ
角度でバケット角一定保持制御を行え、操作性を向上で
きる。 更に、設定領域の境界に近い位置からバケット
角一定保持制御を行え、この点でも操作性を向上でき
る。
【図１】本発明の第１の実施の形態による油圧ショベル
のフロント制御装置を油圧駆動装置と共に示す図であ
る。
のフロント制御装置を油圧駆動装置と共に示す図であ
る。
【図２】本発明が適用される油圧ショベルの外観とその
周囲の設定領域の形状を示す図である。
周囲の設定領域の形状を示す図である。
【図３】領域制限掘削制御で用いる座標系と領域の設定
方法を示す図である。
方法を示す図である。
【図４】領域制限掘削制御のための演算とバケット角一
定保持制御のための演算を行う制御手順を示すフローチ
ャートである。
定保持制御のための演算を行う制御手順を示すフローチ
ャートである。
【図５】領域制限掘削制御における減速領域及び復元領
域での速度ベクトルの補正方法を示す図である。
域での速度ベクトルの補正方法を示す図である。
【図６】領域制限掘削制御におけるバケットの先端と設
定領域の境界との距離と減速ベクトルとの関係を示す図
である。
定領域の境界との距離と減速ベクトルとの関係を示す図
である。
【図７】領域制限掘削制御でバケットの先端が補正通り
に減速制御されたときの軌跡の一例を示す図である。
に減速制御されたときの軌跡の一例を示す図である。
【図８】領域制限掘削制御におけるバケットの先端と設
定領域の境界との距離と復元ベクトルとの関係を示す図
である。
定領域の境界との距離と復元ベクトルとの関係を示す図
である。
【図９】領域制限掘削制御でバケットの先端が補正通り
に復元制御されたときの軌跡の一例を示す図である。
に復元制御されたときの軌跡の一例を示す図である。
【図１０】バケット角一定保持制御のためのバケットの
操作信号を演算する処理の詳細を示すフローチャートで
ある。
操作信号を演算する処理の詳細を示すフローチャートで
ある。
【図１１】領域制限掘削制御とバケット角一定保持制御
の関係を示す機能ブロック図である。
の関係を示す機能ブロック図である。
１Ａ フロント作業機 １Ｂ 車体 １ａ ブーム １ｂ アーム １ｃ バケット １ｄ 上部旋回体 １ｅ 下部走行体 ２ 油圧ポンプ ３ａ〜３ｆ 油圧アクチュエータ ４ａ〜４ｆ 操作レバー装置 ５ａ〜５ｆ 流量制御弁 ６ リリーフ弁 ７ 設定器 ８ａ，８ｂ，８ｃ 角度検出器 ９ 制御ユニット ５０ アーム速度指令値の演算部 ５１ アーム減速制御演算部 ５２ アーム出力指令値演算部 ５３ アーム各速度の実測値演算部 ５９ ブーム速度指令値の演算部 ６０ フロント姿勢演算部 ６１ 速度ベクトル演算部 ６２ 修正速度ベクトル演算部 ６３ ブーム角速度の目標値演算部 ６４ リンク変換部 ６５ ブーム出力指令値演算部 ７０ 偏差を０と改定した修正速度ベクトル演算部 ７１ ブーム角速度の目標値演算部 ７２ バケット速度指令値演算部 ７３ バケット角速度の目標値演算部 ７４ リンク変換部 ７５ バケット出力指令値演算部 ７６ バケット角速度の実測値演算部
───────────────────────────────────────────────────── フロントページの続き (72)発明者 小倉 弘 茨城県土浦市神立町650番地 日立建機株 式会社土浦工場内 (72)発明者 冨田 ▲禎▼久 茨城県土浦市神立町650番地 日立建機株 式会社土浦工場内 Ｆターム(参考） 2D003 AA01 AB03 AB04 BA01 BA06 BB07 BB11 DA03 DA04 DB04
Claims (5)
- 【請求項１】多関節型のフロント作業機を構成する上下
方向に回動可能なブーム、アーム、バケットを含む複数
のフロント部材と、前記複数のフロント部材をそれぞれ
駆動する複数の油圧アクチュエータと、前記複数のフロ
ント部材の動作を指示する複数の操作手段と、前記複数
の操作手段の操作信号に応じて駆動され、前記複数の油
圧アクチュエータに供給される圧油の流量を制御する複
数の油圧制御弁とを備える油圧ショベルに備えられ、前
記フロント作業機に領域を制限した掘削を連続して行わ
せる油圧ショベルのフロント制御装置において、 （ａ）前記フロント作業機の位置と姿勢に関する状態量
を検出する検出手段と、 （ｂ）前記検出手段からの信号に基づき前記フロント作
業機の位置と姿勢を演算する第１演算手段と、 （ｃ）前記検出手段からの信号に基づき前記アーム及び
バケットの実動作速度を演算し、この動作速度から前記
フロント作業機のバケット先端の速度ベクトルを演算す
る第２演算手段と、 （ｄ）前記フロント作業機のバケット先端が予め設定し
た領域内でその設定領域の境界の近傍にあるとき、前記
第１及び第２演算手段の演算値に基づき、前記第２演算
手段で演算した前記速度ベクトルの前記設定領域の境界
に接近する方向のベクトル成分を減じる減速ベクトルを
演算する第３演算手段と、 （ｅ）前記第３演算手段で演算した前記減速ベクトルに
対応する前記ブームの操作信号を演算しこれを対応する
油圧制御弁に出力する第４演算手段と、 （ｆ）前記第３演算手段で演算した減速ベクトルに対応
する前記ブームの目標動作速度を演算し、このブームの
目標動作速度と前記検出手段で検出した前記フロント作
業機の位置と姿勢に関する状態量とから前記バケットの
姿勢を一定に保持するための前記バケットの操作信号を
演算し、このバケットの操作信号を対応する油圧制御弁
に出力する第４演算手段とを備えることを特徴とする油
圧ショベルのフロント制御装置。 - 【請求項２】請求項１記載の油圧ショベルのフロント制
御装置において、 前記第３演算手段は、前記減速ベクトルとして、そのと
きの設定領域の境界とバケット先端との距離に対応する
第１減速ベクトルと、前記設定領域の境界と前記バケッ
ト先端との距離が０であると仮定した第２減速ベクトル
とを演算し、 前記第４演算手段は前記第１減速ベクトルを用いて前記
ブームの操作信号を演算し、 前記第５演算手段は前記第２減速ベクトルを用いて前記
ブームの目標動作速度を演算することを特徴とする油圧
ショベルのフロント制御装置。 - 【請求項３】請求項２記載の油圧ショベルのフロント制
御装置において、 前記第３演算手段は、設定領域の境界とバケット先端と
の距離の関数として減速係数を予め設定しておき、この
予め設定した関数から前記設定領域の境界とバケット先
端との距離に対応する減速係数を求め、前記第１及び第
２減速ベクトルを演算することを特徴とする油圧ショベ
ルのフロント制御装置。 - 【請求項４】請求項２記載の油圧ショベルのフロント制
御装置において、 前記第３演算手段は、前記設定領域の境界と前記バケッ
ト先端との距離が第１の値以下になると前記第１減速ベ
クトルの演算を開始し、前記設定領域の境界と前記バケ
ット先端との距離が前記第１の値より小さい第２の値以
下になると前記第２減速ベクトルの演算を開始すること
を特徴とする油圧ショベルのフロント制御装置。 - 【請求項５】請求項１記載の油圧ショベルのフロント制
御装置において、 前記第２演算手段は、前記検出手段からの信号に基づき
前記アーム及びバケットの実動作速度としてアーム及び
バケットの実角速度を演算し、 前記第５演算手段は、前記ブームの目標動作速度として
ブームの目標角速度を演算し、このブームの目標角速度
と前記第２演算手段で演算したアームの実角速度とか
ら、バケットが一定の角度を保つ動作をするときブーム
の角速度とアームの角速度とバケットの角速度との和が
０になる関係を用いて前記バケットの目標角速度を演算
し、このバケットの目標角速度から前記バケットの操作
信号を演算することを特徴とする油圧ショベルのフロン
ト制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2000369086A JP4215944B2 (ja) | 2000-12-04 | 2000-12-04 | 油圧ショベルのフロント制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2000369086A JP4215944B2 (ja) | 2000-12-04 | 2000-12-04 | 油圧ショベルのフロント制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2002167794A true JP2002167794A (ja) | 2002-06-11 |
| JP4215944B2 JP4215944B2 (ja) | 2009-01-28 |
Family
ID=18839181
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2000369086A Expired - Fee Related JP4215944B2 (ja) | 2000-12-04 | 2000-12-04 | 油圧ショベルのフロント制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4215944B2 (ja) |
Cited By (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009179968A (ja) * | 2008-01-29 | 2009-08-13 | Hitachi Constr Mach Co Ltd | 油圧ショベルのフロント制御装置 |
| US8340875B1 (en) * | 2011-06-16 | 2012-12-25 | Caterpillar Inc. | Lift system implementing velocity-based feedforward control |
| US8886415B2 (en) | 2011-06-16 | 2014-11-11 | Caterpillar Inc. | System implementing parallel lift for range of angles |
| US9115581B2 (en) | 2013-07-09 | 2015-08-25 | Harnischfeger Technologies, Inc. | System and method of vector drive control for a mining machine |
| JP2016215438A (ja) * | 2015-05-18 | 2016-12-22 | 東芝機械株式会社 | 加飾装置及び成形加飾システム |
| WO2017086488A1 (ja) * | 2016-11-29 | 2017-05-26 | 株式会社小松製作所 | 建設機械の制御装置及び建設機械の制御方法 |
| WO2017104408A1 (ja) * | 2016-11-29 | 2017-06-22 | 株式会社小松製作所 | 作業機制御装置および作業機械 |
| WO2017104407A1 (ja) * | 2016-11-29 | 2017-06-22 | 株式会社小松製作所 | 作業機制御装置および作業機械 |
| WO2017115809A1 (ja) * | 2015-12-28 | 2017-07-06 | 住友建機株式会社 | ショベル |
| WO2018051511A1 (ja) | 2016-09-16 | 2018-03-22 | 日立建機株式会社 | 作業機械 |
| US10120369B2 (en) | 2015-01-06 | 2018-11-06 | Joy Global Surface Mining Inc | Controlling a digging attachment along a path or trajectory |
| JP2018193704A (ja) * | 2017-05-15 | 2018-12-06 | コベルコ建機株式会社 | 作業機械の自動制御装置 |
| WO2019116842A1 (ja) * | 2017-12-14 | 2019-06-20 | 日立建機株式会社 | 作業機械 |
| JP2019132064A (ja) * | 2018-01-31 | 2019-08-08 | 株式会社小松製作所 | 積込機械の制御装置および制御方法 |
| CN115210430A (zh) * | 2021-01-27 | 2022-10-18 | 日立建机株式会社 | 液压挖掘机 |
| CN116657695A (zh) * | 2023-08-01 | 2023-08-29 | 徐工集团工程机械股份有限公司科技分公司 | 装载机工作装置的控制方法、装置及系统 |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH108489A (ja) * | 1996-06-26 | 1998-01-13 | Hitachi Constr Mach Co Ltd | 建設機械のフロント制御装置 |
| JPH10292417A (ja) * | 1997-04-21 | 1998-11-04 | Hitachi Constr Mach Co Ltd | 建設機械のフロント制御装置 |
-
2000
- 2000-12-04 JP JP2000369086A patent/JP4215944B2/ja not_active Expired - Fee Related
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH108489A (ja) * | 1996-06-26 | 1998-01-13 | Hitachi Constr Mach Co Ltd | 建設機械のフロント制御装置 |
| JPH10292417A (ja) * | 1997-04-21 | 1998-11-04 | Hitachi Constr Mach Co Ltd | 建設機械のフロント制御装置 |
Cited By (49)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009179968A (ja) * | 2008-01-29 | 2009-08-13 | Hitachi Constr Mach Co Ltd | 油圧ショベルのフロント制御装置 |
| US8340875B1 (en) * | 2011-06-16 | 2012-12-25 | Caterpillar Inc. | Lift system implementing velocity-based feedforward control |
| US8886415B2 (en) | 2011-06-16 | 2014-11-11 | Caterpillar Inc. | System implementing parallel lift for range of angles |
| US9506221B2 (en) | 2013-07-09 | 2016-11-29 | Harnischfeger Technologies, Inc. | System and method of vector drive control for a mining machine |
| US9115581B2 (en) | 2013-07-09 | 2015-08-25 | Harnischfeger Technologies, Inc. | System and method of vector drive control for a mining machine |
| US10120369B2 (en) | 2015-01-06 | 2018-11-06 | Joy Global Surface Mining Inc | Controlling a digging attachment along a path or trajectory |
| JP2016215438A (ja) * | 2015-05-18 | 2016-12-22 | 東芝機械株式会社 | 加飾装置及び成形加飾システム |
| JP2020122389A (ja) * | 2015-12-28 | 2020-08-13 | 住友建機株式会社 | ショベル及びショベル用のシステム |
| CN113107045A (zh) * | 2015-12-28 | 2021-07-13 | 住友建机株式会社 | 挖土机以及挖土机用的控制装置和挖土机的控制方法 |
| WO2017115809A1 (ja) * | 2015-12-28 | 2017-07-06 | 住友建機株式会社 | ショベル |
| US10781574B2 (en) | 2015-12-28 | 2020-09-22 | Sumitomo (S.H.I) Construction Machinery Co, Ltd. | Shovel |
| US11434624B2 (en) | 2015-12-28 | 2022-09-06 | Sumitomo(S.H.I) Construction Machinery Co., Ltd. | Shovel |
| JPWO2017115809A1 (ja) * | 2015-12-28 | 2018-10-25 | 住友建機株式会社 | ショベル |
| JP7341949B2 (ja) | 2015-12-28 | 2023-09-11 | 住友建機株式会社 | ショベル及びショベル用の制御装置 |
| US10794046B2 (en) | 2016-09-16 | 2020-10-06 | Hitachi Construction Machinery Co., Ltd. | Work machine |
| EP3514288A4 (en) * | 2016-09-16 | 2020-08-05 | Hitachi Construction Machinery Co., Ltd. | CONSTRUCTION MACHINE |
| WO2018051511A1 (ja) | 2016-09-16 | 2018-03-22 | 日立建機株式会社 | 作業機械 |
| KR20180044274A (ko) | 2016-09-16 | 2018-05-02 | 히다찌 겐끼 가부시키가이샤 | 작업 기계 |
| KR20190110641A (ko) | 2016-09-16 | 2019-09-30 | 히다찌 겐끼 가부시키가이샤 | 작업 기계 |
| JPWO2017086488A1 (ja) * | 2016-11-29 | 2017-11-16 | 株式会社小松製作所 | 建設機械の制御装置及び建設機械の制御方法 |
| JPWO2017104407A1 (ja) * | 2016-11-29 | 2017-12-14 | 株式会社小松製作所 | 作業機制御装置および作業機械 |
| KR101886798B1 (ko) * | 2016-11-29 | 2018-08-08 | 가부시키가이샤 고마쓰 세이사쿠쇼 | 작업기 제어 장치 및 작업 기계 |
| KR20180062967A (ko) * | 2016-11-29 | 2018-06-11 | 가부시키가이샤 고마쓰 세이사쿠쇼 | 건설 기계의 제어 장치 및 건설 기계의 제어 방법 |
| WO2017104407A1 (ja) * | 2016-11-29 | 2017-06-22 | 株式会社小松製作所 | 作業機制御装置および作業機械 |
| KR101934052B1 (ko) * | 2016-11-29 | 2018-12-31 | 가부시키가이샤 고마쓰 세이사쿠쇼 | 작업기 제어 장치 및 작업 기계 |
| CN107109818A (zh) * | 2016-11-29 | 2017-08-29 | 株式会社小松制作所 | 工程机械的控制装置及工程机械的控制方法 |
| US10352021B2 (en) | 2016-11-29 | 2019-07-16 | Komatsu Ltd. | Work equipment control device and work machine |
| KR101907938B1 (ko) | 2016-11-29 | 2018-10-15 | 가부시키가이샤 고마쓰 세이사쿠쇼 | 건설 기계의 제어 장치 및 건설 기계의 제어 방법 |
| WO2017086488A1 (ja) * | 2016-11-29 | 2017-05-26 | 株式会社小松製作所 | 建設機械の制御装置及び建設機械の制御方法 |
| KR20180062968A (ko) * | 2016-11-29 | 2018-06-11 | 가부시키가이샤 고마쓰 세이사쿠쇼 | 작업기 제어 장치 및 작업 기계 |
| US10501911B2 (en) | 2016-11-29 | 2019-12-10 | Komatsu Ltd. | Work equipment control device and work machine |
| US10584463B2 (en) | 2016-11-29 | 2020-03-10 | Komatsu Ltd. | Control device for construction machine and method of controlling construction machine |
| CN107109820B (zh) * | 2016-11-29 | 2020-04-28 | 株式会社小松制作所 | 工作装置控制装置以及作业机械 |
| CN107109820A (zh) * | 2016-11-29 | 2017-08-29 | 株式会社小松制作所 | 工作装置控制装置以及作业机械 |
| JPWO2017104408A1 (ja) * | 2016-11-29 | 2017-12-21 | 株式会社小松製作所 | 作業機制御装置および作業機械 |
| WO2017104408A1 (ja) * | 2016-11-29 | 2017-06-22 | 株式会社小松製作所 | 作業機制御装置および作業機械 |
| JP2018193704A (ja) * | 2017-05-15 | 2018-12-06 | コベルコ建機株式会社 | 作業機械の自動制御装置 |
| KR20200087744A (ko) * | 2017-12-14 | 2020-07-21 | 히다찌 겐끼 가부시키가이샤 | 작업 기계 |
| WO2019116842A1 (ja) * | 2017-12-14 | 2019-06-20 | 日立建機株式会社 | 作業機械 |
| US11555294B2 (en) | 2017-12-14 | 2023-01-17 | Hitachi Construction Machinery Co., Ltd. | Work machine |
| KR102378143B1 (ko) | 2017-12-14 | 2022-03-24 | 히다찌 겐끼 가부시키가이샤 | 작업 기계 |
| JP2019132064A (ja) * | 2018-01-31 | 2019-08-08 | 株式会社小松製作所 | 積込機械の制御装置および制御方法 |
| US11286638B2 (en) | 2018-01-31 | 2022-03-29 | Komatsu Ltd. | Loading machine control device and control method |
| JP7036606B2 (ja) | 2018-01-31 | 2022-03-15 | 株式会社小松製作所 | 積込機械の制御装置および制御方法 |
| WO2019150616A1 (ja) * | 2018-01-31 | 2019-08-08 | 株式会社小松製作所 | 積込機械の制御装置および制御方法 |
| CN115210430A (zh) * | 2021-01-27 | 2022-10-18 | 日立建机株式会社 | 液压挖掘机 |
| CN115210430B (zh) * | 2021-01-27 | 2024-03-15 | 日立建机株式会社 | 液压挖掘机 |
| CN116657695A (zh) * | 2023-08-01 | 2023-08-29 | 徐工集团工程机械股份有限公司科技分公司 | 装载机工作装置的控制方法、装置及系统 |
| CN116657695B (zh) * | 2023-08-01 | 2023-10-03 | 徐工集团工程机械股份有限公司科技分公司 | 装载机工作装置的控制方法、装置及系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP4215944B2 (ja) | 2009-01-28 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3091667B2 (ja) | 建設機械の領域制限掘削制御装置 | |
| KR100281009B1 (ko) | 2피스부움식 유압셔블의 간섭 방지장치 | |
| US5799419A (en) | Method for controlling the operation of power excavator | |
| JP4776640B2 (ja) | 油圧ショベルのフロント制御装置 | |
| US4889466A (en) | Control device for a power shovel | |
| JP2002167794A (ja) | 油圧ショベルのフロント制御装置 | |
| JPH06336747A (ja) | シヨベル系建設機械の作業部制御装置 | |
| JPH11350537A (ja) | 油圧作業機械の制御装置 | |
| JP2000303492A (ja) | 建設機械のフロント制御装置 | |
| JP2000355957A (ja) | 油圧ショベルの領域制限掘削制御装置 | |
| JPH0823155B2 (ja) | 作業機の制御装置 | |
| JP3682352B2 (ja) | 建設機械のフロント制御装置 | |
| JP2912986B2 (ja) | 作業機の軌跡制御装置 | |
| JPH10292417A (ja) | 建設機械のフロント制御装置 | |
| JPH10292420A (ja) | 油圧ショベルの掘削軌跡制御装置 | |
| JP3781920B2 (ja) | 建設機械の領域制限掘削制御装置 | |
| JP3437348B2 (ja) | 建設機械の軌跡制御装置 | |
| JPH0745742B2 (ja) | 油圧ショベルの掘削制御方法 | |
| JPH0791844B2 (ja) | 作業機の制御装置 | |
| JP2574671B2 (ja) | パワ−シヨベルにおける作業機の制御装置 | |
| JP2601865B2 (ja) | 作業機の軌跡制御装置 | |
| JP3705661B2 (ja) | 建設機械の作業機の姿勢制御装置 | |
| JP2699097B2 (ja) | 建設機械のバケット刃先深さ制御装置 | |
| JPS62164921A (ja) | マスタスレ−ブ式パワ−シヨベルの制御装置 | |
| JPH04171302A (ja) | 建設機械 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060605 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20080724 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20080805 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20080904 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20081104 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20081105 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111114 Year of fee payment: 3 |
|
| LAPS | Cancellation because of no payment of annual fees |