JPH07291461A - Controlling method and device for continuous type unloader - Google Patents

Controlling method and device for continuous type unloader

Info

Publication number
JPH07291461A
JPH07291461A JP8897094A JP8897094A JPH07291461A JP H07291461 A JPH07291461 A JP H07291461A JP 8897094 A JP8897094 A JP 8897094A JP 8897094 A JP8897094 A JP 8897094A JP H07291461 A JPH07291461 A JP H07291461A
Authority
JP
Japan
Prior art keywords
teaching
coordinates
unit
correction
scraping
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
JP8897094A
Other languages
Japanese (ja)
Other versions
JP3491332B2 (en
Inventor
Toru Hayashi
亨 林
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.)
IHI Corp
Original Assignee
IHI Corp
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 IHI Corp filed Critical IHI Corp
Priority to JP8897094A priority Critical patent/JP3491332B2/en
Publication of JPH07291461A publication Critical patent/JPH07291461A/en
Application granted granted Critical
Publication of JP3491332B2 publication Critical patent/JP3491332B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Abstract

PURPOSE:To shorten the time required to perform playback process without changing the teaching process. CONSTITUTION:In the teaching process (Step S1), the positions of the raking part to be moved along the desired path by manual operation are detected at certain intervals, and a string of coordinates formed by laying in alignment the coordinates representing these positions in the sequence they are detected, is stored. This is followed by a correction process (Step S2) in which the coordinates are corrected so that the teaching path represented by the string of coordinates becomes smooth. Then a playback process (Step S3) is conducted, in which the raking part is moved automatically along the teaching path, and the load in a ship hold is raked by a plurality of baskets and landed.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【産業上の利用分野】本発明は、ティーチング/プレー
バック方式の連続式アンローダの制御方法およびその装
置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a teaching / playback type continuous unloader control method and apparatus.

【0002】[0002]

【従来の技術】アンローダは、例えば、鉱石、石炭、穀
物等の積荷を、船の船倉(ホールド部)6から陸揚げす
る場合に使用されるものであり、その全体構成の一例を
図7に示す。この図に示すアンローダは、荷積み/陸揚
げ場である埠頭に走行自在に設けられた走行部1と、こ
の走行部1に旋回自在かつ起伏自在に設けられたブーム
2と、このブーム2の先端部に設けられたトップ支持フ
レーム3に旋回自在に支承されるとともに鉛直方向に垂
下された旋回マスト4と、この旋回マスト4の下端部に
設けられる掻取部5とから主に構成される。
2. Description of the Related Art An unloader is used, for example, when unloading a load of ore, coal, grain, etc. from a hold (hold section) 6 of a ship, and an example of its entire structure is shown in FIG. . The unloader shown in this figure is provided with a traveling unit 1 provided for traveling freely on a wharf which is a loading / unloading site, a boom 2 provided for swinging and undulating on the traveling unit 1, and a tip of the boom 2. The swinging mast 4 is rotatably supported by a top support frame 3 provided on the upper portion of the swinging mast 4 and is vertically suspended, and a scraping portion 5 provided at a lower end of the swinging mast 4 is mainly configured.

【0003】この図に示すアンローダは、一般にチェー
ンバケット式アンローダと呼ばれるものであり、複数の
バケットが取り付けられたエンドレスチェーンが旋回マ
スト4上部と掻取部5外周とを回遊して敷設され、掻取
部5底部に位置するバケットが船倉6内の積荷を掻き取
り、被掻取積荷を旋回マスト4上部へ搬送する。そし
て、被掻取積荷は、ブーム2、走行部1を介して陸揚げ
される。この際、掻取作業は、船倉6内の積荷の上面が
略水平となるように、積荷の上層から順に行われる必要
がある。
The unloader shown in this figure is generally called a chain bucket type unloader, and an endless chain having a plurality of buckets attached thereto is laid around the upper part of the swivel mast 4 and the outer periphery of the scraping part 5 to scrape it. A bucket located at the bottom of the picking section 5 scrapes the cargo in the cargo hold 6 and conveys the scraped cargo to the upper part of the turning mast 4. Then, the scraped load is unloaded via the boom 2 and the traveling unit 1. At this time, the scraping work needs to be sequentially performed from the upper layer of the cargo so that the upper surface of the cargo in the hold 6 becomes substantially horizontal.

【0004】ところで、この種のアンローダは、諸事情
により、単位時間あたりの移載量が船倉6の大きさに対
して小である場合が多く、陸揚げ作業に極めて長い時間
を要する。このため、制御装置により制御され、陸揚げ
作業を自動的に連続して行うティーチング/プレーバッ
ク方式の連続式アンローダが開発されている。この連続
式アンローダは、ティーチング工程においては、手動運
転されるとともに、当該各部の位置や旋回角度等を検出
し、掻取部5の軌跡や旋回マスト4の旋回角度等からな
る運転情報を記憶する。
By the way, in this kind of unloader, the transfer amount per unit time is often small with respect to the size of the hold 6, due to various circumstances, and it takes a very long time for the landing work. For this reason, a teaching / playback type continuous unloader has been developed which is controlled by a control device and automatically and continuously performs landing work. In the teaching process, this continuous unloader is manually operated, detects the position of each part, the turning angle, etc., and stores the operation information including the trajectory of the scraping unit 5, the turning angle of the turning mast 4, and the like. .

【0005】連続式アンローダの制御装置において、運
転情報中の掻取部5の軌跡は、通常、1cm〜数cm間
隔の点の順列として表され、各点の座標を検出順に整列
してなる座標列が制御装置に記憶される。なお、各点の
間隔(1cm〜数cm)は、実用上必要な精度と、想定
される軌跡の長さと、運転情報を記憶するために割り当
てられたメモリ容量とに基づいて決定される。
In the controller of the continuous unloader, the locus of the scraping section 5 in the operation information is usually expressed as a permutation of points at intervals of 1 cm to several cm, and the coordinates of each point are arranged in the order of detection. The column is stored in the controller. The distance between each point (1 cm to several cm) is determined based on the accuracy required for practical use, the length of the expected trajectory, and the memory capacity assigned to store the driving information.

【0006】ここで、掻取部5の軌跡の一例を図8に示
す。この図に示すように、連続式アンローダ各部は、掻
取部5の先端部5aおよび後端部5bが、本来得られる
べき理想経路LA,LBに沿って移動するよう手動運転
される。連続式アンローダ各部は、その長さが数m〜数
十mに渡るものもあるため、船倉6内の積荷の状態等に
より、各部が僅かに撓んだり捻れたりすることがある。
したがって、ティーチング工程において掻取部5を滑ら
かに移動させようとしても、その軌跡には僅かなブレが
発生することが多々ある。
Here, an example of the trajectory of the scraping section 5 is shown in FIG. As shown in this figure, each part of the continuous unloader is manually operated so that the front end part 5a and the rear end part 5b of the scraping part 5 move along the ideal paths LA and LB that should be originally obtained. Since each part of the continuous unloader has a length of several meters to several tens of meters, each part may be slightly bent or twisted depending on the state of the cargo in the hold 6.
Therefore, even if the scraping unit 5 is smoothly moved in the teaching process, a slight blur often occurs on the locus.

【0007】例えば、図8において、掻取部5の先端部
5aの軌跡を表す各点AP1〜AP11のうち、点AP
6は、理想経路LAから数cm逸れている。同様に、点
BP6は、理想経路LBから数cm逸れている。しかし
ながら、通常、数cm程度のブレは許容範囲とされ、各
点AP1,AP2,…からなる経路LA’と、各点BP
1,BP2,…からなる経路LB’とが、それぞれティ
ーチング経路とされる。ティーチング工程は、船倉6内
の積荷を1層だけ陸揚げするのに必要な運転情報が記憶
された時点で終了する。
For example, in FIG. 8, a point AP among points AP1 to AP11 representing the locus of the tip 5a of the scraping section 5 is shown.
No. 6 deviates from the ideal route LA by several cm. Similarly, the point BP6 deviates from the ideal path LB by several cm. However, normally, a blur of about several cm is considered to be within an allowable range, and a path LA ′ including each point AP1, AP2, ... And each point BP.
A route LB 'composed of 1, BP2, ... Is respectively a teaching route. The teaching process ends when the operation information necessary for landing only one layer of the cargo in the hold 6 is stored.

【0008】そして、操作者が、連続式アンローダ各部
をティーチング工程開始時点と同様な状態とした後、プ
レーバック工程が開始される。当該工程では、まず、制
御装置が掻取部5を所定距離だけ降下させて船倉6内の
積荷に差し入れる。そして、制御装置は、記憶した運転
情報に応じて、ティーチング工程における動作を再現す
べく連続式アンローダ各部を制御する。これにより、掻
取部5は、制御装置に記憶された座標列に表されるティ
ーチング経路に沿って移動し、最上層の積荷が陸揚げさ
れる。こうした処理が繰り返され、最終的には全ての積
荷が陸揚げされてプレーバック工程が終了する。
Then, after the operator sets each part of the continuous unloader to the same state as at the time of starting the teaching process, the playback process is started. In this step, first, the control device lowers the scraping unit 5 by a predetermined distance and inserts it into the cargo in the hold 6. Then, the control device controls each part of the continuous unloader to reproduce the operation in the teaching process according to the stored operation information. As a result, the scraping unit 5 moves along the teaching path represented by the coordinate sequence stored in the control device, and the uppermost cargo is unloaded. This process is repeated until all the cargo is unloaded and the playback process ends.

【0009】[0009]

【発明が解決しようとする課題】上述したように、従来
の連続式アンローダの制御方法または装置では、掻取部
5のティーチング経路LA’,LB’が、理想経路L
A,LBから僅かに逸れることが多々ある。ティーチン
グ経路LA’またはLB’を表す各点の逸れ方は、その
際に各部にかかる負荷等に応じて決まるため、単に理想
経路LAまたはLBと直交する方向へ逸れるだけではな
く、場合によっては、点AP6のように理想経路LAに
対して鋭角をなすように逸れる場合もある。このような
逸れ方の点AP6の座標が制御装置に記憶された座標列
中に含まれている場合、当該座標列で表されるティーチ
ング経路LA’,LB’に沿って掻取部5を移動させる
プレーバック工程では、掻取部5が点AP6を通過する
よう連続式アンローダ各部の動作方向を大幅に変更する
必要が生じる。
As described above, in the conventional control method or apparatus for the continuous unloader, the teaching paths LA 'and LB' of the scraping section 5 are the ideal paths L.
Often slightly deviates from A and LB. The deviation of each point representing the teaching path LA ′ or LB ′ is determined according to the load applied to each part at that time, so not only the deviation to the direction orthogonal to the ideal path LA or LB but also to some cases, In some cases, the point AP6 may deviate from the ideal path LA at an acute angle. When the coordinate of the point AP6 of such deviation is included in the coordinate sequence stored in the control device, the scraping unit 5 is moved along the teaching paths LA ′ and LB ′ represented by the coordinate sequence. In the playback process to be performed, it is necessary to significantly change the operation direction of each part of the continuous unloader so that the scraping part 5 passes the point AP6.

【0010】プレーバック工程において、連続式アンロ
ーダに上述したような大幅な動作方向変更を行わせる
と、アンローダ各部がティーチング経路から逸脱するこ
とが多々ある。この逸脱が許容範囲を超過した場合、プ
レーバック工程を一時中断し、所定の処理を行った後に
当該工程を再開するという一連の復帰処理を行う必要が
あり、プレーバック工程にかかる時間および手間が増大
するという問題がある。
In the playback process, when the continuous unloader is caused to change the operation direction as described above, each part of the unloader often deviates from the teaching path. If this deviation exceeds the allowable range, it is necessary to temporarily stop the playback process, perform a predetermined process, and then restart the process, which requires a time and labor required for the playback process. There is a problem of increasing.

【0011】また、一般に、連続式アンローダにおい
て、各部の動作方向を大幅に変更するためには、各部の
動作速度を大きく低下させる必要がある。すなわち、掻
取部5をティーチング経路LA’,LB’に追従させる
ための時間が長くなる。前述したように、プレーバック
工程では、ティーチング経路LA’,LB’への追従処
理を繰り返して行うため、ティーチング経路LA’,L
B’が、大幅な動作方向変更を伴う経路である場合、そ
の時間的損失は極めて大となる。したがって、ティーチ
ング経路LA’,LB’を表す座標列中の点AP6,B
P6に対応する座標を補正する必要がある。
Further, generally, in the continuous unloader, in order to largely change the operation direction of each part, it is necessary to greatly reduce the operation speed of each part. That is, the time for causing the scraping unit 5 to follow the teaching paths LA ′, LB ′ becomes long. As described above, in the playback process, the processing of following the teaching paths LA ', LB' is repeatedly performed, and thus the teaching paths LA ', L'
If B'is a path with a large change in direction of motion, its time loss is extremely large. Therefore, the points AP6 and B in the coordinate sequence representing the teaching paths LA 'and LB' are
It is necessary to correct the coordinates corresponding to P6.

【0012】ところで、ティーチング工程およびプレー
バック工程において、ティーチング経路LA’,LB’
は、水平方向の対角線が数m〜数十mとなる船倉6の側
壁を模式的に表す図形とともに、遠隔操作室の表示装置
に表示される。しかしながら、当該表示装置としては、
通常、9インチ程度の大きさの画面を有するディスプレ
イを使用しているため、掻取部5の軌跡に生じた数cm
程度のブレを、連続式アンローダの操作者が認識するこ
とは極めて困難である。
By the way, in the teaching process and the playback process, the teaching paths LA 'and LB' are used.
Is displayed on the display device in the remote control room together with a figure schematically showing the side wall of the hold 6 having a horizontal diagonal line of several meters to several tens of meters. However, as the display device,
Normally, since a display having a screen with a size of about 9 inches is used, several cm generated on the locus of the scraping unit 5
It is extremely difficult for the operator of the continuous unloader to recognize the degree of blurring.

【0013】このため、ティーチング工程において、大
幅な動作方向変更を招致するブレが看過され、当該ブレ
を含むティーチング経路(座標列)が記憶されてしま
う。また、仮に、操作者が掻取部5の軌跡におけるブレ
を認識したとしても、そのブレが大幅な動作方向変更を
招致するブレであるか否かを判断することは極めて困難
である。さらに、こうした判断をすることなく、ブレを
認識した時点で、即座にティーチング工程を中断し、正
しい軌跡を記憶し直すことも考えられるが、上述したよ
うに、ブレは多々発生するものであるため、極めて非効
率である。
Therefore, in the teaching process, a blur that causes a large change in the operation direction is overlooked, and the teaching path (coordinate sequence) including the blur is stored. Even if the operator recognizes a blur on the trajectory of the scraping unit 5, it is extremely difficult to determine whether or not the blur is a blur that causes a large change in the operation direction. Further, without making such a judgment, it is conceivable to immediately interrupt the teaching process and memorize the correct locus again when the blur is recognized, but as described above, the blur frequently occurs. , Very inefficient.

【0014】このように、従来の連続式アンローダの制
御装置では、操作者が視認困難なブレを解消する有効な
手法がなく、プレーバック工程の所要時間が長くなるの
を避けることができなかった。本発明は、上述した事情
に鑑みてなされたものであり、ティーチング工程を変更
することなく、プレーバック工程にかかる時間を短縮す
ることができる連続式アンローダの制御方法およびその
装置を提供することを目的とする。
As described above, in the conventional controller for the continuous unloader, there is no effective method for eliminating the blur which is difficult for the operator to visually recognize, and it is inevitable that the playback process takes a long time. . The present invention has been made in view of the above circumstances, and it is an object of the present invention to provide a control method and apparatus for a continuous unloader that can reduce the time required for a playback process without changing the teaching process. To aim.

【0015】[0015]

【課題を解決するための手段】請求項1に記載の連続式
アンローダの制御方法は、複数のバケットを周囲に沿っ
て回遊させる掻取部を船倉内に挿入し、ティーチング工
程においては手動運転により所望の経路で移動される前
記掻取部の位置を所定距離間隔で検出するとともに前記
位置を表す座標を検出順に整列してなる座標列を記憶
し、プレーバック工程においては前記座標列で表される
ティーチング経路に沿って前記掻取部を自動的に移動さ
せ、前記船倉内の積荷を前記複数のバケットによって掻
き取って陸揚げするティーチング/プレーバック方式の
連続式アンローダを制御する方法であって、前記ティー
チング工程と前記プレーバック工程との間に、前記ティ
ーチング経路が滑らかになるよう前記各座標を補正する
補正工程を行うことを特徴としている。また、請求項2
に記載の連続式アンローダの制御方法は、前記補正工程
では、前記座標列を構成する前記各座標を順次読み出
し、読み出した前記座標のうち、少なくとも3つの座標
に基づいて前記各座標を補正することを特徴としてい
る。請求項3に記載の連続式アンローダの制御装置は、
複数のバケットを周囲に沿って回遊させる掻取部を船倉
内に挿入し、ティーチング工程、補正工程、およびプレ
ーバック工程を順次行って前記船倉内の積荷を陸揚げす
るティーチング/プレーバック方式の連続式アンローダ
を制御する装置であって、操作者の操作内容に応じた指
令を出力する操作部と、ティーチング工程においては前
記指令に応じて移動する前記掻取部の位置を所定距離間
隔で検出して検出信号を出力する検出部と、前記指令に
応じて連続式アンローダ各部を制御するための制御信号
を出力するとともに、ティーチング工程においては前記
検出信号に基づいて前記掻取部の位置を表す位置情報を
出力する制御部と、ティーチング工程においては前記制
御部から供給される前記位置情報に対応する座標を供給
順に整列してなる座標列を記憶し、補正工程においては
前記座標列で表されるティーチング経路が滑らかになる
よう前記各座標を補正し、プレーバック工程においては
前記座標列に基づいて得られる運転情報を前記制御部へ
供給する処理部とを具備し、前記制御部は前記運転情報
に応じた制御信号を出力することを特徴としている。ま
た、請求項4に記載の連続式アンローダの制御装置は、
前記処理部は、補正工程においては、前記座標列を構成
する前記各座標を順次読み出すとともに、読み出した各
座標のうち、少なくとも3つの座標に基づいて前記各座
標を補正することを特徴としている。
According to a first aspect of the present invention, there is provided a continuous unloader control method, wherein a scraping section that causes a plurality of buckets to circulate along a circumference is inserted into a hold, and a manual operation is performed in a teaching process. The position of the scraping unit moved along a desired path is detected at predetermined distance intervals, and a coordinate sequence in which the coordinates representing the position are arranged in the order of detection is stored, and is represented by the coordinate sequence in the playback process. A method for controlling a teaching / playback type continuous unloader for automatically moving the scraping unit along a teaching path according to the above, scraping the cargo in the hold by the plurality of buckets and landing. Performing a correction step between the teaching step and the playback step to correct each coordinate so that the teaching path becomes smooth. It is characterized. In addition, claim 2
In the control method of the continuous unloader described in [3], in the correction step, the respective coordinates forming the coordinate sequence are sequentially read, and the respective coordinates are corrected based on at least three of the read coordinates. Is characterized by. The control device for the continuous unloader according to claim 3,
A continuous teaching / playback method in which a scraping unit that allows multiple buckets to circulate along the circumference is inserted into the hold, and the teaching process, the correction process, and the playback process are sequentially performed to unload the cargo in the hold. A device for controlling an unloader, which detects a position of an operation unit that outputs a command according to an operation content of an operator and a position of the scraping unit that moves according to the command at a predetermined distance interval in a teaching process. A detection unit that outputs a detection signal and a control signal for controlling each unit of the continuous unloader according to the command, and position information indicating the position of the scraping unit based on the detection signal in the teaching process. And a coordinate corresponding to the position information supplied from the controller in the teaching process are arranged in the supply order. A mark is stored, and in the correction step, each of the coordinates is corrected so that the teaching path represented by the coordinate series is smoothed, and in the playback step, the operation information obtained based on the coordinate series is used by the control unit. And a processing unit that supplies the control signal to the control information according to the operation information. Further, the control device of the continuous unloader according to claim 4,
In the correction step, the processing unit sequentially reads each of the coordinates forming the coordinate sequence, and corrects each of the coordinates based on at least three of the read coordinates.

【0016】[0016]

【作用】上記方法または装置によれば、ティーチング工
程とプレーバック工程との間に、ティーチング経路が滑
らかになるよう、ティーチング経路を表す座標列を構成
する各座標を補正する補正工程を行うため、前記ティー
チング経路に連続式アンローダ各部を追従させるプレー
バック工程において、連続式アンローダ各部は滑らかな
軌跡を描くよう作動する。すなわち、ティーチング工程
を変更することなく、プレーバック工程にかかる時間が
短縮される。
According to the above method or apparatus, the correction step is performed between the teaching step and the playback step so as to correct each coordinate forming the coordinate sequence representing the teaching path so that the teaching path becomes smooth. In the playback process in which each part of the continuous unloader follows the teaching path, each part of the continuous unloader operates so as to draw a smooth trajectory. That is, the time required for the playback process is shortened without changing the teaching process.

【0017】[0017]

【実施例】以下、図面を参照して、本発明の一実施例に
ついて説明する。図1は、本発明の一実施例による連続
式アンローダの制御方法を説明するための処理図であ
る。この図に示すように、本実施例による連続式アンロ
ーダの制御方法は、ステップS1のティーチング工程、
ステップS2の補正工程、ステップS3のプレーバック
工程から構成される。各ステップS1,S3は、従来と
同様な処理を行うため、その説明を省略し、以下、ステ
ップS2の補正工程について、図2を参照して説明す
る。なお、本実施例は、ティーチング経路を一致させる
べき理想経路が、滑らかな直線または曲線である場合に
のみ適用されるものである。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An embodiment of the present invention will be described below with reference to the drawings. FIG. 1 is a processing diagram for explaining a control method of a continuous unloader according to an embodiment of the present invention. As shown in this figure, the control method of the continuous unloader according to the present embodiment is the teaching process of step S1,
The correction process of step S2 and the playback process of step S3 are included. Since each of steps S1 and S3 performs the same processing as the conventional one, the description thereof will be omitted, and the correction step of step S2 will be described below with reference to FIG. It should be noted that the present embodiment is applied only when the ideal path for which the teaching paths are to be matched is a smooth straight line or curved line.

【0018】図2は、補正工程で行われる処理の流れを
示すフローチャートであり、この図に示す各処理は、連
続式アンローダの制御装置により行われる。ここでは、
補正工程の説明に先だって、連続式アンローダの制御装
置について、図3を参照して説明する。図3は、連続式
アンローダの制御装置の一例を示すブロック図であり、
この図に示す構成の制御装置は、操作者の指示に応じ
て、ティーチング工程、補正工程、およびプレーバック
工程を行うように作動する。なお、本実施例が適用され
る連続式アンローダの構成は、図3に示す制御装置を除
いて、図7に示す連続式アンローダと同一であるものと
する。
FIG. 2 is a flow chart showing the flow of processing performed in the correction step, and each processing shown in this figure is performed by the control device of the continuous unloader. here,
Prior to the description of the correction process, the control device of the continuous unloader will be described with reference to FIG. FIG. 3 is a block diagram showing an example of a control device of a continuous unloader,
The control device having the configuration shown in this figure operates so as to perform the teaching process, the correction process, and the playback process in response to an instruction from the operator. The configuration of the continuous unloader to which this embodiment is applied is the same as that of the continuous unloader shown in FIG. 7, except for the control device shown in FIG.

【0019】図3において、K1 〜K6 は各々センサで
あり、センサK1 は走行部1の陸上での位置、センサK
2 はブーム2の旋回角度、センサK3 は旋回マスト4の
旋回角度、センサK4 は掻取部5の伸縮幅、センサK5
はブーム2の起伏角度、センサK6 は掻取部5の掻取面
5aの傾動角度を検出する。これらのセンサK1 〜K6
は一つの検出部を構成し、常時、あるいは所定時間間隔
で検出信号を出力する。
In FIG. 3, K1 to K6 are sensors, and the sensor K1 is the position of the traveling unit 1 on land and the sensor K.
2 is the swing angle of the boom 2, sensor K3 is the swing angle of the swing mast 4, sensor K4 is the expansion / contraction width of the scraping unit 5, and sensor K5.
Is the hoisting angle of the boom 2, and the sensor K6 detects the tilting angle of the scraping surface 5a of the scraping section 5. These sensors K1 to K6
Constitutes one detection unit and outputs a detection signal constantly or at predetermined time intervals.

【0020】また、C1 〜C6 は各々制御器であり、制
御器C1 は走行部1の走行動作、制御器C2 はブーム2
の旋回動作、制御器C3 は旋回マスト4の旋回動作、制
御器C4 は掻取部5の掻取部伸縮動作、制御器C5 はブ
ーム2の起伏動作、制御器C6 は掻取部5の掻取面5a
の傾動動作を制御する。これらの制御器C1 〜C6 は後
述する制御部7から供給される制御信号に応じて作動す
る。
Further, C1 to C6 are each a controller, the controller C1 is a traveling operation of the traveling unit 1, and the controller C2 is a boom 2
Of the swivel mast 4, the controller C4 of the scraping part 5 extending and retracting, the controller C5 of the boom 2 up and down, and the controller C6 of the scraping part 5. Chamfer 5a
Control the tilting motion of. These controllers C1 to C6 operate according to a control signal supplied from a control unit 7 which will be described later.

【0021】次に、8はCPU,ROM,RAM,各種
I/Oインタフェース等から構成される処理部、9は各
種表示ランプやCRT等の表示部である。10はハンド
ルやスライドスイッチ等の操作機器が設けられた操作部
であり、操作者に操作され、操作内容に応じた指令を制
御部7へ供給する。この操作部10には、図示を略す
が、ティーチング工程を開始するためのティーチング開
始釦、同工程を終了させるためのティーチング終了釦、
補正工程を開始するための補正開始釦、プレーバック工
程を開始させるためのプレーバック開始釦が設けられて
いる。
Next, 8 is a processing unit including a CPU, ROM, RAM, various I / O interfaces and the like, and 9 is a display unit such as various display lamps and CRT. Reference numeral 10 denotes an operation unit provided with an operation device such as a handle and a slide switch, which is operated by an operator and supplies a command according to the operation content to the control unit 7. Although not shown, the operation unit 10 includes a teaching start button for starting the teaching process, a teaching end button for ending the process,
A correction start button for starting the correction process and a playback start button for starting the playback process are provided.

【0022】制御部7は、例えば、内部に記憶されたプ
ログラムに応じて動作し、センサK1 〜K6 から供給さ
れる各検出信号に基づいて、連続式アンローダ各部の位
置情報を処理部8へ供給するとともに、当該位置情報と
予め設定されたしきい値情報とを比較し、比較結果に応
じた情報を処理部8および表示部9へ供給する。また、
制御部7は、操作部10から供給される指令に応じた運
転情報を処理部8へ供給する。
The control unit 7 operates, for example, according to a program stored therein, and supplies position information of each unit of the continuous unloader to the processing unit 8 based on each detection signal supplied from the sensors K1 to K6. At the same time, the position information is compared with preset threshold information, and information corresponding to the comparison result is supplied to the processing unit 8 and the display unit 9. Also,
The control unit 7 supplies the operation information according to the command supplied from the operation unit 10 to the processing unit 8.

【0023】処理部8は、操作部10のティーチング開
始釦が押下されてからティーチング終了釦が押下される
までのティーチング工程においては、制御部7から供給
される位置情報に表される座標を順次記憶し、操作部1
0のプレーバック開始釦が押下されて開始されるプレー
バック工程においては、記憶した座標列から順に座標を
読み出し、当該座標に基づいた運転情報を制御部7へ供
給する。制御部7は、処理部8から供給される運転情
報、または操作部10から供給される指令に応じた制御
信号を対応する制御器C1 〜C6 へ供給する。
In the teaching process from when the teaching start button of the operation unit 10 is pressed to when the teaching end button is pressed, the processing unit 8 sequentially sets the coordinates represented by the position information supplied from the control unit 7. Memorize and operation unit 1
In the playback process started by pressing the 0 playback start button, the coordinates are sequentially read from the stored coordinate sequence, and driving information based on the coordinates is supplied to the control unit 7. The control unit 7 supplies the control information corresponding to the operation information supplied from the processing unit 8 or the command supplied from the operation unit 10 to the corresponding controllers C1 to C6.

【0024】また、処理部8は、ティーチング/プレー
バック両工程において、座標列に応じた表示信号を表示
部9へ常時供給する。したがって、表示部9のCRTに
は、常時、アンローダ各部の状態と、ティーチング経路
が図形表示されている。また、表示部9の各種表示ラン
プは、例えば、制御部7から供給される各部の状態を表
す情報に応じて点灯する。操作者は表示部9を視認しつ
つ、操作部10を操作して連続式アンローダを作動させ
る。
Further, the processing section 8 constantly supplies a display signal corresponding to the coordinate sequence to the display section 9 in both the teaching / playback process. Therefore, the CRT of the display unit 9 constantly displays the state of each unit of the unloader and the teaching path in graphic form. Further, the various display lamps of the display unit 9 are turned on, for example, according to the information indicating the state of each unit supplied from the control unit 7. The operator operates the operation unit 10 to operate the continuous unloader while visually recognizing the display unit 9.

【0025】次に、再び図2を参照して、上述した構成
の制御装置において為される補正工程について説明す
る。なお、この図に示す各処理は、上述した制御装置の
処理部8により為されるものであるため、特に断らない
限り、処理の主体を処理部8のCPUとする。
Next, referring again to FIG. 2, the correction process performed in the control device having the above-described configuration will be described. Since each processing shown in this figure is performed by the processing unit 8 of the above-described control device, the main body of the processing is the CPU of the processing unit 8 unless otherwise specified.

【0026】ティーチング工程が終了し、処理部8にテ
ィーチング経路を表す座標列が記憶された状態で、操作
部10の補正開始釦が押下されると、処理はステップS
4へ進む。ステップS4では、まず、初期設定が行われ
る。具体的には、座標列中の先頭座標、および後続する
座標をRAMから読み出す。例えば、図8に示す点AP
1,AP2,…に対応した座標列が記憶されている場合
には、点AP1に対応する座標、および点AP2に対応
する座標が順に読み出される。
When the correction start button of the operation unit 10 is pressed while the teaching process is completed and the coordinate sequence representing the teaching path is stored in the processing unit 8, the process proceeds to step S.
Go to 4. In step S4, first, initial setting is performed. Specifically, the leading coordinates and the following coordinates in the coordinate sequence are read from the RAM. For example, the point AP shown in FIG.
When the coordinate sequence corresponding to 1, AP2, ... Is stored, the coordinate corresponding to the point AP1 and the coordinate corresponding to the point AP2 are sequentially read.

【0027】読み出された座標は、図4(a)に示すよ
うに、RAMの所定領域に書き込まれる。この際、RA
Mの他の領域には、点BP1,BP2,…に対応した座
標や、その他のティーチング経路を構成する各点に対応
した座標が同様な形式で書き込まれる。ここでは、説明
が煩雑になるのを避けるために、理想経路LA(図8参
照)に関わる座標の補正処理についてのみ説明する。ま
た、図2のステップS4では、変数FLに0を代入す
る。この変数FLは、補正処理の内容を決定するための
変数であるので、以後、補正変数FLと称す。
The read coordinates are written in a predetermined area of the RAM, as shown in FIG. At this time, RA
In the other area of M, the coordinates corresponding to the points BP1, BP2, ... And the coordinates corresponding to the other points constituting the teaching path are written in the same format. Here, in order to avoid making the description complicated, only the correction processing of the coordinates related to the ideal route LA (see FIG. 8) will be described. Further, in step S4 of FIG. 2, 0 is assigned to the variable FL. Since this variable FL is a variable for determining the content of the correction process, it will be referred to as a correction variable FL hereinafter.

【0028】次に、ステップS5では、図4(a)に示
すようにRAMの所定領域に書き込まれた各座標(以
後、対象座標と称す)が、図4(b)に示すようにシフ
トされる。そして、シフトにより空いた領域に、に示す
ように、次の点AP3に対応した座標が書き込まれる
(図4(c)参照)。すなわち、3つの点AP1〜AP
3の座標が対象座標となる。なお、図4(a)〜図4
(c)に示す領域は、少なくとも3つの点に対応した座
標を記憶できるよう確保されている。
Next, in step S5, each coordinate (hereinafter referred to as target coordinate) written in a predetermined area of the RAM as shown in FIG. 4A is shifted as shown in FIG. 4B. It Then, as shown in, the coordinates corresponding to the next point AP3 are written in the area vacated by the shift (see FIG. 4C). That is, the three points AP1 to AP
The coordinates of 3 are the target coordinates. 4 (a) to FIG.
The area shown in (c) is ensured so that the coordinates corresponding to at least three points can be stored.

【0029】次に、図2のステップS6では、対象座標
の3つの点がなす2つの角のうち、小なる角θ(図8参
照,0≦θ≦180゜)が90゜未満であるか否かが判
断される。上記3つの点が、点AP1〜AP3である場
合、図8から明かなように、そのなす角θは鈍角とな
る。すなわち、θ≧90゜となるため、当該ステップで
の判断結果は「No」となり、処理は図2のステップS
7へ進む。
Next, in step S6 of FIG. 2, is the smaller angle θ (see FIG. 8, 0 ≦ θ ≦ 180 °) of the two angles formed by the three points of the target coordinates less than 90 °? It is determined whether or not. When the above three points are points AP1 to AP3, the angle θ formed by them is an obtuse angle, as is clear from FIG. That is, since θ ≧ 90 °, the determination result in this step is “No”, and the processing is step S in FIG.
Proceed to 7.

【0030】ステップS7では、補正変数FLが「1」
以上であるか否かが判断される。ここでは、補正変数F
Lは「0」であるため、判断結果は「No」となり、処
理はステップS8へ進む。ステップS8では、最後の座
標がまだ読み出されていないか否か、すなわち、次に読
み出すべき座標が存在するか否かが判断される。この判
断結果が「No」である間、処理はステップS5に戻
る。ステップS5では、再び、対象座標がシフトされ、
後続する座標を含む3つの座標が対象座標となる。すな
わち、対象座標の3つの点がなす角θが90゜以上であ
る間、上述した処理が繰り返される。
In step S7, the correction variable FL is "1".
It is determined whether or not the above. Here, the correction variable F
Since L is "0", the determination result is "No", and the process proceeds to step S8. In step S8, it is determined whether the last coordinate has not been read yet, that is, whether there is a coordinate to be read next. While this determination result is "No", the process returns to step S5. In step S5, the target coordinates are shifted again,
Three coordinates including the subsequent coordinates are the target coordinates. That is, the processing described above is repeated while the angle θ formed by the three points of the target coordinates is 90 ° or more.

【0031】ところで、図4(d)に示すように、点A
P4〜AP6に対応した座標が対象座標である場合、図
2のステップS6での判断結果は、「Yes」となり、
処理はステップS9へ進む。ステップS9では、補正変
数FLが「1」以上であるか否かが判断される。ここで
は、補正変数FLが「0」であるため、当該判断結果は
「No」となり、処理はステップS10へ進む。
By the way, as shown in FIG.
When the coordinates corresponding to P4 to AP6 are the target coordinates, the determination result in step S6 of FIG. 2 is “Yes”,
The process proceeds to step S9. In step S9, it is determined whether the correction variable FL is "1" or more. Here, since the correction variable FL is "0", the determination result is "No", and the process proceeds to step S10.

【0032】ステップS10では、対象座標のうち、最
も早く読み出された座標(ここでは、点AP4に対応し
た座標)が、RAMの補正開始点領域(図示略)に上書
きされる。そして、次のステップS11では、補正変数
FLに「1」が加算される。その後、処理は前述したス
テップS8,S5を介してステップS6へ進む。再び、
ステップS6において、対象座標に対応する角度θが9
0゜未満であるか否かが判断される。この際、対象座標
は、図4(e)に示すように、点AP5〜AP7に対応
した座標となっており、対象座標がなす角θは、図8か
ら明らかなように、鋭角となる。したがって、当該ステ
ップでの判断結果は「Yes」となり、処理はステップ
S9へ進む。
In step S10, the coordinates read out earliest among the target coordinates (here, the coordinates corresponding to the point AP4) are overwritten in the correction start point area (not shown) of the RAM. Then, in the next step S11, "1" is added to the correction variable FL. Then, the process proceeds to step S6 via steps S8 and S5 described above. again,
In step S6, the angle θ corresponding to the target coordinate is 9
It is determined whether the angle is less than 0 °. At this time, the target coordinates are coordinates corresponding to the points AP5 to AP7 as shown in FIG. 4E, and the angle θ formed by the target coordinates is an acute angle as is clear from FIG. Therefore, the determination result in this step is “Yes”, and the process proceeds to step S9.

【0033】ここでは、補正変数FLは「1」であるた
め、ステップS9での判断結果が「Yes」となり、処
理はステップS12へ進む。ステップS12では、補正
変数FLが1であるか否かが判断される。上述したよう
に、この場合の補正変数FLは1であるため、当該判断
結果は「Yes」となり、処理はステップS13へ進
む。ステップS13では、対象座標のうち、最も早く読
み出された座標(ここでは、点AP5に対応した座標)
が、RAMの補正開始点領域に上書きされる。
Here, since the correction variable FL is "1", the determination result in step S9 is "Yes", and the process proceeds to step S12. In step S12, it is determined whether the correction variable FL is 1. As described above, since the correction variable FL in this case is 1, the determination result is “Yes”, and the process proceeds to step S13. In step S13, the coordinates read out earliest among the target coordinates (here, the coordinates corresponding to the point AP5).
Is overwritten in the correction start point area of the RAM.

【0034】次に、ステップS11では、補正変数FL
に「1」が加算され、処理は、ステップS8,S5を介
してステップS6へ進む。ここでは、図4(f)に示す
ように、対象座標は、点AP6〜AP8に対応した座標
となるため、そのなす角θは、図8から明らかなよう
に、鈍角となる。したがって、当該ステップでの判断結
果は「No」となり、処理はステップS7へ進む。
Next, in step S11, the correction variable FL
"1" is added to, and the process proceeds to step S6 via steps S8 and S5. Here, as shown in FIG. 4 (f), the target coordinates are the coordinates corresponding to the points AP6 to AP8, so the angle θ formed is an obtuse angle, as is apparent from FIG. Therefore, the determination result in this step is “No”, and the process proceeds to step S7.

【0035】ステップS7において、補正変数FLは
「2」であるため、判断結果が「Yes」となり、処理
はステップS14へ進む。ステップS14は、補正処理
を行うステップであり、現在の対象座標のうち、2番目
に早く読み出された座標(ここでは、点AP7に対応し
た座標)を補正終了点座標とするとともに、RAMの補
正開始点領域に記憶された座標を補正開始点座標(ここ
では、点AP5に対応した座標)とする。そして、図5
の拡大図に示すように、補正終了点座標と補正開始点座
標とを通る直線Lの方程式を算出し、両者を補間する点
の座標(一つあるいは複数)を求め、得られた座標を、
両者の間の領域に記憶する。
In step S7, since the correction variable FL is "2", the determination result is "Yes", and the process proceeds to step S14. Step S14 is a step of performing a correction process, in which the coordinates read out second earliest among the current target coordinates (here, the coordinates corresponding to the point AP7) are set as the correction end point coordinates, and are stored in the RAM. The coordinates stored in the correction start point area are set as the correction start point coordinates (here, the coordinates corresponding to the point AP5). And FIG.
As shown in the enlarged view of FIG. 5, the equation of the straight line L passing through the correction end point coordinates and the correction start point coordinates is calculated, the coordinates (one or more) of the points interpolating the two are calculated, and the obtained coordinates are
Store in the area between them.

【0036】例えば、点AP6に対応した座標に代え
て、点AP6’に対応した座標を記憶する。すなわち、
RAMに記憶された座標列に表される点は、「…,AP
5,AP6’,AP7,…」という並びになる。図5か
ら明かなように、上述した点の並びで表されるティーチ
ング経路TPは、大幅な動作方向変更を伴わない経路と
なる。
For example, instead of the coordinates corresponding to the point AP6, the coordinates corresponding to the point AP6 'are stored. That is,
The points represented in the coordinate sequence stored in the RAM are “..., AP
5, AP6 ', AP7, ... ". As is clear from FIG. 5, the teaching path TP represented by the above-mentioned array of points is a path that does not involve a significant change in the operation direction.

【0037】次に、処理は図2のステップS15へ進
み、補正変数FLに「0」が代入される。そして、処理
はステップS8へ進み、前述した場合と同様な処理が為
される。対象座標において、最も遅く読み出された座標
が、座標列中の最後の座標である場合、ステップS8で
の判断結果は「Yes」となり、処理はステップS16
へ進む。ステップS16では、補正変数FLが「0」で
あるか否かが判断される。この判断結果が「Yes」で
あれば、補正工程が終了する。
Next, the process proceeds to step S15 in FIG. 2 and "0" is substituted into the correction variable FL. Then, the process proceeds to step S8, and the same process as that described above is performed. In the target coordinates, when the latest read coordinate is the last coordinate in the coordinate sequence, the determination result in step S8 is “Yes”, and the process is step S16.
Go to. In step S16, it is determined whether the correction variable FL is "0". If the result of this determination is “Yes”, then the correction step ends.

【0038】逆に、補正変数FLが「0」でなければ、
ステップS16での判断結果が「No」となり、処理は
ステップS17へ進む。補正変数FLが「0」でないと
いうことは、現在の対象座標がなす角θが鋭角であるこ
とを意味しており、ステップS17では、補正処理が行
われる。ここで行われる補正処理は、最後の座標を補正
終了点座標とする点を除いて、ステップS14で為され
る補正処理と同様であるので、その説明を省略する。こ
のステップS17での処理が終了すると、補正工程が終
了する。
On the contrary, if the correction variable FL is not "0",
The determination result in step S16 is "No", and the process proceeds to step S17. The fact that the correction variable FL is not “0” means that the angle θ formed by the current target coordinates is an acute angle, and the correction process is performed in step S17. The correction process performed here is the same as the correction process performed in step S14 except that the last coordinate is the correction end point coordinate, and therefore the description thereof is omitted. When the processing in step S17 ends, the correction process ends.

【0039】ところで、上記説明では、対象座標がなす
角θが連続して90゜以上となる場合、および、当該角
θが連続して鋭角となる場合の処理について説明した
が、角θが一度だけ90゜以上となり、その直後に鈍角
となる場合の処理について、図2および図6を参照して
説明する。図2のステップS5において、対象座標が、
図6に示す点P1〜P3となる場合、対象座標がなす角
θの大きさαは、90゜未満となる。したがって、この
場合の処理は、図2のステップS6,S9,S10,S
11,S8を介してステップS5に戻る。この際、補正
開始点座標は、点P1に対応する座標となる。
By the way, in the above description, the processing in the case where the angle θ formed by the target coordinates is continuously 90 ° or more and the case where the angle θ is continuously acute is described. The process in the case where the angle becomes 90 ° or more and the angle becomes an obtuse angle immediately thereafter will be described with reference to FIGS. 2 and 6. In step S5 of FIG. 2, the target coordinates are
In the case of the points P1 to P3 shown in FIG. 6, the size α of the angle θ formed by the target coordinates is less than 90 °. Therefore, the processing in this case is performed in steps S6, S9, S10, S in FIG.
11, the process returns to step S5 via S8. At this time, the correction start point coordinates are the coordinates corresponding to the point P1.

【0040】次に、ステップS5において、対象座標が
点P2〜P4(図6参照)に対応した座標となる。この
場合、対象座標がなす角θの大きさβは、鈍角となり、
処理は、ステップS6,S7,S14,S15を介して
ステップS8へ進む。この際、ステップS14において
補正処理が為されるが、上述したように、補正開始点座
標は点P1に対応する座標であるため、点P1に対応す
る座標と点P3に対応する座標とを通る直線から点P
2’が求められ、この点P2’に対応する座標が、点P
2に対応する座標に代えて記憶される。このように、対
象座標がなす角θが連続して鋭角になる場合と、一度だ
け鋭角になる場合とでは、為される処理が異なる。
Next, in step S5, the target coordinates become the coordinates corresponding to the points P2 to P4 (see FIG. 6). In this case, the size β of the angle θ formed by the target coordinates is an obtuse angle,
The process proceeds to step S8 via steps S6, S7, S14 and S15. At this time, the correction process is performed in step S14. As described above, since the correction start point coordinates are the coordinates corresponding to the point P1, the correction start point coordinates pass through the coordinates corresponding to the point P1 and the coordinates corresponding to the point P3. Straight line to point P
2 ′ is obtained, and the coordinates corresponding to this point P2 ′ are the points P
It is stored instead of the coordinate corresponding to 2. In this way, the processing to be performed differs depending on whether the angle θ formed by the target coordinates becomes a continuous acute angle or when the angle becomes a sharp angle only once.

【0041】次に、上述した補正工程を有する連続式ア
ンローダの制御方法について、図1を参照して説明す
る。この図に示すように、まず、操作者が操作部10
(図3参照)のティーチング開始釦を押下することによ
り、ステップS1のティーチング工程が行われる。この
ティーチング工程では、滑らかな理想経路に沿って掻取
部5が手動運転され、処理部8(図3参照)のRAM
に、ティーチング経路を表す座標列が記憶される。
Next, a control method of the continuous unloader having the above-mentioned correction process will be described with reference to FIG. As shown in this figure, first, the operator operates the operation unit 10
By pressing the teaching start button (see FIG. 3), the teaching process of step S1 is performed. In this teaching process, the scraping unit 5 is manually operated along the smooth ideal path, and the RAM of the processing unit 8 (see FIG. 3) is used.
A coordinate sequence representing the teaching path is stored in.

【0042】次に、操作者により、ティーチング終了釦
が押下され、さらに、補正開始釦が押下されると、処理
はステップS2の補正工程に進む。この補正工程では、
処理部8により、図2に示す処理が行われ、ティーチン
グ経路TPが滑らかになるよう(大幅な動作方向変更を
伴わないよう)座標列中の座標が補正される。次に、プ
レーバック開始釦が押下されると、処理部8は制御部7
へ座標列に基づいた運転情報を繰り返し供給し、制御部
7は、運転情報に応じた制御信号を制御器C1〜C6へ
供給する。こうして、船倉6内の積荷が自動的に陸揚げ
される。この際、座標列で表されるティーチング経路T
Pは、大幅な動作方向変更を伴わない滑らかな経路とな
るため、作動速度をさほど低下させることなく、連続式
アンローダ各部をティーチング経路に追従させることが
できる。
Next, when the operator presses the teaching end button and then the correction start button, the process proceeds to the correction step of step S2. In this correction process,
The processing unit 8 performs the processing shown in FIG. 2 and corrects the coordinates in the coordinate sequence so that the teaching path TP becomes smooth (without a large change in the operation direction). Next, when the playback start button is pressed, the processing unit 8 causes the control unit 7
The operation information based on the coordinate sequence is repeatedly supplied to the controller 7, and the control unit 7 supplies the control signals corresponding to the operation information to the controllers C1 to C6. In this way, the cargo in the hold 6 is automatically unloaded. At this time, the teaching path T represented by the coordinate sequence
Since P is a smooth path that does not involve a large change in the operation direction, each part of the continuous unloader can be made to follow the teaching path without significantly lowering the operating speed.

【0043】以上説明したように、3点の座標からなる
対象座標がなす角θに基づいて、補正開始点座標および
補正終了点座標を求め、両者を通る直線上の点に対応し
た座標を、大幅な動作方向変更を招致する点の座標に代
えて記憶するようにしたため、記憶された座標列で表さ
れるティーチング経路を滑らかな経路とすることができ
る。したがって、プレーバック工程における連続式アン
ローダ各部の逸脱の発生を抑制することができる。ま
た、作動速度をさほど低下させることなく、連続式アン
ローダ各部をティーチング経路に追従させることができ
る。
As described above, the correction start point coordinates and the correction end point coordinates are obtained based on the angle θ formed by the target coordinates composed of the three points, and the coordinates corresponding to the points on the straight line passing through the two are calculated. Since the coordinates are stored instead of the coordinates of the point that causes a large change in the operation direction, the teaching path represented by the stored coordinate sequence can be made smooth. Therefore, it is possible to suppress the occurrence of deviation of each part of the continuous unloader in the playback process. Further, each part of the continuous unloader can be made to follow the teaching path without significantly lowering the operating speed.

【0044】また、対象座標がなす角θが連続して鋭角
となる場合と、一度だけ鋭角となる場合とに応じて、補
正開始点座標を変更するようにしたため、より適切な補
正を行うことができる。さらに、座標列中の最後の座標
を含む対象座標がなす角θが鋭角である場合にも、ステ
ップS17で補正処理を行うようにしたため、確実に補
正処理を行うことができる。
Further, since the correction start point coordinate is changed depending on whether the angle θ formed by the target coordinates becomes an acute angle continuously or once, the correction start point coordinate is changed. You can Further, even when the angle θ formed by the target coordinates including the last coordinate in the coordinate sequence is an acute angle, the correction process is performed in step S17, so that the correction process can be reliably performed.

【0045】なお、上述した一実施例においては、説明
の煩雑化を避けるために、座標列を一系列とする例を示
したが、通常は、複数系列の座標列に対して上述した補
正工程を行うようにする。また、対象座標がなす角θの
許容角度を90゜としたが、これに限らず、必要に応じ
て許容角度を変更してもよい。さらに、本実施例では、
補正開始点座標および補正終了点座標を通る直線を求め
るようにしたが、これに限らず、公知の曲線補間を行う
ようにしてもよい。この際、補間に用いる曲線の傾き
は、補正開始点座標においては、補正開始点座標とその
直前の座標とを通る直線と一致し、補正終了点座標にお
いては、補正終了点座標とその直後の座標とを通る直線
と一致するよう設定される。
In addition, in the above-described embodiment, the example in which the coordinate series is one series is shown in order to avoid complication of the description, but normally, the above-described correction process is performed for a plurality of series of coordinate series. To do. Further, although the allowable angle of the angle θ formed by the target coordinates is 90 °, the allowable angle is not limited to this, and the allowable angle may be changed as necessary. Furthermore, in this embodiment,
Although the straight line passing through the correction start point coordinates and the correction end point coordinates is obtained, the present invention is not limited to this, and known curve interpolation may be performed. At this time, the slope of the curve used for interpolation coincides with the straight line passing through the correction start point coordinates and the coordinates immediately before it at the correction start point coordinates, and at the correction end point coordinates, the correction end point coordinates and immediately after that. It is set to match a straight line passing through the coordinates.

【0046】また、本実施例では、ティーチング経路を
一致させるべき理想経路が滑らかな直線または曲線とな
る場合に適用する例を示したが、予め、座標を補正する
区間を設定しておくことにより、理想経路に大幅な動作
方向変更がある場合にも適用可能である。さらに、本実
施例では、対象座標がなす角θに応じて、座標を補正す
べきか否かを判断するようにしたが、これに限らず、本
願明細書の要旨を変更しない範囲の手法を用いて、補正
を行うか否かの判断をするようにしてもよい。
In the present embodiment, an example is shown in which the ideal route to be matched with the teaching route is a smooth straight line or curved line. However, by setting a section for correcting the coordinates in advance, It is also applicable when there is a large change in the direction of movement of the ideal route. Further, in the present embodiment, whether or not the coordinates should be corrected is determined according to the angle θ formed by the target coordinates, but the present invention is not limited to this, and a method that does not change the gist of the specification of the present application is used. Then, it may be determined whether or not the correction is performed.

【0047】[0047]

【発明の効果】以上説明したように、本発明によれば、
ティーチング工程とプレーバック工程との間に、ティー
チング経路が滑らかになるよう、ティーチング経路を表
す座標列を構成する各座標を補正する補正工程を行うた
め、前記ティーチング経路に連続式アンローダ各部を追
従させるプレーバック工程において、連続式アンローダ
各部は滑らかな軌跡を描くよう作動する。したがって、
ティーチング工程を変更することなく、プレーバック工
程にかかる時間を短縮することができるという効果があ
る。
As described above, according to the present invention,
Between the teaching process and the playback process, a correction process is performed to correct each coordinate forming the coordinate sequence representing the teaching route so that the teaching route becomes smooth. Therefore, each part of the continuous unloader follows the teaching route. In the playback process, each part of the continuous unloader operates so as to draw a smooth trajectory. Therefore,
There is an effect that the time required for the playback process can be shortened without changing the teaching process.

【図面の簡単な説明】[Brief description of drawings]

【図1】本発明の一実施例による連続式アンローダの制
御方法を説明するための処理図である。
FIG. 1 is a processing diagram for explaining a control method for a continuous unloader according to an embodiment of the present invention.

【図2】同制御方法に含まれる補正工程を説明するため
のフローチャートである。
FIG. 2 is a flowchart for explaining a correction process included in the control method.

【図3】同制御方法を実現する連続式アンローダの制御
装置の概略構成を示すブロック図である。
FIG. 3 is a block diagram showing a schematic configuration of a control device of a continuous unloader that realizes the control method.

【図4】対象座標を説明するための概念図である。FIG. 4 is a conceptual diagram for explaining target coordinates.

【図5】補正処理を説明するための図である。FIG. 5 is a diagram for explaining a correction process.

【図6】補正処理を説明するための図である。FIG. 6 is a diagram for explaining a correction process.

【図7】一般的な連続式アンローダの構成例を示す図で
ある。
FIG. 7 is a diagram showing a configuration example of a general continuous unloader.

【図8】一般的なティーチング経路を説明するための図
である。
FIG. 8 is a diagram for explaining a general teaching path.

【符号の説明】[Explanation of symbols]

S1 ティーチング工程 S2 補正工程 S3 プレーバック工程 S1 Teaching process S2 Correction process S3 Playback process

Claims (4)

【特許請求の範囲】[Claims] 【請求項1】 複数のバケットを周囲に沿って回遊させ
る掻取部を船倉内に挿入し、ティーチング工程において
は手動運転により所望の経路で移動される前記掻取部の
位置を所定距離間隔で検出するとともに前記位置を表す
座標を検出順に整列してなる座標列を記憶し、プレーバ
ック工程においては前記座標列で表されるティーチング
経路に沿って前記掻取部を自動的に移動させ、前記船倉
内の積荷を前記複数のバケットによって掻き取って陸揚
げするティーチング/プレーバック方式の連続式アンロ
ーダを制御する方法であって、 前記ティーチング工程と前記プレーバック工程との間
に、前記ティーチング経路が滑らかになるよう前記各座
標を補正する補正工程を行うことを特徴とする連続式ア
ンローダの制御方法。
1. A scraping part for moving a plurality of buckets along the circumference is inserted into a hold, and in the teaching process, positions of the scraping part moved by a desired route by manual operation are set at predetermined distance intervals. A coordinate sequence formed by arranging the coordinates representing the position while detecting is stored, and in the playback step, the scraping unit is automatically moved along the teaching path represented by the coordinate sequence. A method for controlling a teaching / playback type continuous unloader for scraping cargo in a cargo hold by a plurality of buckets and landing the cargo, wherein the teaching path is smooth between the teaching step and the playback step. A method of controlling a continuous unloader, which comprises performing a correction step of correcting each coordinate so that
【請求項2】 前記補正工程では、前記座標列を構成す
る前記各座標を順次読み出し、読み出した前記座標のう
ち、少なくとも3つの座標に基づいて前記各座標を補正
することを特徴とする請求項1に記載の連続式アンロー
ダの制御方法。
2. In the correction step, the respective coordinates forming the coordinate sequence are sequentially read, and the respective coordinates are corrected based on at least three of the read coordinates. 2. The control method for the continuous unloader according to 1.
【請求項3】 複数のバケットを周囲に沿って回遊させ
る掻取部を船倉内に挿入し、ティーチング工程、補正工
程、およびプレーバック工程を順次行って前記船倉内の
積荷を陸揚げするティーチング/プレーバック方式の連
続式アンローダを制御する装置であって、 操作者の操作内容に応じた指令を出力する操作部と、 ティーチング工程においては前記指令に応じて移動する
前記掻取部の位置を所定距離間隔で検出して検出信号を
出力する検出部と、 前記指令に応じて連続式アンローダ各部を制御するため
の制御信号を出力するとともに、ティーチング工程にお
いては前記検出信号に基づいて前記掻取部の位置を表す
位置情報を出力する制御部と、 ティーチング工程においては前記制御部から供給される
前記位置情報に対応する座標を供給順に整列してなる座
標列を記憶し、補正工程においては前記座標列で表され
るティーチング経路が滑らかになるよう前記各座標を補
正し、プレーバック工程においては前記座標列に基づい
て得られる運転情報を前記制御部へ供給する処理部とを
具備し、 前記制御部は前記運転情報に応じた制御信号を出力する
ことを特徴とする連続式アンローダの制御装置。
3. A teaching / playing method in which a scraping unit that allows a plurality of buckets to circulate along the circumference is inserted into a hold, and a teaching process, a correction process, and a playback process are sequentially performed to unload a cargo in the hold. A device for controlling a back-type continuous unloader, in which the position of the operation unit that outputs a command according to the operation content of the operator and the position of the scraping unit that moves according to the command in the teaching process are set to a predetermined distance. A detection unit that outputs a detection signal by detecting at intervals, outputs a control signal for controlling each unit of the continuous unloader according to the command, and in the teaching process, the scraping unit of the scraping unit based on the detection signal. A control unit that outputs position information indicating a position, and a coordinate that corresponds to the position information supplied from the control unit in the teaching process. The coordinate sequence that is arranged in the coordinate sequence is stored, in the correction step, each of the coordinates is corrected so that the teaching path represented by the coordinate sequence is smoothed, and in the playback step, the operation obtained based on the coordinate sequence is performed. A processing unit for supplying information to the control unit, wherein the control unit outputs a control signal according to the operation information.
【請求項4】前記処理部は、補正工程においては、前記
座標列を構成する前記各座標を順次読み出すとともに、
読み出した各座標のうち、少なくとも3つの座標に基づ
いて前記各座標を補正することを特徴とする請求項3に
記載の連続式アンローダの制御装置。
4. The processing section, in the correction step, sequentially reads out each of the coordinates forming the coordinate sequence,
The control device for a continuous unloader according to claim 3, wherein the coordinates are corrected based on at least three of the read coordinates.
JP8897094A 1994-04-26 1994-04-26 Control method and device for continuous unloader Expired - Fee Related JP3491332B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP8897094A JP3491332B2 (en) 1994-04-26 1994-04-26 Control method and device for continuous unloader

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP8897094A JP3491332B2 (en) 1994-04-26 1994-04-26 Control method and device for continuous unloader

Publications (2)

Publication Number Publication Date
JPH07291461A true JPH07291461A (en) 1995-11-07
JP3491332B2 JP3491332B2 (en) 2004-01-26

Family

ID=13957677

Family Applications (1)

Application Number Title Priority Date Filing Date
JP8897094A Expired - Fee Related JP3491332B2 (en) 1994-04-26 1994-04-26 Control method and device for continuous unloader

Country Status (1)

Country Link
JP (1) JP3491332B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019107208A1 (en) * 2017-11-28 2019-06-06 川崎重工業株式会社 Method for controlling operation of working machine

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019107208A1 (en) * 2017-11-28 2019-06-06 川崎重工業株式会社 Method for controlling operation of working machine

Also Published As

Publication number Publication date
JP3491332B2 (en) 2004-01-26

Similar Documents

Publication Publication Date Title
KR20180071353A (en) Operation support device of working machine
JPH07291461A (en) Controlling method and device for continuous type unloader
JP2001240392A (en) Method and device for calculating deflection angle for boom working vehicle
JP2831929B2 (en) Teaching method of continuous unloader
JP5844172B2 (en) Crane system
JPH08245166A (en) Crane operating state display
JPH1017269A (en) Correcting method for automatic operating locus of continuous type unloader
JP5235115B2 (en) Operation equipment for aerial work platforms
JP3497044B2 (en) Excavation management system in shield method
JPH07291460A (en) Automatic operating device for continuous type unloader
JPS6156755B2 (en)
JPH0349159Y2 (en)
JPS63194030A (en) Controlling method and apparatus for service machine of power shovel
JPH07109368B2 (en) Current position display of mobile
JPH0758201B2 (en) Current position display of mobile
JP2919279B2 (en) Control method of continuous unloader
JP4199819B2 (en) Control device for telescopic boom type work machine
JP2657549B2 (en) Current position display device of moving object
JPH08301456A (en) Method and device for controlling operation of continuous unloader
JPH0826492A (en) Control method of continuous unloader and its device
JP2756090B2 (en) Control method of continuous unloader
JPH0647908Y2 (en) Aerial work vehicle
JPH11210020A (en) Automatically operated construction equipment
JPH10146108A (en) Posture controller of working machine in tractor
JPS6051224A (en) Displayer for regulating leader angle

Legal Events

Date Code Title Description
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20031014

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313113

R360 Written notification for declining of transfer of rights

Free format text: JAPANESE INTERMEDIATE CODE: R360

R371 Transfer withdrawn

Free format text: JAPANESE INTERMEDIATE CODE: R371

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313113

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20071114

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20081114

Year of fee payment: 5

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20091114

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20091114

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20101114

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20101114

Year of fee payment: 7

S533 Written request for registration of change of name

Free format text: JAPANESE INTERMEDIATE CODE: R313533

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20101114

Year of fee payment: 7

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

S531 Written request for registration of change of domicile

Free format text: JAPANESE INTERMEDIATE CODE: R313531

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20101114

Year of fee payment: 7

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20111114

Year of fee payment: 8

LAPS Cancellation because of no payment of annual fees