JPS60199193A - さく孔装置の制御システム - Google Patents
さく孔装置の制御システムInfo
- Publication number
- JPS60199193A JPS60199193A JP5679684A JP5679684A JPS60199193A JP S60199193 A JPS60199193 A JP S60199193A JP 5679684 A JP5679684 A JP 5679684A JP 5679684 A JP5679684 A JP 5679684A JP S60199193 A JPS60199193 A JP S60199193A
- Authority
- JP
- Japan
- Prior art keywords
- boom
- coordinate system
- drilling
- memory
- positioning
- 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
- Earth Drilling (AREA)
- Drilling And Exploitation, And Mining Machines And Methods (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
(産業上の利用分野)
本発明は、1〜ンネル等の掘さくにおいて切羽面にさく
孔をりる際、さく孔装置を乗架したブームを切羽面の所
定のざく孔位置に自動的に位置決め制御Jるための制御
シスツムに関し、1!■に117置)大め制御のための
処理時間の短縮化対策に関づる。
孔をりる際、さく孔装置を乗架したブームを切羽面の所
定のざく孔位置に自動的に位置決め制御Jるための制御
シスツムに関し、1!■に117置)大め制御のための
処理時間の短縮化対策に関づる。
(従来技術)
一般に、トンネル等を掘さくする場合、切羽面の所定位
置を所定方向にさく孔し、この多数さく孔された孔に爆
薬を仕掛けて発l1lllJることによってEA’i:
’<”Jることが行われている。(のため、上記さく孔
の際、さく孔装置を乗架したブームを切羽面の所定の位
置に位置決めする必要がある。
置を所定方向にさく孔し、この多数さく孔された孔に爆
薬を仕掛けて発l1lllJることによってEA’i:
’<”Jることが行われている。(のため、上記さく孔
の際、さく孔装置を乗架したブームを切羽面の所定の位
置に位置決めする必要がある。
このようなブームの位置決め手段として、従来、手動装
量により予め位置決め作業(ア5r−チング作業)を行
い、これを記憶した後に再生Jるという再生制御方式(
プレイバック方式)が広く採用されている。しかし、上
記ティーヂング作業が人間の技能によるため、作業能率
が極めで悪く、また位置決めの正確性に欠りるものであ
った。
量により予め位置決め作業(ア5r−チング作業)を行
い、これを記憶した後に再生Jるという再生制御方式(
プレイバック方式)が広く採用されている。しかし、上
記ティーヂング作業が人間の技能によるため、作業能率
が極めで悪く、また位置決めの正確性に欠りるものであ
った。
この1=め、これに代わるものとして、最近、特公昭5
7−51518号公報に示されるように数値入力制御方
式(N C1li(I御方式)が採用されつつある。こ
の数値入力制御方式は、さく孔装置を、乗架したブーム
を駆!!llツるブーム駆動手段に対し、切羽面直前に
直角座標系で与えられたさく孔面上で設定される多数の
ざく凡慮の位置J3よび方向を記憶したメモリー=J′
段と、該メtり一手段ノ〕日うC1角座標系で与えられ
るさく凡慮の1直をブームの座標系で19られる碩に)
す1弁変I?!づる)す3 C> ’f’段ど、該演弊
乎段からの随に応じて上記ブーム駆動1段を作動制Ot
+iる位置決めリーボルIJ tlll+手段と、該ブ
ーム駆動手段の作!1!lI邑を上記位置決ν)リーボ
1.す御−1段にフィードバックづるフィードバック手
段とを備えて、切羽面上で直角座標系て゛表示され!、
:さく凡慮をブームの座標系に変操し、該ブームの先端
位置を数値にて指定して、ブームを所定位置にフィード
バック制御にJ、り位ii?!決めりることにJ、す、
ブームの位置決めを自動的に正確かつ迅速に行うように
しlcらのである。
7−51518号公報に示されるように数値入力制御方
式(N C1li(I御方式)が採用されつつある。こ
の数値入力制御方式は、さく孔装置を、乗架したブーム
を駆!!llツるブーム駆動手段に対し、切羽面直前に
直角座標系で与えられたさく孔面上で設定される多数の
ざく凡慮の位置J3よび方向を記憶したメモリー=J′
段と、該メtり一手段ノ〕日うC1角座標系で与えられ
るさく凡慮の1直をブームの座標系で19られる碩に)
す1弁変I?!づる)す3 C> ’f’段ど、該演弊
乎段からの随に応じて上記ブーム駆動1段を作動制Ot
+iる位置決めリーボルIJ tlll+手段と、該ブ
ーム駆動手段の作!1!lI邑を上記位置決ν)リーボ
1.す御−1段にフィードバックづるフィードバック手
段とを備えて、切羽面上で直角座標系て゛表示され!、
:さく凡慮をブームの座標系に変操し、該ブームの先端
位置を数値にて指定して、ブームを所定位置にフィード
バック制御にJ、り位ii?!決めりることにJ、す、
ブームの位置決めを自動的に正確かつ迅速に行うように
しlcらのである。
そして、上記の数値入力ルリ御方式では、切羽面上で直
角座標系でI〕えられたさく凡慮の1ホ1をブームの座
標系(球面外枠系)で457られる1に1に変操づる場
合、通常、漸近ill l:’)法という演咋丁法が採
られている。号なわら、さく凡慮のrに標系とI−ムの
座標系との間での辻立方秤式を解くために、漸近H,l
梓法により、ある初期値を代入して解の順化式を繰返し
計痒し、正解1向に収束さUるに・)に演亦づるもので
ある。
角座標系でI〕えられたさく凡慮の1ホ1をブームの座
標系(球面外枠系)で457られる1に1に変操づる場
合、通常、漸近ill l:’)法という演咋丁法が採
られている。号なわら、さく凡慮のrに標系とI−ムの
座標系との間での辻立方秤式を解くために、漸近H,l
梓法により、ある初期値を代入して解の順化式を繰返し
計痒し、正解1向に収束さUるに・)に演亦づるもので
ある。
このため、この演算処理にはコンビ−L−夕による演算
であってもかなりの時間がかかり、また個々のさく凡慮
毎に演算が必要であるので、処理時間が長いものとなり
、特に初期値が適正でないとぎには顕著である。そして
、このJ、うな演算処理は、切羽面の岩盤の軟、硬質等
によるさく孔パターンの変更や、ざく孔装置の機種の変
更4rどに応じてての都度初期値を設定して行わねばな
らず、汎用性がないため、その作業が極めて煩雑である
(発明の目的) 本発明はかかる点に鑑み【なされたもので、その目的と
づるところは、上記の如き数値入力制御方式での漸近目
算法による演算処理にJ3いては初期値を適正に選定し
てやれば正解値への収束速度が速くなることに着目し、
そのことにより、切羽面におりるブームの移動領域を多
数のエリアに分割し、各エリア毎に適正初期値をめてJ
3き、さく凡慮の情報にJ:りその点に対応するエリア
の適正初1!Q Ii&を検索し、この適正初期値を用
いct(fi3丘a1輝法による演算処理を行うことに
より、 1llj咋通度を速めてブームの位置決め処理
部間を短縮化Jるとどもに、さく孔パターン等の変更に
応じ(し汎用性を持たせることにある。。
であってもかなりの時間がかかり、また個々のさく凡慮
毎に演算が必要であるので、処理時間が長いものとなり
、特に初期値が適正でないとぎには顕著である。そして
、このJ、うな演算処理は、切羽面の岩盤の軟、硬質等
によるさく孔パターンの変更や、ざく孔装置の機種の変
更4rどに応じてての都度初期値を設定して行わねばな
らず、汎用性がないため、その作業が極めて煩雑である
(発明の目的) 本発明はかかる点に鑑み【なされたもので、その目的と
づるところは、上記の如き数値入力制御方式での漸近目
算法による演算処理にJ3いては初期値を適正に選定し
てやれば正解値への収束速度が速くなることに着目し、
そのことにより、切羽面におりるブームの移動領域を多
数のエリアに分割し、各エリア毎に適正初期値をめてJ
3き、さく凡慮の情報にJ:りその点に対応するエリア
の適正初1!Q Ii&を検索し、この適正初期値を用
いct(fi3丘a1輝法による演算処理を行うことに
より、 1llj咋通度を速めてブームの位置決め処理
部間を短縮化Jるとどもに、さく孔パターン等の変更に
応じ(し汎用性を持たせることにある。。
(発明の構成)
上記の目的を達成りるため、本発明の構成は、第1図に
示すように、さく孔装向13を乗架したブーム4を駆動
りるブーム駆動手段′17と、切羽面直前に直角座標系
で与えられたさく孔面上で51定される多数のさく凡慮
の位置J3よび方向を該面角座標系の値で記憶りる第1
メモリ一手段22と、切羽面におけるブーム4の移動領
域を多数のエリアに分割し、各エリア毎に適1[初期値
を上記直角座標系の値で記憶づる第2メモリ一手段23
と、上記第1メモリー千t922から与えられるさく凡
慮の情報により第2メモリ一手段23の対応規るエリア
にお(〕る適適正初期fullを検索Jる検索手段24
と、該検索手段24により検索した適11初期1ホ1に
基づいて上記第1メモリ一手段22からn角厘標系で与
えられるさく凡慮の値をブーム4の座標系で(りられる
饋に演算斐換づる演眸手段25と。
示すように、さく孔装向13を乗架したブーム4を駆動
りるブーム駆動手段′17と、切羽面直前に直角座標系
で与えられたさく孔面上で51定される多数のさく凡慮
の位置J3よび方向を該面角座標系の値で記憶りる第1
メモリ一手段22と、切羽面におけるブーム4の移動領
域を多数のエリアに分割し、各エリア毎に適1[初期値
を上記直角座標系の値で記憶づる第2メモリ一手段23
と、上記第1メモリー千t922から与えられるさく凡
慮の情報により第2メモリ一手段23の対応規るエリア
にお(〕る適適正初期fullを検索Jる検索手段24
と、該検索手段24により検索した適11初期1ホ1に
基づいて上記第1メモリ一手段22からn角厘標系で与
えられるさく凡慮の値をブーム4の座標系で(りられる
饋に演算斐換づる演眸手段25と。
該演等手段25からの値に応じて上記ブーム駆動手段1
7を作動させる位置決めザーボili制御手段18と、
該ブーム駆動手段17の作動しIこ10を検出づる検出
部19を有し、該検出部19T′検出したlaを上記位
置決めサーボ制御手段18に)C−ドパツクするフィー
ドバック手段27と、上記ブーム駆動手段17上のざく
孔装置13を作動さけるさく礼装同制御手段9と、上記
位置決めサーボ制御手段18からの位置決め完了信号を
受けて上記さく礼装同制御手段9を作動させるととしに
、該さく礼装同制御手段9からの作業柊了餌すを受けて
−に記第1メモリ一手段22に作動用の指令借料を出力
づる中央処理手段28とを備え!、:bのである。
7を作動させる位置決めザーボili制御手段18と、
該ブーム駆動手段17の作動しIこ10を検出づる検出
部19を有し、該検出部19T′検出したlaを上記位
置決めサーボ制御手段18に)C−ドパツクするフィー
ドバック手段27と、上記ブーム駆動手段17上のざく
孔装置13を作動さけるさく礼装同制御手段9と、上記
位置決めサーボ制御手段18からの位置決め完了信号を
受けて上記さく礼装同制御手段9を作動させるととしに
、該さく礼装同制御手段9からの作業柊了餌すを受けて
−に記第1メモリ一手段22に作動用の指令借料を出力
づる中央処理手段28とを備え!、:bのである。
このことにより、中央処理手段28からの作動指令18
号により第1メモリ一手段22かIう所定のさく凡慮の
情報が呼出されると、このさく凡慮情報により第2メモ
リ一手段23から対応りるエリアの適正初期値を検索し
、この適i[初!III (laを用いて上記さく凡慮
の肖f?+座標系でI〕えられた舶を漸近計算法により
ブーム4の座標系でiqられる沁に演算*扮し、このブ
ーム座標系のl+<+に基づいてブーム4先端をフィー
ドバック制御により1−配さく凡慮に位置決めづるよう
にしたものひある。
号により第1メモリ一手段22かIう所定のさく凡慮の
情報が呼出されると、このさく凡慮情報により第2メモ
リ一手段23から対応りるエリアの適正初期値を検索し
、この適i[初!III (laを用いて上記さく凡慮
の肖f?+座標系でI〕えられた舶を漸近計算法により
ブーム4の座標系でiqられる沁に演算*扮し、このブ
ーム座標系のl+<+に基づいてブーム4先端をフィー
ドバック制御により1−配さく凡慮に位置決めづるよう
にしたものひある。
(発明の効果)
したがって、本発明によれば、数値入力制御り式のさく
孔装置の制御システムにおいて、的角P1メ標系の埴で
、!jえられたさく凡慮の情報を、漸近■1算法を用い
てブームの座標系で百られる舶に弯換するに際し、切羽
面にお()るブームの移動1z[域を多数のエリアに分
割し、各コニリア毎に適正初期値をめておき、上記さく
凡慮の情報にJ、り対応Jる]エリアの適正初期値を検
索し、この適正初期値を用いて上記漸近it R法の演
綽を()うようにしたので、演算速度が速くなり、ブー
t1の位置決め処理時間ひいてはさく孔時間を著しく短
縮化できる。
孔装置の制御システムにおいて、的角P1メ標系の埴で
、!jえられたさく凡慮の情報を、漸近■1算法を用い
てブームの座標系で百られる舶に弯換するに際し、切羽
面にお()るブームの移動1z[域を多数のエリアに分
割し、各コニリア毎に適正初期値をめておき、上記さく
凡慮の情報にJ、り対応Jる]エリアの適正初期値を検
索し、この適正初期値を用いて上記漸近it R法の演
綽を()うようにしたので、演算速度が速くなり、ブー
t1の位置決め処理時間ひいてはさく孔時間を著しく短
縮化できる。
しかも、各エリア毎の適正初期値の記憶にJ、す、さく
孔パターンの変更やざく孔装賀のlfi!I[’の変史
笠に対しても対応でき、よって汎用性があり、迅速かつ
正確にブームを自動的に位置決めできるシステムを捉供
りることができる。
孔パターンの変更やざく孔装賀のlfi!I[’の変史
笠に対しても対応でき、よって汎用性があり、迅速かつ
正確にブームを自動的に位置決めできるシステムを捉供
りることができる。
(f施例)
以];、本発明の実施例を第2図以−トの図面に基づい
て説明覆る。
て説明覆る。
第2図〜第7図は本発明をトンネル掘さくのために切羽
面1〈の所定位置にさく孔をJる場合に適用した実施例
を示づ。第2図は全体概略(111成を示し、1は作業
台車、2は該作業台車1を地面に固定りる支脚であり、
作業台車1土には1」−タリーアクチコエータ3が設置
されている。4Iま第1ブーム5と第2ブーム6とから
なる1−ムて゛あって、該ブーム4の第1ブーム5の後
端1j、上記ロータリーアクヂコJ−夕3に回転自在に
軸支されており、該第1ブーム5の先ネ;:には第2ブ
ーム6の後端が前1般移動自在に支持され、さらに該第
21−1.s 6の先端に1よけルマウンテイング7を
介してガイドヒルスライド用のシリンダ8が固定されで
いる。
面1〈の所定位置にさく孔をJる場合に適用した実施例
を示づ。第2図は全体概略(111成を示し、1は作業
台車、2は該作業台車1を地面に固定りる支脚であり、
作業台車1土には1」−タリーアクチコエータ3が設置
されている。4Iま第1ブーム5と第2ブーム6とから
なる1−ムて゛あって、該ブーム4の第1ブーム5の後
端1j、上記ロータリーアクヂコJ−夕3に回転自在に
軸支されており、該第1ブーム5の先ネ;:には第2ブ
ーム6の後端が前1般移動自在に支持され、さらに該第
21−1.s 6の先端に1よけルマウンテイング7を
介してガイドヒルスライド用のシリンダ8が固定されで
いる。
該シリンダ8には、後端に後述のさく孔装置13を作動
制御する)r−ドモータより<fるさく礼装同制御手段
(図示Uず)(a装?1した万−rドレル10が1習動
自在に載架されていて1.L記シリング8の作動により
ガイドヒル10を前後進さUるようにしているとともに
、該ガイドヒル10」−には、ピッ1〜1′1を先端に
右するロッド12を取イ]りたさく孔装置13が円動自
(tに乗架されていて、さく孔作業間に」−記さく孔装
置1bll II e「段(ノイードモータ)によりさ
く孔装置′13を前1(進さUる」、うにし【いる。さ
らに、上記ブーlx 4に(,1、ガーイドセルスイン
グ用のシリンダ(図示せず)と、ブームリフト用のシリ
ンダ14と、シーム:Lクスフンション用のシリンダ1
5と、ガイドヒルリフ1へ用のシリンダ16とが取イ」
けられていと)。J、)(、第3図に示1ように、ブー
ム4は作1r、台中1に対し、ロータリーアクチュエー
タ3にJ、り図中y 1111+周囲方向に、かつf−
ムリ71〜用シリング+4+こより図中×軸周囲り向に
それぞれ変位可能に設(〕られており、まIIさく孔I
fα13を乗架したがイドヒル10はブーム4に対し、
ガイドヒルリフ1〜用シリンダ16により図中×軸周囲
方向に、ガイドヒルスイング用シリンダにより図中y軸
周囲方向に、ブームエクステンション用シリンダ15に
より図中l軸方向に、かつガイドセルスライド用シリン
ダ8により図中Z軸方向にイれぞ1し変1* il能に
設置ノられている。この各変位量は、ブーム4及びガイ
ドヒル1Qのp+1長がOで、ブーム4及びガイドセル
゛10がZ方向に平行であるときを原点位置としたとき
、図示の如く、ブームリフ1−角Bし°、ローデンショ
ン角RO’、ガイドセルスイング角SS°、ガイドヒル
リフト角Sビ、ブームエクスデンション長90X、ガイ
ドセルスラrド長9Sで表わされる。このことがら、ロ
ータリーアクヂュエータ3どブーム4との軸支点を原点
とした球面座標系にJ5いて、ブーム4の先端υI首(
つまりガイドヒル1oの先端位置)は、(ol。
制御する)r−ドモータより<fるさく礼装同制御手段
(図示Uず)(a装?1した万−rドレル10が1習動
自在に載架されていて1.L記シリング8の作動により
ガイドヒル10を前後進さUるようにしているとともに
、該ガイドヒル10」−には、ピッ1〜1′1を先端に
右するロッド12を取イ]りたさく孔装置13が円動自
(tに乗架されていて、さく孔作業間に」−記さく孔装
置1bll II e「段(ノイードモータ)によりさ
く孔装置′13を前1(進さUる」、うにし【いる。さ
らに、上記ブーlx 4に(,1、ガーイドセルスイン
グ用のシリンダ(図示せず)と、ブームリフト用のシリ
ンダ14と、シーム:Lクスフンション用のシリンダ1
5と、ガイドヒルリフ1へ用のシリンダ16とが取イ」
けられていと)。J、)(、第3図に示1ように、ブー
ム4は作1r、台中1に対し、ロータリーアクチュエー
タ3にJ、り図中y 1111+周囲方向に、かつf−
ムリ71〜用シリング+4+こより図中×軸周囲り向に
それぞれ変位可能に設(〕られており、まIIさく孔I
fα13を乗架したがイドヒル10はブーム4に対し、
ガイドヒルリフ1〜用シリンダ16により図中×軸周囲
方向に、ガイドヒルスイング用シリンダにより図中y軸
周囲方向に、ブームエクステンション用シリンダ15に
より図中l軸方向に、かつガイドセルスライド用シリン
ダ8により図中Z軸方向にイれぞ1し変1* il能に
設置ノられている。この各変位量は、ブーム4及びガイ
ドヒル1Qのp+1長がOで、ブーム4及びガイドセル
゛10がZ方向に平行であるときを原点位置としたとき
、図示の如く、ブームリフ1−角Bし°、ローデンショ
ン角RO’、ガイドセルスイング角SS°、ガイドヒル
リフト角Sビ、ブームエクスデンション長90X、ガイ
ドセルスラrド長9Sで表わされる。このことがら、ロ
ータリーアクヂュエータ3どブーム4との軸支点を原点
とした球面座標系にJ5いて、ブーム4の先端υI首(
つまりガイドヒル1oの先端位置)は、(ol。
θ2.θ3.θ4.ρs、Rcx)で衷ゎさすすること
になり、さく孔装詔13を乗架したブー1. /Iを該
球面座標系(0+ 、02.θ3.θ4+Qs。
になり、さく孔装詔13を乗架したブー1. /Iを該
球面座標系(0+ 、02.θ3.θ4+Qs。
Qex)で自在に変位させるように駆動Jるブーム駆動
手段17を構成している。
手段17を構成している。
さらに、18は、に記ブーム駆動手段17を作動制御す
る位置決め曝ナーボ制御手段であっC、ブーム駆動手段
17の各アクブコ「−り(ロータリーアクヂュエータ3
および各シリンダ8.14〜′1G)に接続されている
。まlこ、19は1(己ブーム駆動手段17の各アクチ
ユエータのIT動吊を検出づる■ンコーダJ、りなる検
出部ぐある。イして、上記ブーム駆動手段17の各アク
ブ1]−−り、1☆置決めり”−ボルリ御手段18、(
σ)山部19おJ、びさく孔装置制御手段はそれぞれイ
ンターフ] rス20を介してマイク+=+−:+ンビ
」−り21に侶(シの授受可能に接続されている。
る位置決め曝ナーボ制御手段であっC、ブーム駆動手段
17の各アクブコ「−り(ロータリーアクヂュエータ3
および各シリンダ8.14〜′1G)に接続されている
。まlこ、19は1(己ブーム駆動手段17の各アクチ
ユエータのIT動吊を検出づる■ンコーダJ、りなる検
出部ぐある。イして、上記ブーム駆動手段17の各アク
ブ1]−−り、1☆置決めり”−ボルリ御手段18、(
σ)山部19おJ、びさく孔装置制御手段はそれぞれイ
ンターフ] rス20を介してマイク+=+−:+ンビ
」−り21に侶(シの授受可能に接続されている。
上、![l!マイクロコンビ−I−夕21の内部IJ、
、第4図に示Jように構成されている。すなわら、第4
図に−3いて、22はWl Iメしり一丁「受(゛あっ
て。
、第4図に示Jように構成されている。すなわら、第4
図に−3いて、22はWl Iメしり一丁「受(゛あっ
て。
切羽面に直1)6に直角座標系でうえられるさく孔面上
に設定される多数のさく乳点Pの位ii?l(χ、y。
に設定される多数のさく乳点Pの位ii?l(χ、y。
Z)および方向(φχ、φy、φl)が該直角n1標系
の(+IJ (χ、y、z’、ψχ、φy、φl)て゛
人カされて記憶されている。23は第2メモリ一手段で
あって、切羽面Kにおけるブーム先端の移動領l4Ii
(χ、y)を例えば第7図に示すように多数のエリアA
、A・・・に分割し、各エリアAMに後述の演算手段2
5における漸近J1算法の演nでの適正初期値(例えば
第7図中のPa点)が前記球面座標系の値(”l’+a
2+・・・as)で入力されて記憶されている。24は
、上記第1メモリ一手段22から与えられるさく凡慮P
情報のχ、y値により上記第2メモリ一手段23からそ
の×、y値に対応するエリアSにお()る適正初期値(
al。
の(+IJ (χ、y、z’、ψχ、φy、φl)て゛
人カされて記憶されている。23は第2メモリ一手段で
あって、切羽面Kにおけるブーム先端の移動領l4Ii
(χ、y)を例えば第7図に示すように多数のエリアA
、A・・・に分割し、各エリアAMに後述の演算手段2
5における漸近J1算法の演nでの適正初期値(例えば
第7図中のPa点)が前記球面座標系の値(”l’+a
2+・・・as)で入力されて記憶されている。24は
、上記第1メモリ一手段22から与えられるさく凡慮P
情報のχ、y値により上記第2メモリ一手段23からそ
の×、y値に対応するエリアSにお()る適正初期値(
al。
a2.・・・aS)を検索する検索手段であり、さく乳
点Pの情報に対して漸近計算法の演算での適正初期値を
与えるようにしている。ざらに、25は、上記検索手段
24により検索した第2メモリ一手段23からの適正初
期値(a+、a2+・・・a6)を用いて、上記第1メ
モリ一手段22から直角座標系で与えられるさく乳点P
の値(χ、y、z。
点Pの情報に対して漸近計算法の演算での適正初期値を
与えるようにしている。ざらに、25は、上記検索手段
24により検索した第2メモリ一手段23からの適正初
期値(a+、a2+・・・a6)を用いて、上記第1メ
モリ一手段22から直角座標系で与えられるさく乳点P
の値(χ、y、z。
φχ、φy、φl)を漸近計算法によりブーム4の球面
座標系で得られる値(θ+、0□、θ3゜θ4. ps
、 QeX)に演惇変挨する)占咋手段であって、該
演陣手段25で疫換されたブームア1ろ種糸での値くθ
1.θ2.θ3.θJ 、QS 、9cx)はレジスフ
26に記憶されるとどしに上記(flf決めザーボ制御
手段18に出)Jされる。イして、該位置決めザーボ制
す11手段18に/、り土、記フーIXFP標系の値(
0亀、θ2.θ3.θ、+ 、 9s 、 2cx)に
基づいてブーム駆動手段17が作動制御されるとともに
、該ブーム駆動手段17の作動した(1r1(θl’+
07’l 03′、θ4’、US’、Qex’ )が検
出部1つによって検出され、この検出した値(θ1・、
θ、・′、θ3′ 、θ1′・ 9s1 、 Q ex
t )が位置決め)ノーボ制御手段18にフィードバッ
クされることにJ、す、ブーム4の先※;;;(ガイド
セル10の先端)が土泥ブーム座標系の埴(θ1.θ7
.θ3,04 、 s 、20X)の(l’/置おにび
方向に位置決めされるJ、うノイードバック制御するフ
ィードバック手段27が構成されている。また、28+
よ、上記IQ厘ン大めサーボ!IJ御丁段18からの位
置決め完了m号を受【)【さく孔択開制御手段9(フィ
ードモータ)を作動させ、所定のさく凡慮Pのさく孔を
行わせるとともに、操作入力信号および該さく孔装置制
911f段9からの作業終了信号を受けて上記第1メモ
リ一手段22を作動さU“るよう指令信号を出力づる中
央処理手段である。
座標系で得られる値(θ+、0□、θ3゜θ4. ps
、 QeX)に演惇変挨する)占咋手段であって、該
演陣手段25で疫換されたブームア1ろ種糸での値くθ
1.θ2.θ3.θJ 、QS 、9cx)はレジスフ
26に記憶されるとどしに上記(flf決めザーボ制御
手段18に出)Jされる。イして、該位置決めザーボ制
す11手段18に/、り土、記フーIXFP標系の値(
0亀、θ2.θ3.θ、+ 、 9s 、 2cx)に
基づいてブーム駆動手段17が作動制御されるとともに
、該ブーム駆動手段17の作動した(1r1(θl’+
07’l 03′、θ4’、US’、Qex’ )が検
出部1つによって検出され、この検出した値(θ1・、
θ、・′、θ3′ 、θ1′・ 9s1 、 Q ex
t )が位置決め)ノーボ制御手段18にフィードバッ
クされることにJ、す、ブーム4の先※;;;(ガイド
セル10の先端)が土泥ブーム座標系の埴(θ1.θ7
.θ3,04 、 s 、20X)の(l’/置おにび
方向に位置決めされるJ、うノイードバック制御するフ
ィードバック手段27が構成されている。また、28+
よ、上記IQ厘ン大めサーボ!IJ御丁段18からの位
置決め完了m号を受【)【さく孔択開制御手段9(フィ
ードモータ)を作動させ、所定のさく凡慮Pのさく孔を
行わせるとともに、操作入力信号および該さく孔装置制
911f段9からの作業終了信号を受けて上記第1メモ
リ一手段22を作動さU“るよう指令信号を出力づる中
央処理手段である。
次に、上記マイクロコンピュータ21の主たる作動を第
5図および第6図によって31明づるに、第5図に示づ
メインフローにおい1、スフ−1−して第1ステツプS
1で切羽面)く上の直角座際系で表わされたさく孔パタ
ーン〈χ、y’、z、φχ。
5図および第6図によって31明づるに、第5図に示づ
メインフローにおい1、スフ−1−して第1ステツプS
1で切羽面)く上の直角座際系で表わされたさく孔パタ
ーン〈χ、y’、z、φχ。
φy、φl)が人力されると′、第2ステツプS2にお
いて上記さく凡慮情報の(χ、y)に含まれるエリアへ
の検索を行う。このエリアの検索は、第6図の1ノブル
ーチンに示づ”ように、ステップS28でχ値がiくχ
≦i+1(i=1〜n)の範囲にあることを判別し、か
つステップS2bでy値がj<y≦j→、1(j=i〜
11)の範囲にあることを判別して、に記χ、y11f
Iに対応(るエリアΔを検索したのら、ステップ52C
1’該エリアAでの適正初期値を読み出すことが繰返さ
れる。
いて上記さく凡慮情報の(χ、y)に含まれるエリアへ
の検索を行う。このエリアの検索は、第6図の1ノブル
ーチンに示づ”ように、ステップS28でχ値がiくχ
≦i+1(i=1〜n)の範囲にあることを判別し、か
つステップS2bでy値がj<y≦j→、1(j=i〜
11)の範囲にあることを判別して、に記χ、y11f
Iに対応(るエリアΔを検索したのら、ステップ52C
1’該エリアAでの適正初期値を読み出すことが繰返さ
れる。
次いで、メインフLJ−に戻って、第3ステツプS3に
おいて上記適正初期11口を用いてさく凡慮の値(χ、
y、z、φχ、φy、φZ)を漸近n1算法によりブー
ム座標系の値(θl 、 02 、θ(。
おいて上記適正初期11口を用いてさく凡慮の値(χ、
y、z、φχ、φy、φZ)を漸近n1算法によりブー
ム座標系の値(θl 、 02 、θ(。
θ4 、9S 、 9ex)に変換づ°る演算が(jわ
れる。
れる。
この演算は6元連立力程式に上記適正初期値を代入して
解の順化式を繰返してδ1粋づるもので、第4ステップ
54−(’解が正解誼に収束Jるのを侍って、第5ステ
ツプS5で正W?碩つまり上記さく凡慮の値に対応する
ブーム座標系の値(θ1.θ2゜03、θ4. js
、 9eX)を出力し、以後この舶を基にブーム駆動手
段17が上記さく凡慮に位置決めされるようフィードバ
ック制御される。
解の順化式を繰返してδ1粋づるもので、第4ステップ
54−(’解が正解誼に収束Jるのを侍って、第5ステ
ツプS5で正W?碩つまり上記さく凡慮の値に対応する
ブーム座標系の値(θ1.θ2゜03、θ4. js
、 9eX)を出力し、以後この舶を基にブーム駆動手
段17が上記さく凡慮に位置決めされるようフィードバ
ック制御される。
したがって、上記の如く、直角rト標系のh(1(χ。
y、z、φχ、φy、φZ)で与えられたさく凡慮Pの
情報を、漸近81障法を用いてブームの座標系の伯(θ
1.θ2.θ3.θ4.9s 、 9ax)に変換する
にあたり、切羽面Kにおけるブーム先端の移動領域を多
数のエリア△、Δ・・・に分割し、各エリアA毎に適正
初期値を記憶さけてJ3ぎ、上記さく凡慮P情報のχ、
y値によりそれに対応づ−るエリアへの適正初期値を検
索し、この適正初WJ埴を用いて上記漸近計算法の演算
を行゛)にうにしたので、その演算速度が速いものとな
り、ブームの位置決めが迅速にかつ正確に行われて、イ
の処理時間の短縮化を図ることができ、ひいてはさく孔
時間の短縮化を図ることができる4、シかも、各エリア
AfQに適正初期値が記憶されているので、岩盤の軟、
硬質などによるさく孔パターンの変更さく孔!I!置1
3の機種の変更等に対してし、一度適正初期値をめてお
けば対応でき、汎用性に浸れている。
情報を、漸近81障法を用いてブームの座標系の伯(θ
1.θ2.θ3.θ4.9s 、 9ax)に変換する
にあたり、切羽面Kにおけるブーム先端の移動領域を多
数のエリア△、Δ・・・に分割し、各エリアA毎に適正
初期値を記憶さけてJ3ぎ、上記さく凡慮P情報のχ、
y値によりそれに対応づ−るエリアへの適正初期値を検
索し、この適正初WJ埴を用いて上記漸近計算法の演算
を行゛)にうにしたので、その演算速度が速いものとな
り、ブームの位置決めが迅速にかつ正確に行われて、イ
の処理時間の短縮化を図ることができ、ひいてはさく孔
時間の短縮化を図ることができる4、シかも、各エリア
AfQに適正初期値が記憶されているので、岩盤の軟、
硬質などによるさく孔パターンの変更さく孔!I!置1
3の機種の変更等に対してし、一度適正初期値をめてお
けば対応でき、汎用性に浸れている。
尚、本発明のさく孔装置の制御シスフl\は、上記実施
例の如きトンネル掘さく用に限らず、その他各種掘さく
において切羽面にさく孔を行う場合に適用でき、またそ
の地条関節のブーム構造を持つものにも同様に適用でき
るものである。
例の如きトンネル掘さく用に限らず、その他各種掘さく
において切羽面にさく孔を行う場合に適用でき、またそ
の地条関節のブーム構造を持つものにも同様に適用でき
るものである。
第1図は本発明の構成を示すブロック図、第2図〜第7
図は本発明の実施例を示し、第2図1よ全体概略構成図
、第3図はさく孔装置を乗架したブームの動ぎを示づ説
明図、第4図1よマイク]」コンピュータの内部構成を
示すブロック図、第5図IJマイクロコンピュータのメ
インフ1」−を示づフ【」−チャート図、第6図は同エ
リア検索サブルーチンを示り゛フローチャート図、第7
図はブーlX移Eh領域のエリア分割状態の一例を承り
シ1明図である。 4・・・ブーム、13・・・さく孔装置、17・・ブー
ム駆動手段、18・・・位置決めザーボ制御手段、19
・・・検出部、21・・・マイク1」コンビ」−夕、2
2・・・第1メモリ一手段、23・・・第2メモリー丁
段、24・・・検索手段、25・・・演算手段、27・
・・ノイードバック手段、28・・・中火処理手段。 jar’s′−−二白
図は本発明の実施例を示し、第2図1よ全体概略構成図
、第3図はさく孔装置を乗架したブームの動ぎを示づ説
明図、第4図1よマイク]」コンピュータの内部構成を
示すブロック図、第5図IJマイクロコンピュータのメ
インフ1」−を示づフ【」−チャート図、第6図は同エ
リア検索サブルーチンを示り゛フローチャート図、第7
図はブーlX移Eh領域のエリア分割状態の一例を承り
シ1明図である。 4・・・ブーム、13・・・さく孔装置、17・・ブー
ム駆動手段、18・・・位置決めザーボ制御手段、19
・・・検出部、21・・・マイク1」コンビ」−夕、2
2・・・第1メモリ一手段、23・・・第2メモリー丁
段、24・・・検索手段、25・・・演算手段、27・
・・ノイードバック手段、28・・・中火処理手段。 jar’s′−−二白
Claims (1)
- (1) さく孔装置を乗架したブームを駆動づるブーム
駆動手段と、切羽面直前に直角座標系で与えられたさく
孔面上で設定される多数のさく凡慮の位置および方向を
該直角座標系の埴で記憶プ゛る第1メモリ一手段と、切
羽面におりるブームの移動領域を多数のエリアに分割し
、各エリア旬に適正初期値を上記直角座標系の値で記憶
する第2メモリ一手段と、上記第1メモリ一手段から与
えられるさく凡慮の情報ににり第2メモリ一手段の対応
するエリアにおける適正初期値を検索する検索手段と、
該検索手段により検索した適正初期値に基づいて上記第
1メモリ一手段から直角座標系で与えられるさく凡慮の
狛をブームの座標系で得られる値に演惇0換する演算手
段と、該1i1in手段からの餡に応じ1.1−記ブー
ム駆動手段を作動させる位置決めザーボ制御手段と、該
ブーム駆動手段の作動した値を検出する検出部を右し、
該検出部て゛検出した虻を上記位置決めり一−ボ制御手
段にフィードバックづるフィードバック手段ど、1記ブ
ー11駆動丁段上のさく孔装置を作動さU゛るさく孔装
置制御手段と、上記(3′/賀決め1ナ一ボ制御手段か
らの位置決め完了信号を受(プて上記さく孔装置G制御
丁段を作動さぜるどどもに、該さく孔菰置制1111丁
段からの作業終了(8号を受t]で上記第1メモリ一手
段に作動用の指令信号を出力りる中火処1!I+手段と
を備えたことを特徴とづるさく孔択?lの制御システム
。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP5679684A JPS60199193A (ja) | 1984-03-24 | 1984-03-24 | さく孔装置の制御システム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP5679684A JPS60199193A (ja) | 1984-03-24 | 1984-03-24 | さく孔装置の制御システム |
Publications (2)
Publication Number | Publication Date |
---|---|
JPS60199193A true JPS60199193A (ja) | 1985-10-08 |
JPH0138956B2 JPH0138956B2 (ja) | 1989-08-17 |
Family
ID=13037361
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP5679684A Granted JPS60199193A (ja) | 1984-03-24 | 1984-03-24 | さく孔装置の制御システム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS60199193A (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2017057708A (ja) * | 2015-09-17 | 2017-03-23 | 鹿島建設株式会社 | トンネル切羽前方の地山評価方法及びシステム |
-
1984
- 1984-03-24 JP JP5679684A patent/JPS60199193A/ja active Granted
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2017057708A (ja) * | 2015-09-17 | 2017-03-23 | 鹿島建設株式会社 | トンネル切羽前方の地山評価方法及びシステム |
Also Published As
Publication number | Publication date |
---|---|
JPH0138956B2 (ja) | 1989-08-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JPS60199194A (ja) | さく孔方法 | |
ES2785273T3 (es) | Vehículo minero y método para mover el brazo | |
US4343367A (en) | Drilling machine positioning arrangement | |
JPS58138894A (ja) | 自動さく孔制御装置 | |
AU2008240564A1 (en) | Method of directing drilling pattern in curved tunnels, rock drilling rig, and software product | |
JPS6126000B2 (ja) | ||
AU2008300440A1 (en) | Method and software product for designing drilling pattern for rock cavity excavation | |
JP5642652B2 (ja) | トンネル施工方法 | |
JPS60199193A (ja) | さく孔装置の制御システム | |
JPS6350514B2 (ja) | ||
JPS60203797A (ja) | さく孔方法 | |
JPH0410971B2 (ja) | ||
RU2800704C1 (ru) | Машина для инженерно-геологических работ и способ компенсации отклонения манипулятора указанной машины | |
RU2800704C9 (ru) | Машина для инженерно-геологических работ и способ компенсации отклонения манипулятора указанной машины | |
JPH0554560B2 (ja) | ||
JPH0617589B2 (ja) | 掘削機の制御装置 | |
JPS62202196A (ja) | さく孔装置のさし角表示装置 | |
JPH061666Y2 (ja) | さく孔制御装置 | |
JPS61117395A (ja) | さく岩機の芯出し装置 | |
JPH06102953B2 (ja) | さく孔機の位置決め補正方法 | |
JP2002097895A (ja) | 山岳トンネル用自動掘削装置 | |
JPS61216991A (ja) | さく岩機用ブ−ム位置決め装置 | |
Marian et al. | Inverse Kinematics Model of a Bucket Excavator’s Digging Equipment | |
JP2023034969A (ja) | 制御システム、制御方法および制御プログラム | |
JPH06313327A (ja) | 掘削作業機 |