JP4973410B2 - 建設機械のアーム駆動用制御装置 - Google Patents

Description

本発明は、アームを有する建設用機械で、アームを動かす動力として電動機を用い、この電動機を駆動するのにインバータを用いるシステムにおいて、このアームを動かす速度制御装置に関するものである。

現在、アームを有する建設用機械、例えばショベルカーのアームを左右旋回方向に動かす動力は油圧モータで、このモータはディーゼルエンジンと油圧ポンプにより発生させる高圧、大量の油で駆動する。旋回方向、速度制御は油圧ポンプと油圧モータの間に設けられたコントロールバルブにより、方向、流量を調整して行う。欠点としては、効率が悪く、高圧、大量の油を使用するため、油漏れ、火災など環境性と安全性を配慮したメンテナンスが必要となることである。これらの事項を解決するため、近年、小型で効率が高く、強力な電動機の出現と、これらの電動機を駆動するインバータが小型、高性能化されたことで、アームを旋回方向に動かす動力に、電動機とインバータの組合せが使用され始めた。
この電動機で駆動するアームの操作方法は、図９に示すように、操作レバー１が中央にいる状態を０とし、右に傾けたときをプラス信号、左に傾けたときをマイナス信号として旋回速度信号が出力される。このように、操作レバー１を倒すことで、旋回方向、速度調整を行うが、中央部付近では無感帯領域として遊びを設け、旋回方向の指令は操作レバー１を左右に倒す方向で指令し、旋回速度の度合いはレバーの傾きで調整する。
アーム制御用インバータの構成図を図１０に示す。操作者が意図する動きを操作レバー１で実現できるように操作して、操作レバー１からの指令信号を、フィルタ部４に出力するが、このフィルタ部は建設機械自身の振動が操作レバー１を揺らすことにより発生する機械的振動によるノイズ除去と応答速度を調整するために必要であり、フィルタ部４の出力１０はインバータで実現しようとする旋回方向と速度の指令信号でインバータの制御部５に出力し、この指令値に応じてインバータ７がアーム用電動機６を駆動しアームを動かす。このフィルタは加速時も減速時のどちらにも使用するので、加速時も減速時も応答速度は同じとなる。
なお、建設用機械のアーム制御としては特許文献１が公知となっているが、この特許文献１では、電動機を制御するためにインバータを用い、このインバータのコントローラにレバーからの制御信号を入力して電動機を制御することが記載されているが、図１０で示すようなフィルタ部については、記載されてない。
特開２００１−２２６０７７

安全性、作業性、環境性を考慮し、かつ人間工学的にも良いとされるアーム旋回速度は、加速時はゆっくりとした応答で、減速時は速い応答で、かつ急激な加減速をしないことである。現状では、加速時、減速時とも同じ応答速度で、応答速度は減速時に合わせて速く設定することが多いため、微加速で動かすべき動作のところを速く動かしてしまう可能性が高く、安全性の低下と、作業性が悪いという課題はある。他に、急加速から急減速した場合は速度の時間微分による過大な力がアームにかかり、振動、騒音が発生して環境条件を悪化させるという課題がある。

本発明が目的とするところは、アームを有する建設用機械で、アームを動かす動力として電動機を用い、この電動機を駆動するのにインバータを用いるシステムにおいて、作業性、安全性、環境性を向上させるためにアーム動作の加速時、減速時の応答速度を、各時別々に調整をできるようにし、さらに急加速から急減速の指令でも急激な速度変化を抑制するインバータ装置を提供することにある。

本発明の請求項１は、アームを有する建設用機械で、アームを動かす動力として電動機を用い、この電動機を制御するインバータであって、このインバータの制御信号はアームを操作する操作レバーの操作量がフィルタ部を通して入力されるものにおいて、
前記操作レバーの操作量を入力して加減速を判断する加減速判断処理部と、加速
状態時用の時定数と減速状態時用の時定数が各別に設定され、前記加減速判断処理部の判断処理信号に応じて加速か減速かの時定数を選択する加速状態時用時定数、減速状態時用時定数の選択部を設け、
前記加減速判断処理部による加減速判断時の判定値は、操作レバーの機械的振動によるノイズの１．５〜２．０倍の範囲とし、この判定値と前記操作レバーの操作による変化量の絶対値の関係が｜変化量｜＞判定値で、且つ変化量＞０のときに加速状態と判定し、｜変化量｜＞判定値で、且つ変化量＜０のときに減速状態と判定し、｜変化量｜≦判定値のときに定常状態として判断することを特徴としたものである。

本発明の請求項２は、前記選択部における時定数は、加速時の応答速度を減速時の応答速度より遅く設定することを特徴とした特徴としたものである。

本発明の請求項３は、前記操作レバーの操作による速度指令信号と前記フィルタ部の出力信号との差分を求め、この差分をフィルタ差分として前記加減速判断処理部に入力し、加減速判断処理部は前記判定値と操作レバーの操作による変化量の絶対値の関係が｜変化量｜＞判定値、変化量＜０で、且つ前記フィルタ差分＞０のときに加速状態と判断し、｜変化量｜＞判定値、変化量＜０で、且つ前記フィルタ差分＜０のときに減速状態と判断することを特徴としたものである。

以上のとおり、本発明によれば、アームを有する建設用機械で、アームを動かす動力として電動機を用い、この電動機を駆動するのにインバータを用いるシステムにおいて、実現しようとするアーム動作速度の、加速状態、減速状態の応答速度を、別々に調整できるようになり、作業性、安全性が大幅に向上する効果があると共に、操作上での速度指令で、急加速から急減速する時でも、インバータへの速度指令は急激な変化を抑制させスムーズな動作を実現し、その結果アームにかかる力も小さくなり、振動、騒音の低減ができるので環境性も改善される効果がある。

本願発明は、アームの動作を電動機とインバータで駆動、制御する方式において、安全性、作業性、環境性を向上するため、加速時と減速時に各々専用のフィルタ定数を使用して、応答性を別々に調節するものである。以下、実施例に基づき詳述する。

図１は、本発明の旋回方向での実施例を示す構成図である。１はアームの操作レバーで、旋回方向と速度指令の2条件の設定を行う。２は加減速判断処理部で、操作レバー１からの信号を受け、加速状態の指令か減速状態の指令かの判断を行う。３は加速状態時用時定数、減速状態時用時定数の選択部で各時の時定数が記憶され、加減速判断処理部２からの指令に基き、どちらかの時定数を選択して４のフィルタ部の定数設定を行う。フィルタ部の定数設定は２と３から構成される定数設定部８により行われる。５はインバータの制御部であり、フィルタ部４から送出される旋回方向と速度指示の出力でインバータ７を制御する。６はアーム駆動用電動機で、インバータ７で駆動される。インバータ７は２から５の構成要素からなる。以上のように構成されたものにおいて、その動作を説明する。

アームの速度指令が加速状態か減速状態かの判断は、操作レバーの指令値の変化量から判断するため、操作レバー１からの旋回方向と速度指令値の2条件を含んだ信号を定期的にサンプリングし、２の加速減速判断処理部で速度指令値のみ取出すため、旋回方向を指示する正負の極性を絶対値演算で除去した後、変化量を式（１）で計算する。

変化量＝｜今回の指令値｜−｜前回の指令値｜ … （１）
操作レバー１から発する指令値には、操作レバー自身が受ける械的振動により生じる振動幅が含まれるため誤差を含んでいるので、この式（１）の変化量による加速、減速の判断を確実にするため、判定値としては振動幅の１．５倍から２倍程度の式（２）で設定する値を用いる。

判定値＝（レバーの機械的振動によるノイズ）×１．５〜２程度 …（２）
この判定値を用いた、加速状態の判断は式（３）で、減速状態の判断は式（４）で行い、
加速状態の判断 ｜変化量｜＞判定値 かつ 変化量＞０ … （３）
減速状態の判断 ｜変化量｜＞判定値 かつ 変化量＜０ … （４）
定常状態 ｜変化量｜≦判定値 … （５）
式（５）の時は、加速でもなく減速でもない、定常状態と判断する。加減速状態の判断フローを図２示す。加減速判断処理部２で判断が決定した後、３の加速状態時用時定数、減速状態時用時定数の選択部は、各時の時定数、定常状態では直前まで使用していた時定数を選択して、フィルタ部４の時定数を設定する。
フィルタ部４の出力はインバータの制御部５に旋回方向と速度信号として入力されて、加速状態時と減速状態時の応答速度を別々に調節できる制御が実現でき、作業性、安全性が向上する。フィルタが一次遅れで加速時定数が減速時定数より大きい時の、操作レバーの指令値とフィルタ部４の入出力関係図を図３に示す。
図３で明らかなように、実現しようとするアーム動作速度の、加速状態、減速状態の応答速度を、別々に調整できるようになり、作業性、安全性が大幅に向上するものである。

図４は、本発明の他の実施例を示す構成図で、図１と同じ部分若しくは相当する部位に同符号を付してその説明を省略する。実施例１の場合、加速、減速の定常時での応答速度は円滑に実行できるが、図３で示すように、加速状態から減速状態に移行する過渡時において、速度指令として急加速から急減速が発せられる場合がある。実施例２は、急加速変化を抑制して更に安全性の向上を図ったものである。

図４において、図１と相違する点は、操作レバーからの速度指令信号からインバータへの速度指令であるフィルタ出力の差分を求める演算部９が追加されたもので、この演算結果は、加減速判断処理部に出力され、加速状態から減速状態への切替えの追加の条件とし、その動作を説明する。
加速状態から減速状態に切替えるタイミングを、操作レバーからの速度指令値とインバータへの速度指令値であるフィルタ出力との差（以下、フィルタ差分という）を式（６）により９の演算部で算出する。

フィルタ差分=｜指令値｜−｜フィルタ出力｜ … （６）
算出されたフィルタ差分は加減速判断処理部２に出力され、２ではフィルタ差分の条件を追加して、加速状態の判断は式（７）、減速状態の判断は式（８）、で行い、その他の条件では、定常状態と判断する。
加速状態の判断 ｜変化量｜＞判定値かつ変化量＞０かつフィルタ差分＞０ …（７）
減速状態の判断 ｜変化量｜＞判定値かつ変化量＜０かつフィルタ差分＜０ …（８）
図５に示すように、フィルタ差分が正から負に変わる時に、加速状態から減速状態と判断することで、インバータ制御部への速度指令として大きな変化がなく、これによってスムーズな切替えが実現できる。加減速状態の判断フローを図６に示す。加減速判断処理部２で判断が決定した後、３の加速状態時用時定数、減速状態時用時定数の選択部は、各時の時定数、定常状態では直前まで使用していた時定数を選択して、フィルタ部４の時定数を設定する。フィルタの出力はインバータの制御部５に旋回方向と速度信号として入力されて、加速状態時と減速状態時の応答速度を別々に調節できる制御が実現でき、作業性、安全性が向上する。
図７と図８は、図６の手法による実際のフィルタの入出力動作図で、加速時定数５００ｍｓ、減速字定数５０ｍｓとしたときの指令値（実線）とフィルタ出力（点線）で、フィルタ出力が指令値に追いついた時点で時定数の切換が実行され、より安全な制御の実行が可能となる。

本発明の実施形態を示す構成図 加速減速状態の判断フロー図 フィルタ入出力波形図 本発明の他の実施形態を示す構成図 フィルタ出力を考慮したフィルタ入出力波形図 フィルタ出力を考慮した加速減速状態の判断フロー図 フィルタ動作図１ フィルタ動作図２ 操作レバー実態図と入出力関係図 インバータ構成図

符号の説明

１… 操作レバー
２… 加減速判断処理部
３… 加速状態時用時定数、減速状態時用時定数の選択部
４… フィルタ部
５… 制御部
６… アーム駆動用電動機
７… インバータ
８… フィルタ時定数設定部
９… フィルタ差分演算部
１０…旋回方向指令と速度指令

Claims (3)

1. アームを有する建設用機械で、アームを動かす動力として電動機を用い、この電動機を制御するインバータであって、このインバータの制御信号はアームを操作する操作レバーの操作量がフィルタ部を通して入力されるものにおいて、
   前記操作レバーの操作量を入力して加減速を判断する加減速判断処理部と、加速
   状態時用の時定数と減速状態時用の時定数が各別に設定され、前記加減速判断処理部の判断処理信号に応じて加速か減速かの時定数を選択する加速状態時用時定数、減速状態時用時定数の選択部を設け、
   前記加減速判断処理部による加減速判断時の判定値は、操作レバーの機械的振動によるノイズの１．５〜２．０倍の範囲とし、この判定値と前記操作レバーの操作による変化量の絶対値の関係が｜変化量｜＞判定値で、且つ変化量＞０のときに加速状態と判定し、｜変化量｜＞判定値で、且つ変化量＜０のときに減速状態と判定し、｜変化量｜≦判定値のときに定常状態として判断することを特徴とした建設機器のアーム駆動用電動機の制御装置。
2. 前記選択部における時定数は、加速時の応答速度を減速時の応答速度より遅く設定することを特徴とした請求項１記載の建設機器のアーム駆動用電動機の制御装置。
3. 前記操作レバーの操作による速度指令信号と前記フィルタ部の出力信号との差分を求め、この差分をフィルタ差分として前記加減速判断処理部に入力し、加減速判断処理部は前記判定値と操作レバーの操作による変化量の絶対値の関係が｜変化量｜＞判定値、変化量＜０で、且つ前記フィルタ差分＞０のときに加速状態と判断し、｜変化量｜＞判定値、変化量＜０で、且つ前記フィルタ差分＜０のときに減速状態と判断することを特徴とした請求項１又は２記載の建設機器のアーム駆動用電動機の制御装置。

Images