JP2011505029A - 液圧作動ブームの調整方法、装置およびコンピュータプログラム - Google Patents

液圧作動ブームの調整方法、装置およびコンピュータプログラム Download PDF

Info

Publication number
JP2011505029A
JP2011505029A JP2010527481A JP2010527481A JP2011505029A JP 2011505029 A JP2011505029 A JP 2011505029A JP 2010527481 A JP2010527481 A JP 2010527481A JP 2010527481 A JP2010527481 A JP 2010527481A JP 2011505029 A JP2011505029 A JP 2011505029A
Authority
JP
Japan
Prior art keywords
boom
movement
computer program
adjustment
joint
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
Application number
JP2010527481A
Other languages
English (en)
Other versions
JP5255643B2 (ja
Inventor
ユッシ プウラ、
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Sandvik Mining and Construction Oy
Original Assignee
Sandvik Mining and Construction Oy
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Sandvik Mining and Construction Oy filed Critical Sandvik Mining and Construction Oy
Publication of JP2011505029A publication Critical patent/JP2011505029A/ja
Application granted granted Critical
Publication of JP5255643B2 publication Critical patent/JP5255643B2/ja
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/19Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66CCRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
    • B66C13/00Other constructional features or details
    • B66C13/18Control systems or devices
    • B66C13/20Control systems or devices for non-electric drives
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1653Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/0205Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system
    • G05B13/024Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system in which a parameter or coefficient is automatically adjusted to optimise the performance
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/39Robotics, robotics to robotics hand
    • G05B2219/39206Joint space position control
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/40Robotics, robotics mapping to robotics vision
    • G05B2219/40124During manipulator motion, sensor feedback to adapt model in memory

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Robotics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Evolutionary Computation (AREA)
  • Artificial Intelligence (AREA)
  • Health & Medical Sciences (AREA)
  • Manufacturing & Machinery (AREA)
  • Human Computer Interaction (AREA)
  • Feedback Control In General (AREA)
  • Operation Control Of Excavators (AREA)
  • Earth Drilling (AREA)
  • Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
  • Numerical Control (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

本発明は、液圧作動ブームの動作を調整する方法および装置ならびにコンピュータプログラムに関するものであり、ブーム(1)は、液圧アクチュエータ(5a〜5b、7a〜7b)によって相対的に動くように連結された少なくとも2つの可動的相互連結ブーム部(1a、1b)と、液圧アクチュエータを制御する制御手段(13、14)と、ブーム部(1a、1b)間の位置を検出する検出器(15)とを含み、それにより、ブーム(1)の動作を調整するために、制御手段にある継ぎ手制御装置の、動きに固有の調整パラメータを個々の動きごとに設定することができる。本発明では、ブーム部(1a、1b)の相対的動きをブーム部(1a、1b)間の所定の位置に対してその両側において制御し、制御信号に応じて検出器(15)から取得した実際の位置および運動速度の値を理論上の位置および運動速度の値と比較し、これらの値の間の差に基づいて継ぎ手制御装置の調整パラメータを調整する。
【選択図】図1a

Description

発明の背景
本発明は、液圧作動ブームの動作を調整する方法に関するものであり、このブームは、少なくとも2つの可動的に相互連結されたブーム部を含み、各ブーム部は軸を中心に相対的に回転するように、または液圧アクチュエータによって直線運動で移動するように可動的に連結され、
−液圧アクチュエータを制御する制御手段と、
−ブーム部間の動きおよび位置を検出する検出器とを含み、
−各動きは制御手段に含まれる継ぎ手制御装置によって制御され、ブームの動作を調整するために、制御手段にある継ぎ手制御装置の、動きに固有の調整パラメータを個々の動きごとに設定することができる。
本発明はまた、液圧作動ブームの動作の調整装置に関するものであり、このブームは、少なくとも2つの可動的に相互連結されたブーム部を含み、各ブーム部は、軸を中心に相対的に回転するように、または液圧アクチュエータによって直線運動で移動するように可動的に連結され、ブームはさらに、液圧アクチュエータを制御する制御手段と、ブーム部間の動きおよび位置を検出する検出器とを含み、各動きは制御手段に含まれる継ぎ手制御装置によって制御され、ブームの動作を調整するために、制御手段にある継ぎ手制御装置の、動きに固有の調整パラメータを個々の動きごとに設定することができる。
また、本発明は、液圧作動ブームの動作の調整装置に含まれる処理装置を制御するコンピュータプログラムを含み、このブームは少なくとも2つの可動的に相互連結されたブーム部を含み、各ブーム部は軸を中心に相対的に回転するように、または液圧アクチュエータによって直線運動で移動するように可動的に連結され、前述の調整装置は液圧アクチュエータを制御する制御手段と、ブーム部間の動きおよび位置を検出する検出器とを含み、各動きは制御手段に含まれる継ぎ手制御装置によって制御され、ブームの動作を調整するために、制御手段にある継ぎ手制御装置の、動きに固有の調整パラメータを個々の動きに対して設定でき、このコンピュータプログラムはブームの動作を調整するプログラムコードを含む。
多段の液圧作動ブームは様々な装置に使用される。液圧式ブームは「開鎖」型のマニピュレータであり、2つ以上の連続する継ぎ手からなり、この継ぎ手は連結アームによって接続されている。継ぎ手は回転自在な回転継ぎ手または柱状継ぎ手でよく、連結アームの相対的動きは直線的、つまり一直線である。ブーム端部のデカルト位置を達成するためには、逆運動学で算出した角度値にブーム継ぎ手の連結角度を調整する必要がある。継ぎ手の位置の情報を検出器で求め、これにより作成した位置データを、各継ぎ手を調整する際、該当する継ぎ手の位置を調整する継ぎ手制御装置に入力する。継ぎ手制御装置は、一般的にはデジタル処理装置アプリケーションであり、これは、継ぎ手の位置を変更するアクチュエータを制御して所期の継ぎ手の位置と検出器が測定した実際の位置との差分をできるだけ零に近けるものである。
ブーム制御の目的は、ブーム端に位置する工具を十分な精度で所望の位置に置くことにある。その一方で、ブームの動きの動特性をできるだけ良好にすることを目的とする。良好な動特性とは、アクチュエータおよび調整可能な継ぎ手における所望の位置に対する、また最小振動量に対する継ぎ手の、またそれによりブーム全体の位置決め率を言う。
液圧式ブームの場合、ソフトウェアで実現される、または制御機器に含まれる継ぎ手制御装置パラメータを調整して、用いた調整アルゴリズムによってブームを望み通りに動作させる、すなわち、できるだけ完全に設定値の変化に追従させようとすることは、かなり困難な作業である。液圧式ブームの複雑な力学はモデル化するのが難しいため、調整装置を調整するのが困難である。また、液圧式ブームは構造上、可撓性および弾性を特徴とするため、継ぎ手制御装置のパラメータ調整も難しい。複数のブーム継ぎ手を同時に動かす必要がある場合、継ぎ手制御装置の最適な調整は、1自由度の場合とは大きく異なる。一般的な調整方法を多段マニピュレータの継ぎ手制御装置に適用するのは、まったく不可能ではないであろうが、難しい。ブーム制御および調整の管理は、1つの継ぎ手を調整すると、他の継ぎ手の加速および位置の変化に加え、調整可能な継ぎ手に対するブーム連結アームの慣性モーメントの変化によって、調整対象の継ぎ手の調整特性が影響を受けることから、さらに複雑である。
調整装置の実験的な調整に代わるものとして、調整すべき系の正確な数学モデルを作成して、このモデルに基づいて継ぎ手制御装置を調整する。しかしこれには、モデルを作成しても1つの特定のブームのみを正確に表すにすぎず、各ブームのモデルを個々にモデル化しなければならないという問題点がある。これは、たとえもっと簡単な実験方式を用いることができたとしても、現実面において経済的に実行不可能である。
現在、ブーム調整制御は、1自由度の場合について種々のパラメータの近似値を求めることで調整し、次に、所望の動作が実現するまで、継ぎ手制御装置パラメータを暗探法を用いて継ぎ手ごとに調整する。調整者が調整技術について情報不足であると、実際において、継ぎ手制御装置パラメータの役割を果たす数値を与えることができない。結局、調整の最終結果の評価について適切な方法および指標がないと、最終結果は視覚的な判断のみに基づくことになる。
発明の簡単な説明
本発明は、公知の技術よりも簡便で、継ぎ手の数および型に関係なくいろいろなブームに適用可能な液圧作動ブームの動作を調整する方法および装置を提供することを目的とする。
本発明の方法は、ブーム部の相対的動きを、ブーム部の間の所定の位置に対してその両側で、対称的で反復する制御信号を用いて制御し、制御信号に応じて検出器から取得した実際の位置値および運動速度値を、制御信号に基づいて決定した理論上の位置値および運動速度値と比較し、これらの値の間の差に基づいて、継ぎ手制御装置の調整パラメータを調整し、検出器から取得した実際の位置値および運動速度値と制御信号に基づいて決定した理論上の位置値および運動速度値との差が所期の大きさになるまでこの調整を続けることを特徴とする。
本発明の装置は、ブーム部の相対的動きを、ブーム部の間の所定の位置に対してその両側で、対称的で反復する制御信号を用いて制御するように構成可能であり、制御手段は、制御信号に応じて検出器から取得した実際の位置値および運動速度値を、制御信号に基づいて決定した理論上の位置値および運動速度値と比較する手段と、これらの値の間の差に基づいて、継ぎ手制御装置の調整パラメータを調整し、検出器から取得した実際の位置値および運動速度値と制御信号に基づいて決定した理論上の位置値および運動速度値との差が所期の大きさになるまでこの調整を続ける手段とを含むことを特徴とする。
本発明のコンピュータプログラムは、
ブーム部の相対的動きを、ブーム部の間の所定の位置に対してその両側で、対称的な反復する制御信号を用いて制御し、制御信号に応じて検出器から取得した実際の位置値および運動速度値を、制御信号に基づいて決定した理論上の位置値および運動速度値と比較し、これらの値の間の差に基づいて、継ぎ手制御装置の調整パラメータを調整し、検出器から取得した実際の位置値および運動速度値と制御信号に基づいて決定した理論上の位置値および運動速度値との差が所期の大きさになるまでこの調整を続けるプログラムコードを含むことを特徴とする。
本発明の基本概念は、ブーム部運動の調整可能な継ぎ手制御装置の設定値の役割を果たす対称的で、好ましくは正弦波の制御信号を、開始位置、すなわち零位置の両側に供給してブーム部を往復運動させ、同時にブーム部の相対的位置を角度または位置検出器で測定することにある。また、実施例の基本概念は、動きの位置および速度を表示装置に位置および速度の座標系で示すことであり、表示結果は実質的に楕円状のパターンとなる。さらに別の基本概念は、設定値および運動速度に基づいて作成されるパターンを、位置および速度の座標系に示す測定した継ぎ手の現在値およびその運動速度に基づいて作成されるパターンと比較して、その差に基づいて、継ぎ手制御装置の調整パラメータ、例えば制御装置利得を変更することにある。測定して実現したパターンが十分な精度で設定値パターンと一致すると、調整が完了する。
本発明を添付図面と関連付けて詳細に述べる。
液圧式ブームの概略側面図である。 同じくその概略上面図である。 ブームの動作を制御する制御装置接続部の概略図である。 ないし 1ブーム継ぎ手の制御装置の調整において可能なユーザインタフェースの表示を概略的に示す図である。 ブーム位置決め精度の測定値を概略的に示す図である。
発明のいくつかの実施例の詳細な説明
図1aおよび図1bは、液圧作動ブーム1の概略側面および同様に概略上面を示す図であり、ブーム1は、例えば、複数のブーム部1aおよび1bを有する削岩装置ブームである。ブーム部1a〜1bは相互に連結され、また他方において、概略的に図示したキャリア2に継ぎ手3aによって連結され、先端のブーム部1bの端部には工具4が継ぎ手3bによって取り付けてある。工具4の位置決めは、ブーム部1a〜1bをキャリア2および互いに対して回転させ、また工具をブーム部1bに対して回転させて行う。ブームは、キャリアおよびブーム部の継ぎ手3a〜3cに作用するアクチュエータ5a〜5bを用いて制御する。同様に、図1bは継ぎ手6a〜6cを示し、これら継ぎ手の各軸は継ぎ手3aおよび3bと直交関係にあり、これらの軸を中心にブーム部がアクチュエータ7a〜7cによってキャリアおよび互いに対して回転する。
図2は、ブームを1つの継ぎ手3aに関連して制御する接続部を概略的に示す。これは、継ぎ手3aによってキャリア2に連結されたブーム部1aを含む。キャリア2とブーム部1aの間には液圧アクチュエータ5aを設けてあり、このアクチュエータは例えば液圧シリンダである。ポンプ8は、液圧流体を制御弁11から液圧流体路9および10を通って液圧シリンダに供給し、また同様に、液圧流体を液圧流体容器12に戻す。制御弁11は継ぎ手制御装置13によって制御されるように接続され、継ぎ手制御装置13は、制御ユニット14の一部として概略的に図示するが、制御ユニット14によって制御される。継ぎ手3aは角度検出器15を含み、角度検出器はブーム部1aとキャリアの間の回転角度を検出するものであり、破線で示すように、継ぎ手制御装置13および適宜、制御ユニット14にも接続されて回転角度を検出する。継ぎ手制御装置は、独立した電子的に動作する調整装置でよく、電子的に動作する制御ユニットの一部または制御用のソフトウェアの一部であり、本特許出願明細書および特許請求の範囲においては、継ぎ手制御装置とは上述のすべてを指す。継ぎ手制御装置13は実時間で、制御ユニット14の与える設定値と検出器15の生成する位置情報との差に基づいて、選択された調整アルゴリズムに従って制御弁11の制御を選択する。
また、継ぎ手は角柱状でもよく、その場合、検出器は角度の代わりに連結アーム間の直線的な動きを測定する。さらに、制御装置は一般的に表示装置16を備え、この表示装置に、ブーム継ぎ手の連結角度および/またはブーム端または工具のデカルト位置を表示してもよい。実際には、現存のコンピュータ制御による装置では、継ぎ手制御装置と制御ユニットとは一般に同一の処理装置、すなわちマイクロプロセッサであり、制御機能および継ぎ手制御装置機能をソフトウェアによって行う。当然のことながら、本発明の適用において、本来知られている他のいろいろな方式を用いることも可能である。
図3aないし図3cは、一例として図2の1継ぎ手のモデルを使用して、継ぎ手制御装置を調整するブーム制御におけるユーザインタフェース表示を概略的に示す。図3aは、あるブーム継ぎ手の理論上の位置/速度記述子を表示装置に示す表示例を示している。ブーム継ぎ手の記述子は原則的に、設定値およびその導関数として与えられる正弦波信号の特性に由来する楕円である。理論上の、すなわち目標記述子17は、継ぎ手制御装置を調整するのに求める目標である。
継ぎ手の調整において、正弦波信号を継ぎ手制御装置13の設定値として入力し、それにより、往復運動における該当のブーム継ぎ手の連結角度が変わる。例えば、継ぎ手の動きの駆動時における位置に対していずれかの側に±2.5度、変化する。この連結角度の変化は、表示装置において横軸に示される。同様に、制御信号を微分して理論的に求めた継ぎ手の運動速度は、正弦波状位置変化の場合、運動の端位置で零となり、また継ぎ手が正弦波状位置変化の中間点にあると最高となる。そこで速度は、表示装置には縦軸方向、すなわちy軸に示される。位置/速度座標系で位置値および速度値を実時間でプロットすることで、形成された記述子は理論的には、楕円を描く。実際には、継ぎ手位置の測定値から得られた記述子は、正確には理論的な楕円形記述子にならない。調整の目的は、実現された位置から作成されるパターンと設定値から作成される理論的楕円パターンの差を最小限にすることである。
図3aに示すように、ブームの位置および運動速度の実際の記述子18は、例えばほぼ楕円形である。実現パターン、すなわち記述子18は、設定値のパターンの外側でなく内側に見られることが極めて重要である。したがって、継ぎ手の位置は変動する設定値にきちんと追従するのではなく、遅れをとることになる。この場合、継ぎ手制御装置の利得を高くする必要がある。操作者は単に+および−キーを使って継ぎ手制御装置の利得を変更してもよく、それにより新たなパラメータをすぐに使用できる。操作者は、継ぎ手が経路を追従できる様子を記述子同士の比較によって実時間で観察でき、継ぎ手制御装置パラメータをパターンの差に基づいて調整できる。実現パターンが設定値パターンの内側でなく外側にある場合、この状況は図3bに示されているが、操作者は継ぎ手制御装置の利得を−キーを使用して下げて、記述子が互いに接近するようにする。理論上では、この段階におけるブーム運動の記述子18は、図3cに示すように、目標記述子17の大きさの楕円である。実際には、現実の記述子は理論上の楕円に対する様々な偏差を含み、完璧な楕円形の記述子を実現することは不可能である。しかし、記述子をできるだけ目標楕円に近くして、この特定の継ぎ手についてのブーム調整の精度を極力高めることがとても重要である。各記述子の大きさおよび形状が同じ場合、継ぎ手の位置に基づいて形成される経路は、たとえ継ぎ手制御装置の設定値と実現された位置との間に時間遅延が生じたとしても、時間/位置平面においても設定値に基づいて形成される経路に十分に一致する。同様に、実現パターンと設定値パターンの間の距離を比較することで、継ぎ手の利得を自動的に調整することも可能である。速度および位置が楕円を描くことが分かっていて、この楕円の大きさおよび形状を観察して継ぎ手制御装置の調整の良好さを判断することができれば、実際の楕円の大きさを理想の大きさと自動的に比較することもできる。
調整を自動的に行う場合、何ら記述子を作成する必要はないが、理論上位置値および速度値ならびに検出器で得られる実際の位置値および速度値を数学的に相互に比較してもよく、それにより、表示装置が描き出す記述子に基づいて手動調整において調整者が行なうのと同じ作業を計算によって自動制御で実行する。
検出器の読み取りによって継ぎ手の位置データ、すなわち継ぎ手の位置および速度の値を与える場合、またはある時刻における一連の位置データ項目およびそれらの間の遷移の経過時間に基づいて速度を算出する場合、各サンプル時刻における現実の点と理論上の設定値の間の最短距離を計算することで、実際の値を予定値と比較してもよい。継ぎ手が可能な限り正弦波経路を辿った場合、1周期にわたる測定値と理論上の設定値の間の距離の平均値は零である。
位置および速度の値と設定値の間の誤差をサンプル時間ごとに計算して、十分な設定値変化シーケンスが得られたらその平均を求める。誤差の平均値を求めることで、測定した位置値および速度値と設定値との間の誤差の方向および大きさを得ることができる。この情報を、該当する継ぎ手制御装置のパラメータの調整に使用して誤差の平均値を最小限にすることもできる。誤差を算出後、継ぎ手制御装置の利得を変更して、利得の変化を誤差の大きさに比例させる。
誤差が十分に零に近くなると、調整は完了する。このとき、実際の位置値および速度値は、設定値より低いときほど、設定値よりも高い同じ値をとる。この場合、経路は、可能な限り最良の経路を採る。
他の継ぎ手も、同様の方法で垂直および水平方向の両方において調整する。できるだけ最高の精度を実現するためには、これも行って、1つのブーム継ぎ手を調整するのと同時に他の継ぎ手を駆動させ、これによって他の継ぎ手の動作による当該継ぎ手の動作への妨害を最小限にすることができる。これにより、最終結果として、ブームの全体的な動作および運動は最良の形で意図したものに即する。
上述の方法を用いたブーム継ぎ手制御装置の調整によって最良のブーム位置結果が得られ、調整中はこの位置の付近でブームが制御される。ブームの作業領域の様々な部分で最良のパラメータ値を得るために、作業領域の様々な部分において複数の異なる位置でブームを調整してもよい。
ブームの動作を調整したら、さらにブーム継ぎ手の静的精度を検査する必要がある。この検査は、本例では、継ぎ手を操作して位置選定をすることで行う。ここで、各位置間における継ぎ手経路は、正弦波信号の半周期に相当する。そこで、表示装置では、どんな精度でブーム部が所望の位置に設定されたか、また例えば、最終位置に対するブームまたはブーム部の時間関数としての振動を確認できる。これは図4に図示してあるが、図4ではブーム部の動き記述子を時間関数として概略的且つ理論的に示している。
図4に示すように、ブームまたはブーム部は継ぎ手に対して回転して、実質的に目標記述子に従って、最端位置を示す線19aと19bの間で零位置の両側を動き、これは、時刻t1において、制御信号で決まる最端位置で、つまり理論上は線19aでブームが停止するまで、続く。この位置から先は、設定値に過不足なしに追従すればブーム位置は一定になり、位置記述子18は線19aをなぞるであろう。しかし、ブーム位置を表す線18は、すぐに線19aと同じレベルになるわけではなく、その両側で振動する。そこで、時刻t1以降は、ブーム位置は線19aが画定する位置よりも上になり、その後、時刻t2において線19aより下になり、それ以降は線19a近くに戻る。つまり、時刻t3において実質的に所期の位置に戻る。
本発明をコンピュータプログラムを使用して実現した場合、このプログラムは上述の方法でブームの動作の調整を行うプログラムコードを含むものである。そのため、プログラムコードは、継ぎ手制御装置の制御装置利得の調整、およびブームのキャリアから始めてブームの遠位端に向かう個々のブーム部の間の動きの調整を実現するものであってよい。さらに、プログラムコードは、x/y座標系における記述子を位置および運動速度の値を用いた表示として実現してもよく、その場合、記述子の一方の軸は位置値を表し、他方の軸は運動速度値を表す。またプログラムコードは、
−制御信号として正弦波信号を使用し、
−制御信号に基づいて目標パターンを表示装置上に形成し、この目標パターンにおいて、位置値および運動速度値を直角座標系の別々の軸に配置して、制御装置の利得を、検出器から得た実際の位置値および運動速度値に基づいて定義した対応する記述子に基づいて調整し、
−円形または楕円形の記述子を作成し、
−調整を自動的に実行し、
−削岩装置のブームを制御してもよい。
図面およびそれに関連する記載は、発明の概念を例証するためだけのものである。本発明の詳細は、特許請求の範囲において変更可能である。

Claims (31)

  1. 軸を中心として相対的に回転するように、または液圧アクチュエータによって直線運動で移動するように可動的に連結された少なくとも2つの可動的相互連結ブーム部と、該液圧アクチュエータを制御する制御手段と、前記ブーム部間の動きおよび位置を検出する検出器とを含み、各動きは前記制御手段に含まれる継ぎ手制御装置によって制御され、液圧作動ブームの動作を調整するために、前記制御手段にある継ぎ手制御装置の、動きに固有の調整パラメータを個々の動きごとに設定することができる液圧作動ブームの動作を調整する方法において、該方法は、前記ブーム部の相対的動きを、該ブーム部の間の所定の位置に対してその両側で、対称的で反復する制御信号を用いて制御し、該制御信号に応じて前記検出器から取得した実際の位置値および運動速度値を該制御信号に基づいて決定した理論上の位置値および運動速度値と比較し、これらの値の間の差に基づいて、継ぎ手制御装置の調整パラメータを調整し、前記検出器から取得した実際の位置値および運動速度値と前記制御信号に基づいて決定した理論上の位置値および運動速度値との差が所期の大きさになるまでこの調整を続けることを特徴とする液圧作動ブームの動作を調整する方法。
  2. 請求項1に記載の方法において、該方法はブーム調整装置の制御装置利得を前記調整パラメータとして用いることを特徴とする方法。
  3. 請求項1または2に記載の方法において、前記個々のブーム部間の動きの調整は、ブームキャリアから始めて前記ブームの遠位端に向かって行うことを特徴とする方法。
  4. 前記請求項のいずれかに記載の方法において、前記ブーム部は軸を中心に回転可能に相互連結され、位置検出器が該軸を中心とする回転角を検出することを特徴とする方法。
  5. 前記請求項のいずれかに記載の方法において、前記ブーム部は直線運動で移動可能に相互連結され、前記位置検出器は動く距離を検出することを特徴とする方法。
  6. 前記請求項のいずれかに記載の方法において、該方法は、前記位置値および運動速度値を用いてx/y座標系における記述子を作成し、該x/y座標系の一方の軸は位置値を示し、他方の軸は運動速度値を示すことを特徴とする方法。
  7. 前記請求項のいずれかに記載の方法において、該方法は前記制御信号として正弦波信号を用いることを特徴とする方法。
  8. 前記請求項のいずれかに記載の方法において、前記制御信号に基づいて、目標パターンを表示装置に形成し、前記位置値および運動速度値を直角座標系の別々の軸に配置し、これに対応して前記検出器から取得した実際の位置値および運動速度値に基づいて定義した記述子に基づいて、前記制御装置の利得を調整することを特徴とする方法。
  9. 請求項7または8に記載の方法において、前記記述子は円形または楕円形であることを特徴とする方法。
  10. 前記請求項のいずれかに記載の方法において、前記調整は制御手段によって自動的に行うことを特徴とする方法。
  11. 前記請求項のいずれかに記載の方法において、該方法は前記ブームとして削岩装置のブームを使用することを特徴とする方法。
  12. 軸を中心として相対的に回転するように、または液圧アクチュエータによって直線運動で移動するように可動的に連結された少なくとも2つの可動的相互連結ブーム部と、該液圧アクチュエータを制御する制御手段と、前記ブーム部の間の動きおよび位置を検出する検出器とを含み、各動きは前記制御手段に含まれる継ぎ手制御装置によって制御され、液圧作動ブームの動作を調整するために、前記制御手段にある継ぎ手制御装置の、動きに固有の調整パラメータを個々の動きごとに設定することができる液圧作動ブームの動作の調整装置において、該装置は、前記ブーム部の相対的動きを、該ブーム部の間の所定の位置に対してその両側で、対称的な制御信号を用いて制御するように構成可能であり、前記制御手段は、該制御信号に応じて前記検出器から取得した実際の位置値および運動速度値を該制御信号に基づいて決定した理論上の位置値および運動速度値と比較する手段と、これらの値の間の差に基づいて、前記制御手段に設けられた継ぎ手制御装置の調整パラメータを調整し、前記検出器から取得した実際の位置値および運動速度値と前記制御信号に基づいて決定した理論上の位置値および運動速度値との差が所期の大きさになるまでこの調整を続ける手段とを含むことを特徴とする液圧作動ブームの動作の調整装置。
  13. 請求項12に記載の調整装置において、該装置で使用する前記継ぎ手制御装置の調整パラメータは該継ぎ手制御装置の制御装置利得であることを特徴とする調整装置。
  14. 請求項12または13に記載の調整装置において、該装置は、個々のブーム部間の動きをブームキャリアから始めて該ブームの遠位端に向かって調整するように構成されていることを特徴とする調整装置。
  15. 請求項12ないし14のいずれかに記載の調整装置において、前記ブーム部は軸を中心に回転可能に相互連結され、位置検出器が軸を中心に検出するように構成されていることを特徴とする調整装置。
  16. 請求項12ないし15のいずれかに記載の調整装置において、前記ブーム部は直線運動で移動可能に相互連結され、前記位置検出器は動く距離を検出するように構成されていることを特徴とする調整装置。
  17. 請求項12ないし16のいずれかに記載の調整装置において、前記制御手段は、位置値および運動速度値を用いてx/y座標系における記述子を与えるように構成され、該x/y座標系の一方の軸は位置値を示し、他方の軸は運動速度値を示すことを特徴とする調整装置。
  18. 請求項12ないし17のいずれかに記載の調整装置において、前記制御手段は正弦波信号を制御信号として使用するよう構成されていることを特徴とする調整装置。
  19. 請求項12ないし18のいずれかに記載の調整装置において、前記制御手段は表示装置を含み、また該制御手段は、前記制御信号に基づいて目標パターンを該表示装置に形成し、該目標パターンにおいて前記位置値および運動速度値は直角座標系の別々の軸に配置され、これに対応する記述子を前記検出器から取得した実際の位置値および運動速度値に基づいて作成して、制御装置利得を該記述子に基づいて調整できるように構成されていることを特徴とする調整装置。
  20. 請求項18または19に記載の調整装置において、前記制御手段は円形または楕円形の記述子を作成するよう構成されていることを特徴とする調整装置。
  21. 請求項12ないし20のいずれかに記載の調整装置において、前記制御手段は調整を自動的に実行するよう構成されていることを特徴とする調整装置。
  22. 請求項12ないし21のいずれかに記載の調整装置において、前記ブームは削岩装置のブームであることを特徴とする調整装置。
  23. 可動的に相互連結された少なくとも2つのブーム部を含み、該ブーム部は軸を中心として相対的に回転するように、または液圧アクチュエータによって直線運動で移動するように可動的に連結され、さらに、前記液圧アクチュエータを制御する制御手段と、前記ブーム部の間の動きおよび位置を検出する検出器とを含み、各動きは前記制御手段に含まれる継ぎ手制御装置によって制御され、液圧作動ブームの動作を調整するために、前記制御手段にある継ぎ手制御装置の、動きに固有の調整パラメータを個々の動きごとに設定できる液圧作動ブームの動作の調整を行う装置に含まれる処理装置を制御するコンピュータプログラムにおいて、該コンピュータプログラムは前記ブームの動作を調整するプログラムコードを含み、該コンピュータプログラムは、前記ブーム部の相対的動きを、ブーム部の間の所定の位置に対してその両側で、対称的な制御信号を用いて制御し、該制御信号に応じて前記検出器から取得した実際の位置値および運動速度値を該制御信号に基づいて決定した理論上の位置値および運動速度値と比較し、これらの値の間の差に基づいて継ぎ手制御装置の調整パラメータを調整し、前記検出器から取得した実際の位置値および運動速度値と前記制御信号に基づいて決定した理論上の位置値および運動速度値との差が所期の大きさになるまでこの調整を続けるプログラムコードを含むことを特徴とするコンピュータプログラム。
  24. 請求項23に記載のコンピュータプログラムにおいて、該コンピュータプログラムは、前記継ぎ手制御装置の制御装置利得を調整するプログラムコードを含むことを特徴とするコンピュータプログラム。
  25. 請求項23または24に記載のコンピュータプログラムにおいて、該コンピュータプログラムは、個々のブーム部間の動きをブームキャリアから始めて前記ブームの遠位端に向かって調整するプログラムコードを含むことを特徴とするコンピュータプログラム。
  26. 請求項23ないし25のいずれかに記載のコンピュータプログラムにおいて、該コンピュータプログラムは、前記位置値および運動速度値を用いてx/y座標系における記述子を与えるプログラムコードを含み、該x/y座標系の一方の軸は位置値を示し、他方の軸は運動速度値を示すことを特徴とするコンピュータプログラム。
  27. 請求項23ないし26のいずれかに記載のコンピュータプログラムにおいて、該コンピュータプログラムは前記制御信号として正弦波信号を使用するプログラムコードを含むことを特徴とするコンピュータプログラム。
  28. 請求項23ないし27のいずれかに記載のコンピュータプログラムにおいて、該コンピュータプログラムは、前記制御信号に基づいて、目標パターンを表示装置に形成し、該目標パターンにおいて前記位置値および運動速度値を直角座標系の別々の軸に配置し、これに対応して前記検出器から取得した実際の位置値および運動速度値に基づいて定義した記述子に基づいて、前記制御装置の利得を調整するプログラムコードを含むことを特徴とするコンピュータプログラム。
  29. 請求項27または28に記載のコンピュータプログラムにおいて、該コンピュータプログラムは円形または楕円形の記述子を作成するプログラムコードを含むことを特徴とするコンピュータプログラム。
  30. 請求項23ないし29のいずれかに記載のコンピュータプログラムにおいて、該コンピュータプログラムは前記調整を自動的に実行するプログラムコードを含むことを特徴とするコンピュータプログラム。
  31. 請求項23ないし30のいずれかに記載のコンピュータプログラムにおいて、該コンピュータプログラムは削岩装置のブームを制御するように構成されていることを特徴とするコンピュータプログラム。
JP2010527481A 2007-10-01 2008-09-29 液圧作動ブームの調整方法、装置およびコンピュータプログラム Expired - Fee Related JP5255643B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
FI20075691A FI123361B (fi) 2007-10-01 2007-10-01 Menetelmä ja laitteisto sekä tietokoneohjelma hydraulikäyttöisen puomin toiminnan säätämiseksi
FI20075691 2007-10-01
PCT/FI2008/050541 WO2009043969A1 (en) 2007-10-01 2008-09-29 Method, apparatus and computer program for adjusting hydraulically operated boom

Publications (2)

Publication Number Publication Date
JP2011505029A true JP2011505029A (ja) 2011-02-17
JP5255643B2 JP5255643B2 (ja) 2013-08-07

Family

ID=38656838

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2010527481A Expired - Fee Related JP5255643B2 (ja) 2007-10-01 2008-09-29 液圧作動ブームの調整方法、装置およびコンピュータプログラム

Country Status (10)

Country Link
US (1) US8452454B2 (ja)
EP (1) EP2210154A4 (ja)
JP (1) JP5255643B2 (ja)
CN (1) CN101855602B (ja)
AU (1) AU2008306801B2 (ja)
CA (1) CA2701234A1 (ja)
FI (1) FI123361B (ja)
RU (1) RU2448895C2 (ja)
WO (1) WO2009043969A1 (ja)
ZA (1) ZA201002456B (ja)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
ES2384844B1 (es) * 2009-05-26 2013-07-04 Young & Franklin, Inc Sistema de accionamiento basado en actuador para colector solar.
PT2725184T (pt) * 2012-10-24 2019-06-12 Sandvik Mining & Construction Oy Aparelho de perfuração de rocha e método para controlar a orientação da viga de alimentação
FI20135085L (fi) 2013-01-29 2014-07-30 John Deere Forestry Oy Menetelmä ja järjestelmä työkoneen puomiston ohjaamiseksi kärkiohjauksella
JP6284302B2 (ja) * 2013-04-02 2018-02-28 株式会社タダノ ブームの伸縮パターン選択装置
CN104727804A (zh) * 2014-11-27 2015-06-24 三一重型装备有限公司 一种凿岩台车及其钻臂定位控制方法和装置
DE102016015388B4 (de) * 2016-12-22 2024-09-12 Liebherr-Werk Ehingen Gmbh Verfahren zur assistierten Ausführung von Kranbewegungen eines Krans sowie Kran
US10583556B2 (en) * 2017-06-30 2020-03-10 Disney Enterprises, Inc. Motion stabilization on a motorized monopod jib
US11697917B2 (en) * 2019-07-26 2023-07-11 Deere & Company Anticipatory modification of machine settings based on predicted operational state transition

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01278623A (ja) * 1987-05-29 1989-11-09 Hitachi Constr Mach Co Ltd 作業機の軌跡制御装置
JPH02147791A (ja) * 1988-11-28 1990-06-06 Hitachi Constr Mach Co Ltd 作業機の軌跡制御装置
JPH06193377A (ja) * 1992-12-28 1994-07-12 Hitachi Constr Mach Co Ltd 作業機の定速軌跡制御装置
JPH07261844A (ja) * 1994-03-23 1995-10-13 Matsushita Electric Ind Co Ltd モータ制御装置
JP2002218676A (ja) * 2001-01-16 2002-08-02 Yaskawa Electric Corp モータ駆動装置

Family Cites Families (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0740204B2 (ja) * 1985-03-30 1995-05-01 株式会社東芝 多自由度非線形機械システムの制御装置
US4805086A (en) * 1987-04-24 1989-02-14 Laser Alignment, Inc. Apparatus and method for controlling a hydraulic excavator
US4999553A (en) * 1989-12-28 1991-03-12 The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration Method and apparatus for configuration control of redundant robots
JPH05277976A (ja) * 1992-03-31 1993-10-26 Nippon Telegr & Teleph Corp <Ntt> 動力学モデルパラメータ同定装置
EP0605050A3 (en) 1992-12-28 1997-02-26 Koninkl Philips Electronics Nv Control of machine movement based on an adaptive kinematic model.
AU4889796A (en) * 1995-03-31 1996-10-16 Toyo Kohan Co. Ltd. Handling method and robot used for the same
US6025686A (en) * 1997-07-23 2000-02-15 Harnischfeger Corporation Method and system for controlling movement of a digging dipper
US5953977A (en) * 1997-12-19 1999-09-21 Carnegie Mellon University Simulation modeling of non-linear hydraulic actuator response
FI107182B (fi) * 1998-12-09 2001-06-15 Tamrock Oy Menetelmä asemointivirheiden korjaamiseksi kallionporauksessa ja kallionporauslaitteisto
US6473679B1 (en) * 1999-12-10 2002-10-29 Caterpillar Inc. Angular velocity control and associated method for a boom of a machine
US7457698B2 (en) * 2001-08-31 2008-11-25 The Board Of Regents Of The University And Community College System On Behalf Of The University Of Nevada, Reno Coordinated joint motion control system
DE10240180A1 (de) * 2002-08-27 2004-03-11 Putzmeister Ag Vorrichtung zur Betätigung eines Knickmasts
JP4647325B2 (ja) * 2004-02-10 2011-03-09 株式会社小松製作所 建設機械の作業機の制御装置、建設機械の作業機の制御方法、及びこの方法をコンピュータに実行させるプログラム
US7128479B2 (en) * 2004-03-01 2006-10-31 Chapman/Leonard Studio Equipment Telescoping camera crane
JP4413122B2 (ja) * 2004-10-13 2010-02-10 日立建機株式会社 油圧建設機械の制御装置
WO2006117022A1 (en) * 2005-05-02 2006-11-09 Abb Research Ltd A method for control of an industrial robot
US8386133B2 (en) * 2007-02-21 2013-02-26 Deere & Company Automated control of boom and attachment for work vehicle
US8065037B2 (en) * 2007-08-07 2011-11-22 Board Of Regents Of The Nevada System Of Higher Education, On Behalf Of The University Of Nevada, Reno Control method and system for hydraulic machines employing a dynamic joint motion model
US7874152B2 (en) * 2008-05-01 2011-01-25 Incova Technologies, Inc. Hydraulic system with compensation for kinematic position changes of machine members
JP5424982B2 (ja) * 2010-05-20 2014-02-26 カヤバ工業株式会社 ハイブリッド作業機械

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01278623A (ja) * 1987-05-29 1989-11-09 Hitachi Constr Mach Co Ltd 作業機の軌跡制御装置
JPH02147791A (ja) * 1988-11-28 1990-06-06 Hitachi Constr Mach Co Ltd 作業機の軌跡制御装置
JPH06193377A (ja) * 1992-12-28 1994-07-12 Hitachi Constr Mach Co Ltd 作業機の定速軌跡制御装置
JPH07261844A (ja) * 1994-03-23 1995-10-13 Matsushita Electric Ind Co Ltd モータ制御装置
JP2002218676A (ja) * 2001-01-16 2002-08-02 Yaskawa Electric Corp モータ駆動装置

Also Published As

Publication number Publication date
CN101855602B (zh) 2013-01-02
RU2010117394A (ru) 2011-11-10
US8452454B2 (en) 2013-05-28
WO2009043969A1 (en) 2009-04-09
FI123361B (fi) 2013-03-15
FI20075691A0 (fi) 2007-10-01
FI20075691A (fi) 2009-04-02
AU2008306801B2 (en) 2011-12-22
ZA201002456B (en) 2011-02-23
CA2701234A1 (en) 2009-04-09
EP2210154A4 (en) 2013-05-01
EP2210154A1 (en) 2010-07-28
JP5255643B2 (ja) 2013-08-07
US20100280668A1 (en) 2010-11-04
CN101855602A (zh) 2010-10-06
AU2008306801A1 (en) 2009-04-09
RU2448895C2 (ru) 2012-04-27

Similar Documents

Publication Publication Date Title
JP5255643B2 (ja) 液圧作動ブームの調整方法、装置およびコンピュータプログラム
US8706300B2 (en) Method of controlling a robotic tool
US11534912B2 (en) Vibration display device, operation program creating device, and system
US20190345697A1 (en) Construction machine
CN105487481B (zh) 离线示教机器人的机器人示教装置
CN106272416A (zh) 基于力觉和视觉的机器人细长轴精密装配系统及方法
CN107072730A (zh) 表征运动约束
KR20130141664A (ko) 로봇의 작업 오브젝트 셀 캘리브레이션 디바이스, 시스템, 및 방법
CN114411840B (zh) 平地控制方法、装置和挖掘机
CN109434842A (zh) 示教及显示的装置、方法和存储介质
CN104760044B (zh) 一种无动力关节臂式示教器及其在工业机器人中的应用
CN204525481U (zh) 一种无动力关节臂式示教器
CN113977558B (zh) 一种可视化动态显示并联机器人末端轨迹的装置及方法
US20210031369A1 (en) Apparatus, robot control device, robot system, and method of setting robot coordinate system
JP5667437B2 (ja) ロボットの外部軸の計測方法、ロボットの教示データ作成方法、およびロボットのコントローラ
JPH0580828A (ja) 三次元レーザ加工機のオフライン教示方法
CN113110549B (zh) 一种叶片机器人及其轨迹跟踪方法
US20040020084A1 (en) Method for automatically moving on the ground a tool mounted at the end of an articulated arm
KR101246073B1 (ko) 로봇 제어 장치 및 방법
JP5343725B2 (ja) ロボット制御装置
JP7444603B2 (ja) ロボット駆動領域シミュレーション装置、およびロボット駆動領域シミュレーション方法並びにロボット駆動領域シミュレーションプログラム
JP4530714B2 (ja) 多関節作業ロボットの駆動制御システム
JP2016218934A (ja) ロボット言語プログラムの修正装置,方法およびプログラム

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20101125

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20120612

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20120911

A602 Written permission of extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A602

Effective date: 20120924

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20121012

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: 20130402

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20130419

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: 20160426

Year of fee payment: 3

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees